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

Abstract

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.

arXiv commentPublished in the proceedings of Robotics: Science and Systems 2018

References in corpus (10)

• VINS-Mono: A Robust and Versatile Monocular Visual-Inertial State Estimator
• On-Manifold Preintegration for Real-Time Visual-Inertial Odometry
• Quaternion kinematics for the error-state Kalman filter
• Non-linear Symmetry-preserving Observer on Lie Groups
• State Estimation for a Humanoid Robot
• An EKF-SLAM algorithm with consistency properties
• Contact-Aided Invariant Extended Kalman Filtering for Legged Robot State Estimation
• Hybrid Contact Preintegration for Visual-Inertial-Contact State Estimation Using Factor Graphs
• An Invariant-EKF VINS Algorithm for Improving Consistency
• The Convergence of the Extended Kalman Filter

Cited by in corpus (10)

• Bayesian Spatial Kernel Smoothing for Scalable Dense Semantic Mapping
• Contact-Aided Invariant Extended Kalman Filtering for Legged Robot State Estimation
• Hybrid Contact Preintegration for Visual-Inertial-Contact State Estimation Using Factor Graphs
• The Geometry of Navigation Problems
• Lyapunov-Stable Orientation Estimator for Humanoid Robots
• Efficient Anytime CLF Reactive Planning System for a Bipedal Robot on Undulating Terrain
• Adaptive Continuous Visual Odometry from RGB-D Images
• Continuous Direct Sparse Visual Odometry from RGB-D Images
• Invariant Smoothing for Localization: Including the IMU Biases
• HOPPY: An open-source and low-cost kit for dynamic robotics education