2. 中国西安卫星测控中心, 陕西 西安 710043
随着对高性能与高可靠性要求的增加,卫星姿态控制系统变得越来越精细与复杂。这样的复杂系统不可避免地存在各种各样的故障,尤其是陀螺、强磁计、太阳敏感器以及动量轮等传感器与执行器故障,这些故障将会降低系统的性能,甚至带来灾难性的后果。因此,近几年来卫星姿态控制系统的故障估计问题越来越受到研究者的重视,成为了重要的研究方向,取得了一些富有成效的研究成果[1-4]。
在过去的二十年间,根据先进控制理论,研究了各种各样的故障估计方法。如基于滑模观测器方法、基于未知输入观测器方法、自适应观测器方法以及描述观测器方法等[5-9]。文献[5]针对离散时间线性系统,提出了鲁棒故障估计观测器设计方法,能够实现对系统状态与执行器故障的同时估计;文献[6]采用观测器方法对航天器存在的执行机构失效故障和外部干扰问题进行故障检测与重构;在文献[7]中,将执行器故障作为增广状态向量构造一个增广系统,利用线性矩阵不等式方法设计了一个增广状态观测器,能够同时获得原系统的状态和执行器故障的渐近估计;文献[8]基于故障诊断滤波器设计方法实现对离散线性描述系统的执行器故障诊断;文献[9]针对线性系统,根据已有的自适应故障诊断观测器设计方法,提出了一种增广故障诊断观测器设计方法,拓展了自适应故障诊断观测器的适用范围。
我们注意到,上述研究成果大多是针对线性系统,而且只有文献[8]研究了描述系统的故障诊断问题。根据上述研究成果,本文针对满足Lipschitz条件的非线性系统,采用一种鲁棒自适应观测器设计方法,该方法能够同时估计执行器与传感器故障。通过把传感器故障作为增广状态,建立增广系统模型,应用鲁棒自适应观测器同时估计系统状态、传感器与执行器故障。最后将该方法应用于微小卫星姿态控制系统中执行器与传感器故障估计问题,通过数值仿真证明了该方法在卫星姿态控制系统传感器与执行器故障估计方面的有效性。
1 问题描述(1) |
式中, J=diag{J1, J2, J3}为卫星的转动惯量, ω=[ωx, ωy, ωz]T为卫星本体相对惯性坐标系的角速度在星体坐标系中的表示, u=[u1, u2, u3]T为控制力矩, 非线性项为ζ=[-sinθ, sinφcosθ, cosφcosθ]T, ω0为轨道角速度, Td=[Td1, Td2, Td3]T为外部干扰力矩, 欧拉角φ、θ、ψ分别为滚转、俯仰与偏航角, 斜对称矩阵由下式描述
(2) |
当姿态角较小时, 动力学方程(1)可以写成
(3) |
卫星的运动学方程经过线性化可以描述为
(4) |
选取状态变量x=[φ, θ, ψ, ωx, ωy, ωz]T, 则含有系统不确定项Δψ(t)以及传感器故障fs与执行器故障fa的卫星姿态控制系统可描述为
(5) |
式中:
(6) |
如果把传感器故障作为附加状态, 可以得到如下的增广描述系统形式[11]
(7) |
式中:
注1 在上述增广过程中并未采用任何假设, 所以系统(5)和(7)是完全等价的。
注2 微小卫星的姿态控制系统不同于较大卫星, 较大卫星的柔性与模型的缓变衰减是建模时应该主要考虑的影响因素。而对于微小卫星, 由于不存在柔性特性, 可以把它作为刚体进行考虑。
在进行故障估计观测器设计之前, 首先给出如下合理假设。
假设1 假设系统(5)是能控能观系统, 非线性项f(x, t)满足Lipschitz条件, 即
(8) |
式中:Lf是Lipschitz常数。
假设2 当传感器故障fa与执行器故障fs发生时, 它们是可辨识的, 并且
从形式上看, 系统(7)是一个描述系统, 所以本文将从描述系统出发, 进行故障估计观测器设计。
2 故障估计观测器设计对于系统(7), 根据假设1和2, 一定能够找到矩阵LD∈R(n+q)×p使得矩阵S=E+LDC为非奇异矩阵, 通常选S为单位阵。需要注意的是, 当E=In时, LD可以选择0矩阵使得S为非奇异矩阵。
基于上述讨论, 对系统(7)采用如下观测器[4]
(9) |
式中:w∈Rn+q是中间变量,
(10) |
式中:Γ∈Rm×m是对称正定矩阵, 代表学习速率, F∈Rm×p, P∈R(n+q)×(n+q) > 0为设计参数。
上述观测器(9)可以写成下列形式
(11) |
在方程(7)两边同时加上LD
(12) |
定义状态估计误差e=z-
(13) |
式中:ef=fa-
(14) |
上述(13)式和(14)式能够表达为更简洁的形式
(15) |
式中:
定义
在进行观测器增益矩阵设计时, 设计目标为:在零初始条件下, 对于所有的非零项满足Δ
定理1 考虑满足假设1~2的系统(7), 对于给定的正定标量μ, 如果存在矩阵P∈R(n+q)×(n+q)>0, LP∈R(n+q)×p和F∈Rm×p满足下面的不等式[4, 11]
(16) |
式中:
证 定义Lyapunov函数
(17) |
式中:
(18) |
由于不确定项满足Lipschitz条件, 因此
(19) |
式中:θ0是一个正定标量, θ0=Lf/‖C‖。
对于任意给定的向量x、y与正定对称矩阵P, 不等式xTy+yTx≤xTPx+2yTP-1y总是成立, 因此
(20) |
如果α满足
(21) |
把(20)式和(21)式带入(18)式, 可以得到
(22) |
当Δ
(23) |
如果不等式(16)存在可行解, 则
另外, 当Δ
(24) |
令
(25) |
经过简单的代数运算, (24)式可以写成
(26) |
式中:Λ为不等式(16)的左边。因此, 如果(16)式成立, 则J < 0一定成立。定理1得证。
注意到不等式(16)是一个非线性矩阵不等式, 不能够应用MATLAB的LMI工具箱进行求解。因此需要做进一步的变换。首先给出相关引理。
引理1 对于适维矩阵Q=QT、F、M、N、不等式(27)
(27) |
对所有满足FTF≤I的F均成立, 当且仅当存在ε>0, 不等式(28)成立[12]。
(28) |
定理2 考虑满足假设1~2的系统(7), 如果存在矩阵P∈R(n+q)×(n+q)>0, P∈R(n+q)×(n+q)>0, F∈Rm×p、和LP∈R(n+q)×p, 正定标量ε和ε, 使得下面的最优化问题具有可行解[4, 11]
(29) |
(30) |
(31) |
式中:
由于(31)式为等式约束, 因此根据线性化算法把定理2转化为下面的非线性最小化问题[4]。
(32) |
注3 对于本文采用的故障估计方法, 同样适用于一般的状态空间模型系统。
3 仿真校验考虑系统(5), 仿真参数设置如下[12]:卫星转动惯量:J=diag{18.40, 18.20, 6.80}kg·m2, 轨道角速度ω0=0.001 1 rad/s, 干扰力矩:Tdx=A0(3cos(ω0t)+1), Tdy=A0(1.5sin(ω0t)+3cos(ω0t)), Tdz=A0(3sin(ω0t)+1), A0=1.5×10-5Nm。应用上述算法, 选择α=600, 可以计算得到观测器的增益矩阵为
假设执行器出现突变型加性故障, 故障形式为
(33) |
(34) |
利用故障估计方法(10)实现对故障(33)~(34)的估计, 估计结果如图 1所示。
从图中可以看出, 在发生故障的情况下, 基于鲁棒自适应观测器的故障估计方法能够在很短的时间内实现对突变故障的精确估计, 且由图中40~80 s可知, 该观测器也能实现执行机构无故障时的精确估计。同时也说明, 该观测器能够同时实现对多方向突变故障的精确估计。
3.2 时变型执行机构加性故障仿真结果假设执行器出现时变型加性故障, 故障形式为
(35) |
(36) |
仿真参数、初始条件如上所述, 采用故障估计方法(10)实现对故障(35)~(36)的估计, 其仿真结果如图 2所示。从图中可知, 当执行器发生时变故障时, 本文采用的故障估计方法能够在很短的时间内实现对时变型加性故障的精确估计。
3.3 时变型传感器加性故障仿真结果假设传感器出现时变型加性故障, 故障形式为
(37) |
(38) |
仿真参数、初始条件如上所述,采用故障估计方法(10)实现对故障(37)式~(38)式的估计。仿真结果如图 3所示。
从图中可以看出,在传感器发生缓变故障与指数型变化故障时,本文采用的故障估计方法能够在很短的时间内实现对时变型加性故障的精确估计。同时也说明,该观测器能够同时实现对多方向时变故障的精确估计,且当传感器与执行器同时发生故障时,该观测器也能实现对传感器故障与执行器故障的精确估计。
4 结论本文针对具有非结构不确定项的非线性系统中存在的执行器与传感器故障,采用一种基于描述系统的故障估计观测器设计方法。该方法能够在系统存在不确定项干扰的情况下实现对突变故障与时变故障等故障类型的精确估计。仿真实例说明了该方法的有效性。
[1] | Nguang S K, Shi P, Ding S. Fault Detection for Uncertain Fuzzy Systems:An LMI Approach[J]. IEEE Trans on Fuzzy System , 2007, 15 (2) : 1251–1262. |
[2] | Zhang Z, Imad M., Jaimoukha. On-Line Fault Detection and Isolation for Linear Discrete-Time Uncertain Systems[J]. Automatica , 2014, 50 (5) : 513–518. |
[3] | Feng J, Wang S, Zhao Q. Closed-Loop Design of Fault Detection for Networked Non-Linear Systems with Mixed Delays and Packet Losses[J]. IET Control Theory and Applications , 2013, 7 (4) : 858–868. |
[4] | Zhang J, Swain A K, Nguang S K. Robust Adaptive Descriptor Observer Design for Fault Estimation of Uncertain Nonlinear Systems[J]. Journal of The Franklin Institute , 2014, 351 (4) : 5162–5181. |
[5] | Seyed M T, Thomas B. Robust Observer-Based Fault Estimation and Accommodation of Discrete-Time Piecewise Linear Systems[J]. Journal of The Franklin Institute , 2014, 35 (1) : 277–295. |
[6] |
肖冰, 胡庆雷, 马广富.
基于观测器的航天器执行机构失效故障重构[J]. 宇航学报 , 2011, 32 (2) : 323–328.
Xiao Bing, Hu Qinglei, Ma Guangfu. Observer Based Fault Reconstruction for Spacecraft under Loss of Actuator Effectiveness[J]. Journal of Astronautics , 2011, 32 (2) : 323–328. |
[7] |
王振华, 沈毅, 张筱雷.
基于增广观测器的非线性系统执行器故障诊断[J]. 宇航学报 , 2012, 33 (12) : 1472–1476.
Wang Zhenhua, Shen Yi, Zhang Xiaolei. Augmented Observer-Based Actuator Fault Diagnosis for Nonlinear Systems[J]. Journal of Astronautics , 2012, 33 (12) : 1472–1476. |
[8] |
王振华.描述系统的故障诊断观测器设计[D].哈尔滨:哈尔滨工业大学, 2013
Wang Zhenhua. Fault Diagnosis Observer Design for Descriptor System[D]. Harbin, Harbin Institute of Technology, 2013(in Chinese) http://cdmd.cnki.com.cn/article/cdmd-10213-1014080715.htm |
[9] |
张柯.基于观测器的动态系统故障估计和调节[D].南京:南京航空航天大学, 2012
Zhang Ke. Observer Based Fault Estimation and Accommodation for Dynamic Systems[D]. Nanjing, Nanjing University of Aeronautics and Astronautics, 2012(in Chinese) http://cdmd.cnki.com.cn/article/cdmd-10287-1013023977.htm |
[10] | Zhang J, Swain A K, Nguang S K. Robust Sensor Fault Estimation Scheme for Satellite Attitude Control Systems[J]. Journal of The Franklin Institute , 2013, 18 (5) : 2581–2604. |
[11] | Gao Z F, Jiang B, Shi P. Sensor Fault Estimation and Compensation for Microsatellite Attitude Control Systems[J]. International Journal of Control , 2010, 8 (2) : 228–237. DOI:10.1007/s12555-010-0207-7 |
[12] |
管宇.卫星姿态控制系统的故障诊断与容错方法研究[D].哈尔滨:哈尔滨工业大学, 2012
Guan Yu. Research on Fault Diagnosis and Fault-Tolerant Control of Satellite Attitude Control System[D]. Harbin, Harbin Institute of Technology, 2012(in Chinese) |
2. China Xi'an Satellite Control Center, Xi'an 710043, China