仲 秦,闫 杰,张晓峰,武文斌
(1 西北工业大学航天学院,西安 710072; 2 西安现代控制技术研究所,西安 710065)
为保障超燃冲压发动机稳定工作,吸气式高超声速飞行器姿态角及姿态角速度都必须满足一定约束。针对状态输出的约束问题,国内外学者开展了一系列的研究[1-7]:文献[3-4]基于不变集控制方法,设计滑模控制器,在调节状态受约束的问题上效果良好,但没有对跟踪问题加以研究。文献[5]采用一种基于障碍Lyapunov函数的状态约束航迹倾角跟踪控制方法,对航迹倾角模型的参数化方程采用BLF反步法,在满足攻角约束的条件下,可实现对航迹倾角的无差跟踪。文献[6]考虑了高超声速飞行器工作过程的多状态约束,在高度回路中引入了指令调节器,基于PI+LQ的方法设计过载控制器,产生的过载信号生成指令、控制器跟踪指令完成高度跟踪,该控制系统能够满足一定条件下的状态约束并实现快速跟踪。文献[7]提出了一种兼顾多约束和控制性能的鲁棒姿态控制方法,采用IBLF方法保证攻角约束,通过辅助误差子系统降低飞行器输入饱和非线性对闭环系统的影响,同时引入非线性干扰观测器对参数摄动及外部干扰进行估计和补偿,最终通过Lyapunov理论证明及仿真实验,验证了该控制器的有效性。
文中针对前述受限控制问题,利用单向辅助面滑模控制方法,设计跟踪控制器,使其满足状态及控制量约束,求解简单,跟踪指令信号迅速,通过对飞行器的姿态控制器的设计,对方法进行仿真验证,证明了其的有效性。
对于一个线性时不变系统,其描述如下:
(1)
式中:A∈Rn×n,B∈Rn×n,输出矩阵C∈Rq×n,且A、B可逆。约束要求为系统状态不能超过预设的边界,表示如下:
对于任意的t≥0有x(t)∈Ψ,并有:
(2)
(3)
可以得到,平衡状态下,控制量和状态的稳态值为:
(4)
(5)
设控制器结构如下所示:
(6)
(7)
单向辅助面滑模控制器设计步骤如下:
Step 1选择合适的组合切换面
(8)
式中:c1=diag[c11,…,c1n],c2=diag[c21,…,c2n],S1(e)=[S11,…,S1n]T,S2(e)=[S21,…,S2n]T,c1i>0,c2i>0,c1i≠c2i,i∈{1,2,…,n}。
将第i维的误差和误差积分组成的平面分为4个子区域,分别记为第ki子区域,k=0,1,2,3。如图1所示。
图1 切换面划分二维空间示意图
根据误差的选取要求,如图1所示取适当的点PS1i+、PS1i-、PS2i+、PS2i-,满足:
点PS1i+、PS1i-、PS2i+、PS2i-组成凸四边形Δ,满足-ai≤ei≤ai(ai>0),并组成线段H0i、H1i、H2i、H3i,作为该系统的单向辅助面。
(9)
式中:H0i=0,H1i=0,H2i=0,H3i=0分别表示单向辅助面线段所在直线的数学方程;ωki1,ωki2,Mki,k∈{0,1,2,3},表示这4个直线方程中对应的系数。
Step 3考虑当前单向辅助面的第i个分量
其中:
设计对于误差动态方程(7)的状态输出约束滑模控制器,即:
(10)
对原系统而言,所需的控制信号即为式(6)所示。
对于任意给定的初始条件P(t0),选定了组合切换面后,可组成以P(t0)为边界的凸四边形,构成正不变集。所设计的控制器能够完成正不变集控制[8]。常值跟踪问题中,当跟踪信号确定后,控制器初值由系统状态初值与误差信号初值确定,随状态演进,误差信号最终将单调达到0,系统完成跟踪。
图2 误差状态变化趋势图
具体设置如下:
由于控制量单调变化,对于满足控制约束和给定跟踪范围的初始状态范围也由下式确定:
(11)
不论起点在0i子区域还是在3i子区域,c1-1c2都是常值矩阵(0i子区域或3i子区域c1、c2数值大小相等,符号相同)。求解u(t0)、u(t)∈[umin,umax],就可以得到在给定控制范围xi∈[ni,mi],控制受限情况下起控点x0应该满足的范围。在此范围内,控制器可实现在控制量受限时跟踪参考信号且状态单调收敛于参考信号。起控点x0满足的范围即为该型控制结构下,控制系统所能满足跟踪指标要求的状态边界。通过对c1-1c2的合理取值,可以得到满足要求的控制器。
以某鸭尾舵复合控制的高超声速飞行器为研究对象[9],其纵向平面姿态运动微分方程为:
其中:ue、uc分别表示飞行器尾舵、鸭舵控制量。飞行器攻角要求保持在2°±1°范围内,俯仰角速率达到误差范围[-1°/s,5°/s],飞行器舵偏应满足的条件为:ue、uc∈[-20°,20°]。
欲使该范围都处于正不变集,需要使范围内的4个顶点((3,5),(3,-1),(1,5),(1,-1))代入式(11)中,满足控制量约束。
设置切换面为:
图3 正不变集区域示意图
图3中三角形标注的位置表示控制指令。小长方形表示要求的状态量变化范围。实线与虚线之间的区域为控制量约束所形成的正不变集。在此范围内,系统都能满足控制量约束的情况下跟踪控制指令。
取初始值α0=-2°,q0=10°/s。控制指令设为[2,0]。得到的响应曲线如图4~图7。
图4 飞行器攻角误差变化曲线
图5 飞行器俯仰角速率误差变化曲线
由仿真可知,用该方法设计的控制器,能够实现飞行器俯仰角速率的快速稳定,攻角的快速无静差跟踪,用舵量保持在±20°内,满足要求,系统状态满足约束条件。
图6 状态量变化曲线
图7 控制量变化曲线
文中研究了线性系统状态输出及控制量输入有界约束跟踪问题。通过理论证明和仿真实验可知,对于给定的状态约束,可以设计包含该约束的不变集控制器。当初始状态满足控制量约束时,系统状态能够无静差跟踪指令,且各个状态量单调收敛,达到约束边界条件后将始终满足状态约束。对于未知的瞬时干扰,只要不使系统状态出离该不变集控制区域,系统依然能够将状态调节到指定位置,且控制量满足约束。基于不变集控制方法的调节器可以完成对非线性控制系统的调节,文中所推导的跟踪控制器如何应用于非线性系统尚待进一步研究。另外,如何加强系统的鲁棒性,克服由于模型不确定性引起的偏差,也值得深入探讨。