Legged Robot State Estimation With Dynamic Contact Event Information
- 30 June 2021
- journal article
- research article
- Published by Institute of Electrical and Electronics Engineers (IEEE) in IEEE Robotics and Automation Letters
- Vol. 6 (4) , 6733-6740
Abstract
This letter presents a state estimation algorithm for the legged robot by defining the problem as a Maximum A Posteriori (MAP) estimation problem and solving the problem with the Gauss-Newton algorithm. Moreover, marginalization by the Schur Complement method is adopted to make a fixed size problem. Each component of the cost function and its Jacobian are derived utilizing the SO(3) manifold structure, while we reparameterize the state with nominal state and variation to make linear algebra and vector calculus applied properly. Furthermore, a slip rejection method is proposed to reduce the erroneous effect of fault modeling of kinematics models. The proposed algorithm is verified by comparison with the Invariant Extended Kalman Filter (IEKF) in real robot experiments on various environments.Keywords
Funding Information
- Defense Challengeable Future Technology Program of Agency for Defense Development
- MIT Biomimetic Robotics Lab and Naver Labs Corporation
This publication has 19 references indexed in Scilit:
- VINS-Mono: A Robust and Versatile Monocular Visual-Inertial State EstimatorIEEE Transactions on Robotics, 2018
- Legged Robot State-Estimation Through Combined Forward Kinematic and Preintegrated Contact Factors2018
- Probabilistic foot contact estimation by fusing information from dynamics and differential/forward kinematics2016
- On-Manifold Preintegration for Real-Time Visual--Inertial OdometryIEEE Transactions on Robotics, 2016
- Drift-free humanoid state estimation fusing kinematic, inertial and LIDAR sensing2014
- State estimation for legged robots on unstable and slippery terrain2013
- State Estimation for Legged Robots - Consistent Fusion of Leg Kinematics and2012
- iSAM2: Incremental smoothing and mapping using the Bayes treeThe International Journal of Robotics Research, 2011
- An observability-constrained sliding window filter for SLAM2011
- Trust-Region Methods on Riemannian ManifoldsFoundations of Computational Mathematics, 2006