发明名称 一种增加前馈补偿改善磁控能力的方法
摘要 本发明涉及一种增加前馈补偿改善磁控能力的方法,包括:(1)根据卫星上双轴帆板的A轴转角α<sub>F</sub>和B轴转角β<sub>F</sub>,以及地磁场强度矢量<img file="201010528016.1_ab_0.GIF" wi="38" he="32" />计算前馈补偿力矩T<sub>F</sub>,本方法中涉及的外扰力矩主要是重力梯度力矩(2)采用比例-微分控制律计算x轴的常规磁控力矩(3)根据前馈补偿力矩T<sub>F</sub>与常规的磁控力矩T<sub>m</sub>计算卫星Y轴的磁矩M<sub>y</sub>,本发明方法可以在不增加硬件设备的条件下,大大提高偏置动量卫星的磁控能力,有效地改善姿态控制精度,本发明方法已经过在卫星轨测试,取得良好的效果,当卫星所受外扰较大的情况下,可以将姿态指向精度从1度提高至0.5度以内,大大改善了卫星的姿态控制指标。
申请公布号 CN102001453A 申请公布日期 2011.04.06
申请号 CN201010528016.1 申请日期 2010.10.27
申请人 北京控制工程研究所 发明人 柯旗;王勇;蒋庆华;魏春岭;杨鸣;莫鑫;宋利芳
分类号 B64G1/24(2006.01)I 主分类号 B64G1/24(2006.01)I
代理机构 中国航天科技专利中心 11009 代理人 范晓毅
主权项 1.一种增加前馈补偿改善磁控能力的方法,其特征在于包括如下步骤:(1)根据卫星上双轴帆板的A轴转角α<sub>F</sub>和B轴转角β<sub>F</sub>,以及地磁场强度矢量<img file="FSA00000328474200011.GIF" wi="72" he="59" />计算前馈补偿力矩T<sub>F</sub>,具体方法如下:T<sub>F</sub>=SIGN<sub>α</sub>·SIGN<sub>β</sub>·SIGN<sub>Bz</sub>·FV其中:<maths num="0001"><![CDATA[<math><mrow><msub><mover><mi>B</mi><mo>&RightArrow;</mo></mover><mi>b</mi></msub><mo>=</mo><msup><mrow><mo>[</mo><msub><mi>B</mi><mi>bx</mi></msub><mo>,</mo><msub><mi>B</mi><mi>by</mi></msub><mo>,</mo><msub><mi>B</mi><mi>bz</mi></msub><mo>]</mo></mrow><mi>T</mi></msup><mo>,</mo></mrow></math>]]></maths><maths num="0002"><![CDATA[<math><mrow><mo>|</mo><msub><mi>B</mi><mi>b</mi></msub><mo>|</mo><mo>=</mo><msqrt><msup><msub><mi>B</mi><mi>bx</mi></msub><mn>2</mn></msup><mo>+</mo><msup><msub><mi>B</mi><mi>by</mi></msub><mn>2</mn></msup><mo>+</mo><msup><msub><mi>B</mi><mi>bz</mi></msub><mn>2</mn></msup></msqrt></mrow></math>]]></maths>B<sub>bx</sub>,B<sub>by</sub>,B<sub>bz</sub>分别为地磁场强度矢量<img file="FSA00000328474200014.GIF" wi="43" he="59" />在卫星笛卡尔坐标系x轴、y轴、z轴的分量;<img file="FSA00000328474200015.GIF" wi="919" he="253" />SIGN<sub>β</sub>=sign(β<sub>F</sub>);SIGN<sub>Bz</sub>=sign(B<sub>bz</sub>);sign()为取符号函数;<maths num="0003"><![CDATA[<math><mrow><mi>FV</mi><mo>=</mo><mfenced open='{' close=''><mtable><mtr><mtd><msub><mi>k</mi><mrow><mi>F</mi><mn>2</mn></mrow></msub></mtd><mtd><mfrac><mi>&pi;</mi><mn>6</mn></mfrac><mo>&lt;</mo><mo>|</mo><msub><mi>&beta;</mi><mi>F</mi></msub><mo>|</mo></mtd></mtr><mtr><mtd><msub><mi>k</mi><mrow><mi>F</mi><mn>1</mn></mrow></msub></mtd><mtd><mfrac><mi>&pi;</mi><mn>12</mn></mfrac><mo>&lt;</mo><mo>|</mo><msub><mi>&beta;</mi><mi>F</mi></msub><mo>|</mo><mo>&le;</mo><mfrac><mi>&pi;</mi><mn>6</mn></mfrac></mtd></mtr><mtr><mtd><mn>0</mn></mtd><mtd><mo>|</mo><msub><mi>&beta;</mi><mi>F</mi></msub><mo>|</mo><mo>&le;</mo><mfrac><mi>&pi;</mi><mn>12</mn></mfrac></mtd></mtr></mtable></mfenced></mrow></math>]]></maths>k<sub>F1</sub>,k<sub>F2</sub>为补偿力矩幅值的分段参数,且k<sub>F2</sub>>k<sub>F1</sub>。所述卫星双轴帆板的A轴和B轴为卫星帆板具有的两个旋转自由度,其中A轴以垂直卫星运行轨道面的方向旋转,B轴嵌套在A轴之内,即A轴可以带动B轴一起旋转,B轴的旋转方向定义为:当帆板处于零位状态,卫星前进的方向即为B轴的旋转方向,所述零位状态是指A轴和B轴的转角输出均为0的状态;(2)根据比例-微分控制律计算出常规的磁控力矩T<sub>m</sub>,计算公式如下:<img file="FSA00000328474200021.GIF" wi="628" he="67" />其中:k<sub>PX</sub>:比例-微分控制律中位置的修正系数;k<sub>DX</sub>:比例-微分控制律中速度的修正系数;B<sub>bx</sub>,B<sub>bz</sub>:地磁场强度矢量<img file="FSA00000328474200022.GIF" wi="43" he="59" />在X轴,Z轴的分量<img file="FSA00000328474200023.GIF" wi="55" he="50" />卫星X轴的姿态角;<img file="FSA00000328474200024.GIF" wi="53" he="63" />卫星X轴的姿态角速度;(3)根据前馈补偿力矩T<sub>F</sub>与常规的磁控力矩T<sub>m</sub>计算卫星Y轴的磁矩M<sub>y</sub>,公式如下:<img file="FSA00000328474200025.GIF" wi="1311" he="75" />(4)卫星Y轴的磁矩M<sub>y</sub>和地磁场<img file="FSA00000328474200026.GIF" wi="43" he="59" />作用后产生X轴的磁控力矩T<sub>x</sub>,用于卫星的姿态控制。
地址 100080 北京市2729信箱