DeepAI AI Chat
Log In Sign Up

Contact-Aided Invariant Extended Kalman Filtering for Legged Robot State Estimation

05/26/2018
by   Ross Hartley, et al.
0

This paper derives a contact-aided inertial navigation observer for a 3D bipedal robot using the theory of invariant observer design. Aided inertial navigation is fundamentally a nonlinear observer design problem; thus, current solutions are based on approximations of the system dynamics, such as an Extended Kalman Filter (EKF), which uses a system's Jacobian linearization along the current best estimate of its trajectory. On the basis of the theory of invariant observer design by Barrau and Bonnabel, and in particular, the Invariant EKF (InEKF), we show that the error dynamics of the point contact-inertial system follows a log-linear autonomous differential equation; hence, the observable state variables can be rendered convergent with a domain of attraction that is independent of the system's trajectory. Due to the log-linear form of the error dynamics, it is not necessary to perform a nonlinear observability analysis to show that when using an Inertial Measurement Unit (IMU) and contact sensors, the absolute position of the robot and a rotation about the gravity vector (yaw) are unobservable. We further augment the state of the developed InEKF with IMU biases, as the online estimation of these parameters has a crucial impact on system performance. We evaluate the convergence of the proposed system with the commonly used quaternion-based EKF observer using a Monte-Carlo simulation. In addition, our experimental evaluation using a Cassie-series bipedal robot shows that the contact-aided InEKF provides better performance in comparison with the quaternion-based EKF as a result of exploiting symmetries present in the system dynamics.

READ FULL TEXT
04/19/2019

Contact-Aided Invariant Extended Kalman Filtering for Robot State Estimation

Legged robots require knowledge of pose and velocity in order to maintai...
06/29/2021

Deep Multi-Modal Contact Estimation for Invariant Observer Design on Quadruped Robots

This work reports on developing a deep learning-based contact estimator ...
03/13/2019

Exploiting Symmetries to Design EKFs with Consistency Properties for Navigation and SLAM

The Extended Kalman Filter (EKF) is both the historical algorithm for mu...
09/18/2019

Segmentation of Robot Movements using Position and Contact Forces

In this paper, a method for autonomous segmentation of demonstrated robo...
10/28/2022

KD-EKF: A Kalman Decomposition Based Extended Kalman Filter for Multi-Robot Cooperative Localization

This paper investigates the consistency problem of EKF-based cooperative...
03/01/2023

Probabilistic Contact State Estimation for Legged Robots using Inertial Information

Legged robot navigation in unstructured and slippery terrains depends he...
02/25/2022

On the Use of Torque Measurement in Centroidal State Estimation

State of the art legged robots are either capable of measuring torque at...