一种高超声速飞行器再入姿态容错控制方法
【技术领域】
[0001] 本发明属于自动控制技术领域，尤其涉及一种融合气动舵面和RCS的高超声速飞 行器再入姿态容错控制方法。
【背景技术】
[0002] 与普通飞行器相比，高超声速飞行器高阶非线性、强耦合、不确定等独有的特点以 及外界飞行环境的复杂多变给控制器的设计带来了挑战。再入段控制的目的是设计姿态控 制策略，使得姿态角能够跟踪参考指令，并且保证整个飞行器控制系统稳定。
[0003] 高超声速飞行器再入初期，由于空气稀薄动压小、气动舵面效率低，需要使用反作 用控制系统（reactioncontrolsystem，RCS)控制姿态。RCS由多个喷管推力器构成，利用 横向喷流的反推力控制姿态。与连续气动舵面不同，RCS推力器是开关型的执行机构，只能 提供常值离散力矩，采用一种混合整型线性规划的方法可以有效地解决离散控制量在连续 系统中的设计问题。根据高超声速飞行器再入初期的特点，通常需要反作用控制系统（RCS) 来协助气动舵面完成姿态控制。将气动舵面看作首要执行机构，将期望的力矩在气动舵面 之间进行控制分配。如果气动舵面不能达到期望力矩，则开启RCS。由RCS来提供气动舵面 不能提供的这部分力矩。
[0004] 高超声速飞行器飞行环境的特点或者传感器、执行器以及飞行器结构的老化容易 导致故障的发生。因此，对于飞行器的控制系统而言，提高系统的稳定性和可靠性是至关重 要的。一旦故障发生，往往会造成经济上的损失甚至带来灾难性的后果。当故障发生时，需 要采取更为有效的控制策略保证故障后的系统仍旧可以安全飞行，避免事故的发生。因此， 如何提高飞行器的可靠性，使得飞行器在故障情况下保持安全飞行，已经成为目前控制研 宄领域的一个重要问题。而容错控制作为一种处理故障影响的有效的控制手段，已经成为 控制领域学者研宄的一个热点。
【发明内容】
[0005] 本发明的目的在于提供一种应用方便简单，且能基于气动舵面和RCS融合控制技 术实现高超声速飞行器再入姿态容错控制方法。
[0006] 为达到上述目的，本发明的一种高超声速飞行器再入姿态容错控制方法，采用 Backstepping设计的控制器来得到期望控制力矩：
[0008] 其中，t为期望控制力矩tdes，hJxD=R( ? )，h2(x2) =-J-1DJw，h3=J―1，Zi =x「Qd，z2=x2-x2d，虚拟控制变量x2d =Wx,)-V-qz, +￡irf)，c5 >〇，Dd为参考姿态角指令；
[0009] 当舵面发生故障时，设计容错控制分配算法将期望力矩分配到各个气动舵面上：
[0010] 1)当气动舵面发生部分失效故障时，气动舵面提供力矩为
[0012] 其中，3 = …，As!-，相应的目标函数为：
[0014] 其中，约束条件为：Smin< 6。彡6
[0015] 2)当第j个舵面卡死在某一位置$，气动舵面提供的力矩为：
[0017] 其中，R 7X1为剩余健康舵面，R 3X7为剩余健康舵面对应的控制分配矩 阵，R3X1为〇(?)中与卡死舵面相对应的列，则目标函数为：
[0019]其中，约束条件：Smin彡6r彡6
[0020] 如果气动舵面提供的力矩达不到期望力矩，则采用整型线性规划的控制分配方法 将气动舵面欠缺的力矩分配到10个RCS，求出RCS喷管逻辑0-1，其中TMS=Tdes-Ts，设 计目标函数如下：
[0022] 满足如下约束条件：
[0025] 其中，uk取值0或1，0表示RCS关闭，1表示RCS开启，RCS第i个轴上提供的期 望力矩为，为第i个轴上力矩误差的权重系数，《k表示第k个RCS的权重系数。
[0026] 优选地，针对故障后的执行器动态，设计一个虚拟执行器如下：
[0028] 其中，残差信号为疋=€-&，当残差信号为0时，说明无故障发生；否则，故障发 生。
[0029] 优选地，针对部分失效故障的情况，设计观测器如下：
[0031] 其中，A是对部分失效因子估计，An，A2i为正常数，S^为执行器舵面偏 转角指令的输入，Sn为舵面实际输出；
[0032] 针对执行器卡死故障的情况，设计观测器如下：
[0035] 则定义4 4 -巧。
[0036] 优选地，设计失效因子A的自适应律如下：
[0038] 其中，
，c7>0,p12，p22为P中元素，P满足
，Q =Qt> 0〇
[0039] 优选地，为了识别不同类型的故障，定义性能指标如下：
[0042] 其中，％e2,e3,e4>〇,入>〇,比较In(t)和I2i(t)的大小，当In⑴较小时， 则说明发生的是部分失效故障；反之，则说明发生的是执行器卡死故障。
[0043] 本发明的有益效果：
[0044] 本发明的高超声速飞行器再入姿态容错控制方法使得气动舵面和RCS两个执行 机构能够很好的融合控制，并且尽量多的使用气动舵面无动力控制；当舵面发生故障时，设 计的估计失效因子的自适应律和容错控制策略很好的保证了系统的稳定，且所有控制变量 和状态变量都是有界的。
【附图说明】
[0045] 图1绘示本发明的高超声速飞行器再入姿态容错控制方法于实施例中的原理方 框图。
[0046] 图2A绘示本发明中所有执行器正常工作时姿态角跟踪曲线图。
[0047] 图2B绘示本发明中所有执行器正常工作时角速率响应曲线图。
[0048] 图2C绘示本发明中所有执行器正常工作时气动舵面偏转角曲线图。
[0049] 图2D绘示本发明中所有执行器正常工作时RCS提供的力矩数据图。
[0050] 图3A绘示本发明中右内侧升降舵发生50%失效故障时姿态角跟踪曲线图。
[0051] 图3B绘示本发明中右内侧升降舵发生50%失效故障时角速率响应曲线图。
[0052] 图3C绘示本发明中右内侧升降舵发生50%失效故障时气动舵面偏转角曲线图。
[0053] 图3D绘示本发明中右内侧升降舵发生50%失效故障时RCS提供的力矩数据图。
[0054] 图4A绘示本发明中右侧机身襟翼在Is处发生卡死故障时姿态角跟踪曲线图。
[0055] 图4B绘示本发明中右侧机身襟翼在Is处发生卡死故障时角速率响应曲线图。
[0056] 图4C绘示本发明中右侧机身襟翼在Is处发生卡死故障时气动舵面偏转角曲线 图。
[0057] 图4D绘示本发明中右侧机身襟翼在Is处发生卡死故障时RCS提供的力矩数据 图。
【具体实施方式】
[0058] 为了便于本领域技术人员的理解，下面结合实施例与附图对本发明作进一步的说 明，实施方式提及的内容并非对本发明的限定。
[0059] 参照图1至图4D所示，本发明的一种高超声速飞行器再入姿态容错控制方法，首 先，采用Backstepping设计的控制器来得到期望控制力矩：
[0060] 定义状态变量Xi=Q，x2= ?，选取再入姿态模型
[0063] y=x:
[0064]其中，h(x) =R(? )，h2(x2) =-J-1SJo，h3=J'
[0065] 步骤1:定义zf xZi的微分：
[0067] 其中，x2为虚拟控制量，选取Lyapunov函数K=彳^/2，导数为：
[0069] 设计虚拟控制量
，使得R < 0。
[0070] 步骤2 :定义z2=x2_x2d，则z2的微分：
[0072]将t看作系统的控制输入，选取Lyapunov函数r2 =6+士2/2，导数为：
[0074] 设计控制输入t为：
[0076] 带入上式，得到：
[0078] 式中变量21^2有界，则状态量Xl，x2&是有界，所以得到的控制力矩t也是有界 的。这里得到的控制力矩t即为期望力矩T&。
[0079] 然后，将把控制力矩tdes分配到各个操纵舵面和RCS上：
[0080] (1)当舵面正常工作时：采用二次规划的方法把期望力矩tdes分配到各个气动舵 面上；
[0081] 气动舵面提供的力矩Ts= 0) (?)S。，为了最大限度使用气动舵面，定义目标函 数如下：
[0083] 其中，0 < 〇 < 1，约束条件：Smin彡SS_，6_和Smin分别为气动舵面允 许偏转范围的上下界。
[0084] (2)当舵面发生故障时，设计容错控制分配算法将期望力矩分配到各个气动舵面 上：
[0085] 首先，选取执行器二阶动态模型：
[0087] 其中，