Optimized Factor Graph for Tightly-Coupled LiDAR/IMU Localization in Underground Parking Garages

Abstract

To address the challenge of intelligent vehicle localization in underground parking structures due to the loss of GNSS signals, this paper introduces a method to address this issue by developing a novel localization framework known as GF-LIO, which denotes a tightly-coupled fusion of LiDAR and IMU data, innovatively combining the Interactive Extended State Kalman Filter (IESKF) with a factor graph to enhance the localization process and solve the problem of GNSS signal loss in underground parking lots. The GF-LIO model commences with a strategic feature selection process, facilitated by a greedy algorithm that prioritizes environmental cues within the point cloud data. This method effectively filters out redundant features, thereby enhancing the saliency of retained features and subsequently improving the robustness of the localization process. Following feature selection, the model integrates LiDAR and IMU measurements utilizing the IESKF algorithm, ensuring a cohesive fusion of sensor data and bolstering attitude estimation accuracy. The culmination of the GF-LIO framework involves factor graph optimization, a sophisticated technique that synthesizes LiDAR odometry, IMU pre-integration factors, and loop closure detection factors. This optimization step enhances the overall precision and consistency of the localization process, resulting in superior performance compared to existing methodologies. Experimental evaluations conducted within underground parking environments corroborate the efficacy of the GF-LIO model. Comparative analyses against established approaches such as A-LOAM, LeGO-LOAM, LIO-LOAM, and FAST-LIO demonstrate a notable performance improvement exceeding 12.53%. The proposed model adeptly integrates domain-specific environmental characteristics with multi-sensor data, thereby facilitating precise localization and map construction tasks for intelligent vehicle navigating within the intricate confines of subterranean parking structures.