微小卫星姿态控制系统鲁棒自适应故障估计

张科, 韩治国, 杨天社, 王靖宇

(1.西北工业大学 航天学院, 陕西 西安 710072; 2.中国西安卫星测控中心, 陕西 西安 710043)



微小卫星姿态控制系统鲁棒自适应故障估计

张科1, 韩治国1, 杨天社2, 王靖宇1

(1.西北工业大学 航天学院, 陕西 西安 710072; 2.中国西安卫星测控中心, 陕西 西安 710043)

针对具有非结构不确定项的非线性系统中存在的执行器与传感器故障，采用一种基于描述系统的故障估计观测器设计方法。该方法具有期望的鲁棒性能指标，能够在系统存在不确定项干扰的情况下实现对突变故障与时变故障等故障类型的精确估计。根据Lyapunov稳定性理论推导了上述方法存在的充分条件，根据线性化算法把上述充分条件转变为准线性矩阵不等式，应用迭代优化算法求得该充分条件的可行解。最后，将该方法应用于微小卫星姿态控制系统中执行器与传感器故障估计，仿真结果证明了该方法的有效性。

姿态控制；线性矩阵不等式；故障估计；Lyapunov函数

随着对高性能与高可靠性要求的增加，卫星姿态控制系统变得越来越精细与复杂。这样的复杂系统不可避免地存在各种各样的故障，尤其是陀螺、强磁计、太阳敏感器以及动量轮等传感器与执行器故障，这些故障将会降低系统的性能，甚至带来灾难性的后果。因此，近几年来卫星姿态控制系统的故障估计问题越来越受到研究者的重视，成为了重要的研究方向，取得了一些富有成效的研究成果[1-4]。

在过去的二十年间，根据先进控制理论，研究了各种各样的故障估计方法。如基于滑模观测器方法、基于未知输入观测器方法、自适应观测器方法以及描述观测器方法等[5-9]。文献[5]针对离散时间线性系统，提出了鲁棒故障估计观测器设计方法，能够实现对系统状态与执行器故障的同时估计；文献[6]采用观测器方法对航天器存在的执行机构失效故障和外部干扰问题进行故障检测与重构；在文献[7]中，将执行器故障作为增广状态向量构造一个增广系统，利用线性矩阵不等式方法设计了一个增广状态观测器，能够同时获得原系统的状态和执行器故障的渐近估计；文献[8]基于故障诊断滤波器设计方法实现对离散线性描述系统的执行器故障诊断；文献[9]针对线性系统，根据已有的自适应故障诊断观测器设计方法，提出了一种增广故障诊断观测器设计方法，拓展了自适应故障诊断观测器的适用范围。

我们注意到，上述研究成果大多是针对线性系统，而且只有文献[8]研究了描述系统的故障诊断问题。根据上述研究成果，本文针对满足Lipschitz条件的非线性系统，采用一种鲁棒自适应观测器设计方法，该方法能够同时估计执行器与传感器故障。通过把传感器故障作为增广状态，建立增广系统模型，应用鲁棒自适应观测器同时估计系统状态、传感器与执行器故障。最后将该方法应用于微小卫星姿态控制系统中执行器与传感器故障估计问题，通过数值仿真证明了该方法在卫星姿态控制系统传感器与执行器故障估计方面的有效性。

1 问题描述

根据文献[10-11]，卫星姿态动力学方程可以由下式描述:

(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常数。

从形式上看,系统(7)是一个描述系统,所以本文将从描述系统出发,进行故障估计观测器设计。

2 故障估计观测器设计

基于上述讨论,对系统(7)采用如下观测器[4]

(9)

针对上述观测器,采用如下的自适应故障估计率[4,9]

(10)

式中:Γ∈Rm×m是对称正定矩阵,代表学习速率,F∈Rm×p,P∈R(n+q)×(n+q)>0为设计参数。

上述观测器(9)可以写成下列形式

(11)

(12)

(13)

(14)

上述(13)式和(14)式能够表达为更简洁的形式

(15)

定理1 考虑满足假设1～2的系统(7),对于给定的正定标量μ,如果存在矩阵P∈R(n+q)×(n+q)>0,LP∈R(n+q)×p和F∈Rm×p满足下面的不等式[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)

(24)

(25)

经过简单的代数运算,(24)式可以写成

(26)

式中:Λ为不等式(16)的左边。因此,如果(16)式成立,则J<0一定成立。定理1得证。

注意到不等式(16)是一个非线性矩阵不等式,不能够应用MATLAB的LMI工具箱进行求解。因此需要做进一步的变换。首先给出相关引理。

引理1 对于适维矩阵Q=QT、F、M、N、不等式(27)Q+εMFN+NTFTMT<0

(27)

对所有满足FTF≤I的F均成立,当且仅当存在ε>0,不等式(28)成立[12]。

(28)

(29)

(30)

(31)

证 具体证明请参见文献[4,11]。

由于(31)式为等式约束,因此根据线性化算法把定理2转化为下面的非线性最小化问题[14]。

(32)

注3 对于本文采用的故障估计方法,同样适用于一般的状态空间模型系统。

3 仿真校验

考虑系统(5),仿真参数设置如下[12]:卫星转动惯量:J=diag{18.40,18.20,6.80}kg·m2,轨道角速度ω0=0.001 1rad/s,干扰力矩:Tdx=A0(3cos(ω0t)+1),Tdy=A0(1.5sin(ω0t)+3cos(ω0t)),Tdz=A0(3sin(ω0t)+1),A0=1.5×10-5Nm。应用上述算法,选择α=600,可以计算得到观测器的增益矩阵为

3.1 突变型执行机构加性故障仿真结果

假设执行器出现突变型加性故障,故障形式为

(33)

(34)

利用故障估计方法(10)实现对故障(33)～(34)的估计,估计结果如图1所示。

图1 执行机构突变故障时响应曲线

从图中可以看出,在发生故障的情况下,基于鲁棒自适应观测器的故障估计方法能够在很短的时间内实现对突变故障的精确估计,且由图中40～80s可知,该观测器也能实现执行机构无故障时的精确估计。同时也说明,该观测器能够同时实现对多方向突变故障的精确估计。

3.2 时变型执行机构加性故障仿真结果

假设执行器出现时变型加性故障,故障形式为

(35)

(36)

图2 执行机构时变故障时响应曲线

仿真参数、初始条件如上所述,采用故障估计方法(10)实现对故障(35)～(36)的估计,其仿真结果如图2所示。从图中可知,当执行器发生时变故障时,本文采用的故障估计方法能够在很短的时间内实现对时变型加性故障的精确估计。

3.3 时变型传感器加性故障仿真结果

假设传感器出现时变型加性故障,故障形式为

(37)

(38)

仿真参数、初始条件如上所述，采用故障估计方法(10)实现对故障(37)式～(38)式的估计。仿真结果如图3所示。

图3 传感器时变故障时响应曲线

从图中可以看出，在传感器发生缓变故障与指数型变化故障时，本文采用的故障估计方法能够在很短的时间内实现对时变型加性故障的精确估计。同时也说明，该观测器能够同时实现对多方向时变故障的精确估计，且当传感器与执行器同时发生故障时，该观测器也能实现对传感器故障与执行器故障的精确估计。

4 结 论

本文针对具有非结构不确定项的非线性系统中存在的执行器与传感器故障，采用一种基于描述系统的故障估计观测器设计方法。该方法能够在系统存在不确定项干扰的情况下实现对突变故障与时变故障等故障类型的精确估计。仿真实例说明了该方法的有效性。

[1]NguangSK,ShiP,DingS.FaultDetectionforUncertainFuzzySystems:AnLMIApproach[J].IEEETransonFuzzySystem, 2007, 15(2): 1251-1262

[2]ZhangZ,ImadM.Jaimoukha.On-LineFaultDetectionandIsolationforLinearDiscrete-TimeUncertainSystems[J].Automatica, 2014, 50(5): 513-518

[3]FengJ,WangS,ZhaoQ.Closed-LoopDesignofFaultDetectionforNetworkedNon-LinearSystemswithMixedDelaysandPacketLosses[J].IETControlTheoryandApplications, 2013, 7(4): 858-868

[4]ZhangJ,SwainAK,NguangSK.RobustAdaptiveDescriptorObserverDesignforFaultEstimationofUncertainNonlinearSystems[J].JournalofTheFranklinInstitute, 2014, 351(4): 5162-5181

[5]SeyedMT,ThomasB.RobustObserver-BasedFaultEstimationandAccommodationofDiscrete-TimePiecewiseLinearSystems[J].JournalofTheFranklinInstitute, 2014, 35(1): 277-295

[6] 肖冰, 胡庆雷, 马广富. 基于观测器的航天器执行机构失效故障重构[J]. 宇航学报, 2011, 32(2): 1000-1328

XiaoBing,HuQinglei,MaGuangfu.ObserverBasedFaultReconstructionforSpacecraftunderLossofActuatorEffectiveness[J].JournalofAstronautics, 2011, 32(2): 323-328 (inChinese)

[7] 王振华, 沈毅, 张筱雷. 基于增广观测器的非线性系统执行器故障诊断[J]. 宇航学报, 2012, 33(12): 1472-1476

WangZhenhua,ShenYi,ZhangXiaolei.AugmentedObserver-BasedActuatorFaultDiagnosisforNonlinearSystems[J].JournalofAstronautics, 2012, 33(12): 1472-1476 (inChinese)

[8] 王振华. 描述系统的故障诊断观测器设计[D]. 哈尔滨: 哈尔滨工业大学, 2013

WangZhenhua.FaultDiagnosisObserverDesignforDescriptorSystem[D].Harbin,HarbinInstituteofTechnology, 2013 (inChinese)

[9] 张柯. 基于观测器的动态系统故障估计和调节[D]. 南京: 南京航空航天大学, 2012

ZhangKe.ObserverBasedFaultEstimationandAccommodationforDynamicSystems[D].Nanjing,NanjingUniversityofAeronauticsandAstronautics, 2012 (inChinese)

[10]ZhangJ,SwainAK,NguangSK.RobustSensorFaultEstimationSchemeforSatelliteAttitudeControlSystems[J].JournalofTheFranklinInstitute, 2013, 18(5): 2581-2604

[11]GaoZF,JiangB,ShiP.SensorFaultEstimationandCompensationforMicrosatelliteAttitudeControlSystems[J].InternationalJournalofControl, 2010, 8(2): 228-237

[12] 管宇. 卫星姿态控制系统的故障诊断与容错方法研究[D]. 哈尔滨: 哈尔滨工业大学, 2012

GuanYu.ResearchonFaultDiagnosisandFault-TolerantControlofSatelliteAttitudeControlSystem[D].Harbin,HarbinInstituteofTechnology, 2012 (inChinese)

Robust Adaptive Fault Estimation for Microsatellite Attitude Control Systems

Zhang Ke1, Han Zhiguo1, Yang Tianshe2, Wang Jingyu1

1.School of Astronautics, Northwestern Polytechnical University, Xi′an 710072, China 2.China Xi′an Satellite Control Center, Xi′an 710043, China

This paper using a fault estimation observer design method based on described system, which is subjected to actuator faults and sensor faults in nonlinear systems with unstructured uncertainties. The method has the desired robust performance index, and in the presence of uncertainties, it can achieve accurate reconstructions of abrupt faults and time-varying faults, etc. Sufficient conditions for the existence of the proposed observer have been derived based on Lyapunov stability theory, and then converted into quasi-convex Linear Matrix Inequalities(LMIs) by using the cone complementarily linearization (CCL) algorithm, consecutively using iterative algorithm to get the feasibility solutions. Finally, the performance of the fault estimation scheme derived here is evaluated extensively through applying this method into microsatellite attitude dynamics, which can effectively estimates the actuator faults and sensor faults.

attitude control; linear matrix inequalities; Lyapunov function; fault estimation

2016-04-10

国家自然科学基金(61174204、61101191、61502391)及航天支撑基金(2015KC020121)资助

张科(1968—)，西北工业大学教授、博士生导师，主要从事飞行器导航、制导与控制研究。

V448

A

1000-2758(2016)05-0798-07