主权项 |
飞轮欠驱动时结合磁力矩器的卫星三轴姿态控制方法,其特征在于包括如下步骤:(1)根据磁强计测量得到的地磁场强度矢量B确定磁控矩阵Γ(b),并根据实际的飞轮可用情况,确定飞轮控制矩阵K<sub>w</sub>,<maths num="0001"><math><![CDATA[<mrow><mi>Γ</mi><mrow><mo>(</mo><mi>b</mi><mo>)</mo></mrow><mo>=</mo><mo>-</mo><msup><mi>b</mi><mo>×</mo></msup><msup><mi>b</mi><mo>×</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>进行姿态控制。 |