Search papers, labs, and topics across Lattice.
This paper introduces an invariant extended Kalman filtering (InEKF) method for real-time state estimation of humanoid robots on non-inertial ground, utilizing only onboard proprioceptive sensors. The approach effectively estimates the robot's base position and velocity relative to a moving ground frame by leveraging kinematic constraints from foot-mounted IMUs, achieving significant improvements in convergence rates and position accuracy. Experimental results demonstrate a 96% speedup in convergence and an 80% reduction in position estimate errors compared to existing methods, showcasing the method's robustness in dynamic environments.
Humanoid robots can achieve real-time state estimation on moving ground with 80% less positional error using only onboard sensors.
This paper presents an invariant extended Kalman filtering (InEKF) approach for real-time state estimation of humanoid robots operating on non-inertial ground using only onboard proprioceptive sensing. The proposed approach estimates the robot's base position and velocity relative to the moving ground frame without requiring direct measurements of ground motion or externally mounted sensors. By exploiting kinematic constraints at the stance foot through foot-mounted IMUs, the filter accounts for ground-induced nonlinearities in the process and measurement models while remaining fully proprioceptive. The estimator is formulated to admit a right-invariant measurement model, enabling favorable error dynamics under large initial uncertainties. Observability analysis establishes conditions under which the robot's relative base position and velocity are observable with respect to the non-inertial ground frame. Experiments with the Digit humanoid robot standing and squatting atop a swaying and pitching ground showcase a 96% speedup in convergence rate and an 80% reduction in position estimate errors over existing InEKFs. Walking experiments on a uni-axially rotating ground achieve an average estimation error of less than 9 cm for an initial error of up to 1 m.
