摘要
掌握弹箭的滚转姿态信息是飞行制导的必要条件,利用地磁场矢量辅助测量弹体姿态是目前常用的一种方案,其中校准磁强计是准确测量姿态前非常重要的一步;提出了一种基于能量评估的无迹卡尔曼滤波算法(PUKF)校准磁强计并测量姿态;方案利用磁强计敏感轴测量轴矢量方向上的地磁场分量,在时域空间内对测量的数据进行参数评估,快速获取磁强计的初始校准参数,创新地将磁强计初始校准参数与姿态二阶拟合参数共同作为无迹卡尔曼滤波的状态量,在初步测量姿态的同时持续精确校准磁强计,确认校准参数收敛后,对现有无迹卡尔曼滤波算法进行重构,精准测量弹体姿态;通过数值仿真结果表明:所提出的PUKF算法在收敛特性和求解速度上优于传统的校准测量方法。
-
单位中国兵器工业第五九研究所; 中北大学