利索能及
我要发布
收藏
专利号: 2016110120085
申请人: 南京邮电大学
专利类型:发明专利
专利状态:已下证
更新日期:2025-06-08
缴费截止日期: 暂无
联系人

摘要:

权利要求书:

1.一种刚体航天器执行器多故障的诊断与容错控制方法,其特征在于,所述方法包括如下步骤:步骤1:建立刚体航天器姿态控制系统的运动学模型和动力学模型;

1)刚体航天器控制系统运动学模型:

取 其中,θ, ψ分别代表滚动角,俯仰角以及偏航角;而ω=[ω1,ω2,ω3]T则为刚体航天器基于本体坐标下的角速度向量;ω0表示已知的常量轨道速度;

刚体航天器姿态小范围变化下的运动学模型简化为:

其中,

2)刚体航天器控制系统动力学模型为:

其中,反对称矩阵ω×定义如下:

其中,J为惯量矩阵,u=[u1,u2,u3]T表示由三个正交的反作用飞轮提供的控制力矩,d=[d1,d2,d3]T为范数有界的未知外界扰动,其满足‖d‖≤γ,γ是一个已知的正常量;

步骤2:建立执行器效率损伤故障和恒偏差故障同时存在的航天器动力学模型,具体如下:

其中,b为执行器效率损伤故障的增益矩阵,b=diag{b1,b2,b3},如果bi=1,则表示第i个飞轮工作正常,当0<bi<1时,表示执行器出现效率损伤故障,本发明中有0<bi≤1,偏差故障向量α=[α1,α2,α3]T其具体的值为未知量,通过故障估计观测器获取;

步骤3:建立基于自适应阈值技术的故障检测观测器,具体如下:如果存在一个正定对称矩阵P=PT>0以及一个实矩阵Q,使得如下不等式成立:Q=P(Γ-ξJ-1)+(Γ-ξJ-1)TP-2PJ-1(J-T)P>0则设计具有如下形式的故障检测观测器:

其中, 为故障检测观测器的状态向量, 为观测器的状态观测误差,当欧拉角以及对应的角速度在一个较小的范围内变化时,其满足Lipschitz条件,即为观测器的增益矩阵,定义故障检测阈值为:

当观测误差的二范数超过 时,即检测到刚体航天器的执行器存在故障;

步骤4:建立自适应故障估计观测器;

设B=[b1,b2,b3]T和U=diag{u1,u2,u3},故重写其表述形式为:

针对如上的动力学方程,设计如下的自适应故障观测器为:

其中, 为故障估计观测器的状态向量,为估计的执行器效率因子向量,为估计的执行器偏差故障向量,Σ为自适应故障观测器的增益矩阵,其为一正定对称矩阵,且满足λmin(Σ)>ξ||J-1||;

所述的 和 的自适应律具有如下形式,包括:

1)效率因子向量 的自适应估计律为:

l1为自适应增益值,其值为一正常量,此外,还有μ1(0)>0和υ1>0;

2)横偏差故障向量 的自适应估计律为:

l2同样为自适应增益值,其值为一正常量,μ2(0)>0和υ2>0;

步骤5:利用步骤4中估计出的执行器效率因子向量和偏差故障向量、终端滑模技术和反演控制方法来对多执行器故障情况下的航天器姿态控制系统设计一个主动容错控制器,首先设z1=σ-σd为外环姿态角跟踪误差,z2=ω-ωd为内环角速率跟踪误差,进而根据z1和z2设计内外环滑模面,该滑模面中融合了终端滑模控制,相应的滑模面具有如下的形式:

所述控制器参数包括执行器效率因子向量估计值、执行器偏差故障向量估计值、期望的角速度参数、内外环滑模面的误差量以及外部扰动上界参数;

对于外环,设计虚拟控制器具体如下:

对于内环,设计容错控制器具体如下:u=u1+u2

其中,σ为航天器姿态角向量,σd为期望的姿态角向量,z2为内环状态误差向量, 为内环期望输入信号, 为内环滑模面,和 分别为执行器效率因子估计矩阵和执行器偏差故障的估计向量,I3×1=[1,1,1]T, 此外,还有a2,ε2均为正数,pi>qi>0,i=1,2,