基于抗差平方根容积卡尔曼滤波的惯导姿态空中修正算法

MEMS加速度计和陀螺仪在近程末端战术导弹中已大量使用,受其精度限制,导弹的惯导解算误差不可忽略,对复合制导体制的制导模式空中交班可能存在较大影响。为实现导弹飞行过程中惯导姿态误差的有效修正,提升导弹中末制导交班概率,文中提出一种基于抗差平方根容积卡尔曼滤波的惯导姿态空中修正算法,建立适用近程末端战术导弹的惯导姿态误差空中估计模型,利用地面跟踪雷达对导弹位置的观测信息,结合SRCKF滤波与抗差算法,对惯导姿态误差角进行估计与修正,降低导弹飞行过程中的姿态误差。仿真结果表明,基于抗差SRCKF的惯导姿态空中修正算法可显著降低导弹飞行过程中的姿态解算误差,且能够大幅抑制地面雷达观测粗差对修正效果的影响,验证了算法的有效性和鲁棒性。