[发明专利]一种基于导引头测量信息的目标运动信息估计方法

权利要求书

1.一种基于导引头测量信息的目标运动信息估计方法，其特征在于，包含以下步骤：

步骤1、获取导引头测量信息；

步骤2、设计数字滤波器对导引头测量信息进行滤波处理；

步骤3、解算导弹和目标的相对位置、速度信息；

步骤4、根据坐标转换关系，求解目标绝对位置、绝对速度，完成目标运动信息的估计。

2.如权利要求1所述的一种基于导引头测量信息的目标运动信息估计方法，其特征在于，所述的数字滤波器表示为：

y(k)＝-A₁y(k-1)+B₀u(k)+B₁u(k-1)

式中，u表示数字滤波器的输入，其物理意义为导引头测量惯性视线角、惯性视线角速度、相对距离和相对距离变化率信息，y表示数字滤波器输出，u(k)表示kT时刻数字滤波器的输入，u(k-1)表示(k-1)T时刻数字滤波器的输入，y(k)表示kT时刻数字滤波器的输出，y(k-1)表示(k-1)T时刻数字滤波器的输出，A₁,B₀,B₁为数字滤波器参数矩阵，r表示导弹和目标的相对距离，q_e表示惯性视线高低角，q_β表示惯性视线方位角，表示惯性视线高低角速率，表示惯性视线方位角速率，表示导弹和目标的相对距离变化率，符号“～”代表经过滤波后的相应变量。

3.如权利要求1所述的一种基于导引头测量信息的目标运动信息估计方法，其特征在于，所述的导弹和目标的相对位置、速度信息求解方法表示为：

式中，r_bs为导弹和目标的相对位置在视线坐标系下的矢量，V_bs为导弹和目标的相对速度在视线坐标系下的矢量。

4.如权利要求1所述的一种基于导引头测量信息的目标运动信息估计方法，其特征在于，所述的目标绝对位置、绝对速度的求解方法表示为：

式中，r_t表示目标在地面坐标系下的位置矢量，V_t表示目标在地面坐标系下的速度矢量，为视线坐标系到地面坐标系的转换矩阵，r_m表示导弹在地面坐标系下的位置矢量，V_m表示导弹在地面坐标系下的速度矢量。r_m、V_m可根据导弹自身卫星定位或惯测装置测量得到；其中，