基于AFCKF的捷联旋转弹视线角速率滤波算法

针对捷联旋转弹输出的视线角速率与姿态误差强耦合的问题,提出一种基于自适应渐消容积卡尔曼滤波(AFCKF)的方法。为实现弹目视线角速率的解耦,考虑弹目相对运动特性,构建包含末制导段视线角速率估计模型的状态模型,并根据几何关系建立了包含弹目视线角和姿态角的量测模型。为解决旋转弹下传统CKF视线角速率估计结果的发散导致滤波失效,引入基于残差序列的渐消因子对预测状态协方差进行调节以快速收敛估计结果。为验证AFCKF的有效性,考虑姿态角和量测角的典型干扰。仿真结果表明,所提方法的视线高低角速率估计误差均值、方位角速率估计误差均值分别为传统EKF的30.41%和42.18%,有效提升了旋转弹视线角速率估计的精度。