Multi-Sensor Fusion SLAM Based on LiDAR, IMU and GPS for Structured Urban Scenes

Abstract

Aiming at the current SLAM (Simultaneous Localization and Mapping) algorithms in urban scenarios, which have problems such as elevation drift, odometry drift, and the appearance of false loop closures, a tightly coupled SLAM method with LiDAR and inertial guidance is proposed. In the front-end, a raster-based point cloud feature extraction method is introduced, enabling simultaneous segmentation and extraction of line, surface, and ground features. Utilizing the alignment results of line and surface features as the initial value for ground point alignment, interpolation weights are determined based on roll and pitch angle errors, effectively reducing global elevation errors through frame-by-frame constraints. The back-end employs an error state-based Kalman filter (ESKF) for GPS and IMU data fusion, enhancing the validity of true state estimation. A Scan Context loop closure detection method is designed, augmented by GPS detection as an auxiliary loop closure constraint to mitigate false loop closures. A global factor graph optimization model is also proposed. Experimental results demonstrate that, compared to existing open-source algorithms, the proposed method exhibits improved performance in structured urban scenes, reducing the average RMSE APE by 47.4% compared with LiDAR-only methods and by 22.9% compared with tightly coupled LiDAR-inertial methods. This work highlights the potential of multi-sensor fusion SLAM for achieving high-precision 3D localization and mapping in complex urban environments.