[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]

一种GNSS/SINS组合导航的改进鲁棒滤波算法

  • 孙玉梅 ,
  • 王学伟 ,
  • 任宪洁
展开
  • 潍坊科技学院计算机学院,山东 潍坊 262700

孙玉梅(1974—),女,教授,硕士,研究方向:导航新技术、智能检测和信息处理。

收稿日期: 2023-07-27

  网络出版日期: 2024-12-28

基金资助

山东省高层次人才科研启动项目(KJRC2022009)

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

摘要

GNSS/SINS(全球卫星导航/捷联惯性导航)组合导航系统的最优卡尔曼滤波需要满足测量值为高斯分布的假设条件,否则将会导致滤波精度下降甚至发散。鲁棒滤波是解决上述问题的有效方法,但在提高滤波精度方面存在一定的局限性。为了解决该问题,基于马氏距离和牛顿迭代法提出了一种改进的鲁棒滤波方法。首先,根据马氏距离判断测量值是否存在异常;然后,根据牛顿迭代法引入一个比例因子以对测量噪声协方差矩阵进行优化与调整,进而较精确地调整测量值与系统模型信息在滤波过程中的比重;最后,基于最优卡尔曼滤波(KF)、传统鲁棒卡尔曼滤波(RKF)及文中提出的改进鲁棒卡尔曼滤波(IRKF)对GNSS/SINS组合导航系统进行仿真分析及性能对比。实验结果表明,相对于KF,IRKF可提高位置及速度精度分别为14.1%及13.8%,相对于RKF,IRKF可提高位置及速度精度分别为8.1%及7.7%。

本文引用格式

孙玉梅 , 王学伟 , 任宪洁 . 一种GNSS/SINS组合导航的改进鲁棒滤波算法[J]. 弹箭与制导学报, 2024 , 44(1) : 6 -12 . DOI: 10.15892/j.cnki.djzdxb.2024.01.002

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.

[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.

文章导航

/

[an error occurred while processing this directive]