HR${2}$-KILO: A High-Rate, Robust, Kinematic-Inertial-LiDAR Odometry for Humanoid Robots
Jixin Gao, Fusheng Zha, Lianzhao Zhang, Wei Guo, Pengfei Wang, Lining Sun, Mantian Li
Abstract
In this letter, we present a high-rate and robust multi-sensor fusion framework for state estimation of humanoid robots, named HR<inline-formula xmlns:mml="http://www.w3.org/1998/Math/MathML" xmlns:xlink="http://www.w3.org/1999/xlink"><tex-math notation="LaTeX">$^{2}$</tex-math></inline-formula>-KILO. To handle the inherently high-dynamic characteristics of humanoid robots, the proposed framework tightly couples the measurements from the joint encoder, inertial sensor, and LiDAR. We estimate states within the error-state Kalman filter, incorporating the pointwise update strategy, IMU measurement model, and multiple leg kinematic information. Moreover, acceleration fluctuations, foot positions, and the history map are utilized for online contact detection without any contact sensors. The overall system fully utilizes the available multi-source information, making it compact and easy to deploy. Extensive experiments are conducted both on the public dataset and in the real world, including different humanoid robots and diverse scenarios. The results demonstrate that HR<inline-formula xmlns:mml="http://www.w3.org/1998/Math/MathML" xmlns:xlink="http://www.w3.org/1999/xlink"><tex-math notation="LaTeX">$^{2}$</tex-math></inline-formula>-KILO achieves extremely high rate output and lower drift compared to state-of-the-art LiDAR-inertial(-kinematic) methods. To contribute to the community, the source code and the multi-sensor humanoid dataset are released.
BibTeX
@inproceedings{ral2025_hr2kiloahighrate,
title = {HR${2}$-KILO: A High-Rate, Robust, Kinematic-Inertial-LiDAR Odometry for Humanoid Robots},
author = {Jixin Gao and Fusheng Zha and Lianzhao Zhang and Wei Guo and Pengfei Wang and Lining Sun and Mantian Li},
booktitle = {RA-L 2025},
year = {2025}
}