Electronics and Electrical Engineering and Control

A robust filtering autonomous navigation method based on interactive dynamic and static multi-models in denied environments

  • Zihan NAN ,
  • Ruiyang ZHOU ,
  • Yongliang WANG ,
  • Dayu LIU ,
  • Ming DONG ,
  • Fanchen MENG
Expand
  • 1.Beijing Institute of Aerospace Control Devices,Beijing 100039,China
    2.Beijing Institute of Electrical Engineering,Beijing 100854,China
    3.Beijing Institute of Tracking and Telecommunications Technology,Beijing 100094,China
    4.Key Laboratory of Smart Earth,Beijing 100094,China

Received date: 2025-04-02

  Revised date: 2025-05-13

  Accepted date: 2025-07-09

  Online published: 2025-07-18

Supported by

National Natural Science Foundation of China(62388101);China Aerospace Science and Technology Corporation Independent Research and Development Project(2024899);State Key Laboratory of Inertial Measurement Stabilization Support Project

Abstract

To meet the application requirements of anti-jamming and enhanced robustness for autonomous navigation systems in complex environments, this paper proposes a Robust Cubature Kalman Filter method based on the Interacting Multiple Model (IMM-RCKF) framework. The method integrates measurement uncertainty quantification and nonlinear filter estimation, leveraging the filter innovation before measurement interruption to dynamically adjust the posterior probability matrix weights through prior knowledge. By optimizing the parametric error model of the robust cubature Kalman filter and adopting a hybrid static-dynamic filtering strategy for interactive fusion, a high-order nonlinear multi-model filter is developed. This architecture significantly enhances the environmental adaptability and interference robustness of the filter. The proposed method is implemented in the autonomous navigation system of a hypersonic aerospace vehicle. Experimental results demonstrate that the IMM-based multi-model filtering approach effectively improves the convergence speed and estimation accuracy of the navigation system. Compared with conventional robust Kalman filtering methods, the position accuracy is increased by approximately 14.3% and the velocity accuracy by 11.2%. Furthermore, the system exhibits superior anti-interference capability, successfully addressing the long-standing challenge of traditional Kalman filters in handling model errors under dynamic uncertainties.

Cite this article

Zihan NAN , Ruiyang ZHOU , Yongliang WANG , Dayu LIU , Ming DONG , Fanchen MENG . A robust filtering autonomous navigation method based on interactive dynamic and static multi-models in denied environments[J]. ACTA AERONAUTICAET ASTRONAUTICA SINICA, 2025 , 46(24) : 332062 -332062 . DOI: 10.7527/S1000-6893.2025.32062

References

[1] 郭树人, 姜坤, 李星, 等. PNT体系视角下卫星导航与不依赖卫星导航技术融合发展研究[J]. 中国工程科学202325(2): 50-58.
  GUO S R, JIANG K, LI X, et al. Integrated development of satellite and satellite-independent navigation technologies from the perspective of PNT system[J]. Strategic Study of CAE202325(2): 50-58 (in Chinese).
[2] 王巍, 孟凡琛, 阚宝玺. 国家综合PNT体系下的多源自主导航系统技术[J]. 导航与控制202221(): 1-10.
  WANG W, MENG F C, KAN B X. Multi-source autonomous navigation system technology under national comprehensive PNT system[J]. Navigation and Control202221(Sup 1): 1-10 (in Chinese).
[3] 王巍, 陈巍, 孟凡琛. 面向多源自主导航的智能学习方法研究[J]. 中国科学: 信息科学202454(12): 2778-2793.
  WANG W, CHEN W, MENG F C. Study on intelligent learning methods for multi-source autonomous navigation[J]. Scientia Sinica (Informationis)202454(12): 2778-2793 (in Chinese).
[4] 杨元喜, 任夏, 贾小林, 等. 以北斗系统为核心的国家安全PNT体系发展趋势[J]. 中国科学: 地球科学202353(5): 917-927.
  YANG Y X, REN X, JIA X L, et al. Development trends of the national secure PNT system based on BDS[J]. Scientia Sinica (Terrae)202353(5): 917-927 (in Chinese).
[5] YE X Y, SONG F J, ZHANG Z Y, et al. A review of small UAV navigation system based on multisource sensor fusion[J]. IEEE Sensors Journal202323(17): 18926-18948.
[6] KIM K H, LEE J G, PARK C G. Adaptive two-stage extended Kalman filter for a fault-tolerant INS-GPS loosely coupled system[J]. IEEE Transactions on Aerospace and Electronic Systems200945(1): 125-137.
[7] FENG D Q, WANG C Q, HE C L, et al. Kalman-filter-based integration of IMU and UWB for high-accuracy indoor positioning and navigation[J]. IEEE Internet of Things Journal20207(4): 3133-3146.
[8] KIM J, CHENG J T, GUIVANT J, et al. Compressed fusion of GNSS and inertial navigation with simultaneous localization and mapping[J]. IEEE Aerospace and Electronic Systems Magazine201732(8): 22-36.
[9] RONG LI X, JILKOV V P. Survey of maneuvering target tracking. PartⅠ. Dynamic models[J]. IEEE Transactions on Aerospace and Electronic Systems200339(4): 1333-1364.
[10] BAR-SHALOM Y, LI X R, KIRUBARAJAN T. Estimation with applications to tracking and navigation: Theory, algorithms and software[M]. New York: John Wiley & Sons, 2002: 121-177.
[11] 王磊, 程向红, 李双喜, 等. 自适应交互式多模型AUV组合导航算法[J]. 中国惯性技术学报201624(4): 511-516.
  WANG L, CHENG X H, LI S X, et al. Adaptive interacting multiple model filter for AUV integrated navigation[J]. Journal of Chinese Inertial Technology201624(4): 511-516 (in Chinese).
[12] 赖际舟, 柳敏, 李志敏, 等. 基于有色噪声自回归建模的惯性/卫星交互多模型滤波导航算法[J]. 导航定位与授时20152(6): 19-24.
  LAI J Z, LIU M, LI Z M, et al. Interacting multiple model filter algorithm of the inertial/GPS integrated system based on the colored noise regression modeling[J]. Navigation Positioning and Timing20152(6): 19-24 (in Chinese).
[13] JO K, CHU K, SUNWOO M. Interacting multiple model filter-based sensor fusion of GPS with in-vehicle sensors for real-time vehicle positioning[J]. IEEE Transactions on Intelligent Transportation Systems201213(1): 329-343.
[14] LIU X H, LIU X X, ZHANG W G, et al. Interacting multiple model UAV navigation algorithm based on a robust cubature Kalman filter[J]. IEEE Access20208: 81034-81044.
[15] 王巍, 孟凡琛, 徐小明, 等. 融合载体动力学特征的智能多源自主导航方法研究[J]. 宇航学报202445(4): 550-559.
  WANG W, MENG F C, XU X M, et al. Research on intelligent multi-source autonomous navigation method integrating carrier dynamics characteristics[J]. Journal of Astronautics202445(4): 550-559 (in Chinese).
[16] CUI B B, WEI X H, CHEN X Y, et al. Performance enhancement of robust cubature Kalman filter for GNSS/INS based on Gaussian process quadrature[J]. IEEE Access20208: 25596-25604.
[17] LI S P, WANG P, MU R J, et al. Augmented robust cubature Kalman filter applied in re-entry vehicle tracking[C]∥2021 IEEE Aerospace Conference. Piscataway: IEEE Press, 2021.
[18] 南子寒, 刘大禹, 董明, 等. GNSS拒止下多源自主导航鲁棒滤波方法[J]. 航空学报202445(): 730782.
  NAN Z H, LIU D Y, DONG M, et al. Robust filtering method for GNSS denied multi-source autonomous navigation[J]. Acta Aeronautica et Astronautica Sinica202445(Sup 1): 730782 (in Chinese).
[19] 南子寒, 刘大禹, 苏牡丹, 等. 拒止环境下基于LSTM神经网络的自主导航方法[J]. 中国惯性技术学报202533(4): 331-339, 349.
  NAN Z H, LIU D Y, SU M D, et al. Autonomous navigation method based on LSTM neural network in denial environment[J]. Journal of Chinese Inertial Technology202533(4): 331-339, 349 (in Chinese).
[20] SUN W, LIU J Z. RCKF cooperative navigation algorithm for tightly coupled vehicle ad hoc networks based on Huber M estimation[J]. IEEE Access20219: 139888-139895.
[21] ZHAO S Y, AHN C K, SHI P, et al. Bayesian state estimation for Markovian jump systems: Employing recursive steps and pseudocodes[J]. IEEE Systems, Man, and Cybernetics Magazine20195(2): 27-36.
[22] 王健, 周立辉, 陈家福, 等. 基于交互多模型的时变平滑变结构滤波算法[J]. 航空学报202445(21): 330167.
  WANG J, ZHOU L H, CHEN J F, et al. Time-varying smooth variable structure filter based on interactive multi-model[J]. Acta Aeronautica et Astronautica Sinica202445(21): 330167 (in Chinese).
[23] 赵靖, 宋丹. 无人机GNSS/IMU组合导航系统完好性监测方法[J]. 航空学报202445(7): 328943.
  ZHAO J, SONG D. Integrity monitoring method for GNSS/IMU integrated navigation system of UAV[J]. Acta Aeronautica et Astronautica Sinica202445(7): 328943 (in Chinese).
[24] 张且且, 方乐, 赖际舟, 等. 基于加权最小GDOP值的快速选星算法[J]. 宇航学报202546(1): 108-116.
  ZHANG Q Q, FANG L, LAI J Z, et al. A fast satellite selection algorithm based on weighted minimum GDOP[J]. Journal of Astronautics202546(1): 108-116 (in Chinese).
[25] 张召友, 郝燕玲, 吴旭. 3种确定性采样非线性滤波算法的复杂度分析[J]. 哈尔滨工业大学学报201345(12): 111-115.
  ZHANG Z Y, HAO Y L, WU X. Complexity analysis of three deterministic sampling nonlinear filtering algorithms[J]. Journal of Harbin Institute of Technology201345(12): 111-115 (in Chinese).
[26] 王巍, 邢朝洋, 冯文帅. 自主导航技术发展现状与趋势[J]. 航空学报202142(11): 525049.
  WANG W, XING C Y, FENG W S. State of the art and perspectives of autonomous navigation technology[J]. Acta Aeronautica et Astronautica Sinica202142(11): 525049 (in Chinese).
Outlines

/