基于浮点DSP的航姿系统自适应滤波算法与仿真研究

摘要

介绍了在捷联式航姿系统中采用的简化Sage-Husa算法的自适应滤波原理,建立了基于该自适应滤波算法的导航系统状态方程和观测方程,给出了基于TMS320C32浮点数字信号处理器(DSP)的半物理仿真硬件原理图和软件运行流程,并进行了仿真计算.仿真分析结果表明,基于浮点DSP的航姿系统在采用自适应卡尔曼滤波算法时不仅能有效抑制滤波发散,还使系统具有优越的实时性能和较高的精度.