发明名称 一种卫星控制系统离散积分滑模容错控制方法
摘要 本发明公开了一种卫星控制系统离散积分滑模容错控制方法,基于卫星的离散线性系统模型设计离散积分滑模控制器,控制器的虚拟控制律为<img file="DDA0000447314300000011.GIF" wi="1202" he="68" />,通过故障诊断和参数辨识获得执行机构健康因子W;根据控制量vk和执行机构健康因子W采用基于力矩可达集的直接分配方法获得每个执行机构的控制力矩u<sub>k</sub>;所述基于力矩可达集的直接分配方法将可达集表面按照表面法向量和目标向量之间的夹角由小到大的顺序排列。本发明方法能够有效的在线处理含健康因子不准确、多故障和多种不确定性同时存在的卫星姿态控制问题。
申请公布号 CN103699131B 申请公布日期 2016.05.04
申请号 CN201310738851.1 申请日期 2013.12.26
申请人 北京控制工程研究所 发明人 王大轶;段文杰;刘成瑞;何英姿
分类号 G05D1/08(2006.01)I 主分类号 G05D1/08(2006.01)I
代理机构 中国航天科技专利中心 11009 代理人 褚鹏蛟
主权项 一种卫星控制系统离散积分滑模容错控制方法,包括如下步骤:(1)根据卫星的离散线性系统模型设计离散积分滑模控制器,具体包括如下步骤:(1.1)设计不含故障和不确定性的卫星的线性系统模型为参考模型;所述参考模型为x<sub>0,k+1</sub>=Φx<sub>0,k</sub>+Γv<sub>0,k</sub>;其中,v<sub>0,k</sub>=‑K<sub>0</sub>x<sub>0,k</sub>,x<sub>0,k</sub>为已知的第k步的参考状态,x<sub>0,k+1</sub>为第k+1步的参考状态;K<sub>0</sub>为控制系数;Φ为状态转移矩阵,Φ=I+AT,A为系统矩阵,T为采样时间;Γ为卫星的离散线性系统虚拟控制律的系数矩阵,Γ=BT,B为卫星的连续线性系统虚拟控制律的效率矩阵;I为单位矩阵;(1.2)根据公式e<sub>k</sub>=x<sub>k</sub>‑x<sub>0,k</sub>计算残差e<sub>k</sub>;其中,x<sub>k</sub>为通过测量得到的第k步的状态;(1.3)根据公式σ<sub>k</sub>=G(x<sub>k</sub>‑x<sub>0</sub>)+ε<sub>k</sub>计算滑模面变量σ<sub>k</sub>;其中,ε<sub>k</sub>=ε<sub>k‑1</sub>+Ex<sub>k‑1</sub>,ε<sub>0</sub>=0,E=‑G(Φ‑I‑ΓK<sub>0</sub>),G为系数矩阵,x<sub>k</sub>为第k步测量的状态;x<sub>0</sub>为初始状态;x<sub>k‑1</sub>为通过测量得到的第k‑1步的状态;(1.4)估计匹配的不确定性<img file="FDA0000823441230000011.GIF" wi="93" he="86" />和不匹配的不确定性<img file="FDA0000823441230000012.GIF" wi="116" he="86" />其中<maths num="0001" id="cmaths0001"><math><![CDATA[<mrow><msub><mover><mi>&xi;</mi><mo>^</mo></mover><mrow><mi>u</mi><mo>,</mo><mi>k</mi></mrow></msub><mo>=</mo><msup><mi>B</mi><mo>&perp;</mo></msup><msup><mi>B</mi><mrow><mo>&perp;</mo><mo>+</mo></mrow></msup><msub><mover><mi>d</mi><mo>^</mo></mover><mi>k</mi></msub><mo>/</mo><mi>T</mi><mo>,</mo><msub><mover><mi>&xi;</mi><mo>^</mo></mover><mrow><mi>m</mi><mo>,</mo><mi>k</mi></mrow></msub><mo>=</mo><msup><mi>B</mi><mo>+</mo></msup><msub><mover><mi>d</mi><mo>^</mo></mover><mi>k</mi></msub><mo>/</mo><mi>T</mi><mo>,</mo><msub><mover><mi>d</mi><mo>^</mo></mover><mi>k</mi></msub><mo>=</mo><msub><mi>x</mi><mi>k</mi></msub><mo>-</mo><msub><mi>&Phi;x</mi><mrow><mi>k</mi><mo>-</mo><mn>1</mn></mrow></msub><mo>-</mo><msub><mi>&Gamma;v</mi><mrow><mi>k</mi><mo>-</mo><mn>1</mn></mrow></msub><mo>;</mo></mrow>]]></math><img file="FDA0000823441230000013.GIF" wi="1228" he="92" /></maths>B<sup>⊥</sup>为B的补空间矩阵,B<sup>⊥+</sup>为B<sup>⊥</sup>的伪逆矩阵,B<sup>+</sup>是B的伪逆矩阵;v<sub>k‑1</sub>为第k‑1步的控制量;(1.5)根据公式<maths num="0002" id="cmaths0002"><math><![CDATA[<mrow><msub><mi>v</mi><mi>k</mi></msub><mo>=</mo><mo>-</mo><msub><mi>K</mi><mn>0</mn></msub><msub><mi>x</mi><mrow><mn>0</mn><mo>,</mo><mi>k</mi></mrow></msub><mo>-</mo><msup><mrow><mo>(</mo><mi>G</mi><mi>&Gamma;</mi><mo>)</mo></mrow><mrow><mo>-</mo><mn>1</mn></mrow></msup><mrow><mo>(</mo><mi>G</mi><mi>&Phi;</mi><mo>-</mo><mi>G</mi><mo>+</mo><mi>E</mi><mo>)</mo></mrow><msub><mi>e</mi><mi>k</mi></msub><mo>+</mo><mi>G</mi><mi>&Gamma;</mi><msub><mover><mi>&xi;</mi><mo>^</mo></mover><mrow><mi>m</mi><mo>,</mo><mi>k</mi></mrow></msub><mo>+</mo><mi>G</mi><mi>T</mi><msub><mover><mi>&xi;</mi><mo>^</mo></mover><mrow><mi>u</mi><mo>,</mo><mi>k</mi></mrow></msub><mo>+</mo><msub><mi>&sigma;</mi><mi>k</mi></msub></mrow>]]></math><img file="FDA0000823441230000014.GIF" wi="1227" he="87" /></maths>计算第k步的控制量v<sub>k</sub>;(2)通过故障诊断和参数辨识获得执行机构健康因子W;(3)根据控制量v<sub>k</sub>和执行机构健康因子W采用基于力矩可达集的直接分配方法获得每个执行机构的控制力矩u<sub>k</sub>;所述基于力矩可达集的直接分配方法将可达集表面按照表面法向量和目标向量之间的夹角由小到大的顺序排列。
地址 100080 北京市海淀区北京2729信箱