DILIGENT-KIO: A Proprioceptive Base Estimator for Humanoid Robots using Extended Kalman Filtering on Matrix Lie Groups

• Published in: 2021 IEEE International Conference on Robotics and Automation (ICRA) pp. 2904 - 2910
• Main Authors: Ramadoss, Prashanth, Romualdi, Giulio, Dafarra, Stefano, Andrade Chavez, Francisco Javier, Traversaro, Silvio, Pucci, Daniele
• Format: Conference Proceeding
• Language: English
• Published: IEEE 30-05-2021
• Subjects: Estimation; Filtering theory; Humanoid robots; Measurement units; Position measurement; Robot sensing systems; Uncertainty
• ISSN: 2577-087X
• DOI: 10.1109/ICRA48506.2021.9561248

This paper presents a contact-aided inertial-kinematic floating base estimation for humanoid robots considering an evolution of the state and observations over matrix Lie groups. This is achieved through the application of a geometrically meaningful estimator which is characterized by concentrated Gaussian distributions. The configuration of a floating base system like a humanoid robot usually requires the knowledge of an additional six degrees of freedom which describes its base position-and-orientation. This quantity usually cannot be measured and needs to be estimated. A matrix Lie group, encapsulating the position-and-orientation and linear velocity of the base link, feet positions-and-orientations and Inertial Measurement Units' biases, is used to represent the state while relative positions-and-orientations of contact feet from forward kinematics are used as observations. The proposed estimator exhibits fast convergence for large initialization errors owing to choice of uncertainty parametrization. An experimental validation is done on the iCub humanoid platform.