On the Use of Torque Measurement in Centroidal State Estimation
Authors:
S. Khorshidi, A. Gazar, N. Rotella, M. Naveau, L. Righetti, M. Bennewitz, M. KhadivType:
Conference ProceedingPublished in:
IEEE International Conference on Robotics & Automation (ICRA)Year:
2023Links:
BibTex String
@inproceedings{khorshidi23icra,
title={On the Use of Torque Measurement in Centroidal State Estimation},
author={Khorshidi, Shahram and Gazar, Ahmad and Rotella, Nicholas and Naveau, Maximilien and Righetti, Ludovic and Bennewitz, Maren and Khadiv, Majid},
booktitle={Proc. of the IEEE International Conference on Robotics and Automation (ICRA)},
year={2023}
}
Abstract:
State-of-the-art legged robots are either capableof measuring torque at the output of their drive systems, orhave transparent drive systems which enable the computationof joint torques from motor currents. In either case, this sensormodality is seldom used in state estimation. In this paper,we propose to use joint torque measurements to estimate thecentroidal states of legged robots. To do so, we project thewhole-body dynamics of a legged robot into the nullspace ofthe contact constraints, allowing expression of the dynamics independent of the contact forces. Using the constrained dynamicsand the centroidal momentum matrix, we are able to directlyrelate joint torques and centroidal states dynamics. Using theresulting model as the process model of an Extended KalmanFilter (EKF), we fuse the torque measurement in the centroidalstate estimation problem. Through real-world experiments ona quadruped robot executing different gaits, we demonstratethat the estimated centroidal states from our torque-based EKFdrastically improve the recovery of these quantities comparedto direct computation.