[发明专利]面向变质心飞行器的工程化再入制导方法

摘要

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

主权项

1.一种面向变质心飞行器的工程化再入制导方法，其特征在于包括以下步骤：步骤一、比例制导律增广；定义地面坐标系为ex_ey_ez_e，简记为e：原点e取初始时刻飞行器质心o在地面投影点；ey_e在地心O_E与飞行器质心o的连线上，指向飞行器质心o为正；而ex_e在过e点垂直于ey_e的平面内，指向目标点；ex_ey_ez_e构成右手直角坐标系；定义视线坐标系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在地平面上的投影与ox_e之间的夹角；λ_D是视线oξ_o与地平面之间夹角；视线坐标系通过地面坐标系按2‑3‑1次序转动两次得到；记地面坐标系与视线坐标系之间的方向余弦矩阵为S_e：[oξ_o oη_o oζ_o]^T＝S_e[x_e y_e z_e]^T   (1)其中：设飞行器相对于地面坐标系的速度矢量转动角速度在视线坐标系中的投影为和根据坐标系转换矩阵得到：其中，θ为弹道倾角，和分别为弹道倾角角速度、弹道偏角角速度；联立式(2)和式(3)得到在基本比例制导律的基础上设计增广项，使速度方向变化率和视线角速度满足：其中，视线角和角速度λ_D、和由飞行器导引系统提供；K_LD(λ_D‑γ_DF)/T_g为增广项，用于调节末端弹道倾角大小，实现飞行弹道的抬升和下压，用于调节落速和落角；K_GD、K_GT为基本比例制导参数，K_LD为增广项制导参数，其取值随着高度降低进行切换；γ_DF为落角落速约束决定的参数；T_g为当前弹目距离R和飞行速度V估算的剩余飞行时间；步骤二、制导系数扩维设计；对制导系数K_LD进行鲁棒性扩维设计，以提高变质心固定配平型飞行器在多种偏差因素综合作用下的鲁棒性，设计如下：式中，h_i(i＝1,…,n)是选取的制导系数K_LD切换高度，且h₁＞…h_i＞h_i+1…＞h_n，各切换高度值均在初始高度和落点之间，即h₁＜h₀和h_n＞0满足，其中h₀为飞行器初始高度；是标称条件下切换高度h_i(i＝1,…,n)处的制导系数K_LD的取值；是初始再入弹道倾角标称值；θ₀是初始再入弹道倾角实际值；V_i^*(i＝1,…,n)分别为标称条件下飞行器在制导系数切换高度h_i处的弹道倾角和速度大小；θ_i、V_i(i＝1,…,n)分别为实际飞行过程中飞行器在制导系数切换高度h_i处的实际弹道倾角和速度大小；K_θi、K_Vi(i＝1,…,n)是制导系数切换高度处的偏差修正系数，用于提高增广比例制导律的鲁棒性，其取值均为非负值；增广律比例制导律的增广项系数K_LD进行鲁棒性扩维设计如式(6)，该系数是飞行器当前飞行速度、弹道倾角和典型高度点上标称飞行速度、弹道倾角偏差的函数，依据飞行器在不同高度点上的飞行状态偏差量修正弹道，保证落角、落速末端约束满足；以上变质心固定配平型飞行器从初始再入到最终落地的飞行过程中，在各制导系数切换高度处仅进行一次切换；步骤三、速度滚转角指令确定；基于增广比例制导律式(5)得到需用的速度方向转动角速度代入式(4)得到需用的弹道倾角和弹道偏角的角速度和分别为：依据飞行器动力学规律可知法向需用过载n_yc和侧向需用过载n_zc由弹道倾角θ、弹道偏角ψ_V基于重力加速度g等计算得到：由于固定配平型变质心飞行器仅以速度倾侧角为控制量，升力大小无法控制，而以上给出的增广比例制导需要两个相互独立的控制量n_yc、n_zc；为了将增广比例制导律应用于固定配平型变质心飞行器，利用以下公式将n_yc和n_zc转换为速度倾侧角指令：式中，γ_vc为速度倾侧角指令；n_t为固定配平型飞行器可实现的最大径向过载n_t＝Y/(M_tg)，即垂直于弹体纵轴方向的合过载，其中Y为飞行器受到的法向合外力，M_tg为飞行器总重量；arctan2(·)函数为：式(9)的物理意义是：当可用径向总过载n_t小于需用总过载时，使径向总过载方向与需用总过载方向重合；当可用径向总过载大于需用总过载时，将可用径向总过载沿需用总过载方向和需用总过载垂直方向进行分解，并且使沿需用总过载方向的分量与需用总过载矢量相等。