发明名称 飞轮欠驱动时结合磁力矩器的卫星三轴姿态控制方法
摘要 飞轮欠驱动时结合磁力矩器的卫星三轴姿态控制方法,步骤为:(1)根据磁强计测量得到的地磁场强度矢量B确定磁控矩阵Γ(b),并根据实际的飞轮可用情况,确定飞轮控制矩阵K<sub>w</sub>;(2)计算三轴姿态控制用磁电流指令I<sub>zk</sub>=K<sub>ic</sub>*M<sub>zk</sub>;(3)计算三轴磁卸载用磁电流指令I<sub>xz</sub>=K<sub>ic</sub>*M<sub>xz</sub>;(4)计算磁力矩器指令I<sub>ck</sub>=I<sub>zk</sub>+I<sub>xz</sub>;在磁力矩器按照磁力矩器指令进行姿态控制的同时,可用的反作用飞轮继续基于指令力矩T<sub>c</sub>进行姿态控制。本发明方法在系统仅剩下任意的两台甚至一台飞轮可用时,结合三轴磁力矩器实现了卫星三轴姿态高精度控制,适用于长期对地定向控制或长期对日定向控制,也适用于卫星任意姿态大角度机动控制。
申请公布号 CN106542120A 申请公布日期 2017.03.29
申请号 CN201610877412.2 申请日期 2016.09.30
申请人 上海航天控制技术研究所 发明人 杜宁;尹海宁;李芳华;孙锦花;查理;王世耀;孟其琛
分类号 B64G1/32(2006.01)I 主分类号 B64G1/32(2006.01)I
代理机构 中国航天科技专利中心 11009 代理人 陈鹏
主权项 飞轮欠驱动时结合磁力矩器的卫星三轴姿态控制方法,其特征在于包括如下步骤:(1)根据磁强计测量得到的地磁场强度矢量B确定磁控矩阵Γ(b),并根据实际的飞轮可用情况,确定飞轮控制矩阵K<sub>w</sub>,<maths num="0001"><math><![CDATA[<mrow><mi>&Gamma;</mi><mrow><mo>(</mo><mi>b</mi><mo>)</mo></mrow><mo>=</mo><mo>-</mo><msup><mi>b</mi><mo>&times;</mo></msup><msup><mi>b</mi><mo>&times;</mo></msup><mo>=</mo><mfenced open = "[" close = "]"><mtable><mtr><mtd><mrow><msubsup><mi>b</mi><mi>y</mi><mn>2</mn></msubsup><mo>+</mo><msubsup><mi>b</mi><mi>z</mi><mn>2</mn></msubsup></mrow></mtd><mtd><mrow><mo>-</mo><msub><mi>b</mi><mi>x</mi></msub><msub><mi>b</mi><mi>y</mi></msub></mrow></mtd><mtd><mrow><mo>-</mo><msub><mi>b</mi><mi>x</mi></msub><msub><mi>b</mi><mi>z</mi></msub></mrow></mtd></mtr><mtr><mtd><mrow><mo>-</mo><msub><mi>b</mi><mi>x</mi></msub><msub><mi>b</mi><mi>y</mi></msub></mrow></mtd><mtd><mrow><msubsup><mi>b</mi><mi>x</mi><mn>2</mn></msubsup><mo>+</mo><msubsup><mi>b</mi><mi>z</mi><mn>2</mn></msubsup></mrow></mtd><mtd><mrow><mo>-</mo><msub><mi>b</mi><mi>y</mi></msub><msub><mi>b</mi><mi>z</mi></msub></mrow></mtd></mtr><mtr><mtd><mrow><mo>-</mo><msub><mi>b</mi><mi>x</mi></msub><msub><mi>b</mi><mi>z</mi></msub></mrow></mtd><mtd><mrow><mo>-</mo><msub><mi>b</mi><mi>y</mi></msub><msub><mi>b</mi><mi>z</mi></msub></mrow></mtd><mtd><mrow><msubsup><mi>b</mi><mi>x</mi><mn>2</mn></msubsup><mo>+</mo><msubsup><mi>b</mi><mi>y</mi><mn>2</mn></msubsup></mrow></mtd></mtr></mtable></mfenced><mo>,</mo><msub><mi>K</mi><mi>w</mi></msub><mo>=</mo><mfenced open = "[" close = "]"><mtable><mtr><mtd><msub><mi>k</mi><mi>x</mi></msub></mtd><mtd><mn>0</mn></mtd><mtd><mn>0</mn></mtd></mtr><mtr><mtd><mn>0</mn></mtd><mtd><msub><mi>k</mi><mi>y</mi></msub></mtd><mtd><mn>0</mn></mtd></mtr><mtr><mtd><mn>0</mn></mtd><mtd><mn>0</mn></mtd><mtd><msub><mi>k</mi><mi>z</mi></msub></mtd></mtr></mtable></mfenced></mrow>]]></math><img file="FDA0001125238960000011.GIF" wi="1390" he="271" /></maths>其中,<img file="FDA0001125238960000012.GIF" wi="1021" he="268" />当i轴飞轮可用时,k<sub>i</sub>=1,否则当i轴飞轮故障时,k<sub>i</sub>=0,i=x,y,z;(2)计算三轴姿态控制用磁电流指令I<sub>zk</sub>=K<sub>ic</sub>*M<sub>zk</sub>,其中k<sub>ic</sub>为磁力矩器磁矩和电流转换系数,M<sub>zk</sub>=B×Λ<sup>‑1</sup>(b)T<sub>c</sub>/||B||<sup>2</sup>,Λ(b)=Γ(b)+K<sub>w</sub>,T<sub>c</sub>为飞轮姿态控制算法给出的三轴控制力矩指令;(3)计算三轴磁卸载用磁电流指令I<sub>xz</sub>=K<sub>ic</sub>*M<sub>xz</sub>,其中M<sub>xz</sub>=‑K<sub>u</sub>(B×Δh)/||B||<sup>2</sup>,Δh为当前飞轮角动量与卸载目标角动量的差值,K<sub>u</sub>为磁卸载系数矩阵<maths num="0002"><math><![CDATA[<mrow><msub><mi>K</mi><mi>u</mi></msub><mo>=</mo><mfenced open = "[" close = "]"><mtable><mtr><mtd><msub><mi>K</mi><mrow><mi>u</mi><mi>x</mi></mrow></msub></mtd><mtd><mn>0</mn></mtd><mtd><mn>0</mn></mtd></mtr><mtr><mtd><mn>0</mn></mtd><mtd><msub><mi>K</mi><mrow><mi>u</mi><mi>y</mi></mrow></msub></mtd><mtd><mn>0</mn></mtd></mtr><mtr><mtd><mn>0</mn></mtd><mtd><mn>0</mn></mtd><mtd><msub><mi>K</mi><mrow><mi>u</mi><mi>z</mi></mrow></msub></mtd></mtr></mtable></mfenced></mrow>]]></math><img file="FDA0001125238960000013.GIF" wi="492" he="229" /></maths>K<sub>ux</sub>、K<sub>uy</sub>、K<sub>uz</sub>分别为卫星三轴磁卸载系数;(4)计算磁力矩器指令I<sub>ck</sub>=I<sub>zk</sub>+I<sub>xz</sub>,I<sub>ck</sub>为三轴磁力距器磁控电流;在磁力矩器按照磁力矩器指令进行姿态控制的同时,可用的反作用飞轮继续基于指令力矩T<sub>c</sub>进行姿态控制。
地址 201109 上海市闵行区中春路1555号