The high-precision factor graph optimization algorithm of GNSS/INS for urban complex environment

被引：0
|
作者：
Han Y. [1 ]
Yu X. [1 ]
Ji Z. [2 ]
Chen J. [1 ]
机构：
[1] School of Automation, Beijing Institute of Technology, Beijing
[2] School of Optics and Photonics, Beijing Institute of Technology, Beijing
来源：
Zhongguo Guanxing Jishu Xuebao/Journal of Chinese Inertial Technology | 2022年 / 30卷 / 05期
关键词：
Factor graph optimization; Gross error detection; IMU pre-integration; Satellite navigation;
D O I：
10.13695/j.cnki.12-1222/o3.2022.05.004
中图分类号：
学科分类号：
摘要：
In the complex urban environment, GNSS receivers is easily affected by various factors such as building occlusion and multipath effects, lead to gross errors or rejection of the signal, which easily affects the accuracy and robustness of the GNSS/INS integrated navigation system. A factor graph optimization algorithm of GNSS/INS with gross error online detection is proposed to improve the performance of the integrated navigation system under the interference condition of urban environment. Based on the characteristics of correlation between information, a sliding window gross error detection and fitting replacement algorithm for satellite signals is proposed to suppress the influence of satellite gross errors. The GNSS position, velocity factor and improved IMU pre-integration factor are constructed to realize nonlinear optimization of integrated navigation information. The simulation and vehicle experiments show that the positioning error of the proposed algorithm is reduced by more than 90% compared with the extended Kalman filter and the traditional factor graph optimization algorithm in the case of gross errors in satellite signals, which can assist the navigation system to obtain a better state estimation effect. In the case of GNSS rejection, the positioning error of the algorithm is reduced by more than 30% compared with the extended Kalman filter algorithm. © 2022, Editorial Department of Journal of Chinese Inertial Technology. All right reserved.
引用
收藏
页码：582 / 588
页数：6
相关论文
共 12 条
  • [1] Shen K, Liu T, Zuo S, Et al., Observability analysis and robust fusion algorithms of GNSS/INS integrated navigation in complex urban environment, Chinese Journal of Scientific Instrument, 41, 9, pp. 254-263, (2020)
  • [2] Li Y., Research and Implementation of Multi-source Fusion Navigation Algorithm Based on Factor Graph, (2022)
  • [3] Barrau A., Bonnabel S., A mathematical framework for IMU error propagation with applications to preintegration[C], 2020 IEEE International Conference on Robotics and Automation (ICRA), pp. 5732-5738, (2020)
  • [4] Jiang J, Niu X, Liu J., Improved IMU preintegration with gravity change and earth rotation for optimization-based GNSS/VINS, Remote Sensing, 12, 18, (2020)
  • [5] Tang H, Niu X, Zhang T, Et al., Exploring the Accuracy Potential of IMU Preintegration in Factor Graph Optimization[J]
  • [6] Geng K, Chulin N.A., Applications of multi-height sensors data fusion and fault-tolerant Kalman filter in integrated navigation system of UAV, Procedia Computer Science, 103, pp. 231-238, (2017)
  • [7] Li Z, Zhang H, Zhou Q, Et al., An adaptive low-cost INS/GNSS tightly-coupled integration architecture based on redundant measurement noise covariance estimation, Sensors, 17, 9, (2017)
  • [8] He K, Dong Z, Wang Q., A navigation filtering algorithm considering GPS signal interruption, Journal of Beijing University of Aeronautics and Astronautics, 45, 9, pp. 1874-1881, (2019)
  • [9] Dong Y, Wang D, Zhang L, Et al., Tightly coupled GNSS/INS integration with robust sequential Kalman filter for accurate vehicular navigation, Sensors, 20, 2, (2020)
  • [10] Sun K, Zeng Q, Wang S, Et al., Pseudorange fault detection and adaptive isolation method based on factor graph navigation, Space-time coordinate transformation and its error analysis for INS/CNS integrated navigation, 30, pp. 65-73, (2022)
12