LIKO: LiDAR, Inertial, and Kinematic Odometry for Bipedal Robots

Qingrui Zhao,Mingyuan Li,Yongliang Shi,Xuechao Chen,Zhangguo Yu,Lianqiang Han,Zhenyuan Fu,Jintao Zhang,Chao Li,Yuanxi Zhang,Qiang Huang

2024-04-28

Abstract:High-frequency and accurate state estimation is crucial for biped robots. This paper presents a tightly-coupled LiDAR-Inertial-Kinematic Odometry (LIKO) for biped robot state estimation based on an iterated extended Kalman filter. Beyond state estimation, the foot contact position is also modeled and estimated. This allows for both position and velocity updates from kinematic measurement. Additionally, the use of kinematic measurement results in an increased output state frequency of about 1kHz. This ensures temporal continuity of the estimated state and makes it practical for control purposes of biped robots. We also announce a biped robot dataset consisting of LiDAR, inertial measurement unit (IMU), joint encoders, force/torque (F/T) sensors, and motion capture ground truth to evaluate the proposed method. The dataset is collected during robot locomotion, and our approach reached the best quantitative result among other LIO-based methods and biped robot state estimation algorithms. The dataset and source code will be available at

Robotics

What problem does this paper attempt to address?

### What problem does this paper attempt to solve?

This paper aims to address the following issues:

1. **High-precision state estimation**:
- Bipedal robots require high-frequency and precise state estimation for stable control. However, existing algorithms (such as those based on IMU, joint encoders, and contact sensors) tend to drift over long periods of operation.

2. **Utilization of environmental information**:
- To reduce positional drift and fully utilize environmental information, some bipedal robots are equipped with external sensors (such as stereo cameras and LiDAR). However, these sensors introduce significant computational load.

3. **Fusion of multiple sensor data**:
- Existing methods typically use loosely coupled approaches to fuse data from different sensors, which prevents online estimation of sensor parameters, thereby affecting the accuracy of state estimation.

To address the above issues, the authors propose a tightly coupled LiDAR-Inertial-Kinematic Odometry (LIKO) for high-frequency and precise state estimation of bipedal robots. Specifically, LIKO has the following features:
- **High-frequency updates**: By combining LiDAR, IMU, and leg kinematic measurements, it achieves an output frequency of approximately 1kHz.
- **Contact position estimation**: By using leg kinematic measurements, it estimates the contact position of the foot with the ground in real-time, improving the accuracy of linear velocity and position estimation.
- **Experimental validation**: The performance of LIKO is validated through hardware experiments and public datasets, showing a 14% improvement in accuracy over existing methods.

In summary, this paper aims to improve the accuracy and stability of state estimation for bipedal robots by tightly coupling multiple sensor data.