CN107272639B - 刚性航天器反作用飞轮故障的检测、估计及其调节方法 - Google Patents
刚性航天器反作用飞轮故障的检测、估计及其调节方法 Download PDFInfo
- Publication number
- CN107272639B CN107272639B CN201710421305.3A CN201710421305A CN107272639B CN 107272639 B CN107272639 B CN 107272639B CN 201710421305 A CN201710421305 A CN 201710421305A CN 107272639 B CN107272639 B CN 107272639B
- Authority
- CN
- China
- Prior art keywords
- fault
- spacecraft
- flywheel
- estimation
- following
- 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.)
- Active
Links
- 238000001514 detection method Methods 0.000 title claims abstract description 24
- 238000000034 method Methods 0.000 title claims abstract description 19
- 238000013461 design Methods 0.000 claims abstract description 15
- 238000013178 mathematical model Methods 0.000 claims abstract description 4
- 239000011159 matrix material Substances 0.000 claims description 22
- 239000013598 vector Substances 0.000 claims description 19
- 230000001052 transient effect Effects 0.000 claims description 14
- 230000009466 transformation Effects 0.000 claims description 13
- 238000013459 approach Methods 0.000 claims description 12
- 230000006735 deficit Effects 0.000 claims description 6
- 238000009795 derivation Methods 0.000 claims description 4
- 230000001133 acceleration Effects 0.000 claims description 3
- 238000009499 grossing Methods 0.000 claims description 3
- 238000004364 calculation method Methods 0.000 claims description 2
- 238000003745 diagnosis Methods 0.000 abstract description 10
- 230000003044 adaptive effect Effects 0.000 abstract description 4
- 238000012938 design process Methods 0.000 abstract description 4
- 238000013507 mapping Methods 0.000 abstract 1
- 238000004088 simulation Methods 0.000 description 8
- 238000011217 control strategy Methods 0.000 description 4
- 238000011160 research Methods 0.000 description 3
- OAICVXFJPJFONN-UHFFFAOYSA-N Phosphorus Chemical compound [P] OAICVXFJPJFONN-UHFFFAOYSA-N 0.000 description 2
- 230000007547 defect Effects 0.000 description 2
- 238000012795 verification Methods 0.000 description 2
- RZVHIXYEVGDQDX-UHFFFAOYSA-N 9,10-anthraquinone Chemical compound C1=CC=C2C(=O)C3=CC=CC=C3C(=O)C2=C1 RZVHIXYEVGDQDX-UHFFFAOYSA-N 0.000 description 1
- 241000282414 Homo sapiens Species 0.000 description 1
- 230000032683 aging Effects 0.000 description 1
- 230000009286 beneficial effect Effects 0.000 description 1
- 150000001875 compounds Chemical class 0.000 description 1
- 238000010586 diagram Methods 0.000 description 1
- 238000011156 evaluation Methods 0.000 description 1
- 238000002474 experimental method Methods 0.000 description 1
- 238000003032 molecular docking Methods 0.000 description 1
- 238000012544 monitoring process Methods 0.000 description 1
- 230000005855 radiation Effects 0.000 description 1
- 230000004580 weight loss Effects 0.000 description 1
Classifications
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05B—CONTROL OR REGULATING SYSTEMS IN GENERAL; FUNCTIONAL ELEMENTS OF SUCH SYSTEMS; MONITORING OR TESTING ARRANGEMENTS FOR SUCH SYSTEMS OR ELEMENTS
- G05B23/00—Testing or monitoring of control systems or parts thereof
- G05B23/02—Electric testing or monitoring
- G05B23/0205—Electric testing or monitoring by means of a monitoring system capable of detecting and responding to faults
- G05B23/0218—Electric testing or monitoring by means of a monitoring system capable of detecting and responding to faults characterised by the fault detection method dealing with either existing or incipient faults
- G05B23/0243—Electric testing or monitoring by means of a monitoring system capable of detecting and responding to faults characterised by the fault detection method dealing with either existing or incipient faults model based detection method, e.g. first-principles knowledge model
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05B—CONTROL OR REGULATING SYSTEMS IN GENERAL; FUNCTIONAL ELEMENTS OF SUCH SYSTEMS; MONITORING OR TESTING ARRANGEMENTS FOR SUCH SYSTEMS OR ELEMENTS
- G05B2219/00—Program-control systems
- G05B2219/20—Pc systems
- G05B2219/24—Pc safety
- G05B2219/24065—Real time diagnostics
Landscapes
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Engineering & Computer Science (AREA)
- Automation & Control Theory (AREA)
- Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)
- Medicines Containing Antibodies Or Antigens For Use As Internal Diagnostic Agents (AREA)
Abstract
本发明公开了刚性航天器反作用飞轮故障的检测、估计及其调节方法。首先建立刚性航天器的姿态动力学模型和运动模型;在刚性航天器反作用飞轮发生效率损伤故障的情况下建立其数学模型;再分别设计非线性故障检测观测器以及自适应非线性故障估计观测器用于未知故障的快速检测和精确估计;最后利用所获得的故障估计信息来设计自适应滑模容错控制器。本发明考虑了容错控制器的瞬态性能,实现了刚性航天器在发生反作用飞轮效率损伤故障的情况下,能够准确、快速对未知故障进行检测、估计和调节。将外部扰动对系统造成的影响同时被考虑进来,系统能够相对独立地进行故障诊断模块与容错控制器的设计,既简化了设计过程,更有利于工程中的实现。
Description
技术领域
本发明属于航空航天飞行控制领域,具体涉及一种刚性航天器反作用飞轮故障的检测、估计及其调节方法。
背景技术
由于航天器任务的多样性和复杂性及其恶劣的工作条件(例如真空、失重、高低温和强辐射),航天器机械以及电气部件面临着老化使得执行器容易发生故障。
航天器组件故障一旦发生,不仅会使姿态控制系统的性能有所下降,还会使得整个姿态控制系统变得不稳定,严重的话航天器的空间任务也会因此而失败。所以,航天器要求姿态控制系统的安全性和可靠性能够达到一个很高的水平。然而,在航天器姿态控制系统中反作用飞轮容易发生故障(如:卡死故障、效率损伤故障、偏差故障等)。
姿态控制系统是航天器最重要的子系统之一,因而进行航天器姿态控制的容错设计得到了专家和学者的普遍关注。在过去十年中,已经产生了关于航天器容错控制的一些研究成果,在实际航天工程中具有很强的实用价值,而刚性航天器的姿态控制已经成为航天工程的重要基准,这是因为刚性航天器在人类进行的各种空间实验及应用中具有广泛的应用价值,例如空间监视,会合和对接,在轨服务等。因此,围绕刚性航天器进行的姿态控制系统故障诊断与容错控制研究,更具有理论意义以及实用价值。
但就目前自适应反演滑模控制技术已有的研究成果来说,还存在以下几个方面的问题:
(1)系统到达滑模面所需要的时间难达到快速性要求
(2)进行故障估计难达到快速而又准确,精度难以精确
(3)航天器姿态控制系统对执行器故障难达到高容忍性要求
(4)传统的设计方法过于复杂,使得在工程中难以实现
发明内容
本发明解决的技术问题是提供一种刚性航天器姿态控制系统在反作用飞轮出现效率损伤故障时,能够对未知效率损伤故障进行实时的检测并进行精确的故障估计,并使系统自主消除反作用飞轮效率损伤故障对整个姿态控制系统的影响,还能够保证容错控制器的瞬态性能,达到刚性航天器预期姿态性能指标的故障诊断与容错控制技术。
为了解决上述问题,本发明提出了刚性航天器反作用飞轮故障的检测、估计及其调节方法,包含以下步骤:
步骤一、建立刚性航天器的姿态动力学模型和运动学模型,具体如下:
其中,σ∈R3×1为姿态角向量,其中包括偏航角俯仰角θ、和滚转角ψ;ω∈R3×1为姿态角速度向量,包括偏航角速度ωx、俯仰角速度ωy、和滚转角速度ωz;非线性元素定义为u=[ux,uy,uz]T为反作用飞轮产生的总的控制力矩;J∈R3×3表示刚性航天器的总惯性矩阵;d(t)∈R3×1表示外部扰动力矩,
由反作用飞轮产生的总的控制力矩u可以写成下列表示形式:
u=Dτ(t)
其中,D=[D1,D2,D3,D4]∈R3×4为反作用飞轮的配置矩阵,表示每个反作用飞轮对航天器的角加速度产生的影响;τ=[τ1,τ2,τ3,τ4]T表示由四个反作用飞轮产生的力矩,根据小姿态角原理,刚性航天器动力学和运动学模型可以写成:
y=σ
其中,
步骤二、建立刚体航天器反作用飞轮效率损伤故障发生情形下的数学模型,具体如下:
考虑反作用飞轮全部或部分控制力失效的情况,使用表示由四个反作用飞轮中的第i个反作用飞轮所产生的控制力矩:
其中,ei∈(0,1]是一个未知的常数,表示第i个反作用飞轮的效率损伤因子,τi表示由控制器产生的第i个反作用飞轮期望的控制信号,其中i=1,2,3,4。ei(t)=1表示第i个反作用飞轮工作正常,0<ei(t)<1为第i个反作用飞轮发生效率损伤故障,但仍在工作;刚性航天器在反作用飞轮发生效率损伤故障时的动力学模型可以表示为:
其中,E=diag{e1,e2,e3,e4};
步骤三、在刚性航天器反作用飞轮发生效率损伤故障时,建立故障检测观测器:
其中,为角速度向量ω的估计值;λi>0表示故障检测观测器的特征值矩阵;ρ=[1,1,1]T,
综上,可以得到故障检测观测器的误差方程表示如下:
r=ew
其中,
为了对故障检测观测器产生的残差r进行评估,选择一个阈值量Jth,如果||r||2,T小于或等于该阈值量Jth,则判断为无故障,如果||r||2,T大于该阈值量Jth,则判断为有故障发生需要警报;其中,残差评估函数||r||2,T由下式决定:
其中,t∈(0,T]为有限时间窗口,表示时间窗口的长度是有限的,由于在整个时间范围内对残差信号进行评估难以实现,因而希望故障尽早地被检测到;
步骤四、在刚性航天器反作用飞轮发生效率损伤故障时,建立故障估计观测器,具体如下:
E(t)为对角矩阵,E(t)τ(t)可以写成下列形式:
E(t)τ(t)=U(t)e(t)
其中,U1=diag{τ1,τ2,τ3,τ4},e=[e1,e2,e3,e4]T,利用上述,等式,反作用飞轮发生效率损伤故障时的航天器动力学模型可以表示为:
在发生反作用飞轮效率损伤以及外部扰动存在时,对角速度环设计如下故障估计观测器:
其中, 为w的估计值,表示反作用飞轮效率损伤因子的估计值,可以由下式得到:
其中γ>0,定义 使用上述观测器,得到的状态估计误差动态方程为:
步骤五、根据步骤四所获得的实时故障估计信息,设计容错控制器,具体如下:
定义下列误差变量:
e1=σ-σd,e2=w-wd
对外部姿态角环,引入滑模面如下:
其中,K1=diag{k1,k1,k1},k1为一个正奇数,对S1对时间求导,得到
对选取的滑模面选取指数趋近率:
其中,v1和ε1是两个正的标量,
根据上述等式,虚拟控制输入wd选择为:
对内部姿态角速度环设计滑模面:
其中,K2=diag{k2,k2,k2},k2为一个正奇数,对S2对时间求导,得到
对上述滑模面选取指数趋近率如下:
其中,v2和ε2是两个正的标量,
根据上述等式,控制输入τ选择为:
其中, 为的估计值,ρ=[1,1,1]T,的参数更新率设计为:
步骤六、设计改进的容错控制方案,保证改进后的容错控制器还具备良好的瞬态性能,即不论是否发生反作用飞轮效率损伤故障,跟踪误差z=σ-σd始终能够保持在指定的瞬态性能范围,选择具有性质的递减平滑函数δi(t):R+→R+{0}作为性能界函数,对于规定的标量和如果始终满足以下条件,则可以实现保证瞬态性能,
其中,和分别为zi(t)的下界和上界,δi(0)的减小速率引入zi(t)的收敛速度的下界,
为了设计渐近稳定控制器,然后用于变换后的系统以实现对原始系统的渐近跟踪,引入平滑且严格递增的函数为Ti(vi),其具有以下性质:
(3)Ti(0)=0.
根据变换函数Ti(vi)的性质(1)和(2),性能条件可以写为:
zi(t)=δi(t)Ti(vi)
由于变换函数Ti(vi)的严格单调性以及δi(t)≠0,其反函数可以表示为:
其中vi可以看作一种新型的误差变量,
如果以及通过设计的控制器可以确保vi(t)在t>0时有界,即存在此外,根据函数Ti(vi)的性质(3),如果成立,则可以实现渐近跟踪(即),这里变换函数δi(t)Ti(vi)设计如下:
其中,明显Ti(vi)具有性质(1)-(3),
误差变量vi可写为:
其中,ki(t)=zi(t)/δi(t),
对vi对时间进行求导:
其中ξi定义为:
由于函数Ti(vi)的性质(1)以及 可知ξi≠0,通过将等式中的替换为控制系统方程可以写成:
y=θ
其中,ξ=diag{ξ1,ξ2,ξ3},δ=diag{δ1,δ2,δ3},z=[e11,e12,e13]T,
v=[v1,v2,v3]T,根据上式,规定性能界限可以被并入到原始航天器姿态系统之中;
步骤七、为了设计航天器姿态控制方案保证航天器性能,定义下列变量:
z1=v,z2=ω-ωd
其中,ωd是待设计的虚拟控制量,
对姿态角环,设计滑模面:
其中,K1=diag{k1,k1,k1},k1为一个正奇数,对S1对时间求导,得到
对上述滑模面选取指数趋近率如下:
其中,v1和ε1是两个正的标量,
虚拟控制输入wd选择为:
在角速度误差z2的基础上,对姿态角速度环设计滑模面:
其中,K2=diag{k2,k2,k2},k2为一个正奇数,对S2对时间求导,得到
对上述滑模面选取指数趋近率如下:
其中,v2和ε2是两个正的标量,
控制输入τ选择为:
其中, 为的估计值,ρ=[1,1,1]T,的参数更新率设计为:
本发明还进一步提出一种上述利用刚性航天器反作用飞轮故障的检测、估计及其调节方法来验证系统在发生故障时鲁棒稳定性的方法,具体包含以下步骤:
步骤1、定义Lyapunov函数:
步骤2、对V对时间进行求导,可得如下等式:
将步骤七中的ωd代入上述等式,得到
再将上面步骤七中的τ代入到上述等式,得到
进一步可以得到
步骤3:通过选择足够大的εi和vi,容易看出下列不等式成立。即通过上述证明过程可验证系统的稳定性。
本发明与现有技术相比具有以下显著的进步:
(1)本发明研究的故障类型为发生概率较高的刚性航天器反作用飞轮发生效率损伤故障,设计过程中外部扰动对系统造成的影响同时被考虑进来,更加切合实际。
(2)故障诊断模块使用了故障诊断观测器和故障估计观测器,可以快速检测,并准确估计出反作用飞轮效率损伤故障。采用主动容错策略,能够实时获取故障信息,并通过使用反演控制和滑模控制来进行自适应主动容错控制器的设计,控制器参数可以实时更新,渐近的调节未知反作用飞轮故障对闭环姿态控制系统的影响。
(3)本发明考虑了容错控制器的瞬态性能,通过选择平滑的变换函数作为限定跟踪误差瞬态性能的界函数,使用误差转换的策略,定义新的转换误差变量,从而将保证跟踪误差瞬态性能的问题转化为研究新的转换误差变量有界性的问题,使得改进后的容错控制器能够保证航天器姿态系统跟踪误差始终保持在指定的瞬态性能范围。实现了刚性航天器在发生反作用飞轮效率损伤故障的情况下,还能够满足航天器姿态控制系统的高要求。
(4)本发明设计过程同时使用了多种现代控制理论设计方法(如自适应控制、滑模控制、反演控制等),可以快速、准确的对未知反作用飞轮效率损伤故障进行检测、估计和调节,并使刚性航天器姿态控制系统在发生反作用飞轮效率损伤故障时仍然可以正常工作运行,具有很强的实用价值。
(5)系统能够相对独立地进行故障诊断模块与容错控制器的设计,不仅简化了设计过程,更有利于工程中的实现。
附图说明
图1是本发明的故障诊断与容错控制方法结构框图;
图2是当反作用飞轮效率损伤故障发生时,效率损伤因子估计曲线;
图3、图4分别是当反作用飞轮效率损伤故障发生时,使用本文步骤七中的容错控制策略时的姿态角跟踪响应曲线和实际控制输入响应曲线;
图5是当反作用飞轮效率损伤故障发生时,使用本文步骤七中的容错控制策略时的姿态角跟踪误差曲线;
图6是当反作用飞轮效率损伤故障发生时,仿真结果可以表明姿态角跟踪误差始终处于设定的性能界中。
具体实施方式
现结合说明书附图对本发明的具体实施方式做进一步的详细介绍。为了本领域的技术人员可以更好地了解本发明的具体实施步骤,本发明还提供了利用Matlab2014a软件进行故障诊断与容错控制的仿真验证结果。
如图1所示,当刚性航天器反作用飞轮效率损伤故障发生时,为了使姿态控制系统达到期望的姿态,通过非线性故障检测观测器以及自适应故障估计观测器建立起故障诊断模块,对所发生的故障进行在线的检测与估计,并利用故障估计信息进行自适应滑模容错控制器设计,使得刚性航天器姿态控制系统对故障具有高容忍性。
为了解决上述问题,本发明提出了刚性航天器反作用飞轮效率损伤故障的检测、估计及其调节技术,包含以下步骤:
步骤一、建立刚性航天器的姿态动力学模型和运动模型,具体如下:
其中,σ∈R3×1为姿态角向量,其中包括偏航角俯仰角θ、和滚转角ψ;ω∈R3×1为姿态角速度向量,包括偏航角速度ωx、俯仰角速度ωy、和滚转角速度ωz;非线性元素定义为u=[ux,uy,uz]T为反作用飞轮产生的总的控制力矩;J∈R3×3表示刚性航天器的总惯性矩阵;d(t)∈R3×1表示外部扰动力矩。
由反作用飞轮产生的总的控制力矩u可以写成下列表示形式:
u=Dτ(t)
其中,D=[D1,D2,D3,D4]∈R3×4为反作用飞轮的配置矩阵,表示每个反作用飞轮对航天器的角加速度产生的的影响;τ=[τ1,τ2,τ3,τ4]T表示由四个反作用飞轮产生的力矩。根据小姿态角原理,刚性航天器动力学模型可以写成:
y=σ
其中,
步骤二、在刚性航天器反作用飞轮发生效率损伤故障的情况下,建立其数学模型,具体如下:
考虑反作用飞轮全部或部分控制力失效的情况。我们使用表示由四个反作用飞轮中的第i个反作用飞轮所产生的控制力矩:
其中,ei∈(0,1]是一个未知的常数,表示第i个反作用飞轮的效率损伤因子。τi表示由控制器产生的第i个反作用飞轮期望的控制信号,其中i=1,2,3,4。ei(t)=1表示第i个反作用飞轮工作正常,0<ei(t)<1为第i个反作用飞轮发生效率损伤故障,但仍在工作。综上所述,刚性航天器在反作用飞轮发生效率损伤故障时的动力学模型可以表示为:
其中,E=diag{e1,e2,e3,e4}。
步骤三、在刚性航天器反作用飞轮发生效率损伤故障时,建立故障检测观测器:
其中,为角速度向量ω的估计值;λi>0表示故障检测观测器的特征值矩阵;ρ=[1,1,1]T。
综上,可以得到故障检测观测器的误差方程表示如下:
r=ew
其中,
为了估计产生的残差r,通常采用的方法是选择一个所谓的阈值量Jth,在这个基础上,使用下列逻辑关系
其中,所谓的残差估计函数||r||2,T由下式决定:
其中,t∈(0,T]为有限时间窗口。表示时间窗口的长度是有限的。由于在整个时间范围内估计残差信号难以实现,因而希望尽早的检测到故障。当使用故障检测观测器检测到反作用飞轮发生效率损伤故障时,接下来就是故障估计。
步骤四、在刚性航天器反作用飞轮发生效率损伤故障时,建立故障估计观测器,具体如下:
E(t)为对角矩阵,E(t)τ(t)可以写成下列形式:
E(t)τ(t)=U(t)e(t)
其中,U1=diag{τ1,τ2,τ3,τ4},e=[e1,e2,e3,e4]T。利用上述等式,反作用飞轮发生效率损伤故障时的航天器动力学模型可以表示为:
在发生反作用飞轮效率损伤以及外部扰动存在时,对角速度环设计如下故障估计观测器:
其中, 为w的估计值,表示反作用飞轮效率损伤因子的估计值。可以由下式得到:
其中γ>0。定义 使用上述观测器,得到的状态估计误差动态方程为:
步骤五、根据步骤四所获得的实时故障估计信息,设计容错控制器,具体如下:
定义下列误差变量:
e1=σ-σd,e2=w-wd
对外部姿态角环,引入滑模面如下:
其中,K1=diag{k1,k1,k1},k1为一个正奇数,对S1对时间求导,得到
对选取的滑模面选取指数趋近率:
其中,v1和ε1是两个正的标量。
根据上述等式,虚拟控制输入wd选择为:
对内部姿态角速度环设计滑模面:
其中,K2=diag{k2,k2,k2},k2为一个正奇数,对S2对时间求导,得到
对上述滑模面选取指数趋近率如下:
其中,v2和ε2是两个正的标量。
根据上述等式,控制输入τ选择为:
其中, 为的估计值,ρ=[1,1,1]T。的参数更新率设计为:
步骤六、设计改进的容错控制方案,保证改进后的容错控制器还具备良好的瞬态性能。即不论是否发生反作用飞轮效率损伤故障,跟踪误差z=σ-σd始终能够保持在指定的瞬态性能范围。
选择具有性质的递减平滑函数δi(t):R+→R+{0}作为性能界函数。例如,其中δi0>δi∞且ηi>0。对于规定的标量和如果始终满足以下条件,则可以实现保证瞬态性能,
其中,和分别为zi(t)的下界和上界。δi(0)的减小速率引入zi(t)的收敛速度的下界。
为了设计渐近稳定控制器,然后用于变换系统以实现对原始系统的渐近跟踪。引入平滑且严格递增的函数为Ti(vi),其具有以下性质:
(1)
(2)
(3)Ti(0)=0.
根据变换函数Ti(vi)的性质(1)和(2),性能条件可以写为:
zi(t)=δi(t)Ti(vi)
由于变换函数Ti(vi)的严格单调性以及δi(t)≠0,其反函数可以表示为:
其中vi可以看作一种新型的误差变量。
如果以及通过设计的控制器可以确保vi(t)在t>0时有界,即存在此外,根据函数Ti(vi)的性质(3),如果成立,则可以实现渐近跟踪(即)。在本文中,变换函数δi(t)Ti(vi)设计如下:
其中,明显Ti(vi)具有性质(1)-(3)。
误差变量vi可写为:
其中,ki(t)=zi(t)/δi(t)。
对vi对时间进行求导:
其中ξi定义为:
由于函数Ti(vi)的性质(1)以及可知ξi≠0。通过将等式中的替换为控制系统方程可以写成:
y=θ
其中,ξ=diag{ξ1,ξ2,ξ3}, z=[e11,e12,e13]T,
v=[v1,v2,v3]T。根据上式,规定性能界限现在可以被并入到原始航天器姿态系统之中。
步骤七、为了设计航天器姿态控制方案保证航天器性能,定义下列变量:
z1=v,z2=ω-ωd
其中,ωd是待设计的虚拟控制量。
对姿态角环,设计滑模面:
其中,K1=diag{k1,k1,k1},k1为一个正奇数,对S1对时间求导,得到
对上述滑模面选取指数趋近率如下:
其中,v1和ε1是两个正的标量。
虚拟控制输入wd选择为:
在角速度误差z2的基础上,对姿态角速度环设计滑模面:
其中,K2=diag{k2,k2,k2},k2为一个正奇数,对S2对时间求导,得到
对上述滑模面选取指数趋近率如下:
其中,v2和ε2是两个正的标量。
控制输入τ选择为:
其中, 的估计值,ρ=[1,1,1]T。的参数更新率设计为:
同时,本发明还提出一种利用上述刚性航天器反作用飞轮效率损伤故障的检测、估计及其调节技术,验证系统在发生故障的情况下鲁棒稳定性的方法,包含以下步骤:
步骤一、定义Lyapunov函数:
对V对时间进行求导,可得如下等式:
将步骤七中的ωd代入上述等式,得到
再将步骤七中的τ代入到上述等式,得到
进一步可以得到
通过选择足够大的εi和vi,容易看出下列不等式成立。即通过上述证明过程可验证系统的稳定性。
本发明利用Matlab2014a软件,对所提出的故障诊断与容错控制方法进行了仿真验证工作:
(1)刚性航天器姿态控制系统仿真参数选取如下:
总惯性矩阵 外部扰动矩阵
(2)初始参数选取:
偏航角俯仰角θ0=1.5deg,和滚转角ψ0=2deg;偏航角速度ωx0=0deg/s、俯仰角速度ωy0=0deg/s和滚转角速度ωz0=0deg/s;轨道角速度ω0=0.0012rad/s。yd=σd
为期望的系统输出信号。设定为θd=1deg,ψd=3deg;虚拟控制器ωd和实际控制器τ的增益系数选择为
K1=diag{1,1,1},K2=diag{3,3,3}
v1=1.5,v2=5,ε1=1.2,ε2=4
(3)反作用飞轮效率损伤因子选取如下:
在仿真时假设未知反作用飞轮效率损伤故障在不同时刻发生,即
为了显示容错控制方案的有效性,在此给出必需的仿真比较结果。首先,使用本发明中设计的控制器在反作用飞轮效率损伤故障情况下进行仿真,通过使用故障估计观测器,可以得到效率损伤故障E的估计值如图2所示;图3、图4分别是当反作用飞轮效率损伤故障发生时,使用本文步骤七中的容错控制策略时的姿态角跟踪响应曲线和实际控制输入响应曲线;图5是当反作用飞轮效率损伤故障发生时,使用本文步骤七中的容错控制策略时的姿态角跟踪误差曲线;图6是当反作用飞轮效率损伤故障发生时,仿真结果可以表明姿态角跟踪误差始终处于设定的性能界中。
本发明未详细说明部分都属于领域技术人员公知常识,以上所述仅为本发明的一个具体实施例,并不用以限制本发明,凡在本发明的精神和原则之内,所作的任何修改、等同替换、改进等,均应包含在本发明的保护范围之内。
Claims (1)
1.刚性航天器反作用飞轮效率损伤故障的检测、估计及其调节技术,其特征在于,包含以下步骤:
步骤一、建立刚性航天器的姿态动力学模型和运动模型,具体如下:
其中,σ∈R3×1为姿态角向量,其中包括偏航角俯仰角θ、和滚转角ψ;ω∈R3×1为姿态角速度向量,包括偏航角速度ωx、俯仰角速度ωy、和滚转角速度ωz;非线性元素定义为u=[ux,uy,uz]T为反作用飞轮产生的总的控制力矩;J∈R3×3表示刚性航天器的总惯性矩阵;d(t)∈R3×1表示外部扰动力矩,
由反作用飞轮产生的总的控制力矩u能写成下列表示形式:
u=Dτ(t)
其中,D=[D1,D2,D3,D4]∈R3×4为反作用飞轮的配置矩阵,表示每个反作用飞轮对航天器的角加速度产生的的影响;τ(t)=[τ1(t),τ2(t),τ3(t),τ4(t)]T表示由四个反作用飞轮产生的力矩,
根据小姿态角原理,刚性航天器动力学模型能写成:
y=σ
其中,为非线性向量,为与ω0有关的矩阵且ω0为航天器轨道速率,y为刚性航天器姿态系统的输出向量,
步骤二、在刚性航天器反作用飞轮发生效率损伤故障的情况下,建立其数学模型,具体如下:
考虑反作用飞轮全部或部分控制力失效的情况,我们使用表示由四个反作用飞轮中的第i个反作用飞轮所产生的控制力矩:
其中,ei∈(0,1]是一个未知的常数,表示第i个反作用飞轮的效率损伤因子,τi表示由控制器产生的第i个反作用飞轮期望的控制信号,其中i=1,2,3,4,ei=1表示第i个反作用飞轮工作正常,0<ei<1为第i个反作用飞轮发生效率损伤故障,但仍在工作,综上所述,刚性航天器在反作用飞轮发生效率损伤故障时的动力学模型能表示为:
其中,E=diag{e1,e2,e3,e4}为航天器执行器效率损失矩阵,
步骤三、在刚性航天器反作用飞轮发生效率损伤故障时,建立故障检测观测器:
其中,为角速度向量ω的估计值;Λ=diag{λ1,λ2,λ3}为故障检测观测器增益矩阵,λi>0表示故障检测观测器增益矩阵的特征值;表示Fω的估计向量;ρ=[1,1,1]T为常值向量,
综上,能得到故障检测观测器的误差方程表示如下:
r=eω
其中,为故障检测残差,I为4阶单位矩阵,为扰动补偿误差,
为了估计产生的残差r,通常采用的方法是选择一个所谓的阈值量Jth,在这个基础上,使用下列逻辑关系
其中,所谓的残差估计函数||r||2,T由下式决定:
其中,t∈(0,T]为有限时间窗口,表示时间窗口的长度是有限的,由于在整个时间范围内估计残差信号难以实现,因而希望尽早的检测到故障,当使用故障检测观测器检测到反作用飞轮发生效率损伤故障时,接下来就是故障估计,
步骤四、在刚性航天器反作用飞轮发生效率损伤故障时,建立故障估计观测器,具体如下:
E为对角矩阵,Eτ(t)能写成下列形式:
Eτ(t)=U(t)e
其中,U(t)=diag{τ1(t),τ2(t),τ3(t),τ4(t)},e=[e1,e2,e3,e4]T,利用上述等式,反作用飞轮发生效率损伤故障时的航天器动力学模型能表示为:
在发生反作用飞轮效率损伤以及外部扰动存在时,对角速度环设计如下故障估计观测器:
其中,为ω的估计值,L为故障估计观测器增益矩阵,表示反作用飞轮效率损失因子的估计值,能由下式得到:
其中γ>0为常数,定义为故障估计误差向量,为扰动补偿误差向量,为观测器误差向量,从而能得到观测器状态估计误差动态方程为:
步骤五、根据步骤四所获得的实时故障估计信息,设计容错控制器,具体如下:
定义下列误差变量:
e1=σ-σd,e2=ω-ωd
其中,σd和ωd分别为期望的姿态角向量和期望的姿态角速率向量,
对外部姿态角环,引入滑模面如下:
其中,K1=diag{k1,k1,k1}为常值增益矩阵,k1为一个正奇数,对S1对时间求导,得到
对选取的滑模面选取指数趋近率:
其中,υ1和ε1是两个正的标量,
根据上述等式,虚拟控制输入ωd选择为:
对内部姿态角速度环设计滑模面:
其中,K2=diag{k2,k2,k2}为常值增益矩阵,k2为一个正奇数,对S2对时间求导,得到
对上述滑模面选取指数趋近率如下:
其中,υ2和ε2是两个正的标量,
根据上述等式,控制输入τ选择为:
其中,为效率损失矩阵的估计值,为的估计值,ρ=[1,1,1]T为常值向量,的参数更新率设计为:
其中,Γ是一个正的标量,
步骤六、设计改进的容错控制方案,保证改进后的容错控制器还具备良好的瞬态性能,即不论是否发生反作用飞轮效率损伤故障,跟踪误差z=σ-σd始终能够保持在指定的瞬态性能范围,
选择具有性质的递减平滑函数δi(t):R+→R+{0}作为性能界函数,例如,其中δi0>δi∞且ηi>0,对于规定的标量0<εi≤1和如果始终满足以下条件,则能实现保证瞬态性能,
其中,-εiδi(0)和分别为zi(t)的下界和上界,δi(0)的减小速率引入zi(t)的收敛速度的下界,
为了设计渐近稳定控制器,然后用于变换系统以实现对原始系统的渐近跟踪,引入平滑且严格递增的函数为Ti(vi),其具有以下性质:
(1)
(2)
(3)Ti(0)=0.
根据变换函数Ti(vi)的性质(1)和(2),性能条件能写为:
zi(t)=δi(t)Ti(vi)
由于变换函数Ti(vi)的严格单调性以及δi(t)≠0,其反函数能表示为:
其中vi能看作一种新型的误差变量,
如果以及通过设计的控制器能确保vi(t)在t>0时有界,即存在此外,根据函数Ti(vi)的性质(3),如果成立,则能实现渐近跟踪(即),在本文中,变换函数δi(t)Ti(vi)设计如下:
其中,明显Ti(vi)具有性质(1)-(3),
误差变量vi能写为:
其中,ki(t)=zi(t)/δi(t),
对vi对时间进行求导:
其中ξi定义为:
由于函数Ti(vi)的性质(1)以及能知ξi≠0,通过将等式中的替换为控制系统方程能写成:
y=θ
其中,ξ=diag{ξ1,ξ2,ξ3},δ=diag{δ1,δ2,δ3},z=[e11,e12,e13]T,
v=[v1,v2,v3]T,根据上式,规定性能界限现在能被并入到原始航天器姿态系统之中,
步骤七、为了设计航天器姿态控制方案保证航天器性能,定义下列变量:
z1=v,z2=ω-ωd
其中,ωd是待设计的虚拟控制量,
对姿态角环,设计滑模面:
其中,K1=diag{k1,k1,k1},k1为一个正奇数,对S1对时间求导,得到
对上述滑模面选取指数趋近率如下:
其中,υ1和ε1是两个正的标量,
虚拟控制输入ωd选择为:
在角速度误差z2的基础上,对姿态角速度环设计滑模面:
其中,K2=diag{k2,k2,k2},k2为一个正奇数,对S2对时间求导,得到
对上述滑模面选取指数趋近率如下:
其中,υ2和ε2是两个正的标量,
控制输入τ选择为:
其中, 为的估计值,ρ=[1,1,1]T,的参数更新率设计为:
其中,Γ是一个正的标量,
同时,本发明还提出一种利用上述刚性航天器反作用飞轮效率损伤故障的检测、估计及其调节技术,验证系统在发生故障的情况下鲁棒稳定性的方法,包含以下步骤:
步骤一、定义Lyapunov函数:
对V对时间进行求导,能得如下等式:
将步骤七中的ωd代入上述等式,得到
再将步骤七中的τ代入到上述等式,得到
进一步能得到
通过选择足够大的εi和υi,容易看出下列不等式成立,即通过上述证明过程能验证系统的稳定性。
Applications Claiming Priority (2)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN2017101366288 | 2017-03-09 | ||
CN201710136628 | 2017-03-09 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN107272639A CN107272639A (zh) | 2017-10-20 |
CN107272639B true CN107272639B (zh) | 2019-08-02 |
Family
ID=60066973
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201710421305.3A Active CN107272639B (zh) | 2017-03-09 | 2017-06-07 | 刚性航天器反作用飞轮故障的检测、估计及其调节方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN107272639B (zh) |
Families Citing this family (10)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN107861383B (zh) * | 2017-10-23 | 2021-07-09 | 天津大学 | 基于自适应观测器的卫星故障诊断与容错控制方法 |
CN108181913B (zh) * | 2017-12-06 | 2019-05-03 | 北京航空航天大学 | 一种具有指定跟踪性能的航天器自适应容错姿态跟踪控制方法 |
CN108536161B (zh) * | 2018-03-14 | 2020-12-25 | 南京航空航天大学 | 一种深空探测器的高精度姿态容错控制方法 |
CN108549224B (zh) * | 2018-04-12 | 2020-02-21 | 浙江工业大学 | 基于增强型双幂次趋近律和终端滑模面的刚性航天飞行器有限时间自适应容错控制方法 |
CN108490783B (zh) * | 2018-04-12 | 2020-02-21 | 浙江工业大学 | 基于增强型双幂次趋近律和快速终端滑模面的刚性航天飞行器有限时间自适应容错控制方法 |
CN108762069B (zh) * | 2018-05-08 | 2021-06-01 | 南京邮电大学 | 刚性航天器姿控系统飞轮故障辨识与调节方法 |
CN109116739A (zh) * | 2018-09-28 | 2019-01-01 | 南京工业大学 | 刚性航天器多反作用飞轮故障下的诊断及补偿方法 |
CN111290366B (zh) * | 2020-02-12 | 2022-05-27 | 北京科技大学顺德研究生院 | 一种航天器姿控系统多故障诊断方法 |
CN113625554B (zh) * | 2021-06-28 | 2023-06-30 | 北京控制工程研究所 | 一种考虑故障情况的反作用轮配置优化方法及系统 |
CN114578795B (zh) * | 2022-03-29 | 2024-03-15 | 江苏理工学院 | 一种针对电动汽车eps的具有暂态性能保证的自适应故障补偿控制方法 |
Citations (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN103515952A (zh) * | 2013-09-30 | 2014-01-15 | 天津大学 | 一种接入直流微电网的飞轮储能系统的放电深度控制方法 |
CN103884421A (zh) * | 2014-03-24 | 2014-06-25 | 重庆邮电大学 | 基于联合去噪和伪哈密顿量的Duffing振子弱信号检测方法 |
CN103941762A (zh) * | 2014-03-26 | 2014-07-23 | 北京航空航天大学 | 一种具有冷备份功能的飞轮模拟器 |
CN106094514A (zh) * | 2016-06-06 | 2016-11-09 | 南京邮电大学 | 基于动态输出反馈控制的柔性航天器主动容错控制方法 |
Family Cites Families (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US20120065813A1 (en) * | 2010-09-14 | 2012-03-15 | Nguyen Quang H | System and method for command and data handling in space flight electronics |
-
2017
- 2017-06-07 CN CN201710421305.3A patent/CN107272639B/zh active Active
Patent Citations (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN103515952A (zh) * | 2013-09-30 | 2014-01-15 | 天津大学 | 一种接入直流微电网的飞轮储能系统的放电深度控制方法 |
CN103884421A (zh) * | 2014-03-24 | 2014-06-25 | 重庆邮电大学 | 基于联合去噪和伪哈密顿量的Duffing振子弱信号检测方法 |
CN103941762A (zh) * | 2014-03-26 | 2014-07-23 | 北京航空航天大学 | 一种具有冷备份功能的飞轮模拟器 |
CN106094514A (zh) * | 2016-06-06 | 2016-11-09 | 南京邮电大学 | 基于动态输出反馈控制的柔性航天器主动容错控制方法 |
Also Published As
Publication number | Publication date |
---|---|
CN107272639A (zh) | 2017-10-20 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN107272639B (zh) | 刚性航天器反作用飞轮故障的检测、估计及其调节方法 | |
CN106773679B (zh) | 一种基于角速度观测器的航天器容错控制方法 | |
CN108490783B (zh) | 基于增强型双幂次趋近律和快速终端滑模面的刚性航天飞行器有限时间自适应容错控制方法 | |
CN108445760A (zh) | 基于自适应故障估计观测器的四旋翼无人机容错控制方法 | |
CN110347170B (zh) | 可重复使用运载器再入段鲁棒容错制导控制系统及工作方法 | |
CN109116739A (zh) | 刚性航天器多反作用飞轮故障下的诊断及补偿方法 | |
CN111722645B (zh) | 模型参数已知的带负载四旋翼无人机速度控制方法 | |
CN109189085A (zh) | 基于事件触发的航天器网络化系统姿态控制方法 | |
CN105353615A (zh) | 一种基于滑模观测器的四旋翼飞行器的主动容错控制方法 | |
CN108762069B (zh) | 刚性航天器姿控系统飞轮故障辨识与调节方法 | |
Zhao et al. | Neural-network-based adaptive finite-time output feedback control for spacecraft attitude tracking | |
CN109188910A (zh) | 一种刚性飞行器的自适应神经网络容错跟踪控制方法 | |
Al Younes et al. | Sensor fault detection and isolation in the quadrotor vehicle using nonlinear identity observer approach | |
CN105182990A (zh) | 具有输出受限的三自由度模型直升机的鲁棒控制方法 | |
CN113885547A (zh) | 一种刚体航天器预定时间容错姿态控制策略 | |
Ye et al. | Adaptive switching control for hypersonic vehicle with uncertain control direction | |
CN107831774A (zh) | 基于自适应pi控制的刚体卫星姿态系统被动容错控制方法 | |
CN108958043A (zh) | 一种刚性飞行器的固定时间自适应姿态容错控制方法 | |
CN110515389B (zh) | 一种考虑执行器受限问题的刚性飞行器自适应固定时间姿态镇定方法 | |
Zhang et al. | Integrated fault estimation and fault-tolerant control for rigid spacecraft attitude system with multiple actuator faults | |
CN114995163B (zh) | 一种无人机免疫控制方法 | |
Okada et al. | Neuroadaptive Observer-Based Fault-Diagnosis and Fault-Tolerant Control for Quadrotor UAV | |
CN116699973A (zh) | 一种过驱动四旋翼飞行器实验平台姿态跟踪鲁棒控制方法 | |
CN110488855A (zh) | 一种基于神经网络估计的刚性飞行器自适应固定时间姿态容错控制方法 | |
Zhang et al. | New hybrid adaptive control approach for aircraft with centre of gravity variation |
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 |