The combination of strapdown inertial navigation system (SINS), global navigation satellite system (GNSS), and odometer (ODO) is the most practical and cost-effective way to implement a multi-source fusion automotive navigation system. However, the traditional Kalman filtering (KF) algorithm suffers from the inaccuracy of the system state matrix and the measurement noise covariance matrix during vehicle operation, which leads to a decrease in navigation and positioning accuracy. To solve this problem, a measurement adaptive strong tracking Kalman filter (MA-STKF) algorithm is proposed. The algorithm adopts an asymptotic weighting approach to estimate the measurement covariance array by considering new interest time series being actually filtered, introduces a measurement forgetting factor, perform real-time estimation and correction combines with the decay factor of the strong tracking filter, and takes advantage of the difference between the actual measurement error and the predicted covariance to reset the decay factor, which improves the tracking performance of the algorithm. The proposed algorithm is applied to the SINS/GNSS/ODO integrated navigation system, and simulation and vehicle experiments were conducted, improving the positioning longitude by 52.48% and 30.96%, and the positioning latitude by 63.27% and 37.64%, compared to KF and STKF, respectively.
Acknowledgement
This work was supported by Natural Science Foundation of Gansu Province (No.23JRRA869), Gansu Provincial Science and Technology Guidance Programme (No.2020-61-14), Gansu Province University Industry Support Programme (No.2023CYZC-32), Major Cultivation Project of Scientific Research and Innovation Platform of Universities (No.2024CXPT-17), and National Railway Administration Project (No.KF2022-021).
Declaration of conflicting interests
The authors have no conflict of interests related to this publication.
| [1] |
WEI W H, YUAN W, ZHANG Y F. Adaptive estimation method of observational model systematic errors for intelligent vehicle SINS/GNSS dynamic integrated navigation. China Journal of Highway and Transport, 2024, 37(7): 280-290.
|
| [2] |
YAN Y Q, SI Y B, CHEN G W, et al. GNSS-assisted optimal alignment method for low-cost SINS motion of vehicle. Measurement Science and Technology, 2025, 36(1): 016305.
|
| [3] |
LI B F, CHEN G E. Precise cooperative positioning for vehicles with GNSS and INS integration. Acta Geodaetica et Cartographica Sinica, 2022, 51(8): 1708-1716.
|
| [4] |
ZHANG F, WANG K, LIAO W, et al. Lidar/MEMS IMU/Odometer integrated tightly navigation algorithm. Chinese Journal of Scientific Instrument, 2022, 43(7): 139-148.
|
| [5] |
JIANG Y, PAN S, YE F, et al. Approach for detection of slowly growing fault based on robust estimation and improved AIME. Systems Engineering and Electronics, 2022, 44(9): 2894-2902.
|
| [6] |
XU B, CHEN C, WANG L Z. Vehicle-mounted INS/OD/GPS integrated navigation based on IMM filtering. Journal of Chinese Inertial Technology, 2022, 30(1): 58-64.
|
| [7] |
NI S, LI S, XIE Y, et al. Overview of GNSS/INS ultra-tight integrated navigation. Journal of National University of Defense Technology, 2023, 45(5): 48-59.
|
| [8] |
SUN Z Q, TANG K H, WU M P, et al. High-speed train positioning method based on motion constraints suppressing INS error in tunnel. Journal of Northwestern Polytechnical University, 2021, 39(3): 624-632.
|
| [9] |
WU P B, PAN S G, GAO W, et al. UWB quality control and its integrated positioning with GNSS/INS considering NLOS and system errors. Chinese Journal of Scientific Instrument, 2024, 45(5): 51-60.
|
| [10] |
GUO C, CHEN Y C, LUO Y R. Matrix Lie group filtering algorithm for GNSS/SINS loosely integrated navigation in the world frame. Journal of Chinese Inertial Technology, 2024, 32(3): 242-249.
|
| [11] |
YANG B, LIU F, XUE L, et al. An improved Kalman filter algorithm under colored noise. Journal of Chinese Inertial Technology, 2023, 31(10): 1004-1009.
|
| [12] |
ZENG Q, ZHAO T, ZHAO B, et al. Adaptive Kalman filtering algorithm based on exponential attenuating factor for integrated navigation system. Journal of Chinese Inertial Technology, 2021,29(3): 307-313.
|
| [13] |
JIN K D, CHAI H Z, SU C H, et al. Fading memory variational Bayesian adaptive filter based on variable attenuating factor. Journal of Beijing University of Aeronautics and Astronautics, 2023, 49(11): 2989-2999.
|
| [14] |
ZHAO B, ZENG Q H, LIU J Y, et al. Fault detection and robust adaptive filter algorithm based on smooth bounded layer. Journal of Chinese Inertial Technology, 2023, 31(3): 245-253.
|
| [15] |
HU X, PAN X, LIU C. An Improved Sage-Husa adaptive filtering algorithm for GNSS/SINS integrated navigation . Journal of Geodesy and Geophysics, 2023, 43(8): 791-794.
|
| [16] |
XIONG X, HUANG G, WANG X. Adaptive robust cubature Kalman filter integrated navigation algorithm based on Chi-Square Test. Journal of Detection & Control,2019, 41(5): 125-131.
|
| [17] |
ZHOU D, XI Y, ZHANG Z. Extended Kalman filtering with suboptimal fading factor for nonlinear systems. Control and Decision, 1990(5): 1-6.
|
| [18] |
HU H, YAN Y J, OU M H, et al. Application of adaptive strong tracking Kalman filter based on fuzzy logic to GPS positioning. GNSS World of China, 2017, 42(1): 6-11.
|
| [19] |
LÜ D H, WANG J Q, XIONG K, et al. Strong tracking Kalman filter for non-Gaussian observation. Control Theory & Applications, 2019, 36(12): 1997-2004.
|
| [20] |
LI S X, HUANG F R, QIU S Q, et al. SINS/Odometer integrated navigation method based on adaptive strong tracking filter. Journal of Chinese Inertial Technology, 2018, 26(2): 156-161.
|
| [21] |
XIONG X, HUANG G Y, WANG X D. Strong tracking SVDCKF integrated navigation algorithm based on multiple fading factors. Journal of Chongqing University of Posts and Telecommunications (Natural Science Edition), 2021, 33(2): 330-336.
|
| [22] |
XUE W T, ZHANG B, LI S J. Application of new information adaptive Kalman filter in integrated navigation. GNSS World of China, 2014, 39(4): 8-11.
|
| [23] |
YAN G, WENG J. Strapdown inertial navigation algorithm and integrated navigation principle. Xi’an: Northwestern Polytechnical University Press, 2019(1): 121-127.
|
| [24] |
XIA Q J, SUN Y X, ZHOU C H. An optimal adaptive algorithm for fading Kalman filter and its application. Acta Automatica Sinica, 1990, 16(3): 210-216.
|
| [25] |
JING L, LIN X Y, PAN X L, et al. Research on GNSS/SINS integrated navigation adaptive UKF algorithm based on improved Sage-Husa. Chinese Space Science and Technology, 2024, 44(5): 127-135.
|
PDF
(5126KB)
