[an error occurred while processing this directive] [an error occurred while processing this directive] [an error occurred while processing this directive]
[an error occurred while processing this directive]

An Improved Robust Filtering Algorithm for GNSS/SINS Integrated Navigation System

  • SUN Yumei ,
  • WANG Xuewei ,
  • REN Xianjie
Expand
  • School of Computer Science,Weifang University of Science and Technology,Weifang 262700,Shandong,China

Received date: 2023-07-27

  Online published: 2024-12-28

Abstract

The optimal Kalman filtering of GNSS/SINS integrated navigation system needs to satisfy the assumption that the measurement vector is Gaussian distribution; otherwise, the filtering accuracy will decrease or even diverge. Robust filtering is an effective method to solve this problem, but it has certain limitations in improving the filtering accuracy. To solve this problem, this paper proposes an improved robust filtering method based on Mahalanobis distance and Newton iteration method. Firstly, the Mahalanobis distance is used to determine whether the measured value is abnormal. Secondly, a scaling factor is introduced to optimize and adjust the measurement noise covariance matrix according to Newton iteration method, and then adjust more precisely the proportion of measurement value and system model information in the filtering process. Finally, the GNSS/SINS integrated navigation system is simulated and analyzed based on optimal Kalman filter (KF), traditional robust Kalman filter (RKF) and improved robust Kalman filter (IRKF). The experimental results show that IRKF can improve the position and velocity accuracy by about 14.1% and 13.8% respectively when compared with KF, and can improve position and velocity accuracy by 8.1% and 7.7% respectively when compared with RKF.

Cite this article

SUN Yumei , WANG Xuewei , REN Xianjie . An Improved Robust Filtering Algorithm for GNSS/SINS Integrated Navigation System[J]. Journal of Projectiles, Rockets, Missiles and Guidance, 2024 , 44(1) : 6 -12 . DOI: 10.15892/j.cnki.djzdxb.2024.01.002

[an error occurred while processing this directive]
[1]
郝雨时, 孙剑伟, 隋心, 等. 顾及ISB/IFB的多GNSS RTK/INS紧组合导航方法[J]. 测绘学报, 2022, 51(11): 2265-2272.

DOI

HAO Y S, SUN J W, SUI X, et al. Multi-GNSS RTK/INS tightly coupled integrated navigation method considering ISB/IFB estimation[J]. Acta Geodaetica et Cartographica Sinica, 2022, 51(11): 2265-2272.

DOI

[2]
林雪原, 王萍, 许家龙, 等. 基于序贯UKF的GNSS/CNS/SINS组合导航最优融合算法[J]. 大地测量与地球动力学, 2022, 42(12): 1211-1215.

LIN X Y, WANG P, XU J L, et al. An optimal fusion algorithm for GNSS/CNS/SINS integrated navigation based on sequential UKF[J]. Journal of Geodesy and Geodynamics, 2022, 42(12): 1211-1215.

[3]
张闯, 郭晨, 张大恒. 船舶组合导航自适应迭代粒子滤波方法及应用[J]. 系统工程与电子技术, 2019, 41(4): 884-889.

ZHANG C, GUO C, ZHANG D H. Adaptive iterative particle filter and its application of ship integrated navigation[J]. Systems Engineering and Electronics, 2019, 41(4): 884-889.

[4]
王昆仑, 陶庭叶, 黄祚继, 等. 一种结合H滤波的SINS/GPS组合无人机定位算法[J]. 测绘通报, 2018(5): 16-19.

DOI

WANG K L, TAO T Y, HUANG Z J, et al. A SINS/GPS integrated UAV location algorithm combined with H filter[J]. Bullet of Surveying and Mapping, 2018(5): 16-19.

[5]
YANG Y, HE H, XU G. Adaptively robust filtering for kinematic geodetic positioning[J]. Journal of Geodesy, 2001(75): 109-116.

[6]
YANG Y, SONG L, XU T. Robust estimator for correlated observations based on bifactor equivalent weights[J]. Journal of Geodesy, 2002(76): 353-358.

[7]
YANG Y X, GAO W G. Comparison of two fading filters and adaptively robust filter[J]. Geo-spatial Information Science, 2007, 10(3): 200-2003.

[8]
何浩洋, 夏荣斌. 基于双因子抗差估计的SINS/BDS有轨电车组合导航算法研究[J]. 铁道学报, 2022, 44(8): 50-59.

HE H Y, XIA R B. SINS/BDS integrated navigation algorithm for tram based on dual factor robust estimation[J]. Journal of the China Railway Society, 2022, 44(8): 50-59.

[9]
沈凯, 刘庭欣, 左思琪. 复杂城市环境下GNSS/INS组合导航可观测度分析及鲁棒滤波方法[J]. 仪器仪表学报, 2020, 41(9): 252-261.

SHEN K, LIU T X, ZUO S Q. Observability analysis and robust fusion algorithms of GNSS/INS integrated navigation in complex urban environment[J]. Chinese Journal of Scientific Instrument, 2020, 41(9): 252-261.

[10]
张秋昭, 张书毕, 郑南山, 等. GPS/SINS组合系统的多重渐消鲁棒容积卡尔曼滤波[J]. 中国矿业大学学报, 2014, 43(1): 162-168.

ZHANG Q Z, ZHANG S B, ZHENG N S, et al. Multiple fading robust cubature kalman filter for GPS/SINS integrated navigation[J]. Journal of China University of Mining & Technology, 2014, 43(1): 162-168.

[11]
何康辉, 董朝阳, 王青. 一种考虑GPS信号中断的导航滤波算法[J]. 北京航空航天大学学报, 2019, 45(9): 1874-1881.

HE K H, DONG C Y, WANG Q. A navigation filter algorithm considering GPS signal interruption[J]. Journal of Beijing University of Aeronautics and Astronautics, 2019, 45(9): 1874-1881.

[12]
DONG Y, WANG D J, ZANG L, et al. Tightly coupled GNSS/ INS integration with robust sequential Kalman filter for accurate vehicular navigation[J]. Sensors, 2020, 20(2): 561-579.

[13]
任利简, 赵修斌, 庞春雷, 等. 基于抗差估计改进的GNSS/INS组合导航完好性监测方法[J]. 航天控制, 2021, 39(5): 21-26.

REN L J, ZHAO X B, PANG C L, et al. Improved integrity monitoring method based on robust estimation of GNSS/INS integrated navigation[J]. Aerospace Control, 2021, 39(5): 21-26.

[14]
林雪原, 刘丽丽, 董云云, 等. 改进的GNSS/SINS组合导航系统自适应滤波算法[J]. 武汉大学学报·信息科学版, 2023, 48(1): 127-134.

LIN X Y, LIU L L, DONG Y Y, et al. Improved adaptive filtering algorithm for GNSS/SINS integrated navigation system[J]. Geomatics and Information Science of Wuhan University, 2023, 48(1): 127-134.

[15]
高社生, 洪根元, 高广乐, 等. 基于马氏距离的联邦卡尔曼滤波在SINS/SRS/CNS导航中的应用[J]. 中国惯性技术学报, 2021, 29(2): 142-147.

GAO S S, HONG G Y, GAO G L, et al. Mahalanobis distance based federated Kalman filter for SINS/SRS/CNS integrated navigation system[J]. Journal of Chinese Inertial Technology, 2021, 29(2): 142-147.

[16]
CHEN B D, WANG J J, ZHAO H Q, et al. Convergence of a fixed-point algorithm under maximum correntropy criterion[J]. IEEE Signal Processing Letters, 2015, 22(10): 1723-1727.

[17]
CHANG G B. Robust Kalman filtering based on mahalanobis distance as outlier judging criterion[J]. Journal of Geodesy, 2014, 88(4): 391-401.

Outlines

/

[an error occurred while processing this directive]