Legged Robot State Estimation With Dynamic Contact Event Information
Joon-Ha Kim, Seungwoo Hong, Gwanghyeon Ji, Seunghun Jeon, Jemin Hwangbo, Jun-Ho Oh, Hae-Won Park
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.
BibTeX
@inproceedings{ral2021_leggedrobotstate,
title = {Legged Robot State Estimation With Dynamic Contact Event Information},
author = {Joon-Ha Kim and Seungwoo Hong and Gwanghyeon Ji and Seunghun Jeon and Jemin Hwangbo and Jun-Ho Oh and Hae-Won Park},
booktitle = {RA-L 2021},
year = {2021}
}