A GNSS/LiDAR/IMU Pose Estimation System Based on Collaborative Fusion of Factor Map and Filtering

被引:15
作者
Chen, Honglin [1 ,2 ,3 ,4 ]
Wu, Wei [5 ]
Zhang, Si [1 ,2 ,3 ,6 ]
Wu, Chaohong [1 ,2 ,3 ]
Zhong, Ruofei [1 ,2 ,3 ]
机构
[1] Capital Normal Univ, Key Lab 3D Informat Acquisit & Applicat, MOE, Beijing 100048, Peoples R China
[2] Capital Normal Univ, Base State Key Lab Urban Environm Proc & Digital M, Beijing 100048, Peoples R China
[3] Capital Normal Univ, Coll Resource Environm & Tourism, Beijing 100048, Peoples R China
[4] Neolix Technol Co Ltd, Beijing 100016, Peoples R China
[5] Tsinghua Univ, Sch Vehicle & Mobil, Beijing 100084, Peoples R China
[6] Chinese Acad Sci, Inst Comp Technol, Beijing 100045, Peoples R China
基金
中国国家自然科学基金;
关键词
fusion positioning; GNSS; LiDAR; IMU; factor graph; EKF filtering; SIMULTANEOUS LOCALIZATION; KALMAN FILTER; SLAM;
D O I
10.3390/rs15030790
中图分类号
X [环境科学、安全科学];
学科分类号
08 ; 0830 ;
摘要
One of the core issues of mobile measurement is the pose estimation of the carrier. The classic Global Navigation Satellite System/Inertial Measurement Unit (GNSS/IMU) integrated navigation scheme has high positioning accuracy but is vulnerable to Global Navigation Satellite System (GNSS) signal occlusion and multipath effect. Simultaneous Localization and Mapping (SLAM) is not affected by signal occlusion, but there are problems such as error accumulation and scene degradation. The multi-sensor fusion scheme combining the two technologies can effectively expand the scene coverage and improve the positioning accuracy and system robustness. However, the current scheme has some limitations. On the one hand, GNSS plays a less important role in most SLAM systems, only for initialization or as a closed-loop factor and other auxiliary work. On the other hand, in the fusion method, most of the current systems only use filtering or graph optimization, without taking into account the advantages of both. Aiming at pose estimation for mobile carriers, this paper combines the advantages of the global optimization of the factor graph and the local optimization of filtering and proposes a GNSS-IMU-LiDAR Constraint Kalman Filter (abbreviated as GIL-CKF), which has the characteristics of full coverage and effectively improving absolute accuracy and high output frequency. The scheme proposed in this paper consists of three parts. Firstly, an extensible factor map is used to fuse the positioning information from different sources, including GNSS, IMU, LiDAR, and a closed-loop map, to maintain a high-precision SLAM system, and the output is used as Multi-Sensor-Fusion-Odometry (MSFO). Then, the scene is divided according to the GNSS quality factor, and a Scene Optimizer (SO) is designed to filter GNSS pose and MSFO. Finally, the results are input into the Extended Kalman Filter (EKF) together with the original IMU data for further optimization and smoothing. The experimental results show that the integration of high-precision GNSS positioning information with IMU, LiDAR, a closed-loop map, and other information through the factor map can effectively suppress error accumulation and improve the overall accuracy of the SLAM system. The SO based on GNSS indicators can fully retain high-precision GNSS positioning information, effectively play their respective advantages of filtering and graph optimization, and alleviate the conflict between global and local optimization. SO with EKF filtering furthers optimization, can improve the output frequency, and smooth the trajectory. GIL-CKF can effectively improve the accuracy and robustness of pose estimation and has obvious advantages in multi-sensor scene complementarity, partial road section accuracy improvement, and high input frequency.
引用
收藏
页数:20
相关论文
共 35 条
  • [11] INS/GPS/LiDAR Integrated Navigation System for Urban and Indoor Environments Using Hybrid Scan Matching Algorithm
    Gao, Yanbin
    Liu, Shifei
    Atia, Mohamed M.
    Noureldin, Aboelmagd
    [J]. SENSORS, 2015, 15 (09) : 23286 - 23302
  • [12] Reliable partial ambiguity resolution for single-frequency GPS/BDS and INS integration
    Han, Houzeng
    Wang, Jian
    Wang, Jinling
    Moraleda, Alberto Hernandez
    [J]. GPS SOLUTIONS, 2017, 21 (01) : 251 - 264
  • [13] Integrated GPS/INS navigation system with dual-rate Kalman Filter
    Han, Songlai
    Wang, Jinling
    [J]. GPS SOLUTIONS, 2012, 16 (03) : 389 - 404
  • [14] Bollard Segmentation and Position Estimation From Lidar Point Cloud for Autonomous Mooring
    Jindal, Mehak
    Jha, Ajit
    Cenkeramaddi, Linga Reddy
    [J]. IEEE TRANSACTIONS ON GEOSCIENCE AND REMOTE SENSING, 2022, 60
  • [15] Kaess Michael, 2011, 2011 IEEE International Conference on Robotics and Automation, P3281
  • [16] Kaess M., 2017, Found. Trends Robot., V6, P1, DOI 0.1561/2300000043
  • [17] iSAM: Incremental Smoothing and Mapping
    Kaess, Michael
    Ranganathan, Ananth
    Dellaert, Frank
    [J]. IEEE TRANSACTIONS ON ROBOTICS, 2008, 24 (06) : 1365 - 1378
  • [18] Kim H., 2018, INT ARCH PHOTOGRAMM, V42, P247, DOI DOI 10.5194/ISPRS-ARCHIVES-XLII-1-247-2018
  • [19] Li D., 2018, P 9 CHINA SATELLITE, P185
  • [20] Graph-based SLAM: A survey
    Liang, Mingjie
    Min, Huaqing
    Luo, Ronghua
    [J]. Jiqiren/Robot, 2013, 35 (04): : 500 - 512