Lyapunov-Stable Orientation Estimator for Humanoid Robots

by   Mehdi Benallegue, et al.

In this paper, we present an observation scheme, with proven Lyapunov stability, for estimating a humanoid's floating base orientation. The idea is to use velocity aided attitude estimation, which requires to know the velocity of the system. This velocity can be obtained by taking into account the kinematic data provided by contact information with the environment and using the IMU and joint encoders. We demonstrate how this operation can be used in the case of a fixed or a moving contact, allowing it to be employed for locomotion. We show how to use this velocity estimation within a selected two-stage state tilt estimator: (i) the first which has a global and quick convergence (ii) and the second which has smooth and robust dynamics. We provide new specific proofs of almost global Lyapunov asymptotic stability and local exponential convergence for this observer. Finally, we assess its performance by employing a comparative simulation and by using it within a closed-loop stabilization scheme for HRP-5P and HRP-2KAI robots performing whole-body kinematic tasks and locomotion.


page 1

page 2

page 3

page 4

page 5

page 6

page 7

page 8


Robust Task-Space Quadratic Programming for Kinematic-Controlled Robots

Task-space quadratic programming (QP) is an elegant approach for control...

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

This paper presents a contact-aided inertial-kinematic floating base est...

Tilt estimator for 3D non-rigid pendulum based on a tri-axial accelerometer and gyrometer

The paper presents a new observer for tilt estimation of a 3-D non-rigid...

STEP: State Estimator for Legged Robots Using a Preintegrated foot Velocity Factor

We propose a novel state estimator for legged robots, STEP, achieved thr...

Optimization-Based Quadrupedal Hybrid Wheeled-Legged Locomotion

Hybrid wheeled-legged locomotion is a navigation paradigm only recently ...

Robust stability of moving horizon estimation for nonlinear systems with bounded disturbances using adaptive arrival cost

In this paper, the robust stability and convergence to the true state of...

Pedestrian orientation dynamics from high-fidelity measurements

We investigate in real-life conditions and with very high accuracy the d...

Please sign up or login with your details

Forgot password? Click here to reset