带大落角约束中制导和末制导交接与制导信息的处理方法技术

本发明专利技术涉及一种带大落角约束中制导和末制导交接与制导信息的处理方法，属于制导飞行器技术领域。本发明专利技术的目的是提出一种带大落角约束中制导和末制导交接与制导信息的处理方法，该方法根据惯导测量的弹体位置、速度、姿态信息等，处理得到中制导和末制导所需的制导信息；以及中制导和末制导交接策略，以及中制导和末制导过载指令；以保证飞行器在中制导段飞行更远，在末制导段形成大落角，同时能够精确打击目标。

【技术实现步骤摘要】
带大落角约束中制导和末制导交接与制导信息的处理方法
本专利技术涉及一种带大落角约束中制导和末制导交接与制导信息的处理方法，属于制导飞行器

技术介绍
为提升深埋加固目标、桥洞下目标、楼宇内目标的空地打击能力，以及载机防区外投放能力，迫切要求发展射程远、大落角、大落速、机动性能好的制导飞行器。不断丰富空地打击手段，增强打击能力，特别是发展精确打击敌方坚固、深层目标的能力。为保证制导飞行器射程、落角、落速要求，需要设计新的气动布局、弹道方案和制导控制策略。常规的制导飞行器中制导段采用无控弹道，因此飞行距离近、投放区域小。为实现制导飞行器具有一定的高空滑翔能力，又要满足低空滑翔的机动能力，采用鸭式气动布局方案，即折叠尾翼、无尾式带后缘舵的正常式气动布局。采用初始稳定段、滑翔中制导段和大落角末制导段结合的弹道方案。中制导段采用以弹道倾角、投放角、重力补偿等为多项式的弹道倾角跟踪方案。末制导采用以比例导引、视线角约束、重力补偿、滑模控制项组合的带大落角约束的滑模变结构制导律。中制导和末制导的控制目标以及所需的测量信息不同，而且中末制导交接点对弹道轨迹和末制导效果有较大影响，因此需要设计合理的中制导和末制导交接班策略，以及制导信息处理方法。
技术实现思路
本专利技术的目的是提出一种带大落角约束中制导和末制导交接与制导信息的处理方法，该方法根据惯导测量的弹体位置、速度、姿态信息等，处理得到中制导和末制导所需的制导信息；以及中制导和末制导交接策略，以及中制导和末制导过载指令；以保证飞行器在中制导段飞行更远，在末制导段形成大落角，同时能够精确打击目标。本专利技术的目的是通过下述技术方案实现的。带大落角约束中制导和末制导交接与制导信息的处理方法，具体实现步骤如下：步骤一、利用导航测量的导弹在地面坐标系的位置信息Xm,Ym,Zm，速度信息Vx,Vy,Vz和已知的地面坐标系下目标位置Xt,Yt,Zt，计算得到地面坐标系下的高低视线角qes，方位视线角qbs以及高低视线角速度和方位视线角速度Xg＝Xt-Xm,Yg＝Yt-Ym,Zg＝Zt-Zm(1)其中Tanx＝(Yg/Sqrtx)。目标相对于导弹的相对位置坐标(Xg,Yg,Zg)。所述的地面坐标系为以发射点为坐标原点，以发射点在水平面上的投影与目标点的连线为X轴，朝向目标点为正方向；以垂直于水平面的方向为Y轴，朝向天空为正方向；坐标轴Z与X和Y轴成右手坐标系。步骤二、利用导航设备测量信息，计算弹目相对距离Rg、合成速度Vc、弹道偏角ψV和弹道倾角θd信息。θd＝atan(Vy/Vx)(6)ψV＝atan(-Vz/Vx)(7)步骤三、制导飞行器在过机动点之前，所有实时测量信息从导航系统获得，按照如下中制导律产生的过载指令进行滑翔飞行。Uf1＝a-H/Hr-b×Vr/Vc+57.3c×Q0-57.3θd+d×cos(θd)(8)其中Uf1和Uf2分别为俯仰和偏航方向过载指令，相对高度H＝Yg，Q0为投放时刻弹道倾角，Vr为飞行器标称飞行速度，Hr,a,b,c,d,l,m为系数。步骤四、判断当前状态信息是否满足机动点交接班条件。判断当前高低视线角qes与期望的末端落角qd之差是否大于等于qε；判断当前飞行高度Yg大于等于Yzh；qε与Yzh为根据需求预先设定的参数；若当前飞行状态信息同时满足上述两个条件，则说明飞行器到达机动点，此时进入末制导控制段；否则进入中制导控制段，即按照步骤三的方法进行滑翔飞行；步骤五、进入末制导控制段；完成从中制导段向末制导段制导指令的切换。步骤5.1、采用指数淡入的方式进行中制导段向末制导段制导指令切换，保证制导指令平稳切换。Rksa＝e(-(t1-t1a)/1.0)Uf1b＝Uf1×Rksa+Acc_y×(1-Rksa)(10)Uf2b＝Uf2×Rksa+Acc_z×(1-Rksa)其中，t1为由弹载计算机给出的当前飞行时刻，t1a为刚进入机动点的时刻，Rksa指令交接指数系数，Uf1、Uf2为中制导段俯仰和偏航方向过载指令，Acc_y、Acc_z为末制导段俯仰和偏航方向过载指令，Uf1b、Uf2b为制导系统输出的指令融合后俯仰和偏航方向过载指令。步骤5.2、末制导阶段，所有实时测量信息从导航系统获得并处理，纵向和侧向分别按照如下末制导律产生的过载指令进行飞行。Acc_y＝(Acc1+Acc2+Acc3+Ug)×Rkk(11)其中l1、m1、Rkk为比例系数，Acc1、Acc2、Acc3、Ug分别为各项过载指令分量，由步骤5.3～5.6计算可得。步骤5.3、计算比例导引项过载指令Acc1：其中Xk_bili、Clamda为系数。Rb_l1＝Rg/(Rg+d1)(14)其中d1为系数。步骤5.4、计算落角约束项过载指令Acc2：Acc2＝Vc×(Xk_bili+1)×Clamda×Rb_l2×(qes-qd)/(Rg+d2)/57.3(15)Rb_l2＝Rg/(Rg+d2)(16)其中Rb_l2为中间变量，d2为系数。步骤5.5、计算滑模控制项过载指令Acc3：Acc3＝Epsl×Sgns×Rb_l1(17)其中Epsl为系数。饱和函数项Sgns计算公式为：步骤5.6、计算重力补偿项过载指令Ug：Ug＝9.8×cos(θd)＝9.8×cos(atan(Vy/Vx))(20)其中θd为弹道倾角。有益效果本专利技术提供了一种基于导航测量输出信息的中制导和末制导交接策略以及制导信息处理方法。提出了基于弹道倾角、投放角、高度、和速度的大落角制导飞行器中制导律，设计了中制导律、末制导律切换逻辑，以及中制导段和末制导段制导信息处理方法和平稳切换方法，能够以保证飞行器在中制导段飞行更远，在末制导段形成大落角，同时能够精确打击目标。附图说明图1为本专利技术具体实施方式中制导飞行器弹道方案实施方法；图2为中制导律和末制导律切换判断条件；图3为三维弹道曲线；图4为纵向弹道曲线；图5为侧向弹道曲线；图6为弹道倾角曲线；图7为速度曲线。具体实施方式下面结合附图与实施例对本专利技术作进一步说明实施例1本实施例以空地打击制导飞行器为例，目标点海拔高度1000m，投放高度为5000m，投放速度为Vr＝250m/s，投放角Q0为0度，离轴发射角为5.3度，目标位于水平距离制导飞行器10000m的位置，期望的落角qd＝-70度。制导飞行器的飞行弹道方案如图1所示，分为稳定段、中制导段和末制导段，本专利技术针对后两个制导阶段。带大落角约束中制导和末制导交接与制导信息处理方法，具体实现步骤本文档来自技高网...

【技术保护点】
1.带大落角约束中制导和末制导交接与制导信息的处理方法，其特征在于：具体实现步骤如下：/n步骤一、利用导航测量的导弹在地面坐标系的位置信息X

【技术特征摘要】
1.带大落角约束中制导和末制导交接与制导信息的处理方法，其特征在于：具体实现步骤如下：
步骤一、利用导航测量的导弹在地面坐标系的位置信息Xm,Ym,Zm，速度信息Vx,Vy,Vz和已知的地面坐标系下目标位置Xt,Yt,Zt，计算得到地面坐标系下的高低视线角qes，方位视线角qbs以及高低视线角速度和方位视线角速度
Xg＝Xt-Xm,Yg＝Yt-Ym,Zg＝Zt-Zm(1)






其中Tanx＝(Yg/Sqrtx)；目标相对于导弹的相对位置坐标(Xg,Yg,Zg)；
所述的地面坐标系为以发射点为坐标原点，以发射点在水平面上的投影与目标点的连线为X轴，朝向目标点为正方向；以垂直于水平面的方向为Y轴，朝向天空为正方向；坐标轴Z与X和Y轴成右手坐标系；
步骤二、利用导航设备测量信息，计算弹目相对距离Rg、合成速度Vc、弹道偏角ψV和弹道倾角θd信息；






θd＝atan(Vy/Vx)(6)
ψV＝atan(-Vz/Vx)(7)
步骤三、制导飞行器在过机动点之前，所有实时测量信息从导航系统获得，按照如下中制导律产生的过载指令进行滑翔飞行；
Uf1＝a-H/Hr-b×Vr/Vc+57.3c×Q0-57.3θd+d×cos(θd)(8)



其中Uf1和Uf2分别为俯仰和偏航方向过载指令，相对高度H＝Yg，Q0为投放时刻弹道倾角，Vr为飞行器标称飞行速度，Hr,a,b,c,d,l,m为系数；
步骤四、判断当前状态信息是否满足机动点交接班条件；
判断当前高低视线角qes与期望末端视线角qd之差是否大于等于qε；判断当前飞行高度Yg大于等于Yzh；qε与Yzh为根据需求预先设定的参数；若当前飞行状态信息同时满足上述两个条件，则说明飞行器到达机动点，此时进入末制导控制段；否则进入中制导控制段，即按照步骤三的方法进行滑翔飞行；
步骤五、进入末制导控制段；完成从中制导段...

【专利技术属性】
技术研发人员：贾庆忠，刘俊辉，单家元，刘永善，丁艳，
申请(专利权)人：北京理工大学，
类型：发明
国别省市：北京;11