Abstract: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.

Improved Preintegration Method for Vehicle Navigation Based on Factor Graph Optimization

Fault Detection and Interactive Multiple Models Optimization Algorithm Based on Factor Graph Navigation System

An improved integrated navigation method with enhanced robustness based on factor graph

Resilient Factor Graph-Based GNSS/IMU/Vision/Odo Integrated Navigation Scheme Enhanced by Noise Approximate Gaussian Estimation in Challenging Environments

A Robust Factor Graph Optimization Method of GNSS/INS/ODO Integrated Navigation System for Autonomous Vehicle

GNSS/INS/LiDAR-SLAM Integrated Navigation System Based on Graph Optimization

Optimizing AUV Navigation Using Factor Graphs with Side-Scan Sonar Integration

A Robust Position Estimation Method in the Integrated Navigation System via Factor Graph

Exploring the Accuracy Potential of IMU Preintegration in Factor Graph Optimization

A Hybrid Algorithm of LSTM and Factor Graph for Improving Combined GNSS/INS Positioning Accuracy during GNSS Interruptions

Robust factor graph optimisation method for shipborne GNSS/INS integrated navigation system

A Comparative Study of Factor Graph Optimization-Based and Extended Kalman Filter-Based PPP-B2b/INS Integrated Navigation

An Adaptive Fast Incremental Smoothing Approach to INS/GPS/VO Factor Graph Inference

Navigation for fixed-wing unmanned aerial vehicles in the presence of GNSS outages

An Optimization-Based Tightly-Coupled Integration of PPP, INS and Vision for Precise and Continuous Navigation

Improved Multi-Sensor Fusion Positioning System Based on GNSS/LiDAR/Vision/IMU With Semi-Tight Coupling and Graph Optimization in GNSS Challenging Environments

IM-GIV: an effective integrity monitoring scheme for tightly-coupled GNSS/INS/Vision integration based on factor graph optimization

An Asynchronous Fusion Algorithm of the SINS/GPS/CNS Based on Factor Graph

A low-cost integrated navigation system based on factor graph nonlinear optimization for autonomous flight

A Study on Graph Optimization Method for GNSS/IMU Integrated Navigation System Based on Virtual Constraints