A Real-Time and Robust LiDAR SLAM System Based on IESKF for UGVs

Positioning system is crucial for autonomous navigation of unmanned ground vehicles (UGVs), which provides the accurate position and orientation to perception and planning-control modules. However, the indispensable drifts will significantly affect the accuracy of the positioning system when lacking the global navigation satellite system (GNSS) signal. To address the common issues, this paper proposes a real-time positioning framework without using GNSS for robust positioning performance. Firstly, with the prior map, we adopt iterated error state Kalman filter (IESKF) to predict and optimize vehicles pose. In addition, we utilize the measurement input of Inertial Measurement Unit (IMU) to estimate the current state and covariance, and take it as the odometry output to ensure the real-time performance. Secondly, a novel map construction strategy is developed to boost mapping efficiency. And the corresponding comparisons are implemented to indicate the effectiveness. Finally, we use an UGV platform for data acquisition and generating dataset, and the proposed algorithm is evaluated on our own dataset. The results of the comparative experiments demonstrate the effective of the method in real-world applications.