Search papers, labs, and topics across Lattice.
This paper introduces FOCUS, a novel approach that predicts continuous foot kinematics reliability weights to enhance proprioceptive odometry in legged robots. By blending these reliability weights with IMU-propagated body velocity and adapting the observation covariance of an extended Kalman filter, FOCUS mitigates the drift associated with binary contact decisions during dynamic locomotion. The method significantly improves trajectory accuracy, achieving an 83.7% reduction in absolute trajectory error in simulations and a 70.8% reduction across real-world walking segments.
Continuous reliability weights for foot kinematics can slash trajectory errors by over 83% in dynamic locomotion scenarios.
Foot forward kinematics (FK) is widely used to improve proprioceptive legged odometry by providing reliable velocity constraints during foot support. Existing contact-aided estimators generally rely on binary contact decisions to determine whether the FK measurements of an entire foot should be trusted. However, contact does not necessarily imply FK reliability. Dynamic locomotion often involves partial support, toe dragging, and foot slip, causing binary contact decisions to accumulate significant drift over long trajectories. To address this limitation, we propose FOCUS (Foot Observation Confidence from Unannotated Simulation), which predicts a continuous FK reliability weight for each foot instead of estimating binary foot contact. Rather than replacing the model-based estimator, the predicted reliability weights are used to blend FK velocity observations with IMU-propagated body velocity and to adapt the observation covariance of an extended Kalman filter (EKF), enabling smooth reliability-aware fusion without hard contact switching. The network is trained from automatically generated simulation signals using an FK-weighted velocity consistency loss with lightweight simulator-contact regularization, without manually annotated continuous FK-reliability labels. The deployed model relies only on IMU and joint kinematic measurements, making it suitable for hardware platforms with unreliable torque sensing. Experiments demonstrate that FOCUS reduces absolute trajectory error (ATE) by 83.7% on simulated walking episodes, preserves simulated dynamic-motion fidelity in motion scale and spectral energy, reduces ATE by 70.8% across 19 real walking segments, and reduces mean ATE by 42.7% across four real dynamic-motion routines.
