Tightly Coupled LIDAR/IMU/UWB Fusion via Resilient Factor Graph for Quadruped Robot Positioning

Abstract

Continuous accurate positioning in global navigation satellite system (GNSS)-denied environments is essential for robot navigation. Significant advances have been made with light detection and ranging (LiDAR)-inertial measurement unit (IMU) techniques, especially in challenging environments with varying lighting and other complexities. However, the LiDAR/IMU method relies on a recursive positioning principle, resulting in the gradual accumulation and dispersion of errors over time. To address these challenges, this study proposes a tightly coupled LiDAR/IMU/UWB fusion approach that integrates an ultra-wideband (UWB) positioning technique. First, a lightweight point cloud segmentation and constraint algorithm is designed to minimize elevation errors and reduce computational demands. Second, a multi-decision non-line-of-sight (NLOS) recognition module using information entropy is employed to mitigate NLOS errors. Finally, a tightly coupled framework via a resilient mechanism is proposed to achieve reliable position estimation for quadruped robots. Experimental results demonstrate that our system provides robust positioning results even in LiDAR-limited and NLOS conditions, maintaining low time costs.