可重构性描述的是故障系统的自主恢复能力,可重构性评价则是利用理论判据和数学描述,判断系统重构能力的有无或大小。目前,对于系统可重构性评价的方法主要包括:基于系统固有特性的Gramian矩阵评价方法[10-12]、模态能控度评价方法[13]和状态范数能控度评价方法[14-15]。基于Gramian矩阵评价方法最关键的是Gramian矩阵计算。然而针对实际系统,其存在两方面的不足:①Gramian矩阵的计算要求建立系统精确的数学模型,实际系统不可避免地存在未建模动态和参数摄动;②Gramian矩阵是在系统投入运行之前离线计算,运行之后若系统发生故障,则此矩阵的计算会失去实际意义。基于模态能控度的评价方法通常假设系统特征根两两相异,对于实际系统而言,此假设条件并非均能满足,因此利用该方法进行可重构性评价存在很大的局限性。基于状态范数能控度的评价方法的本质是时间最优控制问题,但对于实际系统很难获得精确的恢复域。
上述研究成果主要还是针对线性系统。现实中,几乎所有的控制系统都或多或少的具有非线性特征。如前述的quadrotor UAV就具有高度非线性,而且具有强耦合、静不稳定等特性,常被建模为一种典型的非线性系统[16]。因此,以其为对象,开展非线性系统的可重构性评价具有重要的实际意义。尽管有****采用循环小增益[17]、李导数[18]等方法进行了非线性系统可重构性研究,但这些方法都局限于某种特定的系统,通用性较差。
据统计[19],50%以上的执行器和传感器故障是利用观测器生成的残差信号进行故障诊断与隔离,并进一步实现故障重构与容错控制,而容错的成败取决于冗余水平的高低,即系统的可重构性水平。但是,目前采用观测器估计状态进行可重构性评价的研究还少有。若以此为基础同时开展可重构性量化评价,无疑是极有意义的。而针对不同系统选择或设计满意的观测器,则是可重构性评价的关键条件。考虑到quadrotor UAV是一种典型的非线性强干扰系统,飞行过程中极易产生参数摄动或者引发执行器故障,本文为此设计了一种对于不确定性和故障兼具鲁棒性的双滑模面观测器。
相似性度量是对2个事物之间相近程度的一种综合评定。当2个事物越接近,它们的相似性度量也就越大,而2个事物越相异,相似性度量也就越小。系统亦是如此,正常运行时实际状态趋近于期望状态,故障时实际状态会偏离期望状态。显然,偏离程度越严重,系统自主恢复能力越弱甚至会瘫痪,因而,相似度的大小在一定程度上可以体现可重构的程度。对于相似性进行度量通常采用的方法就是计算样本距离,不同方法各有优劣。实际控制系统通常是多变量且不同量纲的,而马氏距离的优点是不受量纲影响,排除了变量之间相关性的影响。因此,本文将采用马氏距离对系统可重构性进行量化评价。
综上,针对具有执行器故障的quadrotor UAV,本文首先在建立系统模型的基础上,设计了一种双滑模面鲁棒观测器对受不确定性和故障影响的实际状态进行准确估计;其次综合考虑执行器饱和及状态误差指标约束,采用马氏距离对估计状态和期望状态进行基于相似性度量的可重构性量化评价;最后仿真验证了本文方法的有效性。
1 系统建模和描述 图 1为quadrotor UAV结构,4个旋翼带动无人机工作,同一对称轴上的2个旋翼为一组。前后螺旋桨(T1,T2)按顺时针方向旋转,左右螺旋桨(T3,T4)按逆时针方向旋转。为了使quadrotor UAV沿着xe或ye方向移动,通常需要一个俯仰角θ或滚转角?。然后,通过推力差产生的力矩直接稳定俯仰角和滚转角。
图 1 quadrotor UAV结构 Fig. 1 Quadrotor UAV structure |
图选项 |
为了便于描述quadrotor UAV的运动状态,需先建立合理且科学的运动学模型,地面坐标系(oe, xe, ye, ze)和机体坐标系(ob, xb, yb, zb)。静态变换矩阵R定义为
(1) |
式中:?、θ和ψ分别为滚转角、俯仰角和偏航角。
假设机身固定架的原点与quadrotor UAV的重心重合。由图 1得,系统沿zb方向的总的上升力
(2) |
式中:Ku和Ky分别为产生相关力和力矩的正增益;Ld为任意螺旋桨转轴到重心的距离。
采用牛顿-欧拉公式,quadrotor UAV的力和力矩可表示为
(3) |
式中:m为机体质量;Γ为机体坐标系下的线速度;F=[Fx, Fy, Fz]T为相对于地面坐标系的合力矢量;τ=[τx, τy, τz]T为合成的力矩矢量;ω=[p, q, r]T为相对于机体坐标系的角速度矢量;I=diag[Ixx, Iyy, Izz]为对角惯性矩阵。
力和力矩又可以表示为
(4) |
(5) |
式中:x、y、z为quadrotor UAV的空间实际位置;g、Ir分别为重力加速度、螺旋桨的惯性矩;Ωi(i=1, 2, 3, 4)为第i个螺旋桨的转速;kdi(i=1, 2, …, 6)为阻力系数。
进一步,欧拉角变化率与欧拉角速度关系的动态变换矩阵为
(6) |
假设滚转角和俯仰角的变化很小,则TB近似为单位矩阵,因此,角速度可用欧拉角速度代替。
(7) |
(8) |
由于quadrotor UAV是一个欠驱动系统,只有姿态控制器和高度控制器与执行机构直接相关。将状态向量定义为y=[z, ?, θ, ψ]T,
(9) |
式中:
其中:A和C分别为系统参数矩阵和输出矩阵;f(x, u, t)为已知非线性函数;x∈Rn为系统的状态向量;y∈Rm为系统输出;u∈Rq为输入函数;D为扰动分布矩阵:
考虑执行器故障,quadrotor UAV模型可表示为
(10) |
式中:fa(x, u, t)为执行器故障的未知非线性函数;Ea为执行器故障分布矩阵。
2 双滑模面鲁棒观测器设计 基于观测器进行quadrotor UAV可重构性评价,其关键是要对系统的实际状态进行准确有效的估计。实际quadrotor UAV这一非线性系统在运行时不可避免地存在各种扰动和不确定性,若观测器不具备较强的鲁棒性,则估计的状态会受其影响,从而导致系统可重构性评价结果的不准确,最终影响重构或安全应急决策。因此,采用对扰动和不确定性具有鲁棒性的滑模观测器不失为一种好的选择。
受文献[20]启发,分析quadrotor UAV建立的系统模型(10),不难得出其易满足如下条件:
条件1 ??存在矩阵L∈R8×4使得A0=A-LC为稳定矩阵,且存在正定对称矩阵P、Q,使方程A0TP+PA0=-Q成立。
条件2 ??存在正的Lipschitz常数γ,使得
条件3 ??存在矩阵Δ∈R8×4,使得PD=CTΔT。
条件4 ??扰动d(t)有界的,即‖d(t)≤κ‖,且κ>0。
条件5 ??存在矩阵H∈R4×4,使得PEa=CTHT。
对系统(10)可构造式(11)所示鲁棒滑模观测器[20]:
(11) |
式中:
若采用式(11)对quadrotor UAV进行状态估计,无故障时,较小不连续项v的引入即可对系统状态进行准确估计;一旦发生故障,由于鲁棒滑模观测器对故障具有灵敏性,则无法对故障quadrotor UAV的实际状态进行准确估计。若仍然按照上面的结果进行可重构性评价,评价结果会出现误报,失去指导意义。增大不连续项v的值,虽可以使得估计状态能够跟随实际状态,但是随着不连续项的增大,引入了抖动和高频干扰,进一步进行系统可重构性评价,致使评价出现偏差。
针对上述问题,本文将设计式(12)的基于2个不连续项的双滑模面鲁棒观测器,以期解决过分增大一个不连续项引起的抖动和高频干扰问题,使其同时对扰动和故障均具有鲁棒性。
(12) |
式中:η为如下定义的不连续项,即
(13) |
式中:ρ为标量系数。
定义状态误差
(14) |
定理1 ??对于满足条件1~条件5的系统(10),设计双滑模面鲁棒观测器(12),若常数
证明 ??选取Lyapunov函数V=eT(t)Pe(t),则
系统满足假设条件1~条件5,进而得
若系统满足条件1~条件5,且
考虑到不连续项v、η使系统产生滑动运动的同时会引入抖动,因而用如下饱和函数代替:
(15) |
式中:σ1、σ2为取值较小的标量。
注1 ??式(12)设计的双滑模面鲁棒观测器对于故障和正常系统均适用。
注2 ??对于可建模为式(10),且满足条件1~条件5的任何系统,式(12)设计的双滑模面鲁棒观测器也适用。
3 可重构性量化评价 由于quadrotor UAV的实际状态(位置、姿态角及各自的变化率)不同量纲,最常使用的欧氏距离状态相似性度量方法不再适用,因此,本文采用基于马氏距离的相似性度量方法开展quadrotor UAV可重构性量化评价。
3.1 基于马氏距离的系统相似性度量 采用马氏距离度量点与一个分布之间的距离,取quadrotor UAV的期望状态为样本均值μ=xd=(xd1, xd2, …, xd8)T,实际状态由观测器估计得到,因此
(16) |
式中:Σ为协方差矩阵。
相似度
(17) |
由式(17)得,相似度的取值范围为0<
3.2 可重构性评价阈值选取 可重构性是指当系统发生故障后,系统的自主恢复能力,相似度的大小则反映了其可重构性的大小,用相似度评价系统可重构性之前,先要确定阈值ε,若相似度S(x, xd)<ε,则系统不可重构。假设quadrotor UAV执行器饱和约束为:|ui|≤πi故障时允许的状态误差指标为J≤δ,在此范围内系统可重构,自适应阈值的确定与控制系统状态误差指标相结合,则有
(18) |
4 仿真验证 选取文献[8]中quadrotor UAV作为仿真对象,具体参数如表 1所示。
表 1 quadrotor UAV物理参数 Table 1 Physical parameters of quadrotor UAV
参数 | 数值 |
质量m/kg | 1.4 |
重力加速度g/(m·s-2) | 9.8 |
绕x、y、z轴的转动惯量 I=[Ixx, Iyy, Izz]/(kg·m2) | I=diag[0.03, 0.03, 0.04] |
螺旋桨的惯性矩Ir/(kg·s2) | 0.002 |
阻力系数kdi(i=1, 2, …, 6) | kdi=0.01(i=1, 2, …, 6) |
初始状态 | x=[0,0,0,0,0,0,0,0] |
期望状态 | xd=[3, 0.5, 0.2, 0.3, 0, 0, 0, 0] |
表选项
根据以上参数,选取矩阵L将A0=A-LC的极点配置在-0.8,-0.6,-1,-0.6,-0.1,-1,-0.1,-0.6,相应得到A0和L。
选取矩阵Q为单位阵,由假设条件1得到矩阵P,根据条件3和条件5,得到矩阵F和H分别为
系统采用PD控制,控制器参数设置如下:Kpz=250, Kdz=25, Kp?=2, Kd?=0.5, Kpθ=2, Kdθ=1, Kpψ=3, Kdψ=0.8。考虑执行器饱和约束,|Uz|≤30, |U?|≤0.05, |Uθ|≤0.05, |Uψ|≤0.05,并要求系统状态误差J≤0.2。
4.1 采用式(11)鲁棒观测器 取κ=10,quadrotor UAV无故障时,即Fa=[0,0,0,0]T。系统实际状态和观测状态如图 2所示。可以看出,未发生故障时,鲁棒滑模观测器较强的跟踪能力,
图 2 执行器无故障 Fig. 2 Failure-free actuator |
图选项 |
假设t≥5 s时发生执行器故障,取κ=10,fa(x, u, t)=[15,0,0,0]。从图 3可以看出,滑模观测器观测值发散,相应的残差信号也发散,若用此结果进行可重构性量化评价则会导致误报。
图 3 执行器发生故障 Fig. 3 Actuator with failure |
图选项 |
调整连续项,取κ=100,仿真结果如图 4所示。滑模观测器能够跟踪期望状态,但是抖动很大,
图 4 调整不连续项 Fig. 4 Discontinuous term adjustment |
图选项 |
4.2 采用双滑模面观测器 采用本文的双滑模面观测器(12),取κ=10,ρ=300,在前述故障情形下,仿真结果如图 5所示,与图 4相比,对抖动起到了很好的抑制作用,
图 5 双滑模面观测器 Fig. 5 Double sliding surface observer |
图选项 |
上述仿真结果是针对fa(x, u, t)=[15,0,0,0]故障情形,为了能够更好地验证本文方法的有效性,针对执行器单一和多故障情形,分别给出了可重构性评价结果,具体如表 2所示。
表 2 执行器故障可重构性量化评价 Table 2 Quantitative reconfigurability evaluation of actuator fault
单一故障 | 评价结果 | 多故障 | 评价结果 | |
[5,0,0,0] | 0.906 8 | [5,0,1,0] | 0.905 3 | |
[10,0,0,0] | 0.871 7 | [10,0,1,0] | 0.869 0 | |
[15,0,0,0] | 0.834 7 | [15,0,1,0] | 0.832 1 | |
[20,0,0,0] | 0.796 8 | [20,0,1,0] | 0.797 8 | |
[25,0,0,0] | 0.725 9 | [25,0,1,0] | 0.723 4 |
表选项
由表 2可知,从纵向来看,随着故障从小到大演变,可重构性评价结果亦逐渐变小;从横向来看,多故障情况下的可重构性较单一故障要小,结果符合一般的客观规律。
5 结束语 本文针对quadrotor UAV非线性系统设计了对故障和扰动均具有较强跟踪能力的双滑模面鲁棒观测器,在考虑执行器饱和及状态误差指标约束条件下,采用马氏距离相似度的方法对系统可重构性进行量化评价,并能自适应调整评价阈值,及时准确地对故障系统的可重构程度做出评估,确保系统的安全性。通过仿真验证了文中所述方法的正确性和有效性。由于建立的quadrotor UAV模型与一般的非线性系统描述一致,因此,该方法也适用于满足条件1~条件5的其他非线性对象。
参考文献
[1] | 宿敬亚, 樊鹏辉, 蔡开元. 四旋翼飞行器的非线性PID姿态控制[J]. 北京航空航天大学学报, 2011, 37(9): 1054-1058. SU J Y, FAN P H, CAI K Y. Attitude control of quadrotor aircraft via nonlinear PID[J]. Journal of Beijing University of Aeronautics and Astronautics, 2011, 37(9): 1054-1058. (in Chinese) |
[2] | MOFID O, MOBAYEN S. Adaptive sliding mode control for finite-time stability of quad-rotor UAVs with parametric uncertainties[J]. ISA Transactions, 2018, 72: 1-14. DOI:10.1016/j.isatra.2017.11.010 |
[3] | 周东华, DING X. 容错控制理论及其应用[J]. 自动化学报, 2000, 26(6): 788-797. ZHOU D H, DING X. Theory and application of fault tolerant control[J]. Acta Automatica Sinica, 2000, 26(6): 788-797. (in Chinese) |
[4] | 王宏, 柴天佑, 丁进良, 等. 数据驱动的故障诊断与容错控制:进展与可能的新方向[J]. 自动化学报, 2009, 35(6): 739-747. WANG H, CHAI T Y, DING J L, et al. Data driven fault diagnosis and fault tolerant control:Some advances and possible new directions[J]. Acta Automatica Sinica, 2009, 35(6): 739-747. (in Chinese) |
[5] | YIN S, LUO H, DING S X. Real-time implementation of fault-tolerant control systems with performance optimization[J]. IEEE Transactions on Industrial Electronics, 2014, 61(5): 2402-2411. DOI:10.1109/TIE.2013.2273477 |
[6] | ZHANG Y, JIANG J. Bibliographical review on reconfigurable fault-tolerant control systems[J]. Annual Reviews in Control, 2008, 32(2): 229-252. DOI:10.1016/j.arcontrol.2008.03.008 |
[7] | 李晗, 萧德云. 基于数据驱动的故障诊断方法综述[J]. 控制与决策, 2011, 26(1): 1-9. LI H, XIAO D Y. Survey on data driven fault diadnosis methods[J]. Control and Decision, 2011, 26(1): 1-9. (in Chinese) |
[8] | WANG B, YU X, MU L X, et al. Disturbance observer-based adaptive fault-tolerant control for a quadrotor helicopter subject to parametric uncertainties and external disturbances[J]. Mechanical Systems and Signal Processing, 2019, 120: 727-743. DOI:10.1016/j.ymssp.2018.11.001 |
[9] | WU N E, ZHOU K, SALOMON G. Control reconfigurability of linear time-invariant systems[J]. Automatica, 2000, 36(11): 1767-1771. DOI:10.1016/S0005-1098(00)00080-7 |
[10] | MVLLER P C, WEBER H I. Analysis and optimization of certain qualities of controllability and observability for linear dynamical systems[J]. Automatica, 1972, 8(3): 237-246. DOI:10.1016/0005-1098(72)90044-1 |
[11] | FREII C W, KRAUS F J, BLANKET M.Recoverability viewed as a system property[C]//European Control Conference, 1999: 2197-2202. |
[12] | 徐赫屿, 王大轶, 李文博. 卫星姿态控制系统的可重构性量化评价方法研究[J]. 航天控制, 2016, 34(4): 29-35. XU H Y, WANG D Y, LI W B. A reconfigurability evaluation method for satellite control system based on Gramian matrix[J]. Aerospace Control, 2016, 34(4): 29-35. (in Chinese) |
[13] | HAMDAN A M A, NAYFEH A H. Measures of modal controllability and observability for first and second order linear systems[J]. Journal of Guidance, Control, and Dynamics, 1989, 12(3): 421-428. DOI:10.2514/3.20424 |
[14] | SCHMITENDORF W E. An exact expression for computing the degree of controllability[J]. Journal of Guidance, Control, and Dynamics, 1984, 7(4): 502-504. DOI:10.2514/3.19886 |
[15] | 杜光勋, 全权. 输入受限系统的可控度及其在飞行控制中的应用[J]. 系统科学与数学, 2014, 34(12): 1578-1594. DU G X, QUAN Q. Degree of controllability and its application in aircraft flight control[J]. Journal of Systems Science and Mathematical Sciences, 2014, 34(12): 1578-1594. (in Chinese) |
[16] | 杨荟憭, 姜斌, 张柯. 四旋翼直升机姿态系统的直接自修复控制[J]. 控制理论与应用, 2014, 31(8): 1053-1060. YANG H L, JIANG B, ZHANG K. Direct self-repairing control for four-rotor helicopter attitude systems[J]. Control Theory & Applications, 2014, 31(8): 1053-1060. (in Chinese) |
[17] | JIANG Z P, WANG Y.A generalization of the nonlinear small-gain theorem for large-scale complex systems[C]//Proceedings of the 7th World Congress on Intelligent Control and Automation.Piscataway: IEEE Press, 2008: 1188-1193. |
[18] | ZHAO Y, SONG H, QIU H, et al.Control reconfigurability of nonlinear system based on control redundancy[C]//IEEE 10th International Conference on Industrial Informatics.Piscataway: IEEE Press, 2012: 815-820. |
[19] | GAO Z W, CECATI C, DING S X. A survey of fault diagnosis and fault-tolerant techniques-Part Ⅱ:Fault diagnosis with knowledge-based and hybrid/active approaches[J]. IEEE Transactions on Industrial Electronics, 2015, 62(6): 3768-3774. |
[20] | 何静.基于观测器的非线性系统鲁棒故障检测与重构方法研究[D].长沙: 国防科技大学, 2009: 13-21. HE J.On observer-based robust fault detection and reconstruction for nonlinear system[D].Changsha: National University of Defense Technology, 2009: 13-21(in Chinese). |