Loosely Coupled PPP/Inertial/LiDAR Simultaneous Localization and Mapping (SLAM) Based on Graph Optimization

摘要

Navigation services and high-precision positioning play a significant role in emerging fields such as self-driving and mobile robots. The performance of precise point positioning (PPP) may be seriously affected by signal interference and struggles to achieve continuous and accurate positioning in complex environments. LiDAR/inertial navigation can use spatial structure information to realize pose estimation but cannot solve the problem of cumulative error. This study proposes a PPP/inertial/LiDAR combined localization algorithm based on factor graph optimization. Firstly, the algorithm performed the spatial alignment by adding the initial yaw factor. Then, the PPP factor and anchor factor were constructed using PPP information. Finally, the global localization is estimated accurately and robustly based on the factor graph. The vehicle experiment shows that the proposed algorithm in this study can achieve meter-level accuracy in complex environments and can greatly enhance the accuracy, continuity, and reliability of attitude estimation.