ACTA AERONAUTICAET ASTRONAUTICA SINICA >
A robust filtering autonomous navigation method based on interactive dynamic and static multi-models in denied environments
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
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.
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
| [1] | 郭树人, 姜坤, 李星, 等. PNT体系视角下卫星导航与不依赖卫星导航技术融合发展研究[J]. 中国工程科学, 2023, 25(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 CAE, 2023, 25(2): 50-58 (in Chinese). | |
| [2] | 王巍, 孟凡琛, 阚宝玺. 国家综合PNT体系下的多源自主导航系统技术[J]. 导航与控制, 2022, 21(): 1-10. |
| WANG W, MENG F C, KAN B X. Multi-source autonomous navigation system technology under national comprehensive PNT system[J]. Navigation and Control, 2022, 21(Sup 1): 1-10 (in Chinese). | |
| [3] | 王巍, 陈巍, 孟凡琛. 面向多源自主导航的智能学习方法研究[J]. 中国科学: 信息科学, 2024, 54(12): 2778-2793. |
| WANG W, CHEN W, MENG F C. Study on intelligent learning methods for multi-source autonomous navigation[J]. Scientia Sinica (Informationis), 2024, 54(12): 2778-2793 (in Chinese). | |
| [4] | 杨元喜, 任夏, 贾小林, 等. 以北斗系统为核心的国家安全PNT体系发展趋势[J]. 中国科学: 地球科学, 2023, 53(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), 2023, 53(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 Journal, 2023, 23(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 Systems, 2009, 45(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 Journal, 2020, 7(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 Magazine, 2017, 32(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 Systems, 2003, 39(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]. 中国惯性技术学报, 2016, 24(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 Technology, 2016, 24(4): 511-516 (in Chinese). | |
| [12] | 赖际舟, 柳敏, 李志敏, 等. 基于有色噪声自回归建模的惯性/卫星交互多模型滤波导航算法[J]. 导航定位与授时, 2015, 2(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 Timing, 2015, 2(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 Systems, 2012, 13(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 Access, 2020, 8: 81034-81044. |
| [15] | 王巍, 孟凡琛, 徐小明, 等. 融合载体动力学特征的智能多源自主导航方法研究[J]. 宇航学报, 2024, 45(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 Astronautics, 2024, 45(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 Access, 2020, 8: 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]. 航空学报, 2024, 45(): 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 Sinica, 2024, 45(Sup 1): 730782 (in Chinese). | |
| [19] | 南子寒, 刘大禹, 苏牡丹, 等. 拒止环境下基于LSTM神经网络的自主导航方法[J]. 中国惯性技术学报, 2025, 33(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 Technology, 2025, 33(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 Access, 2021, 9: 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 Magazine, 2019, 5(2): 27-36. |
| [22] | 王健, 周立辉, 陈家福, 等. 基于交互多模型的时变平滑变结构滤波算法[J]. 航空学报, 2024, 45(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 Sinica, 2024, 45(21): 330167 (in Chinese). | |
| [23] | 赵靖, 宋丹. 无人机GNSS/IMU组合导航系统完好性监测方法[J]. 航空学报, 2024, 45(7): 328943. |
| ZHAO J, SONG D. Integrity monitoring method for GNSS/IMU integrated navigation system of UAV[J]. Acta Aeronautica et Astronautica Sinica, 2024, 45(7): 328943 (in Chinese). | |
| [24] | 张且且, 方乐, 赖际舟, 等. 基于加权最小GDOP值的快速选星算法[J]. 宇航学报, 2025, 46(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 Astronautics, 2025, 46(1): 108-116 (in Chinese). | |
| [25] | 张召友, 郝燕玲, 吴旭. 3种确定性采样非线性滤波算法的复杂度分析[J]. 哈尔滨工业大学学报, 2013, 45(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 Technology, 2013, 45(12): 111-115 (in Chinese). | |
| [26] | 王巍, 邢朝洋, 冯文帅. 自主导航技术发展现状与趋势[J]. 航空学报, 2021, 42(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 Sinica, 2021, 42(11): 525049 (in Chinese). |
/
| 〈 |
|
〉 |