{"status":"ok","message-type":"work","message-version":"1.0.0","message":{"indexed":{"date-parts":[[2026,6,2]],"date-time":"2026-06-02T13:23:26Z","timestamp":1780406606984,"version":"3.54.1"},"reference-count":37,"publisher":"MDPI AG","issue":"9","license":[{"start":{"date-parts":[[2019,4,28]],"date-time":"2019-04-28T00:00:00Z","timestamp":1556409600000},"content-version":"vor","delay-in-days":0,"URL":"https:\/\/creativecommons.org\/licenses\/by\/4.0\/"}],"funder":[{"DOI":"10.13039\/501100012226","name":"Fundamental Research Funds for the Central Universities","doi-asserted-by":"publisher","award":["2042018KF0242"],"award-info":[{"award-number":["2042018KF0242"]}],"id":[{"id":"10.13039\/501100012226","id-type":"DOI","asserted-by":"publisher"}]}],"content-domain":{"domain":[],"crossmark-restriction":false},"short-container-title":["Remote Sensing"],"abstract":"<jats:p>A Global Navigation Satellite System (GNSS)\/Inertial Navigation System (INS)\/Light Detection and Ranging (LiDAR)-Simultaneous Localization and Mapping (SLAM) integrated navigation system based on graph optimization is proposed and implemented in this paper. The navigation results are obtained by the information fusion of the GNSS position, Inertial Measurement Unit (IMU) preintegration result and the relative pose from the 3D probability map matching with graph optimizing. The sliding window method was adopted to ensure that the computational load of the graph optimization does not increase with time. Land vehicle tests were conducted, and the results show that the proposed GNSS\/INS\/LiDAR-SLAM integrated navigation system can effectively improve the navigation positioning accuracy compared to GNSS\/INS and other current GNSS\/INS\/LiDAR methods. During the simulation of one-minute periods of GNSS outages, compared to the GNSS\/INS integrated navigation system, the root mean square (RMS) of the position errors in the North and East directions of the proposed navigation system are reduced by approximately 82.2% and 79.6%, respectively, and the position error in the vertical direction and attitude errors are equivalent. Compared to the benchmark method of GNSS\/INS\/LiDAR-Google Cartographer, the RMS of the position errors in the North, East and vertical directions decrease by approximately 66.2%, 63.1% and 75.1%, respectively, and the RMS of the roll, pitch and yaw errors are reduced by approximately 89.5%, 92.9% and 88.5%, respectively. Furthermore, the relative position error during the GNSS outage periods is reduced to 0.26% of the travel distance for the proposed method. Therefore, the GNSS\/INS\/LiDAR-SLAM integrated navigation system proposed in this paper can effectively fuse the information of GNSS, IMU and LiDAR and can significantly mitigate the navigation error, especially for cases of GNSS signal attenuation or interruption.<\/jats:p>","DOI":"10.3390\/rs11091009","type":"journal-article","created":{"date-parts":[[2019,4,29]],"date-time":"2019-04-29T02:57:32Z","timestamp":1556506652000},"page":"1009","update-policy":"https:\/\/doi.org\/10.3390\/mdpi_crossmark_policy","source":"Crossref","is-referenced-by-count":126,"title":["GNSS\/INS\/LiDAR-SLAM Integrated Navigation System Based on Graph Optimization"],"prefix":"10.3390","volume":"11","author":[{"given":"Le","family":"Chang","sequence":"first","affiliation":[{"name":"GNSS Research Center, Wuhan University, 129 Luoyu Road, Wuhan 430079, China"}],"role":[{"vocabulary":"crossref","role":"author"}]},{"ORCID":"https:\/\/orcid.org\/0000-0002-5591-0859","authenticated-orcid":false,"given":"Xiaoji","family":"Niu","sequence":"additional","affiliation":[{"name":"GNSS Research Center, Wuhan University, 129 Luoyu Road, Wuhan 430079, China"}],"role":[{"vocabulary":"crossref","role":"author"}]},{"given":"Tianyi","family":"Liu","sequence":"additional","affiliation":[{"name":"GNSS Research Center, Wuhan University, 129 Luoyu Road, Wuhan 430079, China"}],"role":[{"vocabulary":"crossref","role":"author"}]},{"given":"Jian","family":"Tang","sequence":"additional","affiliation":[{"name":"GNSS Research Center, Wuhan University, 129 Luoyu Road, Wuhan 430079, China"}],"role":[{"vocabulary":"crossref","role":"author"}]},{"given":"Chuang","family":"Qian","sequence":"additional","affiliation":[{"name":"GNSS Research Center, Wuhan University, 129 Luoyu Road, Wuhan 430079, China"}],"role":[{"vocabulary":"crossref","role":"author"}]}],"member":"1968","published-online":{"date-parts":[[2019,4,28]]},"reference":[{"key":"ref_1","unstructured":"Shin, E.-H. (2005). Estimation Techniques for Low-Cost Inertial Navigation, The University of Calgary."},{"key":"ref_2","doi-asserted-by":"crossref","first-page":"565","DOI":"10.5194\/isprsarchives-XLI-B5-565-2016","article-title":"Integration of kinect and low-cost gnss for outdoor navigation","volume":"XLI-B5","author":"Pagliaria","year":"2016","journal-title":"Int. Arch. Photogramm. Remote Sens. Spat. Inf. Sci."},{"key":"ref_3","doi-asserted-by":"crossref","first-page":"991","DOI":"10.5194\/isprs-archives-XLII-2-991-2018","article-title":"Comparison between rgb and rgb-d cameras for supporting low-cost gnss urban navigation","volume":"42","author":"Rossi","year":"2018","journal-title":"Int. Arch. Photogramm. Remote Sens. Spat. Inf. Sci."},{"key":"ref_4","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_5","doi-asserted-by":"crossref","first-page":"335","DOI":"10.1177\/0278364906075026","article-title":"Exactly Sparse Extended Information Filters for Feature-based SLAM","volume":"26","author":"Walter","year":"2007","journal-title":"Int. J. Robot. Res."},{"key":"ref_6","doi-asserted-by":"crossref","unstructured":"Deschaud, J.-E. (2018, January 21\u201325). IMLS-SLAM: Scan-to-model matching based on 3D data. Proceedings of the 2018 IEEE International Conference on Robotics and Automation (ICRA2018), Brisbane, QL, Australia.","DOI":"10.1109\/ICRA.2018.8460653"},{"key":"ref_7","doi-asserted-by":"crossref","unstructured":"Behley, J., and Stachniss, C. (2019, April 25). Efficient Surfel-based Slam Using 3d Laser Range Data in Urban Environments. Available online: http:\/\/roboticsproceedings.org\/rss14\/p16.pdf.","DOI":"10.15607\/RSS.2018.XIV.016"},{"key":"ref_8","doi-asserted-by":"crossref","unstructured":"Zhang, J., and Singh, S. (2014, January 14\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_9","doi-asserted-by":"crossref","first-page":"1004","DOI":"10.1109\/TRO.2018.2853729","article-title":"VINS-Mono: A Robust and Versatile Monocular Visual-Inertial State Estimator","volume":"34","author":"Qin","year":"2018","journal-title":"IEEE Trans. Robot."},{"key":"ref_10","doi-asserted-by":"crossref","unstructured":"Zhang, J., and Singh, S. (2015, January 26\u201330). Visual-lidar odometry and mapping: Low-drift, robust, and fast. Proceedings of the 2015 IEEE International Conference on Robotics and Automation (ICRA2015), Seattle, WA, USA.","DOI":"10.1109\/ICRA.2015.7139486"},{"key":"ref_11","doi-asserted-by":"crossref","first-page":"21","DOI":"10.1002\/rob.20104","article-title":"Mobile robot motion estimation by 2D scan matching with genetic and iterative closest point algorithms","volume":"23","author":"Morales","year":"2006","journal-title":"J. Field Robot."},{"key":"ref_12","doi-asserted-by":"crossref","unstructured":"Censi, A. (2008, January 19\u201323). An ICP variant using a point-to-line metric. Proceedings of the 2008 IEEE International Conference on Robotics and Automation, Pasadena, CA, USA.","DOI":"10.1109\/ROBOT.2008.4543181"},{"key":"ref_13","unstructured":"Aleksandr, S., Haehnel, D., and Thrun, S. (July, January 28). Generalized-ICP. Proceedings of the Robotics: Science and Systems, Seattle, WA, USA."},{"key":"ref_14","doi-asserted-by":"crossref","first-page":"203","DOI":"10.1007\/s10514-009-9108-0","article-title":"On the use of likelihood fields to perform sonar scan matching localization","volume":"26","author":"Burguera","year":"2009","journal-title":"Auton. Robot."},{"key":"ref_15","doi-asserted-by":"crossref","unstructured":"Hess, W., Kohler, D., Rapp, H., and Andor, D. (2016, January 16\u201321). Real-time loop closure in 2D LIDAR SLAM. Proceedings of the IEEE International Conference on Robotics and Automation, Stockholm, Sweden.","DOI":"10.1109\/ICRA.2016.7487258"},{"key":"ref_16","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_17","doi-asserted-by":"crossref","first-page":"99","DOI":"10.1109\/MRA.2006.1678144","article-title":"Simultaneous localization and mapping: Part I","volume":"13","author":"Bailey","year":"2006","journal-title":"IEEE Robot. Autom. Mag."},{"key":"ref_18","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. (2016). An integrated GNSS\/INS\/LiDAR-SLAM positioning method for highly accurate forest stem mapping. Remote Sens., 9.","DOI":"10.3390\/rs9010003"},{"key":"ref_19","doi-asserted-by":"crossref","first-page":"7","DOI":"10.1186\/s40648-018-0104-z","article-title":"Consistent map building in petrochemical complexes for firefighter robots using SLAM based on GPS and LIDAR","volume":"5","author":"Shamsudin","year":"2018","journal-title":"Robomech. J."},{"key":"ref_20","doi-asserted-by":"crossref","first-page":"199","DOI":"10.1016\/j.isprsjprs.2017.09.006","article-title":"Graph SLAM correction for single scanner MLS forest data under boreal forest canopy","volume":"132","author":"Kukko","year":"2017","journal-title":"Isprs J. Photogramm. Remote Sens."},{"key":"ref_21","doi-asserted-by":"crossref","first-page":"217","DOI":"10.1016\/j.compag.2017.12.034","article-title":"Mapping forests using an unmanned ground vehicle with 3D LiDAR and graph-SLAM","volume":"145","author":"Astrup","year":"2018","journal-title":"Comput. Electron. Agric."},{"key":"ref_22","unstructured":"Cartographer (2018, July 09). Latest. Available online: https:\/\/google-cartographer.readthedocs.io\/en\/latest\/."},{"key":"ref_23","doi-asserted-by":"crossref","first-page":"1","DOI":"10.1109\/TRO.2016.2597321","article-title":"On-Manifold Preintegration for Real-Time Visual--Inertial Odometry","volume":"33","author":"Forster","year":"2015","journal-title":"IEEE Trans. Robot."},{"key":"ref_24","unstructured":"Yahao, C. (2013). Algorithm Implementation of Pseudorange Differential BDS\/INS Tightly-Coupled Integration and GNSS Data Quality Control Analysis, Wuhan University."},{"key":"ref_25","unstructured":"Jun, W., and Gongmin, Y. (2016). Strapdown Inertial Navigation Algorithm and Integrated Navigation Principles, Northwestern Polytechnical University Press Co. Ltd."},{"key":"ref_26","unstructured":"Dehai, Z. (2012). Point Cloud Library PCL Learning Tutorial, Beihang University Press."},{"key":"ref_27","unstructured":"(2018, October 02). Slerp. Available online: https:\/\/en.wikipedia.org\/wiki\/Slerp."},{"key":"ref_28","doi-asserted-by":"crossref","unstructured":"Olson, E.B. (2009, January 12\u201317). Real-time correlative scan matching. Proceedings of the IEEE International Conference on Robotics and Automation, Kobe, Japan.","DOI":"10.1109\/ROBOT.2009.5152375"},{"key":"ref_29","unstructured":"(2018, March 23). Ceres Solver, 1.14. Available online: http:\/\/ceres-solver.org."},{"key":"ref_30","doi-asserted-by":"crossref","first-page":"455","DOI":"10.1002\/nme.1296","article-title":"Tricubic Interpolation in Three Dimensions","volume":"63","author":"Lekien","year":"2010","journal-title":"Int. J. Numer. Methods Eng."},{"key":"ref_31","first-page":"658","article-title":"Branch and Bound Algorithms\u2014Principles and Examples","volume":"22","author":"Clausen","year":"1999","journal-title":"Parallel Process. Lett."},{"key":"ref_32","unstructured":"Xiangyuan, K., Jiming, G., and Zongquan, L. (2010). Foundation of Geodesy, Wuhan University Press. [2nd ed.]."},{"key":"ref_33","unstructured":"Sola, J. (2017). Quaternion kinematics for the error-state Kalman filter. arXiv."},{"key":"ref_34","unstructured":"Yongyuan, Q. (2000). Kalman Filter and Integrated Navigation Principle, Northwestern Polytechnical University Press Co. Ltd."},{"key":"ref_35","doi-asserted-by":"crossref","first-page":"587","DOI":"10.1002\/rob.20360","article-title":"Sliding window filter with application to planetary landing","volume":"27","author":"Sibley","year":"2010","journal-title":"J. Field Robot."},{"key":"ref_36","doi-asserted-by":"crossref","unstructured":"Zhang, F. (2005). The Schur Complement and Its Applications, Springer.","DOI":"10.1007\/b105056"},{"key":"ref_37","doi-asserted-by":"crossref","unstructured":"Eckenhoff, K., Paull, L., and Huang, G. (2016, January 9\u201314). Decoupled, consistent node removal and edge sparsification for graph-based SLAM. Proceedings of the IEEE\/RSJ International Conference on Intelligent Robots and Systems, Daejeon, Korea.","DOI":"10.1109\/IROS.2016.7759505"}],"container-title":["Remote Sensing"],"original-title":[],"language":"en","link":[{"URL":"https:\/\/www.mdpi.com\/2072-4292\/11\/9\/1009\/pdf","content-type":"unspecified","content-version":"vor","intended-application":"similarity-checking"}],"deposited":{"date-parts":[[2025,10,11]],"date-time":"2025-10-11T12:47:44Z","timestamp":1760186864000},"score":1,"resource":{"primary":{"URL":"https:\/\/www.mdpi.com\/2072-4292\/11\/9\/1009"}},"subtitle":[],"short-title":[],"issued":{"date-parts":[[2019,4,28]]},"references-count":37,"journal-issue":{"issue":"9","published-online":{"date-parts":[[2019,5]]}},"alternative-id":["rs11091009"],"URL":"https:\/\/doi.org\/10.3390\/rs11091009","relation":{},"ISSN":["2072-4292"],"issn-type":[{"value":"2072-4292","type":"electronic"}],"subject":[],"published":{"date-parts":[[2019,4,28]]}}}