Preintegrated Velocity Bias Estimation to Overcome Contact Nonlinearities in Legged Robot Odometry
Authors:
- 1 May 2020
- conference paper
- Published by Institute of Electrical and Electronics Engineers (IEEE)
- p. 392-398
Abstract
In this paper, we present a novel factor graph formulation to estimate the pose and velocity of a quadruped robot on slippery and deformable terrain. The factor graph introduces a preintegrated velocity factor that incorporates velocity inputs from leg odometry and also estimates related biases. From our experimentation we have seen that it is difficult to model uncertainties at the contact point such as slip or deforming terrain, as well as leg flexibility. To accommodate for these effects and to minimize leg odometry drift, we extend the robot’s state vector with a bias term for this preintegrated velocity factor. The bias term can be accurately estimated thanks to the tight fusion of the preintegrated velocity factor with stereo vision and IMU factors, without which it would be unobservable. The system has been validated on several scenarios that involve dynamic motions of the ANYmal robot on loose rocks, slopes and muddy ground. We demonstrate a 26% improvement of relative pose error compared to our previous work and 52% compared to a state-of-the-art proprioceptive state estimator.Keywords
All Related Versions
This publication has 12 references indexed in Scilit:
- Dynamic Locomotion on Slippery GroundIEEE Robotics and Automation Letters, 2019
- Iterated extended Kalman filter based visual-inertial odometry using direct photometric feedbackThe International Journal of Robotics Research, 2017
- Probabilistic Contact Estimation and Impact Detection for State Estimation of Quadruped RobotsIEEE Robotics and Automation Letters, 2017
- On-Manifold Preintegration for Real-Time Visual--Inertial OdometryIEEE Transactions on Robotics, 2016
- Design of a Momentum-Based Control Framework and Application to the Humanoid Robot AtlasInternational Journal of Humanoid Robotics, 2016
- The EuRoC micro aerial vehicle datasetsThe International Journal of Robotics Research, 2016
- Real-time pose estimation of a dynamic quadruped in GPS-denied environments for 24-hour operationThe International Journal of Robotics Research, 2015
- At all Costs: A Comparison of Robust Cost Functions for Camera Correspondence Outliers2015
- State estimation for legged robots on unstable and slippery terrain2013
- iSAM2: Incremental smoothing and mapping using the Bayes treeThe International Journal of Robotics Research, 2011