[发明专利]一种半捷联寻的导引头的制导信息构造方法

摘要

本发明涉及一种导弹制导信息构造方法，特别涉及一种半捷联寻的导引头制导信息构造方法，属于导弹制导系统设计技术领域。本发明提出一种新的半捷联寻的导引头制导信息构造方法，该方法基于Unscented卡尔曼滤波器(UKF)进行框架角速率估计，然后进行制导信息构造，有效提高了制导信息的构造精度，防止了直接对框架角微分得到角速率的方法所造成的误差放大，而且比采用EKF滤波构造得到的制导信息精度高，能在干扰情况下控制导弹按比例导引飞向目标。可广泛应用于各类半捷联寻的制导武器中，具有重要的军事应用前景。

主权项

1、一种半捷联寻的导引头的制导信息构造方法，其特征在于：构造制导信息，用于控制带有半捷联寻的导引头的导弹准确命中目标；采用Unscented卡尔曼滤波器UKF，用于得到框架角速率比较准确的估计值；为了采用UKF进行滤波估计，首先需要建立半捷联寻的导引头框架动力学数学模型，然后建立框架动力学的滤波状态方程和测量方程，进行框架角速率信息的递推滤波估计；具体实现步骤如下：1)建立半捷联寻的导引头框架动力学数学模型根据动量矩定理，建立两框架半捷联寻的导引头的框架动力学模型：λ··z=Toz-β3α3Toy-[(β1+δ1)-β3(α1+γ1)α3]λ·y-[(β2+δ2)-β3(α2+γ2)α3]λ·z-δ4λ·yλ·z-δ3λ·y2-[(β5+δ5)-β3(α5+γ3)α3]β4-α4β3α3]]>λ··y=1α3[Toy-(α1+γ1)λ·y-(α2+γ2)λ·z-α4λ··z-α5-γ3]]]>其中：α1=I·yin/0]]>α2=I·yzin/0]]>α3=Iyin/0+Iy0]]>α4=Iyzin/0]]>α5=a·(Ixy0+Ixyin/0)+aI·xyin/0+b·(Iy0+Iyin/0)+bI·yin/0+c·(Iyz0+Iyzin/0)+cI·yzin/0]]>γ1=c(Ixy0+Ixyin/0)-a(Iyz0+Iyzin/0)]]>γ2=cIxzin/0-aIzin/0]]>γ3=ac((Ix0+Ixin/0)-(Iz0+Izin/0))+bc(Ixy0+Ixyin/0)+(c2-a2)(Ixz0+Ixzin/0)-ab(Iyz0+Iyzin/0)]]>β1=I·yzin/0]]>β2=I·zin/0]]>β3=Iyzin/0]]>β4=Izin/0]]>β5=a·Ixzin/0+aI·xzin/0+b·Iyzin/0+bI·yzin/0+c·Izin/0+cI·zin/0]]>δ1=a(Iyin/0-Ixin/0)-2bIxyin/0-cIxzin/0]]>δ2=aIyzin/0-bIxzin/0]]>δ3=-Ixyin/0]]>δ4=-Ixzin/0]]>δ5=(a2-b2)Ixyin/0+ab(Iyin/0-Ixin/0)+acIyzin/0-bcIxzin/0]]>abc=Wmxcosλy-WmzsinλyWmyWmxsinλy+Wmzcosλy]]>a·b·c·=W·mxcosλy-Wmxλ·ysinλy-W·mzsinλy-Wmzλ·ycosλyW·myW·mxsinλy+Wmxλ·ycosλy+W·mzcosλy-Wmzλ·ysinλy]]>IxinIxyinIxzinIxyinIyinIyzinIxzinIyzinIzin]]>为内框连同光电负载的转动惯量；IxoIxyoIxzoIxyoIyoIyzoIxzoIyzoIzo]]>为外框转动惯量；λ_z，λ_y分别为俯仰框架角和偏航框架角；W_mx、W_my、W_mz为导弹旋转角速度；T_oz为内框力矩电机产生的驱动力矩；T_oy为外框力矩电机产生的驱动力矩；2)建立半捷联寻的导引头框架动力学的滤波状态方程和测量方程定义状态变量x₁＝λ_zx2=λ·z]]>x₃＝λ_yx4=λ·y]]>控制变量为：u＝[T_oz  T_oy]^T则其状态方程和测量方程为：x·=F(x,u)+w]]>y＝[λ_z λ_y]^T＝Hx+vw为状态噪声，v为测量噪声滤波前，首先将上述微分方程转化为等效离散模型；3)UKF滤波器初始化4)计算2L+1个sigma点x_i和它们的权值5)滤波器时间更新6)滤波器测量更新7)构造制导信息，对导弹进行导引半捷联寻的导引头的制导信息由弹体旋转角速率、框架角速度和目标在像平面的移动角速度组成；其中框架角速率由上述UKF滤波得到，弹体旋转角速率由弹上惯性测量组件得到，目标在像平面的移动角速度由探测器测得的误差角经滤波微分得到；根据自动驾驶仪要求，将制导信息转换到所需要的坐标系中，即对导弹进行导引飞行；8)判断是否已进入导引头盲区，若是则停止滤波，导弹导引信息归零；否则转到4)；至此，通过上述8个步骤完成了基于UKF的半捷联寻的导引头制导信息的构造，能够控制带有半捷联寻的导引头的导弹准确命中目标。