{"status":"ok","message-type":"work","message-version":"1.0.0","message":{"indexed":{"date-parts":[[2026,3,13]],"date-time":"2026-03-13T23:49:15Z","timestamp":1773445755580,"version":"3.50.1"},"reference-count":35,"publisher":"MDPI AG","issue":"3","license":[{"start":{"date-parts":[[2023,1,30]],"date-time":"2023-01-30T00:00:00Z","timestamp":1675036800000},"content-version":"vor","delay-in-days":0,"URL":"https:\/\/creativecommons.org\/licenses\/by\/4.0\/"}],"funder":[{"name":"National Natural Science Foundation of China","award":["42071444"],"award-info":[{"award-number":["42071444"]}]},{"name":"National Natural Science Foundation of China","award":["U22A20568"],"award-info":[{"award-number":["U22A20568"]}]},{"name":"National Natural Science Foundation of China","award":["2022YFB3904101"],"award-info":[{"award-number":["2022YFB3904101"]}]},{"name":"National Key Technologies Research and Development Program of China","award":["42071444"],"award-info":[{"award-number":["42071444"]}]},{"name":"National Key Technologies Research and Development Program of China","award":["U22A20568"],"award-info":[{"award-number":["U22A20568"]}]},{"name":"National Key Technologies Research and Development Program of China","award":["2022YFB3904101"],"award-info":[{"award-number":["2022YFB3904101"]}]}],"content-domain":{"domain":[],"crossmark-restriction":false},"short-container-title":["Remote Sensing"],"abstract":"<jats:p>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.<\/jats:p>","DOI":"10.3390\/rs15030790","type":"journal-article","created":{"date-parts":[[2023,1,30]],"date-time":"2023-01-30T10:19:28Z","timestamp":1675073968000},"page":"790","update-policy":"https:\/\/doi.org\/10.3390\/mdpi_crossmark_policy","source":"Crossref","is-referenced-by-count":25,"title":["A GNSS\/LiDAR\/IMU Pose Estimation System Based on Collaborative Fusion of Factor Map and Filtering"],"prefix":"10.3390","volume":"15","author":[{"given":"Honglin","family":"Chen","sequence":"first","affiliation":[{"name":"Key Laboratory of 3D Information Acquisition and Application, MOE, Capital Normal University, Beijing 100048, China"},{"name":"Base of the State Key Laboratory of Urban Environmental Process and Digital Modeling, Capital Normal University, Beijing 100048, China"},{"name":"College of Resource Environment and Tourism, Capital Normal University, Beijing 100048, China"},{"name":"Neolix Technologies Co., Ltd., Beijing 100016, China"}]},{"given":"Wei","family":"Wu","sequence":"additional","affiliation":[{"name":"School of Vehicle and Mobility, Tsinghua University, Beijing 100084, China"}]},{"given":"Si","family":"Zhang","sequence":"additional","affiliation":[{"name":"Key Laboratory of 3D Information Acquisition and Application, MOE, Capital Normal University, Beijing 100048, China"},{"name":"Base of the State Key Laboratory of Urban Environmental Process and Digital Modeling, Capital Normal University, Beijing 100048, China"},{"name":"College of Resource Environment and Tourism, Capital Normal University, Beijing 100048, China"},{"name":"Institute of Computing Technology, Chinese Academy of Sciences, Beijing 100045, China"}]},{"given":"Chaohong","family":"Wu","sequence":"additional","affiliation":[{"name":"Key Laboratory of 3D Information Acquisition and Application, MOE, Capital Normal University, Beijing 100048, China"},{"name":"Base of the State Key Laboratory of Urban Environmental Process and Digital Modeling, Capital Normal University, Beijing 100048, China"},{"name":"College of Resource Environment and Tourism, Capital Normal University, Beijing 100048, China"}]},{"given":"Ruofei","family":"Zhong","sequence":"additional","affiliation":[{"name":"Key Laboratory of 3D Information Acquisition and Application, MOE, Capital Normal University, Beijing 100048, China"},{"name":"Base of the State Key Laboratory of Urban Environmental Process and Digital Modeling, Capital Normal University, Beijing 100048, China"},{"name":"College of Resource Environment and Tourism, Capital Normal University, Beijing 100048, China"}]}],"member":"1968","published-online":{"date-parts":[[2023,1,30]]},"reference":[{"key":"ref_1","doi-asserted-by":"crossref","first-page":"2127","DOI":"10.1016\/j.measurement.2013.03.006","article-title":"Review of mobile mapping and surveying technologies","volume":"46","author":"Puente","year":"2013","journal-title":"Measurement"},{"key":"ref_2","doi-asserted-by":"crossref","first-page":"389","DOI":"10.1007\/s10291-011-0240-x","article-title":"Integrated GPS\/INS navigation system with dual-rate Kalman Filter","volume":"16","author":"Han","year":"2012","journal-title":"GPS Solut."},{"key":"ref_3","unstructured":"Boime, G., Sicsik-Pare, E., and Fischer, J. (2015, June 01). Differential GNSS+INS for Land Vehicle Autonomous Navigation Qualification. Available online: https:\/\/www.gpsworld.com\/on-the-road-to-driverless\/."},{"key":"ref_4","doi-asserted-by":"crossref","first-page":"251","DOI":"10.1007\/s10291-016-0519-z","article-title":"Reliable Partial Ambiguity Resolution for Single-Frequency GPS\/BDS and INS Integration","volume":"21","author":"Han","year":"2017","journal-title":"GPS Solut."},{"key":"ref_5","doi-asserted-by":"crossref","unstructured":"Qian, C., Liu, H., Tang, J., Chen, Y., Kaartinen, H., Kukko, A., Zhu, L., Liang, X., Chen, L., and Hyypp\u00e4, J. (2017). An integrated GNSS\/INS\/LiDAR-SLAM positioning method for highly accurate forest stem mapping. Remote Sens., 9.","DOI":"10.3390\/rs9010003"},{"key":"ref_6","doi-asserted-by":"crossref","first-page":"229","DOI":"10.1109\/70.938381","article-title":"A solution to the simultaneous localization and map building (SLAM) problem","volume":"17","author":"Dissanayake","year":"2001","journal-title":"IEEE Trans. Robot. Autom."},{"key":"ref_7","doi-asserted-by":"crossref","first-page":"194","DOI":"10.1109\/TIV.2017.2749181","article-title":"Simultaneous Localization and Mapping: A Survey of Current Trends in Autonomous Driving","volume":"2","author":"Bresson","year":"2017","journal-title":"IEEE Trans. Intell. Veh."},{"key":"ref_8","doi-asserted-by":"crossref","first-page":"1309","DOI":"10.1109\/TRO.2016.2624754","article-title":"Past, Present, and Future of Simultaneous Localization and Mapping: Toward the Robust-Perception Age","volume":"32","author":"Cadena","year":"2016","journal-title":"IEEE Trans. Robot."},{"key":"ref_9","doi-asserted-by":"crossref","first-page":"1","DOI":"10.1109\/TGRS.2021.3097134","article-title":"Bollard Segmentation and Position Estimation from Lidar Point Cloud for Autonomous Mooring","volume":"60","author":"Jindal","year":"2022","journal-title":"IEEE Trans. Geosci. Remote Sens."},{"key":"ref_10","doi-asserted-by":"crossref","unstructured":"Zhao, P., Hu, Q., Wang, S., Ai, M., and Mao, Q. (2018). Panoramic Image and Three-Axis Laser Scanner Integrated Approach for Indoor 3D Mapping. Remote Sens., 10.","DOI":"10.3390\/rs10081269"},{"key":"ref_11","doi-asserted-by":"crossref","first-page":"23286","DOI":"10.3390\/s150923286","article-title":"INS\/GPS\/LiDAR Integrated Navigation System for Urban and Indoor Environments Using Hybrid Scan Matching Algorithm","volume":"15","author":"Gao","year":"2015","journal-title":"Sensors"},{"key":"ref_12","unstructured":"Li, D., Jia, X., Zhao, J., Xu, Q., and Zhang, P. (2018, January 23\u201325). An integrated navigation algorithm for SLAM\/GNSS\/INS based on extended Kalman filter. Proceedings of the 9th China Satellite Navigation Conference (CSNC), Harbin, China."},{"key":"ref_13","doi-asserted-by":"crossref","unstructured":"Rogers, J.G., Fink, J.R., and Stump, E.A. (2014, January 4\u20136). Mapping with a ground robot in GPS denied and degraded environments. Proceedings of the 2014 American Control Conference (ACC), Portland, OR, USA.","DOI":"10.1109\/ACC.2014.6859100"},{"key":"ref_14","doi-asserted-by":"crossref","unstructured":"Kaess, M., Johannsson, H., and Roberts, R. (2011, January 9\u201313). Isam2: Incremental Smoothing and Mapping with Fluid Relinearization and Incremental Variable Reordering. Proceedings of the 2011 IEEE International Conference on Robotics and Automation (ICRA), Shanghai, China.","DOI":"10.1109\/ICRA.2011.5979641"},{"key":"ref_15","doi-asserted-by":"crossref","first-page":"1365","DOI":"10.1109\/TRO.2008.2006706","article-title":"Isam: Incremental Smoothing and Mapping","volume":"24","author":"Kaess","year":"2008","journal-title":"IEEE Trans. Robot."},{"key":"ref_16","doi-asserted-by":"crossref","unstructured":"Shan, T., Englot, B., Meyers, D., Wang, W., Ratti, C., and Rus, D. (January, January 24). LIO-SAM: Tightly-Coupled Lidar Inertial Odometry via Smoothing and Mapping. Proceedings of the 2020 IEEE\/RSJ International Conference on Intelligent Robots and Systems (IROS), Las Vegas, NV, USA.","DOI":"10.1109\/IROS45743.2020.9341176"},{"key":"ref_17","doi-asserted-by":"crossref","unstructured":"Wan, G., Yang, X., Cai, R., Li, H., Wang, H., and Song, S. (2017). Robust and precise vehicle localization based on multi-sensor fusion in diverse city scenes. arXiv.","DOI":"10.1109\/ICRA.2018.8461224"},{"key":"ref_18","doi-asserted-by":"crossref","unstructured":"Barfoot, T.D. (2017). State Estimation for Robotics, Cambridge University Press.","DOI":"10.1017\/9781316671528"},{"key":"ref_19","doi-asserted-by":"crossref","first-page":"68","DOI":"10.1109\/MSP.2020.2984780","article-title":"3D Point Cloud Processing and Learning for Autonomous Driving: Impacting Map Creation, Localization, and Perception","volume":"38","author":"Chen","year":"2021","journal-title":"IEEE Signal Process. Mag."},{"key":"ref_20","doi-asserted-by":"crossref","first-page":"2847","DOI":"10.1109\/ACCESS.2019.2962554","article-title":"Multi-Sensor Fusion in Automated Driving: A Survey","volume":"8","author":"Wang","year":"2019","journal-title":"IEEE Access"},{"key":"ref_21","doi-asserted-by":"crossref","unstructured":"Fung, M.L., Chen, M.Z., and Chen, Y.H. (2017, January 28\u201330). Sensor fusion: A review of methods and applications. Proceedings of the 2017 29th Chinese Control And Decision Conference (CCDC), Chongqing, China.","DOI":"10.1109\/CCDC.2017.7979175"},{"key":"ref_22","doi-asserted-by":"crossref","first-page":"247","DOI":"10.5194\/isprs-archives-XLII-1-247-2018","article-title":"Localization of a car based on multi-sensor fusion","volume":"42","author":"Kim","year":"2018","journal-title":"Int. Arch. Photogramm. Remote Sens. Spatial Inf. Sci."},{"key":"ref_23","doi-asserted-by":"crossref","first-page":"65","DOI":"10.1016\/j.imavis.2012.02.009","article-title":"Visual SLAM: Why filter?","volume":"30","author":"Strasdat","year":"2012","journal-title":"Image Vis. Comput."},{"key":"ref_24","doi-asserted-by":"crossref","unstructured":"Strasdat, H., Montiel, J., and Davison, A.J. (2010, January 3\u20137). Real-time monocular SLAM: Why filter?. Proceedings of the 2010 IEEE International Conference on Robotics and Automation (ICRA), Anchorage, AK, USA.","DOI":"10.1109\/ROBOT.2010.5509636"},{"key":"ref_25","doi-asserted-by":"crossref","unstructured":"Mourikis, A.I., and Roumeliotis, S.I. (2007, January 10\u201314). A Multi-State Constraint Kalman Filter for Vision-aided Inertial Navigation. Proceedings of the IEEE International Conference on Robotics and Automation, Roma, Italy.","DOI":"10.1109\/ROBOT.2007.364024"},{"key":"ref_26","first-page":"363","article-title":"The slam problem: A survey","volume":"184","author":"Aulinas","year":"2008","journal-title":"CCIA"},{"key":"ref_27","doi-asserted-by":"crossref","first-page":"500","DOI":"10.3724\/SP.J.1218.2013.00500","article-title":"Graph-based SLAM: A Survey","volume":"35","author":"Liang","year":"2013","journal-title":"Robot"},{"key":"ref_28","doi-asserted-by":"crossref","first-page":"1","DOI":"10.1561\/2300000043","article-title":"Factor graphs for robot perception","volume":"6","author":"Dellaert","year":"2017","journal-title":"Found. Trends Robot."},{"key":"ref_29","unstructured":"Sola, J. (2017). Quaternion kinematics for the error-state Kalman filter. arXiv."},{"key":"ref_30","first-page":"2005","article-title":"Indirect Kalman filter for 3D attitude estimation","volume":"2","author":"Trawny","year":"2005","journal-title":"Univ. Minnesota Dept. Comp. Sci. Eng. Tech. Rep."},{"key":"ref_31","doi-asserted-by":"crossref","first-page":"1","DOI":"10.1109\/TRO.2016.2597321","article-title":"On-manifold preintegration for real-time visual\u2014Inertial odometry","volume":"33","author":"Forster","year":"2016","journal-title":"IEEE Trans. Robot."},{"key":"ref_32","doi-asserted-by":"crossref","unstructured":"Forster, C., Carlone, L., Dellaert, F., and Scaramuzza, D. (2015, January 13\u201317). IMU Preintegration on Manifold for Efficient Visual-Inertial Maximum-a-Posteriori Estimation. Proceedings of the Robotics: Science and Systems, Rome, Italy.","DOI":"10.15607\/RSS.2015.XI.006"},{"key":"ref_33","doi-asserted-by":"crossref","unstructured":"Moore, T., and Stouch, D. (2016, January 15\u201318). A Generalized Extended Kalman Filter Implementation for the Robot Operating System. Proceedings of the 13th International Conference on Intelligent Autonomous Systems (IAS), Padova, Italy.","DOI":"10.1007\/978-3-319-08338-4_25"},{"key":"ref_34","doi-asserted-by":"crossref","unstructured":"Zhang, J., and Singh, S. (2014, January 12\u201316). LOAM: LiDAR odometry and mapping in real-time. Proceedings of the Robotics: Science and Systems, Berkeley, CA, USA.","DOI":"10.15607\/RSS.2014.X.007"},{"key":"ref_35","doi-asserted-by":"crossref","unstructured":"Yan, Z., Sun, L., Krajnik, T., and Ruichek, Y. (2020, January 25\u201329). EU Long-term Dataset with Multiple Sensors for Autonomous Driving. Proceedings of the 2020 IEEE\/RSJ International Conference on Intelligent Robots and Systems (IROS), Las Vegas, NV, USA.","DOI":"10.1109\/IROS45743.2020.9341406"}],"container-title":["Remote Sensing"],"original-title":[],"language":"en","link":[{"URL":"https:\/\/www.mdpi.com\/2072-4292\/15\/3\/790\/pdf","content-type":"unspecified","content-version":"vor","intended-application":"similarity-checking"}],"deposited":{"date-parts":[[2025,10,10]],"date-time":"2025-10-10T18:19:57Z","timestamp":1760120397000},"score":1,"resource":{"primary":{"URL":"https:\/\/www.mdpi.com\/2072-4292\/15\/3\/790"}},"subtitle":[],"short-title":[],"issued":{"date-parts":[[2023,1,30]]},"references-count":35,"journal-issue":{"issue":"3","published-online":{"date-parts":[[2023,2]]}},"alternative-id":["rs15030790"],"URL":"https:\/\/doi.org\/10.3390\/rs15030790","relation":{},"ISSN":["2072-4292"],"issn-type":[{"value":"2072-4292","type":"electronic"}],"subject":[],"published":{"date-parts":[[2023,1,30]]}}}