cs.RONov 18, 2026

Proprioceptive Simultaneous Base and Terrain Elevation Estimation for Legged Robot Locomotion

Authors: Michael Maravgakis, Stylianos Piperakis, Panos Trahanias

Organizations: Institute of Computer Science, Foundation for Research and Technology - Hellas (FORTH), Heraklion, Greece. · VinDynamics.

Abstract

Legged robots in visually degraded environments must rely exclusively on proprioceptive sensing, under which global position and yaw are unobservable. Vertical drift is particularly detrimental, as it corrupts the height reference required by swing-leg trajectories and can destabilize the robot. We treat the terrain itself as a persistent proprioceptive landmark: every footstep provides a height measurement that anchors the vertical axis. We propose Simultaneous Base and Elevation Estimation (SBEE), a real-time open-source framework in which a Left-Invariant Extended Kalman Filter (LI-EKF) for floating-base estimation and a grid-based elevation map are coupled in a bidirectional loop, mirroring SLAM with terrain elevation in place of landmarks. Stable foot contacts insert uncertainty-aware height samples into the map, and previously mapped cells are fed back as uncertainty-weighted vertical pseudo-measurements that act analogously to loop closures. Unlike contact-aided invariant filters, the LI-EKF consumes a kinematic velocity measurement instead of augmenting the state with a contact model per leg, so its state dimension is independent of the number of legs. We evaluate SBEE in MuJoCo on quadrupedal and bipedal platforms and on the ANYmal-D GrandTour dataset over 296 m of locomotion, reducing the absolute trajectory error by 22.1% relative to the best of three state-of-the-art proprioceptive estimators.

Figures & tables

Explore similar work

CardsList
  1. Towards Terrain-Aware Safe Locomotion for Quadrupedal Robots Using Proprioceptive Sensing

    Mar 10, 2026Peiyu Yang, Jiatao Ding, Wei Pan +2Terrain-Aware Robot LocomotionQuadruped Locomotion

  2. Four Simple Proprioceptive Estimators for Legged Robots

    May 21, 2026Frank Dellaert, Chiyun Noh, Varun Agrawal +1Robot State Estimation

  3. Contact-Anchored Proprioceptive Odometry for Legged and Wheel-Legged Robots

    Feb 19, 2026Minxing Sun, Yao MaoLegged RoboticsRobot State Estimation