[发明专利]一种针对执行机构故障的航天器容错控制方法与验证装置

摘要

本发明涉及一种针对执行机构故障的航天器容错控制方法与验证装置，验证装置包括实时仿真机、姿态确定模块、姿态控制模块、执行机构模块、试验主控模块、故障注入模块、干扰模拟模块以及三轴气浮台；所述的验证装置是一类通用化验证装置，能够通过故障注入模块完成不同类型执行机构故障注入，此外能够通过试验主控模块选择姿态控制模块中姿态控制算法类别，能够完成多类不同类型容错控制方法的控制能力进行对比分析验证；所述的容错控制方法，是一类具有干扰抑制特性且对执行机构完全失效具有容错能力的H∞控制方法；本发明能够验证多类抗干扰容错控制方法的有效性与工程实用性，适用于航空航天领域的地面仿真验证，可应用于航天器的高精度姿态控制。

主权项

一种针对执行机构故障的航天器容错控制方法，其特征在于实现步骤如下：第一步，搭建包含多源干扰、故障的航天器动力学模型；第二步，针对第一步建立的含干扰的航天器系统动力学模型中同时存在有界的环境干扰和执行机构失效故障设计抗干扰容错控制器；第三步，求解抗干扰容错控制器控制增益矩阵；所述第一步，建立包含干扰与执行机构故障的航天器系统模型如下：当航天器本体坐标系和轨道坐标系之间的欧拉角很小时，姿态运动学可以小角度线性化，得到如下的航天器系统模型：Σ1:I1φ··(t)-n(I1-I2+I3)ψ·(t)+4n2(I2-I3)φ(t)=uf1(t)+Td1(t)I2θ··(t)+3n2(I1-I3)θ(t)=uf2(t)+Td2(t)I3ψ··(t)+n(I1-I2+I3)φ·(t)+n2(I2-I1)ψ(t)=uf3(t)+Td3(t)]]>其中，I1,I2,I3分别为航天器的三轴转动惯量；φ(t),θ(t),ψ(t)分别为三轴姿态角，分别为三轴姿态角速度，分别为三轴姿态角加速度；uf1、uf2和uf3分别为发生执行机构失效故障后航天器三轴上的实际输出控制力矩；Td1(t),Td2(t),Td3(t)分别为航天器三轴受到的环境干扰力矩，满足范数有界的条件；n为航天器轨道角速度；进一步，从航天器系统模型Σ1中提取惯量矩阵，Σ1可以转化为如下形式：Mp·(t)+Cp·(t)+Vp(t)=BuU(t)+Bwd1(t)]]>其中状态变量p(t)＝[φ,θ,ψ]T为三轴欧拉角，d1(t)＝[Td1,Td2,Td3]T表示干扰力矩；U(t)＝[uf1,uf2,uf3]T为发生执行机构故障后航天器三轴上的实际输出控制力矩，其中M、C、V、Bu、Bw为已知的参数矩阵；进一步，对含执行器故障的航天器姿态控制系统可描述为如下离线形势下的状态空间的形式：Σ2:x(k+1)＝Ax(k)+BU(k)+B1d1(k)其中，k表示当前时刻，x(k+1)表示第k+1时刻的系统状态，d1为范数有界干扰，A、B、C、B1为已知的参数矩阵；在实际航天器中，为了在某一执行机构发生完全失效故障时保证系统的正常工作，需在常规的三正交执行机构的基础上采取硬件冗余的措施，即在与三个主惯量轴角度相等的方位上增加第四个执行机构，构成三正交+斜装的执行机构结构，此时执行机构组安装方向阵为:D=100-13010-13001-13]]>在执行机构发生完全失效故障，执行机构完全失效故障可描述如下：uf(k)＝DLiu(k)其中，u(k)表示第k时刻航天器姿态控制器实际解算的控制力矩，Li＝diag{l1 l2 l3 l4}∈L表示执行器故障矩阵，li为失效因子，表示第i个执行机构的失效程度u＝(u1,u2,u3)，且满足:其中L表示执行器完全失效故障模式的集合；针对航天器系统常见三正交+斜装执行机构模式下，其中一个执行机构发生完全失效，对应的故障模式集合表示为：L＝{L0,L1,L2,L3,L4} ＝{diag[1,1,1,1],diag[0,1,1,1],diag[1,0,1,1],diag[1,1,0,1],diag[1,1,1,0]}因此，对含执行器故障的航天器姿态控制系统的状态空间表达形式Σ2转化为：Σ3:x(k+1)＝Ax(k)+BDLiu(k)+B1d1(k)；所述第二步，抗干扰容错控制器设计如下：在同时存在有界的环境干扰和执行机构失效故障的情况下，采用鲁棒H∞设计思想，建立如下抗干扰容错控制系统Σ4：Σ4:x(k+1)=Ax(k)+BDLiu(k)+B1d1(k)z(k)=Cx(k)]]>其中z(k)为第k时刻H∞性能的参考输出；根据鲁棒H∞设计思想，设计抗干扰容错控制器，完成抗干扰容错控制，抗干扰容错控制器对应的控制律为：u(k)＝Kx(k)式中K为航天器系统三轴的抗干扰容错控制器的增益阵；所述第三步，抗干扰容错控制器控制增益矩阵求解如下：在同时考虑环境干扰和执行机构失效情况下，由于引入了鲁棒H∞设计思想，控制器的增益必须满足使得抗干扰容错控制系统Σ4稳定，且从d1(k)到z(k)的闭环传递函数的H∞范数小于给定的上界γ，因此抗干扰容错控制器控制增益矩阵求解问题转化为求解以下线性矩阵不等式问题：sym(AQ+BDLiR)B1QCT*-γ2I0**-I<0]]>其中，γ是任意选定的正数，Q是已知的正定矩阵，满足Q＝QT>0，符号*表示对称矩阵中相应的对称部分；当控制律的增益阵K＝RQ‑1时，抗干扰容错控制系统Σ4在形式为Li∈L的任意故障作用下均能渐近稳定且满足H∞性能指标||z(t)||2<γ||d1(t)||2。