基于双调节因子的GNSS/SINS组合导航Sage-Husa自适应滤波算法

Sage-Husa Adaptive Filtering Algorithm for GNSS/SINS Integrated Navigation Based on Double Regulatory Factors

ES评分 0

DOI 10.14075/j.jgg.2024.08.391
刊名
Journal of Geodesy and Geodynamics
年,卷(期) 2025, 45(7)
作者
作者单位

1 山东外事职业大学人工智能学院, 山东省威海市长江路788号, 264504;
2 海军航空大学, 山东省烟台市, 264001

摘要
在GNSS/SINS组合导航系统中,当测量噪声方差发生变化时,Sage-Husa自适应滤波算法的测量噪声方差估计功能与故障检测功能有可能相互冲突。为解决该问题,首先,根据故障检测函数设计控制因子,对Sage-Husa自适应滤波算法的测量噪声方差估计模型进行在线调整;然后,根据Sage-Husa自适应滤波算法严重依赖遗忘因子的特性,设计动态遗忘因子以对测量噪声方差进行准确跟踪,进而提出一种基于双调节因子(控制因子和动态遗忘因子)的Sage-Husa自适应滤波(DRSHAKF)算法;最后,基于施加了容错功能的Sage-Husa自适应滤波(SHAKF)算法及DRSHAKF算法,进行组合导航系统的仿真实验。结果表明,相对于SHAKF算法,DRSHAKF算法可以将测量噪声方差估计功能与故障检测函数进行有机融合,充分利用有用的测量信息,进而提高系统滤波精度。
Abstract
When the measurement noise variance changes in GNSS/SINS integrated navigation system, the estimation function of measurement noise variance and the fault detection function may conflict with each other in Sage-Husa adaptive filtering algorithm. In order to solve this problem, firstly, we design a control factor according to the fault detection function to adjust the estimation model of measurement noise variance of Sage-Husa adaptive filtering algorithm online. Then, according to the characteristics that Sage-Husa adaptive filtering algorithm relies heavily on forgetting factor, a dynamic forgetting factor is designed to accurately track the measurement noise variance, and a Sage-Husa adaptive Kalman filtering algorithm based on double regulatory factors(DRSHAKF) is proposed. Finally, the simulation experiment of integrated navigation system is carried out based on Sage-Husa adaptive Kalman filtering (SHAKF) algorithm with fault tolerance function and DRSHAKF algorithm. The results show that, compared with SHAKF algorithm, DRSHAKF algorithm can organically integrate measurement noise variance estimation function and fault detection function, make full use of useful measurement information, and improve the filtering accuracy.
关键词
Sage-Husa算法; 自适应滤波算法; 组合导航系统; 遗忘因子; 控制因子
KeyWord
Sage-Husa algorithm; adaptive filtering algorithm; integrated navigation system; forgetting factor; control factor
基金项目
页码 699-704
  • 参考文献
  • 相关文献
  • 引用本文

林雪原, 孙炜玮, 孙晓范. 基于双调节因子的GNSS/SINS组合导航Sage-Husa自适应滤波算法 [J]. 大地测量与地球动力学. 2025; 45; (7). 699 - 704.

  • 文献评论

相关学者

相关机构