栗 飞,王炎舜,龚 铮
(1.海军驻洛阳地区军事代表室,河南洛阳 471009;2.中国空空导弹研究院,河南洛阳 471009)
红外制导导弹由于其测量器件的限制,只能得到弹目视线角及视线角速度测量信息,而现代制导律为了改善制导回路的性能,通常需要目标的机动信息。因此,提高目标机动估计精度,已成为制约红外制导导弹性能提升的核心问题。
基于角量测量的状态方程与量测方程存在非线性关系[1]。但若采用扩展Kalman(EKF)与粒子滤波(PF)技术等非线性估计方法,又极大地增加了模型的复杂性与运算量。因此,还需进一步研究以线性模式为基础的目标机动估计算法[2]。针对上述问题,本文设计了一种递推的Kalman滤波器,通过构造惯性空间视线角估值残差,进一步得到弹目相对位置的线偏差,实现对目标机动信息的精确估计,并通过仿真验证了算法设计的正确性。

图1 运动模型示意图

由于导弹自身的位置、速度、加速度可由捷联惯导获得,因此Kalman滤波观测器中只考虑选取3个状态[3],即
(1)

系统状态方程为

(2)
(3)
卡尔曼滤波由增益更新方程和状态更新方程两部分构成[4],卡尔曼滤波的相关方程为
协方差预测方程

(4)
状态预测方程
xk/k-1=Φkxk-1+Gkuk-1
(5)
增益运算方程
Kk=MkHT(HMkHT+Rk)-1
(6)
协方差估值方程
Pk=(I-KkH)Mk
(7)
状态估值方程
xk=xk/k-1+Kk(zk-zk/k-1)=
Φkxk-1+Gkuk-1+Kk(zk-HΦkxk-1-HGkuk-1)
(8)
进一步展开有
(9)
其中,




图2 弹目相对关系示意图
由图2,可以得到

(10)
取R≈R*则上式可表示为

(11)
其中,q为导引头视线角的量测值,可直接得到。

(12)
红外制导导弹近距格斗场景……