基于故障特征模型的挠性充液卫星姿态自适应容错控制方法转让专利
申请号 : CN201610080866.7
文献号 : CN105607485B
文献日 : 2018-08-14
发明人 : 孙多青 , 马晓英
申请人 : 河北科技师范学院
摘要 :
权利要求 :
1.一种基于故障特征模型的挠性充液卫星姿态自适应容错控制方法,其特征在于通过以下步骤实现:第一步,根据(1)式所给出的挠性充液卫星姿态动力学方程,建立由(2)式所描述的故障特征模型:(1)式中: 为星体的姿态角矢量,为滚动角,θ为俯仰角,ψ为偏航角;u=[u1,u2,u3]T为作用在星体上的控制力矩,是系统的输入;y为系统的输出; 为星体的角速度矢量;η=[η1,η2,…,ηm]T为挠性体模态坐标矢量:q=[η1,η2,…,η3n]T为等效摆晃动模态坐标矢量,n为等效摆的个数;Td为作用在星体上的干扰力矩,为3维列矢量;I为卫星的转动惯量矩阵,为3阶方阵;C0为挠性体振动运动与星体转动运动耦合系数矩阵,其行数为3、列数为m;ξ为挠性体振动模态阻尼矩阵,为m阶对角阵;Λ为挠性体振动模态频率矩阵,为m阶方阵;Λ2为等效摆振动模态频率矩阵,为3n阶对角阵;G,C1,C2为等效摆振动运动与星体转动运动耦合系数矩阵,G的行数为3、列数为3n,C1,C2的行数均为3n、列数均为3;f为故障项,其表达式为:为关于α的矢量函数, 为故障函
数,diag表示对角矩阵,βi(t-Ti)是故障开关函数,定义为
Ti为第i个执行器故障发生的时刻;
(2)式中:i=1,2,3;y1(k)为第k个采样时刻的滚动角 y2(k)为第k个采样时刻的俯仰角θ,y3(k)为第k个采样时刻的偏航角ψ; 为第k个采样时刻故障特征模型的总输入,包括:第k个采样时刻作用在星体上的控制力矩u、干扰力矩Td、第i个执行器发生故障时故障函数 的量值以及由轨道坐标系至卫星本体坐标系进行坐标变换所涉及的常量;Ei(k)为建模误差;ai1(k),ai2(k),bi1(k),bi2(k),bi3(k)为故障特征模型的系数;
第二步,利用参数估计算法对由第一步得到的故障特征模型的系数ai1(k),ai2(k),bij(k)进行辨识得到ai1(k),ai2(k),bij(k)的估计值,分别为: 其中i,j=1,2,3;
第三步,根据第二步得到的ai1(k),ai2(k),bij(k)的估计值 设计容错控制器:
ui(k)=ugi(k)+uIi(k),i=1,2,3, (3)
(3)式中:ui(k)为第k个采样时刻控制力矩u的第i个分量,ugi(k)为黄金分割自适应控制律,设计为(4)式中:b0i,λ0i均为大于0的控制增益调节参数,视控制效果适当增减;l1=0.382,l2=0.618,ei(k)=yi(k)-yri,yri为姿态角的期望值,uIi(k)为逻辑积分控制律;
第四步,将第三步设计的ui(k)施加到由(1)式所描述的系统中,以控制卫星的姿态角。
说明书 :
基于故障特征模型的挠性充液卫星姿态自适应容错控制方法
技术领域
背景技术
料携带量加大,弹性附件变大,液体晃动和弹性附件振动对航天器姿态的影响越来越严重,
液体晃动的抑制与挠性体振动的抑制问题一并成为姿态控制系统设计的难点之一。卫星长
时间运行于真空、失重、高低温和强辐射的环境中,执行机构不可避免会发生故障,而执行
器发生故障,轻则导致精度、性能降低,重则造成卫星失效。为保证卫星在执行机构故障情
况下能够稳定可靠运行,设计一种容错控制方法来完成挠性充液卫星的高稳定度、高精度
控制便显得尤为重要。现有技术尚未公开有有效的挠性充液卫星姿态容错控制的方法。
下了理论基础。基于特征模型的全系数自适应控制方法在许多工业控制领域中已取得成功
应用,特别值得一提的是:该方法的理论思想和工程要义被创造性地应用于飞船返回再入
控制,其开伞精度达到国际先进水平。尽管基于特征模型的自适应控制方法在工程上方便
易行,但是,将这一思想方法应用于容错控制器的设计尚无文献记载与公开的技术方法。
发明内容
系统的可靠性,防止因执行器故障引起的卫星姿态失控。
体的角速度矢量;η=[η1,η2,…,ηm]T为挠性体模态坐标矢量:q=[η1,η2,…,η3n]T为等效摆晃动模态坐标矢量,n为等效摆的个数;Td为作用在星体上的干扰力矩,为3维列矢量;I为卫星的转动惯量矩阵,为3阶方阵;C0为挠性体振动运动与星体转动运动耦合系数矩阵,其行
数为3、列数为m;ξ为挠性体振动模态阻尼矩阵,为m阶对角阵;Λ为挠性体振动模态频率矩阵,为m阶方阵;Λ2为等效摆振动模态频率矩阵,为3n阶对角阵;G,C1,C2为等效摆振动运动与星体转动运动耦合系数矩阵,G的行数为3、列数为3n,C1,C2的行数均为3n、列数均为3;f为故障项,其表达式为:
入,包括:第k个采样时刻作用在星体上的控制力矩u、干扰力矩Td、第i个执行器发生故障时故障函数 的量值以及由轨道坐标系至卫星本体坐标系进行坐标变换所涉及的常量;
Ei(k)为建模误差;ai1(k),ai2(k),bi1(k),bi2(k),bi3(k)为故障特征模型的系数;
其中i,j=1,2,3;
的问题。
放大作用。
附图说明
具体实施方式
T T
体的角速度矢量;η=[η1,η2,…,ηm] 为挠性体模态坐标矢量:q=[η1,η2,…,η3n]为等效摆晃动模态坐标矢量,n为等效摆的个数;Td为作用在星体上的干扰力矩,为3维列矢量;I为卫星的转动惯量矩阵,表达式为:
入,包括:第k个采样时刻作用在星体上的控制力矩u、干扰力矩Td、第i个执行器发生故障时故障函数 的量值以及由轨道坐标系至卫星本体坐标系进行坐标变换所涉及的常量;
Ei(k)为建模误差;ai1(k),ai2(k),bi1(k),bi2(k),bi3(k)为故障特征模型的系数。
2,3,j=1,2,3,M(s)=s2p+d2p-1s2p-1+…+d1s+d0,且cij,2p-1,cij,2p-2,…,cij,0,d2p-1,…,d1,d0是由(2—2)式中矩阵A,B,C的元素确定的常数。
中i,j=1,2,3;一些具体的参数估计算法参见:《自适应滤波、预测与控制》,G.C.古德温,孙贵生著,科学出版社,1992年版,第35页至第86页。在实施例中,取改进的投影算法:
取为[1.85,-0.9,0.1,0.1,0.1]T,λi1=λi2=0.1。
究”(李英波.上海交通大学博士学位论文,2001,第118页和第119页),姿态角初始值也与此
文献相同,即分别取 θ(0)=0.8°,ψ(0)=0.5°;故障函数取为
故障发生的时刻Ti=25秒。
角ψ的期望值yr3的跟踪曲线;图1、图2、图3中的虚线是期望的输出。仿真实验结果表明:执行器发生故障前,采用本发明提出的方法,卫星姿态在很短的时间内达到稳定状态,滚动角稳
态控制精度小于等于1.3×10–5度、俯仰角稳态控制精度小于等于4.2×10–6度、偏航角稳态
控制精度小于等于1.5×10–5度,滚动角速率稳态控制精度小于1.1×10–8度/秒、俯仰角速
率稳态控制精度小于5.4×10–8度/秒、偏航角速率稳态控制精度小于1.1×10–8度/秒;当执
行器发生故障时,采用本发明提出的方法,系统可在较短的时间内恢复正常工作,卫星姿态
稳定后,滚动角稳态控制精度小于8.2×10–3度、俯仰角稳态控制精度小于1.5×10–2度、偏
航角稳态控制精度小于1.2×10–2度,滚动角速率稳态控制精度小于2.5×10–6度/秒、俯仰
角速率稳态控制精度小于8.2×10–6度/秒、偏航角速率稳态控制精度小于5.0×10–6度/秒。