Contact forces pre-integration for the whole body estimation of legged robots - LAAS - Laboratoire d'Analyse et d'Architecture des Systèmes Accéder directement au contenu
Communication Dans Un Congrès Année : 2021

Contact forces pre-integration for the whole body estimation of legged robots

Résumé

State estimation, in particular estimation of the base position, orientation and velocity, plays a big role in the efficiency of legged robot stabilization. The estimation of the base state is particularly important because of its strong correlation with the underactuated dynamics, i.e. the evolution of center of mass and angular momentum. Yet this estimation is typically done in two phases, first estimating the base state, then reconstructing the center of mass from the robot model. The underactuated dynamics is indeed not properly observed, and any bias in the model would not be corrected from the sensors. While it has already been observed that force measurements make such a bias observable, these are often only used for a binary estimation of the contact state. In this paper, we propose to simultaneously estimate the base and the underactuation state by using all measurements simultaneously. To this end, we propose several contributions to implement a complete state estimator using factor graphs. Contact forces altering the underactuated dynamics are pre-integrated using a novel adaptation of the IMU pre-integration method, which constitutes the principal contribution. IMU pre-integration is also used to measure the positional motion of the base. Encoder measurements are then participating to the estimation in two ways: by providing leg odometry displacements, contributing to the observability of IMU biases; and by relating the positional and centroidal states, thus connecting the whole graph and producing a tightly-coupled whole-body estimator. The validity of the approach is demonstrated on real data captured by the Solo12 quadruped robot.
Fichier principal
Vignette du fichier
ICRA_2021_MFourmy.pdf (2.51 Mo) Télécharger le fichier
Origine : Fichiers produits par l'(les) auteur(s)
Loading...

Dates et versions

hal-02991717 , version 1 (06-11-2020)

Identifiants

Citer

Mederic Fourmy, Thomas Flayols, Nicolas Mansard, Joan Solà. Contact forces pre-integration for the whole body estimation of legged robots. IEEE International Conference on Robotics and Automation - ICRA 2021, May 2021, Xi'an, China. ⟨10.1109/ICRA48506.2021.9561037⟩. ⟨hal-02991717⟩
383 Consultations
410 Téléchargements

Altmetric

Partager

Gmail Facebook X LinkedIn More