An Enhanced-LiDAR/UWB/INS Integrated Positioning Methodology for Unmanned Ground Vehicle in Sparse Environments
Yue Hu, Xu Li, Dong Kong, Peizhou Ni, Weiming Hu, Xiang Song
Abstract
Light detection and ranging (LiDAR) positioning has received great attention especially when satellites fail. However, the positioning accuracy is still subjected to the following. First, the LiDAR positioning accuracy is affected by the sparsity due to LiDAR beams and environment. Second, the existing methods for suppressing cumulative errors are based on ego-vehicle sensing that requires the motion of repeated paths. Moreover, the output frequency of LiDAR is low. To solve the above problems, an enhanced-LiDAR/ultrawideband (UWB)/inertial navigation system integrated positioning methodology is proposed. First, the enhanced LiDAR odometry module is designed to improve the resolution of LiDAR beams for more accurate odometry. Then, the cooperative optimization module is proposed to introduce UWB observation to suppress the accumulated error without relying on ego-vehicle sensing. Finally, the factor graph fusion module is used to fuse multisensor information dynamically and improve the output frequency. Experimental results prove the effectiveness of our methodology.