Improved Preintegration Method for GNSS/IMU/In-Vehicle Sensors Navigation Using Graph Optimization
- 27 September 2021
- journal article
- research article
- Published by Institute of Electrical and Electronics Engineers (IEEE) in IEEE Transactions on Vehicular Technology
- Vol. 70 (11) , 11446-11457
Abstract
GNSS/IMU/in-vehicle sensors navigation can provide accurate localization for land vehicles. Although the sensor fusion is often carried out by Kalman filter, graph optimization can obtain better state estimation. However, the graph optimization is still affected by the lack of rigorous IMU/in-vehicle sensors preintegration. In this paper, an improved preintegration method for GNSS/IMU/in-vehicle sensors navigation using graph optimization is proposed. Different from current methods, the preintegration that involves total error parameters of in-vehicle sensors is derived. The improved factors are subsequently fused with GNSS measurements and kinematic models using graph optimization, which can allow to yield a total parameters estimation. Thereby, more accurate relative constraints provided by the proposed method can improve the positioning accuracy compared with traditional preintegration methods. Meanwhile, the estimation accuracy of the proposed method for these error parameters can be superior to Kalman filter. The KITTI datasets and field tests are carried out to validate the competitive performance of the proposed method. Finally, the computational load of the proposed method is also discussed to verify its applicability for real-time operations.Keywords
Funding Information
- National Natural Science Foundation of China (61973160)
- Aeronautical Science Foundation of China (2018ZC52037)
- Civil Aircraft Project of Ministry of Industry and Information (2018-S-36)
This publication has 26 references indexed in Scilit:
- Pose fusion with chain pose graphs for automated driving2016
- On-Manifold Preintegration for Real-Time Visual--Inertial OdometryIEEE Transactions on Robotics, 2016
- Adaptive Two-stage Kalman Filter for SINS/Odometer Integrated Navigation SystemsJournal of Navigation, 2016
- Kinematic and dynamic vehicle models for autonomous driving control design2015
- Tightly-coupled monocular visual-inertial fusion for autonomous flight of rotorcraft MAVs2015
- Principles of GNSS, inertial, and multisensor integrated navigation systems, 2nd edition [Book review]IEEE Aerospace and Electronic Systems Magazine, 2015
- Factor Graphs for Robot PerceptionFoundations and Trends in Robotics, 2015
- Vision meets robotics: The KITTI datasetThe International Journal of Robotics Research, 2013
- Information fusion in navigation systems via factor graph based incremental smoothingRobotics and Autonomous Systems, 2013
- Visual SLAM: Why filter?Image and Vision Computing, 2012