[发明专利]一种针对导引头失效模式下的数据链末制导方法

权利要求书

1.一种针对导引头失效模式下的数据链末制导方法，其特征在于，包括以下步骤：

S1、利用中制导数据链和导弹导航信息计算弹目相对距离，判断导引头是否失效；导引头失效状态确定，具体为：

(a)确定导弹和目标视线坐标系的位置和速度，计算弹目相对距离

(b)当弹目相对距离小于导引头截获距离R时，延迟1s，导引头向导弹飞控计算机发送截获标志，导弹飞控计算机接收到截获标志后转入末制导；

(c)当弹目相对距离小于导引头截获距离R，延迟1s后，导引头未给出截获标志，则表明导弹进入导引头失效模式，导弹经由下传数据链将导引头失效标志发送至发射平台；

S2、确认导引头失效，发射平台将中制导数据链切换至匹配导引头更新周期的末制导数据链，实时向导弹发送目标信息；目标信息通过地面雷达来检测和解算，并每隔几毫秒到几十毫秒发送一次目标信息；其中，中制导数据链和末制导数据链切换，具体为：

当发射平台接收到导引头失效标志，将更新率低的中制导数据链切换至匹配导引头更新周期的末制导数据链，并通过下行数据链向导弹发送目标信息；

S3、导弹飞控计算机根据接收到的目标信息实时检测并修正末制导数据链中的目标在视线坐标系中的位置和速度；

S4、导弹飞控计算机根据末制导数据链实时发送的目标在视线坐标系下的位置和速度信息，解算视线坐标系下导弹的视线角速度；

S5、根据视线坐标系下导弹的视线角速度解算弹体坐标系下的过载指令；视线坐标系下的过载指令解算如下：

依据比例导引律形成视线坐标系下三维空间制导指令：

将视线坐标系下制导指令转换为弹体坐标系下的过载指令：

其中N为比例导引律导航系数，V_ref比例制导律速度参数，a_ylosC、a_zlosC为导弹加速度指令在视线坐标系下Y、Z方向上的分量，为视线坐标系下Y、Z方向视线角速度，a_ybodyC、a_zbodyC为导弹过载指令在弹体坐标系下的Y、Z方向上的分量；α、β为视线坐标系和弹体坐标系之间的欧拉角；

S6、将过载指令发送给导弹控制系统，驱动舵机向目标位置机动。