GO-INO: Graph Optimization MEMS-IMU/NHC/Odometer Integration for Ground Vehicle Positioning

Global navigation satellite system (GNSS) and inertial navigation system (INS) are indispensable for ground vehicle position and navigation. The Kalman filter (KF) is the first choice to integrate them and output more reliable navigation solutions. However, the GNSS signal is denied in urban areas, i.e., tunnels, and the INS position errors diverge quickly over time. Under normal conditions, the ground vehicle will not slide or jump off the ground; nonholonomic constraints (NHC) and odometers are available to aid the INS and reduce its position errors. Factor graph optimization (FGO) recently attracted attention as an advanced sensor fusion algorithm. This paper implemented the FGO method based on GNSS/INS/NHC/Odometer integration. In the FGO, state transformation, measurement model, the NHC, and the odometer were all regarded as constraints employed to construct a graph; an iterative process was utilized to find the optimal estimation results. Two experiments were carried out: firstly, the FGO-GNSS/INS performance was assessed and compared with the KF-GNSS/INS; secondly, we compared the FGO-GNSS/INS/NHC/Odometer and KF-GNSS/INS/NHC/Odometer under GNSS denied environments. Experimental results supported that the FGO improved the performance.