面向变质心飞行器的工程化再入制导方法技术

本发明专利技术公开了一种面向变质心飞行器的工程化再入制导方法，用于解决现有变质心飞行器再入制导方法工程应用性差的技术问题。技术方案是基于工程中最常见的比例制导律，将变质心飞行器落速落角约束转化为一增广项，进一步对该增广项参数进行鲁棒性扩维设计，使得制导参数为变质心飞行器飞行状态偏差量的函数，在变质心飞行器受干扰作用时保证制导精度，最后基于需用过载与可用过载关系确定制导指令即滚转角指令大小。本发明专利技术在比例制导律的基础上，增加考虑落角和落速约束的增广项，实现弹道抬升和降低，保证落角和落速约束同时满足，在此基础上对增广项系数进行鲁棒性扩维设计，是一种形式简单具有良好工程应用性能的变质心飞行器强鲁棒制导方法。

Engineering reentry guidance method for metamorphic center vehicle

The invention discloses an engineering reentry guidance method for a metamorphic center vehicle, which is used to solve the technical problem of poor engineering applicability of the existing metamorphic center vehicle reentry guidance method. The technical scheme is based on the most common proportional guidance law in engineering, which transforms the landing angle constraint of the metamorphic center vehicle into an augmentation term, and further designs the augmentation term parameter with robustness, so that the guidance parameter is a function of the flight state deviation of the metamorphic center vehicle, and ensures the guidance accuracy when the metamorphic center vehicle is disturbed. Finally, based on the need for overload and availability The overload relation determines the guidance instruction, that is, the roll angle instruction. On the basis of the proportional guidance law, the invention increases the augmentation term considering the landing angle and the landing speed constraint, realizes the ballistic lifting and reducing, and ensures that the landing angle and the landing speed constraint are met at the same time. On this basis, the augmentation term coefficient is designed with robustness expansion, which is a kind of strong robust guidance method of metamorphic center vehicle with simple form and good engineering application performance.

【技术实现步骤摘要】
面向变质心飞行器的工程化再入制导方法
本专利技术涉及一种变质心飞行器再入制导方法，特别涉及一种面向变质心飞行器的工程化再入制导方法。
技术介绍
一维变质心飞行器通常采用固定配平型设计，它是一种简单、易实现的再入飞行器构型。固定配平型飞行器利用自身静稳定性实现俯仰和偏航运动自稳定，只需对滚转通道进行控制即可实现机动飞行。然而，滚转单通道控制模式下，飞行器过载仅方向可控、大小不可控，这为落速落角约束的固定配平型变质心飞行器强鲁棒制导带来挑战。针对带落角落速终端约束的固定配平型变质心飞行器制导问题，葛振振在其硕士学位论文“变质心再入弹头轨迹规划与制导控制系统设计[D].葛振振.西安:西北工业大学硕士学位论文,2015”中提出一种标称轨迹跟踪制导方法，利用模拟退火算法和直接打靶法，寻优得到一条满足落角和落速约束的可飞标称轨迹，通过跟踪这一标称轨迹，较好的解决了固定配平型变质心飞行器的多约束制导问题。但该方法工程应用性较差：一方面基于寻优算法确定的标称轨迹难以复现；另一方面，需离线加载大量标称轨迹信息，给机载计算机存储能力和运行速度提出更高要求。
技术实现思路
为了克服现有变质心飞行器再入制导方法工程应用性差的不足，本专利技术提供一种面向变质心飞行器的工程化再入制导方法。该方法基于工程中最常见的比例制导律，将变质心飞行器落速落角约束转化为一增广项，进一步对该增广项参数进行鲁棒性扩维设计，使得制导参数为变质心飞行器飞行状态偏差量的函数，在变质心飞行器受干扰作用时保证制导精度，最后基于需用过载与可用过载关系确定制导指令即滚转角指令大小。本专利技术在最基本的比例制导律的基础上，增加考虑落角和落速约束的增广项，实现弹道抬升和降低，保证落角和落速约束同时满足，在此基础上对增广项系数进行鲁棒性扩维设计，使增广项作用大小与飞行器当前飞行状态和标称状态的偏差相关，实现制导方法强鲁棒特性，是一种形式简单具有良好工程应用性能的变质心飞行器强鲁棒制导方法。本专利技术解决其技术问题所采用的技术方案：一种面向变质心飞行器的工程化再入制导方法，其特点是包括以下步骤：步骤一、比例制导律增广。定义地面坐标系为exeyeze，简记为e：原点e取初始时刻飞行器质心o在地面投影点；eye在地心OE与飞行器质心o的连线上，指向飞行器质心o为正；而exe在过e点垂直于eye的平面内，指向目标点；exeyeze构成右手直角坐标系。定义视线坐标系oξoηoζo，简记为S：原点在飞行器质心o处；oξo由飞行器质心指向目标点；oζo在水平面内，即在e-xz平面内，且与oξo轴垂直，沿着oξo正向看去向右为正，oηo轴与oξo、oζo轴组成右手直角坐标系。定义视线角高低角λD和视线方位角λT。λT是视线oξo在地平面上的投影与oxe之间的夹角；λD是视线oξo与地平面之间夹角。视线坐标系通过地面坐标系按2-3-1次序转动两次得到。记地面坐标系与视线坐标系之间的方向余弦矩阵为Se：[oξooηooζo]T＝Se[xeyeze]T(1)其中，设飞行器相对于地面坐标系的速度矢量转动角速度在视线坐标系中的投影为和根据坐标系转换矩阵得到：其中，θ为弹道倾角，和分别为弹道倾角角速度、弹道偏角角速度。联立式(2)和式(3)得到在基本比例制导律的基础上设计增广项，使速度方向变化率和视线角速度满足：其中，视线角和角速度λD、和由飞行器导引系统提供。KLD(λD-γDF)/Tg为增广项，用于调节末端弹道倾角大小，实现飞行弹道的抬升和下压，用于调节落速和落角。KGD、KGT为基本比例制导参数，KLD为增广项制导参数，其取值随着高度降低进行切换；γDF为落角落速约束决定的参数；Tg为当前弹目距离R和飞行速度V估算的剩余飞行时间。步骤二、制导系数扩维设计。对制导系数KLD进行鲁棒性扩维设计，以提高变质心固定配平型飞行器在多种偏差因素综合作用下的鲁棒性，设计如下：式中，hi(i＝1,…,n)是选取的制导系数KLD切换高度，且h1＞…hi＞hi+1…＞hn，各切换高度值均在初始高度和落点之间，即h1＜h0和hn＞0满足，其中h0为飞行器初始高度；是标称条件下切换高度hi(i＝1,…,n)处的制导系数KLD的取值；是初始再入弹道倾角标称值；θ0是初始再入弹道倾角实际值；分别为标称条件下飞行器在制导系数切换高度hi处的弹道倾角和速度大小；θi、Vi(i＝1,…,n)分别为实际飞行过程中飞行器在制导系数切换高度hi处的实际弹道倾角和速度大小；Kθi、KVi(i＝1,…,n)是制导系数切换高度处的偏差修正系数，用于提高增广比例制导律的鲁棒性，其取值均为非负值。增广律比例制导律的增广项系数KLD进行鲁棒性扩维设计如式(6)，该系数是飞行器当前飞行速度、弹道倾角和典型高度点上标称飞行速度、弹道倾角偏差的函数，依据飞行器在不同高度点上的飞行状态偏差量修正弹道，保证落角、落速末端约束满足。以上变质心固定配平型飞行器从初始再入到最终落地的飞行过程中，在各制导系数切换高度处仅进行一次切换。步骤三、速度滚转角指令确定。基于增广比例制导律式(5)得到需用的速度方向转动角速度代入式(4)得到需用的弹道倾角和弹道偏角的角速度和分别为：依据飞行器动力学规律得知法向需用过载nyc和侧向需用过载nzc由弹道倾角θ、弹道偏角ψV基于重力加速度g等计算得到：由于固定配平型变质心飞行器仅以速度倾侧角为控制量，升力大小无法控制，而以上给出的增广比例制导需要两个相互独立的控制量nyc、nzc。为了将增广比例制导律应用于固定配平型变质心飞行器，利用以下公式将nyc和nzc转换为速度倾侧角指令：式中，γvc为速度倾侧角指令；nt为固定配平型飞行器可实现的最大径向过载nt＝Y/(Mtg)，即垂直于弹体纵轴方向的合过载，其中Y为飞行器受到的法向合外力，Mtg为飞行器总重量；arctan2(·)函数为：式(9)的物理意义是：当可用径向总过载nt小于需用总过载时，使径向总过载方向与需用总过载方向重合；当可用径向总过载大于需用总过载时，将可用径向总过载沿需用总过载方向和需用总过载垂直方向进行分解，并且使沿需用总过载方向的分量与需用总过载矢量相等。本专利技术的有益效果是：该方法基于工程中最常见的比例制导律，将变质心飞行器落速落角约束转化为一增广项，进一步对该增广项参数进行鲁棒性扩维设计，使得制导参数为变质心飞行器飞行状态偏差量的函数，在变质心飞行器受干扰作用时保证制导精度，最后基于需用过载与可用过载关系确定制导指令即滚转角指令大小。本专利技术在最基本的比例制导律的基础上，增加考虑落角和落速约束的增广项，实现弹道抬升和降低，保证落角和落速约束同时满足，在此基础上对增广项系数进行鲁棒性扩维设计，使增广项作用大小与飞行器当前飞行状态和标称状态的偏差相关，实现制导方法强鲁棒特性，是一种形式简单具有良好工程应用性能的变质心飞行器强鲁棒制导方法。下面结合附图和具体实施方式对本专利技术作详细说明。附图说明图1是本专利技术方法实施例中标称条件下三自由度质点仿真曲线。图2是本专利技术方法实施例中拉偏条件下的蒙特卡洛打靶仿真结果。具体实施方式参照图1-2。本专利技术面向变质心飞行器的工程化再入制导方法具体步骤如下：1、比例制导律增广。定义地面坐标系为exeyeze(简记为e)：原点e取初始时刻飞行器本文档来自技高网...

【技术保护点】
1.一种面向变质心飞行器的工程化再入制导方法，其特征在于包括以下步骤：步骤一、比例制导律增广；定义地面坐标系为exeyeze，简记为e：原点e取初始时刻飞行器质心o在地面投影点；eye在地心OE与飞行器质心o的连线上，指向飞行器质心o为正；而exe在过e点垂直于eye的平面内，指向目标点；exeyeze构成右手直角坐标系；定义视线坐标系oξoηoζo，简记为S：原点在飞行器质心o处；oξo由飞行器质心指向目标点；oζo在水平面内，即在e‑xz平面内，且与oξo轴垂直，沿着oξo正向看去向右为正，oηo轴与oξo、oζo轴组成右手直角坐标系；定义视线角高低角λD和视线方位角λT；λT是视线oξo在地平面上的投影与oxe之间的夹角；λD是视线oξo与地平面之间夹角；视线坐标系通过地面坐标系按2‑3‑1次序转动两次得到；记地面坐标系与视线坐标系之间的方向余弦矩阵为Se：[oξo oηo oζo]

【技术特征摘要】
1.一种面向变质心飞行器的工程化再入制导方法，其特征在于包括以下步骤：步骤一、比例制导律增广；定义地面坐标系为exeyeze，简记为e：原点e取初始时刻飞行器质心o在地面投影点；eye在地心OE与飞行器质心o的连线上，指向飞行器质心o为正；而exe在过e点垂直于eye的平面内，指向目标点；exeyeze构成右手直角坐标系；定义视线坐标系oξoηoζo，简记为S：原点在飞行器质心o处；oξo由飞行器质心指向目标点；oζo在水平面内，即在e-xz平面内，且与oξo轴垂直，沿着oξo正向看去向右为正，oηo轴与oξo、oζo轴组成右手直角坐标系；定义视线角高低角λD和视线方位角λT；λT是视线oξo在地平面上的投影与oxe之间的夹角；λD是视线oξo与地平面之间夹角；视线坐标系通过地面坐标系按2-3-1次序转动两次得到；记地面坐标系与视线坐标系之间的方向余弦矩阵为Se：[oξooηooζo]T＝Se[xeyeze]T(1)其中：设飞行器相对于地面坐标系的速度矢量转动角速度在视线坐标系中的投影为和根据坐标系转换矩阵得到：其中，θ为弹道倾角，和分别为弹道倾角角速度、弹道偏角角速度；联立式(2)和式(3)得到在基本比例制导律的基础上设计增广项，使速度方向变化率和视线角速度满足：其中，视线角和角速度λD、和由飞行器导引系统提供；KLD(λD-γDF)/Tg为增广项，用于调节末端弹道倾角大小，实现飞行弹道的抬升和下压，用于调节落速和落角；KGD、KGT为基本比例制导参数，KLD为增广项制导参数，其取值随着高度降低进行切换；γDF为落角落速约束决定的参数；Tg为当前弹目距离R和飞行速度V估算的剩余飞行时间；步骤二、制导系数扩维设计；对制导系数KLD进行鲁棒性扩维设计，以提高变质心固定配平型飞行器在多种偏差因素综合作用下的鲁棒性，设计如下：式中，hi(i＝1,…,n)是选取的制导系数KLD切换高度，且h1＞…hi＞hi+1…＞hn，各切换高度值均在初始高度和落点之间，即h1＜h0和hn＞0满足，其中h0为...

【专利技术属性】
技术研发人员：周敏，周军，葛振振，赵金龙，
申请(专利权)人：西北工业大学，
类型：发明
国别省市：陕西,61