基于容积卡尔曼滤波的全捷联制导信息估计算法

摘要

Aiming at the problem that the line-of-sight (LOS)angle of strapdown laser-guided munitions could not be measure directly,an estimation algorithm of strapdown guidance information based on cubature Kalman filter (CKF)was proposed.According to the ballistic characteristics of guided ammunition and the relationship between the missile and the target,the projectile motion model and LOS model were built as state model.By taking the advantage of the geometrical relationship between projectile and target and the transformational rela-tion with the coordinate system,the LOS in inertial system was acquired as measurement model.Because of the high nonlinear characteristics of the founded model,the cubature Kalman filter was adopted to estimate the LOS angle and the attitude angle.The digital simulation model was established,and the result showed that the esti-mation algorithm met the demands of guidance information accuracy.%针对全捷联制导弹药视线角不能直接测量的问题,提出基于容积卡尔曼滤波(Cubature Kalman Fil-ter,CKF)的全捷联制导信息估计算法.该算法根据制导弹药弹道特性以及弹目相对运动特性,建立弹体运动模型及弹目视线模型作为状态模型;利用弹体与目标的几何关系以及坐标系间的转换关系得到的惯性系下的弹目视线角度,建立量测模型;针对所建立模型非线性程度较高的特点,采用容积卡尔曼滤波的方法对弹体姿态角以及弹目视线角进行滤波估计.建立数字仿真模型进行验证,实验结果表明,该算法能够满足制导信息精度的要求,并且具有一定的稳定性.