CN107861383B - 基于自适应观测器的卫星故障诊断与容错控制方法 - Google Patents

基于自适应观测器的卫星故障诊断与容错控制方法 Download PDF

Info

Publication number
CN107861383B
CN107861383B CN201710994393.6A CN201710994393A CN107861383B CN 107861383 B CN107861383 B CN 107861383B CN 201710994393 A CN201710994393 A CN 201710994393A CN 107861383 B CN107861383 B CN 107861383B
Authority
CN
China
Prior art keywords
fault
satellite
observer
adaptive
spacecraft
Prior art date
Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
Expired - Fee Related
Application number
CN201710994393.6A
Other languages
English (en)
Other versions
CN107861383A (zh
Inventor
田栢苓
张秀云
宗群
Current Assignee (The listed assignees may be inaccurate. Google has not performed a legal analysis and makes no representation or warranty as to the accuracy of the list.)
Tianjin University
Original Assignee
Tianjin University
Priority date (The priority date is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the date listed.)
Filing date
Publication date
Application filed by Tianjin University filed Critical Tianjin University
Priority to CN201710994393.6A priority Critical patent/CN107861383B/zh
Publication of CN107861383A publication Critical patent/CN107861383A/zh
Application granted granted Critical
Publication of CN107861383B publication Critical patent/CN107861383B/zh
Expired - Fee Related legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Images

Classifications

    • GPHYSICS
    • G05CONTROLLING; REGULATING
    • G05BCONTROL OR REGULATING SYSTEMS IN GENERAL; FUNCTIONAL ELEMENTS OF SUCH SYSTEMS; MONITORING OR TESTING ARRANGEMENTS FOR SUCH SYSTEMS OR ELEMENTS
    • G05B13/00Adaptive control systems, i.e. systems automatically adjusting themselves to have a performance which is optimum according to some preassigned criterion
    • G05B13/02Adaptive control systems, i.e. systems automatically adjusting themselves to have a performance which is optimum according to some preassigned criterion electric
    • G05B13/04Adaptive control systems, i.e. systems automatically adjusting themselves to have a performance which is optimum according to some preassigned criterion electric involving the use of models or simulators
    • G05B13/042Adaptive control systems, i.e. systems automatically adjusting themselves to have a performance which is optimum according to some preassigned criterion electric involving the use of models or simulators in which a parameter or coefficient is automatically adjusted to optimise the performance

Landscapes

  • Engineering & Computer Science (AREA)
  • Health & Medical Sciences (AREA)
  • Artificial Intelligence (AREA)
  • Computer Vision & Pattern Recognition (AREA)
  • Evolutionary Computation (AREA)
  • Medical Informatics (AREA)
  • Software Systems (AREA)
  • Physics & Mathematics (AREA)
  • General Physics & Mathematics (AREA)
  • Automation & Control Theory (AREA)
  • Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)
  • Navigation (AREA)

Abstract

本发明涉及卫星故障诊断与容错控制技术领域,为提出一种故障诊断方法,使其对外界干扰具有很好的鲁棒性,在故障诊断过程不受外界干扰影响,防止产生误报及漏报情况,且可以有效估计故障大小;本发明,基于自适应观测器的卫星故障诊断与容错控制方法,首先建立执行器故障及外界干扰影响下的卫星运动学及动力学模型,分析故障有效因子对系统的影响;其次,针对卫星故障系统设计观测器,基于观测器输出与系统实际输出建立残差评价函数,并获得评价阈值,达到故障检测的目的;然后,当检测出故障发生后,设计自适应观测器,完成故障诊断任务;最后,基于故障的估计值,设计有限时间自适应容错控制器。本发明主要应用于故障诊断与容错控制场合。

Description

基于自适应观测器的卫星故障诊断与容错控制方法
技术领域
本发明涉及卫星故障诊断与容错控制技术领域,特别是一种面向卫星姿态控制系统执行器故障的诊断与容错控制领域。具体讲,涉及基于自适应观测器的卫星故障诊断与容错控制方法。
背景技术
航天器是指按照天体运行规律在大气层外运行的空间飞行器。航天器技术经过几十年的探索和发展,在国家安全、经济发展、技术进步、环境监测、气象预报、减灾救灾等方面发挥了重要作用。航天事业的发展不仅是航天科技实力进步的表现,更是一个国家综合国力不断壮大的体现。然而,由于卫星在太空运行过程中具有远程不可及等应用特殊性,作为保障卫星正常运转的核心子系统,卫星姿态控制系统的故障诊断问题一直是航天领域研究的重点和难点。卫星星上资源和人工干预能力有限,太空监测环境恶劣和不确定性因素多等特点决定了卫星故障诊断不仅要具备一般故障诊断的可靠性及准确性要求,还必须具有快速自诊断及自主容错恢复能力。卫星等航天器一旦发生故障,很可能会在很短时间导致翻滚,不能正常工作甚至导致卫星坠毁,造成巨大经济损失,对空间计划、科学研究、经济乃至政治、军事等都将造成恶劣影响和严重后果。因此,系统研究航天器故障诊断与容错控制理论和方法,对保障航天器的安全可靠运行、延长航天器使用寿命、预防重大事故发生具有十分重要的意义。
然而,由于卫星所处空间环境中的各种未知干扰因素较多,而且随着任务和星体结构的复杂性日益增加,模型不确定性等对卫星容错控制效果的影响也越来越明显,在干扰及不确定影响下的卫星故障诊断与容错控制一直是航天领域研究的重点和难点。目前,基于观测器的故障诊断与容错控制方法应用最为广泛,通过观测被诊断对象的状态,并与可测状态比较,构成残差序列,再运用统计学或几何学方法,对残差序列进行评价与决策,以达到故障检测的目的。然而,基于现有理论方法进行卫星故障诊断与容错控制设计时,存在的不足主要体现在以下几个方面:(1)大部分研究者主要针对卫星线性化模型进行故障诊断的研究,即在小姿态角条件下将卫星姿态运动学方程线性化,然后针对线性化后的卫星故障模型进行故障诊断与容错控制器设计,但由于实际系统中存在不同程度的非线性,容易导致线性残差产生器诊断性能下降,甚至出现误报和漏报的情况;(2)现有故障诊断方法较少考虑空间干扰力矩的影响,或者直接将干扰力矩与故障混合在一起进行估计,不能实现故障与干扰的有效解耦,这些均将极大限制卫星姿控系统的故障诊断精度,难以保证故障诊断方法的鲁棒性;(3)之前大部分工作中均假设系统状态是已知的,且故障形式为加性故障,而在带有乘性故障的卫星非线性模型中,由于故障影响与系统的状态或输入混合在一起,会使得故障诊断更加复杂。
发明内容
为克服现有技术的不足,本发明旨在提出一种故障诊断方法,使其对外界干扰具有很好的鲁棒性,在故障诊断过程不受外界干扰影响,防止产生误报及漏报情况,且可以有效估计故障大小;其有效性及可靠性高,可以保证系统状态在有限时间内实现稳定,有利于提高航天器运行过程中的自我修复能力,有效提高卫星的可靠性和安全性。为此,本发明采用的技术方案是,基于自适应观测器的卫星故障诊断与容错控制方法,首先建立执行器故障及外界干扰影响下的卫星运动学及动力学模型,分析故障有效因子对系统的影响;其次,针对卫星故障系统设计观测器,基于观测器输出与系统实际输出建立残差评价函数,并获得评价阈值,达到故障检测的目的;然后,当检测出故障发生后,设计自适应观测器,对故障的大小及变化形式进行估计,从而完成故障诊断任务;最后,基于故障的估计值,设计有限时间自适应容错控制器,保证系统状态可以有限时间收敛,且无需干扰的上界信息。
故障影响下的卫星非线性模型建立具体步骤:根据航天器飞行特性,基于卫星四元数表示方法,提出外界干扰影响下的卫星非线性运动学及动力学模型,其表达形式为:
Figure GDA0001580459250000021
其中,q为航天器本体坐标系Fb相对于惯性坐标系FI的姿态四元数在Fb中的投影,定义
Figure GDA0001580459250000027
其中
Figure GDA0001580459250000028
分别表示单位四元数的标量部分和向量部分;ω=[ω123]T为航天器本体坐标系Fb相对于惯性坐标系FI的角速度在Fb中的投影;J∈R3×3为航天器的转动惯量矩阵;u=[u1,u2,u3]T为航天器所需控制力矩;d为航天器受到的有界干扰力矩,ω×及qv ×表达方式一致,其中qv ×定义为:
Figure GDA0001580459250000022
考虑航天器故障问题,把执行器故障建模为乘性因子形式,则故障条件下的航天器姿态动力学方程转化为:
Figure GDA0001580459250000026
其中,U=diag(u1,u2,u3),β=[β123]T表示有效因子,0≤βi(i=1,2,3)≤1,βi=1表示第i个执行机构未出现故障,0<βi<1表示第i个执行机构部分失效但仍在工作,βi=0表示第i个执行机构完全失效;
卫星故障检测机制设计具体步骤:针对故障系统(3),设计如下观测器:
Figure GDA0001580459250000023
其中,
Figure GDA0001580459250000024
为ω的估计值,
Figure GDA0001580459250000025
为有效因子β的重构值,L∈R3×3为正定矩阵。
定义状态估计误差
Figure GDA0001580459250000031
故障估计误差
Figure GDA0001580459250000032
结合式(3)及式(4),得到:
Figure GDA0001580459250000033
Figure GDA0001580459250000034
则式(5)转化为:
Figure GDA0001580459250000035
在系统故障发生之前,即t<T时,其中T为执行机构故障发生时刻,
Figure GDA0001580459250000036
此时,状态估计误差动态系统(6)转化为:
Figure GDA0001580459250000037
定义残差信号
Figure GDA0001580459250000038
接下来需要确定残差估计阈值Jth
由(7)得到:
Figure GDA0001580459250000039
假设
Figure GDA00015804592500000310
均为大于0的常数,且存在关于ω的Lipschitz常数γ1,满足
Figure GDA00015804592500000311
另外,假设Λ是一个稳定矩阵,那么存在正数k及λ,使得||eΛt||≤ke-λt,得到:
Figure GDA00015804592500000312
利用Bellman–Gronwall引理得:
Figure GDA00015804592500000313
定义如下残差评价函数:
Figure GDA00015804592500000314
因此故障发生时,故障检测机制如下:
||Jr(t)||<Jth→无故障发生 (12)
||Jr(t)||≥Jth→有故障发生 (13)
其中,Jth为残差评价函数的上界,由(10)得:
Figure GDA0001580459250000041
因此,考虑故障条件下刚体航天器姿态动力学模型(3),若设计故障检测观测器(4)与残差评价函数(14),当残差评价函数||Jr(t)||超出阈值Jth时,则故障检测策略可检测到故障发生。
卫星故障重构机制设计步骤:当故障发生之后,系统检测到残差评价函数||Jr(t)||超过阈值Jth,此时需要对故障进行重构,自适应观测器设计为:
Figure GDA0001580459250000042
其中,γ,δs为正实数,P为待求解对称矩阵;
下面给出自适应观测器增益的求解方法:存在对称矩阵P满足如下条件
Figure GDA0001580459250000043
其中
Figure GDA0001580459250000044
Γ=-J-1L,利用MATLAB/LMI工具箱进行求解。
容错控制器设计步骤:基于式(15)的自适应观测器对有效因子β的估计值
Figure GDA0001580459250000045
并考虑其估计误差,卫星故障影响下运动学及动力学模型转化为:
Figure GDA0001580459250000046
其中,
Figure GDA0001580459250000047
针对卫星系统(17),设计非奇异终端滑模面:
S=ω+Kψ(qv) (18)
其中,K>0,ψ(qv)=[ψ(q1),ψ(q2),ψ(q3)]T,其表达式为
Figure GDA0001580459250000048
其中,0<r<1,ξ>0,l1=(2-r)ξr-1,l2=(r-1)ξr-2
对滑模面(18)进行求导得到:
Figure GDA0001580459250000049
其中,
Figure GDA00015804592500000410
Figure GDA0001580459250000051
针对滑模动态系统(20),设计控制力矩如式(22)所示:
Figure GDA0001580459250000052
其中,k1>0,k2>0,
Figure GDA0001580459250000053
为综合不确定D上界的估计值,用自适应律表示:
Figure GDA0001580459250000054
其中,
Figure GDA0001580459250000055
本发明的特点及有益效果是:
考虑带有乘性故障及外界干扰的卫星非线性模型,本发明提出了基于自适应观测器的故障诊断策略,不仅能够同时估计系统状态及残差信号,而且能够确定未知故障的大小,且故障检测过程中,阈值的获取可以保证所提出的故障检测策略对外界干扰具有强鲁棒性,对故障具有敏感性,有效的处理了故障与干扰之间的矛盾。此外,基于故障的估计值,设计了有限时间自适应终端滑模容错控制器,保证了故障发生后卫星姿态系统可以快速恢复稳定性能,提高了卫星在轨可靠性和安全性,减少了安全隐患风险和防止系统灾难性事故的发生。
附图说明:
图1基于自适应观测器的卫星故障诊断与容错控制系统结构图。
图2无故障时评价函数及有效因子估计仿真结果。
图3角速度及观测值仿真结果。
图4故障发生时评价函数及故障重构仿真结果。
图5卫星四元数及角速度变化曲线。
具体实施方式
针对现有技术的局限,在本发明研究中,考虑带有乘性故障及外界干扰的卫星非线性模型,提出了基于自适应观测器的故障诊断策略,不仅能够同时估计系统状态及残差信号,而且能够确定未知故障的大小,且故障检测过程中,阈值的获取可以保证所提出的故障检测策略对外界干扰具有强鲁棒性,对故障具有敏感性,有效的处理了故障与干扰之间的矛盾。此外,基于故障的估计值,设计了有限时间自适应终端滑模容错控制器,保证了故障发生后卫星姿态系统可以快速恢复稳定性能,提高了卫星在轨可靠性和安全性,减少了安全隐患风险和防止系统灾难性事故的发生。
本发明涉及一种卫星故障诊断与容错控制技术领域。具体来说,首先提出了基于自适应观测器的故障诊断策略及有限时间容错控制算法,随后通过Simulink仿真验证了本发明提出算法的有效性。
本发明的目的在于提出一种基于自适应观测器的卫星故障诊断与容错控制策略。一方面,由于航天器任务的复杂化及其非线性等特性,使得其故障诊断的难度和复杂性显著增加。另一方面,卫星在轨运行时受到空间环境的各种摄动力作用以及高温、低温、电磁干扰、空间粒子辐射等多方面的外界干扰,更增加了卫星故障诊断的复杂性。传统的故障诊断较少考虑空间干扰力矩的影响,且系统状态往往是已知的,而故障形式大多为加性故障。基于此,本发明提出了一种基于自适应观测器的卫星故障诊断方法,首先建立执行器故障及外界干扰影响下的卫星运动学及动力学模型,分析故障有效因子对系统的影响;其次,针对卫星故障系统设计观测器,基于观测器输出与系统实际输出建立残差评价函数,并获得评价阈值,以此达到故障检测的目的;然后,当检测出故障发生后,设计自适应观测器,对故障的大小及变化形式进行估计,从而完成故障诊断任务;最后,基于故障的估计值,设计有限时间自适应容错控制器,保证系统状态可以有限时间收敛,且无需干扰的上界信息。本发明提出的故障诊断方法对外界干扰具有很好的鲁棒性,使得故障诊断过程不受外界干扰影响,防止产生误报及漏报情况,且可以有效估计故障大小;提出的容错控制算法的有效性及可靠性高,可以保证系统状态在有限时间内实现稳定,有利于提高航天器运行过程中的自我修复能力,有效提高卫星的可靠性和安全性。
本发明提出的基于自适应观测器的卫星故障诊断与容错控制算法总体技术方案如图1所示,整个系统包括三部分:故障检测机制、故障重构策略和有限时间容错控制器设计,具体技术方案如下:
第一部分,故障检测机制设计:建立外界干扰及执行器乘性故障影响下的卫星非线性运动学及动力学模型,并基于该模型,设计状态观测器,利用观测器的输出与实际系统的输出获得残差评价函数,在干扰及不确定存在条件下建立残差估计阈值,当评价函数低于阈值时,表明无故障产生;相反,当评价函数高于阈值时,则表明产生故障,从而达到故障检测的目的。该检测机制可以同时保证对干扰的鲁棒性及对故障的敏感性,防止漏报与误报,保证故障检测的准确性。
第二部分,故障重构机制设计:当故障检测机制检测出系统发生故障后,需要触发故障重构机制对故障大小进行估计。本发明采用自适应方法进行故障重构,基于系统的状态估计误差,设计合理的自适应观测器,通过不断实时在线调整,实现卫星故障参数的准确估计。
第三部分,有限时间容错控制器设计:利用自适应观测器对故障大小的估计值,基于自适应终端滑模理论,针对干扰及故障影响下的卫星动力学系统,设计具有有限时间收敛特性的容错控制器,无需综合不确定上界信息,且可以保证故障发生后卫星姿态系统可以快速恢复自身稳定性能,并确保在有限时间内实现对期望姿态的高精度快速跟踪。
最后为了验证本发明提出算法的有效性,搭建卫星姿态控制系统故障诊断与容错控制的MATLAB/Simulink仿真系统,验证本发明提出算法的有效性。
为了验证本发明提出的基于自适应观测器的故障诊断与容错控制方法的有效性,首先将卫星的容错控制系统在Matlba/Simulink中进行集成设计,并进行了仿真实验,主要仿真过程如下:
(1)参数设置
1)卫星物理参数设置:航天器角速度初值设定为ω(0)=[0.06-0.06-0.1]Trad/s,四元数初值设定为q(0)=[0.8986 0.4 0.1 -0.15]T。卫星转动惯量设定为:
Figure GDA0001580459250000071
外界扰动力矩设定为d1=A0(3cosω0t+1),d2=A0(1.5sinω0t+3cosω0t),d3=A0(3sinω0t+1),其中A0=1.5×10-5N·m,ω0=0.0012rad/s。
2)观测器参数设置:β(0)=[0 0 0]T
Figure GDA0001580459250000072
故障检测观测器参数设置:
Figure GDA0001580459250000073
k=0.00095,γ1=0.1,ε=0.001;
故障重构观测器参数设置:
Figure GDA0001580459250000074
λ=0.0001,γ=0.042,δs=1。
3)容错控制器参数设置:k1=1,k2=0.8,δ=1,λ=3.5。
(2)结果分析
为说明本方法的有效性,下面将进行两种情况下的仿真:
情形1:没有故障发生。
情形2:卫星飞轮出现效益损失故障,故障形式设置为:
Figure GDA0001580459250000075
即当t>13s时,β=[0.5 0.5 0.5]T,其余时刻飞轮正常工作,即β=[1 1 1]T
在上述给定的条件下,获得的仿真结果如图2-图5所示。其中图2为利用本发明提出的基于自适应观测器的卫星故障诊断与容错控制方法在无故障情况下的仿真结果,图3-图5为卫星飞轮出现效益损失故障下的仿真结果。
从仿真图2中可以看出,在提出的卫星故障诊断与容错控制框架(如图1)内,利用本发明提出的基于自适应观测器的卫星故障诊断与容错控制方法,在情形1条件下,残差评价函数始终小于设定的故障检测阈值,表明未检测到故障的发生,图2同样给出了相应的执行机构有效因子的估计值,从中可以发现有效因子一直保持为1,同样说明该情形下执行器未发生效力损失故障,验证了所设计的故障诊断方法的有效性。在情形2即执行机构发生故障情形下,图3给出的为本发明设计的观测器对系统状态观测值及观测误差图,从中可以看出观测器可以有效的对角速度进行精确的估计,且观测误差精度达到10-5;从图4评价函数及故障重构仿真结果看出,残差评价函数超出了故障检测阈值,即设计的故障检测观测器检测到有故障发生,这与实际情况完全符合。当故障检测机制检测到发生故障后,用于估计故障的故障重构机制得到触发,由故障的重构仿真结果可以看出,本发明所设计的自适应观测器可以在很短时间内实现对故障的准确估计。图5给出了卫星四元数及角速度的变化曲线,从中可以看出本发明所设计的有限时间自适应终端滑模容错控制器可以保证系统状态有限时间内达到稳定。
基于故障及外界干扰影响下的卫星动力学模型,通过设计观测器,利用观测器输出与系统真实输出的比较,获得残差评价函数及阈值,实现故障检测的目标要求。若检测到故障的发生,则需要进行故障重构,故障重构是故障诊断的核心环节,通过设计自适应观测器,对故障参数进行估计,达到故障诊断的目的;基于故障估计值,设计有限时间自适应容错控制器,保证系统状态的快速稳定。
本发明以基于自适应观测器与有限时间终端滑模的控制理论为主要研究手段,提出一种卫星故障诊断与容错控制算法,具体实现过程如下。
第一步:故障影响下的卫星非线性模型建立。根据航天器飞行特性,基于卫星四元数表示方法,提出外界干扰影响下的卫星非线性运动学及动力学模型,其表达形式为:
Figure GDA0001580459250000081
其中,q为航天器本体坐标系Fb相对于惯性坐标系FI的姿态四元数在Fb中的投影,定义
Figure GDA0001580459250000082
其中
Figure GDA0001580459250000083
分别表示单位四元数的标量部分和向量部分;ω=[ω123]T为航天器本体坐标系Fb相对于惯性坐标系FI的角速度在Fb中的投影;J∈R3×3为航天器的转动惯量矩阵;u=[u1,u2,u3]T为航天器所需控制力矩;d为航天器受到的有界干扰力矩,ω×及qv ×表达方式一致,其中qv ×定义为:
Figure GDA0001580459250000084
考虑航天器故障问题,把执行器故障建模为乘性因子形式,则故障条件下的航天器姿态动力学方程变为:
Figure GDA0001580459250000085
其中,U=diag(u1,u2,u3),β=[β123]T表示有效因子,0≤βi(i=1,2,3)≤1,βi=1表示第i个执行机构未出现故障,0<βi<1表示第i个执行机构部分失效但仍在工作,βi=0表示第i个执行机构完全失效;
第二步:卫星故障检测机制设计。针对故障系统(26),设计如下观测器:
Figure GDA0001580459250000086
其中,
Figure GDA0001580459250000087
为ω的估计值,
Figure GDA0001580459250000088
为有效因子β的重构值,L∈R3×3为正定矩阵。
定义状态估计误差
Figure GDA0001580459250000089
故障估计误差
Figure GDA00015804592500000810
结合式及(26)式(27),可以得到:
Figure GDA0001580459250000091
令f(ω)=-ω×Jω,
Figure GDA0001580459250000092
则式(28)转化为:
Figure GDA0001580459250000093
在系统故障发生之前,即t<T时,其中T为执行机构故障发生时刻,
Figure GDA0001580459250000094
此时,状态估计误差动态系统(29)转化为:
Figure GDA0001580459250000095
定义残差信号
Figure GDA0001580459250000096
接下来需要确定残差估计阈值Jth
由(30)可以得到:
Figure GDA0001580459250000097
假设
Figure GDA0001580459250000098
均为大于0的常数,且存在关于ω的Lipschitz常数γ1,满足
Figure GDA0001580459250000099
另外,假设Λ是一个稳定矩阵,那么存在正数k及λ,使得||eΛt||≤ke-λt,得到:
Figure GDA00015804592500000910
利用Bellman–Gronwall引理可得:
Figure GDA00015804592500000911
定义如下残差评价函数:
Figure GDA00015804592500000912
因此故障发生时,故障检测机制如下:
||Jr(t)||<Jth→无故障发生 (35)
||Jr(t)||≥Jth→有故障发生 (36)
其中,Jth为残差评价函数的上界,由(33)可得:
Figure GDA00015804592500000913
因此,考虑故障条件下刚体航天器姿态动力学模型(3),若设计故障检测观测器(4)与残差评价函数(14),当残差评价函数||Jr(t)||超出阈值Jth时,则故障检测策略可检测到故障发生。
第三步:卫星故障重构机制设计。当故障发生之后,系统检测到残差评价函数||Jr(t)||超过阈值Jth,此时需要对故障进行重构。本发明采用自适应方法进行故障重构,其关键在于设计合理的自适应观测器实现对
Figure GDA0001580459250000101
的精确估计。
自适应观测器设计为:
Figure GDA0001580459250000102
其中,γ,δs为正实数,P为待求解对称矩阵。
下面给出自适应观测器增益的求解方法:存在对称矩阵P满足如下条件
Figure GDA0001580459250000103
其中
Figure GDA0001580459250000104
Γ=-J-1L,利用MATLAB/LMI工具箱进行求解。
第四步:容错控制器设计。基于式(38)的自适应观测器对有效因子β的估计值
Figure GDA0001580459250000105
并考虑其估计误差,卫星故障影响下运动学及动力学模型转化为:
Figure GDA0001580459250000106
v其中,
Figure GDA0001580459250000107
针对卫星系统(39),设计非奇异终端滑模面:
S=ω+Kψ(qv)(40)
其中,K>0,ψ(qv)=[ψ(q1),ψ(q2),ψ(q3)]T,其表达式为
Figure GDA0001580459250000108
其中,0<r<1,ξ>0,l1=(2-r)ξr-1,l2=(r-1)ξr-2
对滑模面(40)进行求导得到:
Figure GDA0001580459250000109
其中,
Figure GDA00015804592500001010
Figure GDA00015804592500001011
针对滑模动态系统(42),设计控制力矩如式(44)所示:
Figure GDA0001580459250000111
其中,k1>0,k2>0,
Figure GDA0001580459250000112
为综合不确定D上界的估计值,用自适应律表示:
Figure GDA0001580459250000113
其中,δ>0,
Figure GDA0001580459250000114
基于以上四步,完成了整个卫星故障诊断与容错控制过程的设计。

Claims (4)

1.一种基于自适应观测器的卫星故障诊断与容错控制方法,其特征是,首先建立执行器故障及外界干扰影响下的卫星运动学及动力学模型,分析故障有效因子对系统的影响;其次,针对卫星故障系统设计观测器,基于观测器输出与系统实际输出建立残差评价函数,并获得评价阈值;然后,当检测出故障发生后,设计自适应观测器,对故障的大小及变化形式进行估计,从而完成故障诊断任务;最后,基于故障的估计值,设计有限时间自适应容错控制器,保证系统状态可以有限时间收敛,且无需干扰的上界信息;其中,容错控制器设计步骤具体如下:基于式(15)的自适应观测器对有效因子β的估计值
Figure FDA0003026328810000018
并考虑其估计误差,卫星故障影响下运动学及动力学模型转化为:
Figure FDA0003026328810000011
Figure FDA0003026328810000012
其中,
Figure FDA0003026328810000013
其中,q为航天器本体坐标系Fb相对于惯性坐标系FI的姿态四元数在Fb中的投影,定义
Figure FDA0003026328810000014
其中q0,
Figure FDA0003026328810000015
分别表示单位四元数的标量部分和向量部分;ω=[ω123]T为航天器本体坐标系Fb相对于惯性坐标系FI的角速度在Fb中的投影;J∈R3×3为航天器的转动惯量矩阵;u=[u1,u2,u3]T为航天器所需控制力矩;d为航天器受到的有界干扰力矩,ω×及qv ×表达方式一致,其中qv ×定义为:
Figure FDA0003026328810000016
U=diag(u1,u2,u3),β=[β123]T表示有效因子,0≤βi(i=1,2,3)≤1,βi=1表示第i个执行机构未出现故障,0<βi<1表示第i个执行机构部分失效但仍在工作,βi=0表示第i个执行机构完全失效;
针对卫星系统(16),设计非奇异终端滑模面:
S=ω+Kψ(qv) (17)
其中,K>0,ψ(qv)=[ψ(q1),ψ(q2),ψ(q3)]T,其表达式为
Figure FDA0003026328810000017
其中,0<r<1,ξ>0,l1=(2-r)ξr-1,l2=(r-1)ξr-2
对滑模面(17)进行求导得到:
Figure FDA0003026328810000021
其中,
Figure FDA0003026328810000022
Figure FDA0003026328810000023
针对滑模动态系统(19),设计控制力矩如式(21)所示:
Figure FDA0003026328810000024
其中,k1>0,k2>0,
Figure FDA0003026328810000025
为综合不确定D上界的估计值,用自适应律表示:
Figure FDA0003026328810000026
其中,δ>0,
Figure FDA0003026328810000027
2.如权利要求1所述的基于自适应观测器的卫星故障诊断与容错控制方法,其特征是,故障影响下的卫星非线性模型建立具体步骤:根据航天器飞行特性,基于卫星四元数表示方法,提出外界干扰影响下的卫星非线性运动学及动力学模型,其表达形式为:
Figure FDA0003026328810000028
考虑航天器故障问题,把执行器故障建模为乘性因子形式,则故障条件下的航天器姿态动力学方程转化为:
Figure FDA0003026328810000029
3.如权利要求1所述的基于自适应观测器的卫星故障诊断与容错控制方法,其特征是,卫星故障检测机制设计具体步骤:针对故障系统(3),设计如下观测器:
Figure FDA00030263288100000210
其中,
Figure FDA00030263288100000211
为ω的估计值,
Figure FDA00030263288100000212
为有效因子β的重构值,L∈R3×3为正定矩阵;
定义状态估计误差
Figure FDA00030263288100000213
故障估计误差
Figure FDA00030263288100000214
结合式(3)及式(4),得到:
Figure FDA00030263288100000215
Figure FDA00030263288100000216
则式(5)转化为:
Figure FDA00030263288100000217
在系统故障发生之前,即t<T时,其中T为执行机构故障发生时刻,
Figure FDA00030263288100000218
此时,状态估计误差动态系统(6)转化为:
Figure FDA00030263288100000219
定义残差信号
Figure FDA0003026328810000031
接下来需要确定残差估计阈值Jth
由(7)得到:
Figure FDA0003026328810000032
Figure FDA0003026328810000033
ε,
Figure FDA0003026328810000034
均为大于0的常数,且存在关于ω的Lipschitz常数γ1,满足
Figure FDA0003026328810000035
另外,假设Λ是一个稳定矩阵,那么存在正数k及λ,使得||eΛt||≤ke-λt,得到:
Figure FDA0003026328810000036
利用Bellman–Gronwall引理得:
Figure FDA0003026328810000037
定义如下残差评价函数:
Figure FDA0003026328810000038
因此故障发生时,故障检测机制如下:
||Jr(t)||<Jth→无故障发生 (12)
||Jr(t)||≥Jth→有故障发生 (13)
其中,Jth为残差评价函数的上界,由(10)得:
Figure FDA0003026328810000039
因此,考虑故障条件下刚体航天器姿态动力学模型(3),若设计故障检测观测器(4)与残差评价函数(14),当残差评价函数||Jr(t)||超出阈值Jth时,则故障检测策略可检测到故障发生。
4.如权利要求1所述的基于自适应观测器的卫星故障诊断与容错控制方法,其特征是,卫星故障重构机制设计步骤:当故障发生之后,系统检测到残差评价函数||Jr(t)||超过阈值Jth,此时需要对故障进行重构,自适应观测器设计为:
Figure FDA00030263288100000310
其中,γ,δs为正实数,P为待求解对称矩阵;
下面给出自适应观测器增益的求解方法:存在对称矩阵P满足如下条件
Figure FDA0003026328810000041
其中
Figure FDA0003026328810000042
Γ=-J-1L,利用MATLAB/LMI工具箱进行求解。
CN201710994393.6A 2017-10-23 2017-10-23 基于自适应观测器的卫星故障诊断与容错控制方法 Expired - Fee Related CN107861383B (zh)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN201710994393.6A CN107861383B (zh) 2017-10-23 2017-10-23 基于自适应观测器的卫星故障诊断与容错控制方法

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN201710994393.6A CN107861383B (zh) 2017-10-23 2017-10-23 基于自适应观测器的卫星故障诊断与容错控制方法

Publications (2)

Publication Number Publication Date
CN107861383A CN107861383A (zh) 2018-03-30
CN107861383B true CN107861383B (zh) 2021-07-09

Family

ID=61696215

Family Applications (1)

Application Number Title Priority Date Filing Date
CN201710994393.6A Expired - Fee Related CN107861383B (zh) 2017-10-23 2017-10-23 基于自适应观测器的卫星故障诊断与容错控制方法

Country Status (1)

Country Link
CN (1) CN107861383B (zh)

Families Citing this family (30)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN108803317B (zh) * 2018-05-08 2021-08-03 天津大学 自适应多变量四旋翼无人机有限时间容错控制方法
CN109164819B (zh) * 2018-08-22 2021-09-14 哈尔滨工业大学(深圳) 刚体航天器的反步自适应滑模大角度姿态机动控制方法
CN109116737B (zh) * 2018-09-19 2021-04-06 南京航空航天大学 观测器下的多智能体系统故障评估及容错一致性控制算法
CN109407520B (zh) * 2018-12-26 2021-04-06 南京航空航天大学 基于滑模控制的二阶多智能体系统的容错一致性控制算法
CN109901395B (zh) * 2019-03-22 2022-03-11 杭州电子科技大学 异步系统的自适应容错控制方法
CN109991857A (zh) * 2019-05-07 2019-07-09 中国民航大学 基于pd型学习观测器的故障重构方法
CN111953009A (zh) * 2019-05-17 2020-11-17 天津科技大学 一种孤岛多逆变器并联传感器故障诊断方法
CN110568757B (zh) * 2019-09-04 2020-06-26 北京航空航天大学 一种电推力器的自适应容错控制方法
CN110554606B (zh) * 2019-09-04 2022-04-22 南京航空航天大学 一种用于高超音速飞行器的自适应容错控制方法
CN110826881B (zh) * 2019-10-25 2022-09-27 北京控制工程研究所 考虑不确定干扰的航天器在轨健康状态评估方法和系统
CN110635686B (zh) * 2019-11-14 2021-10-01 东北电力大学 一种基于切换系统的升压电路的控制及故障检测方法
CN110727199B (zh) * 2019-11-18 2022-09-30 哈尔滨工业大学 控制受限航天器交会控制系统的时变反馈有限时间镇定方法
CN111176252B (zh) * 2019-11-29 2022-05-13 南京航空航天大学 高超声速再入过驱动系统并发执行器故障诊断方法
CN111169666B (zh) * 2020-01-19 2020-10-23 北京空间飞行器总体设计部 一种可恢复状态域的受限系统可重构性包络确定方法
CN111381581B (zh) * 2020-03-06 2021-07-09 北京控制工程研究所 一种执行机构故障诊断与容错控制的一体化方法和系统
CN111472468B (zh) * 2020-04-17 2021-10-12 南通大学 基于分布式故障诊断与协同容错的高层建筑减震控制方法
CN112631245B (zh) * 2020-06-11 2022-12-13 江苏航空职业技术学院 一种基于扩展状态观测器的飞机机电作动系统故障检测方法
CN111783945B (zh) * 2020-06-22 2022-08-16 东北石油大学 基于迁移学习lstm的长输油管道泄漏实时检测系统
CN111965978B (zh) * 2020-08-11 2022-08-23 北京航空航天大学 一种基于执行器可靠性的四旋翼控制器实时重构方法
CN113093706B (zh) * 2021-04-05 2023-06-30 西北工业大学 一种基于综合观测器的飞行控制系统执行器微小故障诊断方法
CN113128035B (zh) * 2021-04-08 2022-10-11 上海交通大学 民用飞机飞控传感器信号重构容错控制方法
CN113359438A (zh) * 2021-05-18 2021-09-07 浙江工业大学 一种基于二维增益调节机制的两轴雕刻机故障估计方法
CN113805561A (zh) * 2021-08-16 2021-12-17 天津大学 基于深度迁移学习的航天器智能故障诊断方法
CN113867307B (zh) * 2021-08-20 2022-10-21 天津大学 基于深度神经网络的航天器智能故障诊断方法
CN113949064B (zh) * 2021-11-04 2023-11-14 国网宁夏电力有限公司电力科学研究院 基于逆向行为重构的负荷频率容错控制系统及方法
CN114035550B (zh) * 2021-11-15 2023-11-21 江苏科技大学 一种基于eso的自主式水下机器人执行机构故障诊断方法
CN115373275A (zh) * 2022-09-14 2022-11-22 河北科技大学 四旋翼无人机的指定时间预定性能容错控制方法
CN115629547B (zh) * 2022-12-08 2023-04-25 西北工业大学 一种面向舵面故障的飞机机载容错控制方法及系统
CN117031935B (zh) * 2023-06-28 2024-09-20 北京空间飞行器总体设计部 一种航天器自主诊断重构过程动态协同方法
CN116923730B (zh) * 2023-07-24 2024-06-18 哈尔滨工业大学 一种具有自调节预设性能约束的航天器姿态主动容错控制方法

Citations (7)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
EP2696251A2 (de) * 2012-08-07 2014-02-12 Prüftechnik Dieter Busch AG Verfahren zum Überwachen von rotierenden Maschinen
CN104880948A (zh) * 2015-05-08 2015-09-02 北京航空航天大学 一种基于鲁棒自适应的带有飞轮的航天器容错控制方法
CN105843240A (zh) * 2016-04-08 2016-08-10 北京航空航天大学 一种考虑执行器故障的航天器姿态积分滑模容错控制方法
CN106292681A (zh) * 2016-09-19 2017-01-04 北京航空航天大学 一种基于观测器和在线控制分配的卫星主动容错控制方法
CN106647693A (zh) * 2016-11-17 2017-05-10 南京邮电大学 刚体航天器执行器多故障的诊断与容错控制方法
CN107272639A (zh) * 2017-03-09 2017-10-20 南京邮电大学 刚性航天器反作用飞轮故障的检测、估计及其调节方法
CN105353615B (zh) * 2015-11-10 2018-02-09 南京航空航天大学 一种基于滑模观测器的四旋翼飞行器的主动容错控制方法

Patent Citations (7)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
EP2696251A2 (de) * 2012-08-07 2014-02-12 Prüftechnik Dieter Busch AG Verfahren zum Überwachen von rotierenden Maschinen
CN104880948A (zh) * 2015-05-08 2015-09-02 北京航空航天大学 一种基于鲁棒自适应的带有飞轮的航天器容错控制方法
CN105353615B (zh) * 2015-11-10 2018-02-09 南京航空航天大学 一种基于滑模观测器的四旋翼飞行器的主动容错控制方法
CN105843240A (zh) * 2016-04-08 2016-08-10 北京航空航天大学 一种考虑执行器故障的航天器姿态积分滑模容错控制方法
CN106292681A (zh) * 2016-09-19 2017-01-04 北京航空航天大学 一种基于观测器和在线控制分配的卫星主动容错控制方法
CN106647693A (zh) * 2016-11-17 2017-05-10 南京邮电大学 刚体航天器执行器多故障的诊断与容错控制方法
CN107272639A (zh) * 2017-03-09 2017-10-20 南京邮电大学 刚性航天器反作用飞轮故障的检测、估计及其调节方法

Non-Patent Citations (3)

* Cited by examiner, † Cited by third party
Title
Adaptive fault detection and estimation scheme for a class of uncertain nonlinear systems;Maryam Shahriari-kahkeshi;《Nonlinear Dynamics》;20141214;参见第2627页及附录1-3 *
基于滑模观测器的卫星姿态控制系统滑模容错控制;程月华;《上海交通大学学报》;20110228;全文 *
微纳卫星姿态控制系统的滑模容错抗干扰控制方法;雷燕婕;《Proceedings of the 32nd Chinese Control Coference》;20130728;全文 *

Also Published As

Publication number Publication date
CN107861383A (zh) 2018-03-30

Similar Documents

Publication Publication Date Title
CN107861383B (zh) 基于自适应观测器的卫星故障诊断与容错控制方法
CN103488092B (zh) 基于t-s模糊模型与学习观测器的卫星故障诊断与容错控制方法
Zhang et al. Robust observer-based fault diagnosis for nonlinear systems using MATLAB®
Alwi et al. Sliding mode estimation schemes for incipient sensor faults
Odendaal et al. Actuator fault detection and isolation: An optimised parity space approach
CN111290366B (zh) 一种航天器姿控系统多故障诊断方法
CN106647693B (zh) 刚体航天器执行器多故障的诊断与容错控制方法
CN108490783B (zh) 基于增强型双幂次趋近律和快速终端滑模面的刚性航天飞行器有限时间自适应容错控制方法
CN103676941B (zh) 基于运动学和动力学模型的卫星控制系统故障诊断方法
CN107121961A (zh) 一种基于迭代学习干扰观测器的航天器姿态容错控制方法
CN103676918B (zh) 一种基于未知输入观测器的卫星执行机构故障诊断方法
CN101481019A (zh) 一种用于卫星姿态控制系统的传感器容错观测方法
CN115629547B (zh) 一种面向舵面故障的飞机机载容错控制方法及系统
CN110531737A (zh) 基于混合模型的卫星执行机构故障诊断方法、系统及介质
CN114035550B (zh) 一种基于eso的自主式水下机器人执行机构故障诊断方法
CN114879512B (zh) 基于学习神经网络滑模的航天器编队轨道容错控制方法
CN107703753A (zh) 一种空间机械臂的容错控制方法
CN102200776A (zh) 飞行控制系统执行器的故障诊断方法
Han et al. Quadratic-Kalman-filter-based sensor fault detection approach for unmanned aerial vehicles
Al Younes et al. Sensor fault detection and isolation in the quadrotor vehicle using nonlinear identity observer approach
Ma et al. DUKF-based GTM UAV fault detection and diagnosis with nonlinear and LPV models
Zhong et al. Sensor fault diagnosis for unmanned quadrotor helicopter via adaptive two-stage extended Kalman filter
Varrier et al. A parity space-based fault detection on lpv systems: Approach for vehicle lateral dynamics control system
Jamel et al. State estimation via observers with unknown inputs: Application to a particular class of uncertain takagi-sugeno systems
Song et al. Fault-tolerant prescribed performance control of nonlinear systems with process faults and actuator failures

Legal Events

Date Code Title Description
PB01 Publication
PB01 Publication
SE01 Entry into force of request for substantive examination
SE01 Entry into force of request for substantive examination
GR01 Patent grant
GR01 Patent grant
CF01 Termination of patent right due to non-payment of annual fee

Granted publication date: 20210709