主权项 |
一种挠性敏捷卫星姿态机动滚动优化控制方法,其特征是,该方法由以下步骤实现:步骤一、选择惯性坐标系为参考坐标系,建立以金字塔构型CMG群为执行机构的具有挠性附件的卫星姿态动力学及运动学方程;以挠性附件的模态坐标系为基准,建立挠性附件振动的动力学方程,通过定义新的状态变量,基于建立的三个方程获得用于预测卫星姿态未来信息的非线性状态空间方程;具体过程为:建立的以金字塔构型CMG群为执行机构的具有挠性附件的卫星姿态动力学方程为:<maths num="0001"><math><![CDATA[<mrow><mi>J</mi><mover><mi>w</mi><mo>·</mo></mover><mo>+</mo><msup><mi>δ</mi><mi>T</mi></msup><mover><mi>η</mi><mo>··</mo></mover><mo>+</mo><mo>[</mo><mi>w</mi><mo>×</mo><mo>]</mo><mi>J</mi><mi>w</mi><mo>+</mo><mo>[</mo><mi>w</mi><mo>×</mo><mo>]</mo><msup><mi>δ</mi><mi>T</mi></msup><mover><mi>η</mi><mo>·</mo></mover><mo>=</mo><mo>-</mo><msub><mover><mi>H</mi><mo>·</mo></mover><mrow><mi>C</mi><mi>M</mi><mi>G</mi></mrow></msub><mo>-</mo><mo>[</mo><mi>w</mi><mo>×</mo><mo>]</mo><msub><mi>H</mi><mrow><mi>C</mi><mi>M</mi><mi>G</mi></mrow></msub><mo>+</mo><msub><mi>T</mi><mi>d</mi></msub></mrow>]]></math><img file="FDA0000980356020000011.GIF" wi="1102" he="71" /></maths>式中,J为卫星的转动惯量矩阵,w为星体三轴姿态角速度,δ为挠性附件与星体的刚柔耦合矩阵,η为挠性附件在模态坐标系下的位移,H<sub>CMG</sub>为金字塔构型CMG群的三轴角动量,T<sub>d</sub>为空间干扰力矩;定义CMG群的控制力矩<img file="FDA0000980356020000012.GIF" wi="491" he="71" />其中[w×]定义为:<maths num="0002"><math><![CDATA[<mrow><mo>[</mo><mi>w</mi><mo>×</mo><mo>]</mo><mo>=</mo><mfenced open = "[" close = "]"><mtable><mtr><mtd><mn>0</mn></mtd><mtd><mrow><mo>-</mo><msub><mi>w</mi><mi>z</mi></msub></mrow></mtd><mtd><msub><mi>w</mi><mi>y</mi></msub></mtd></mtr><mtr><mtd><msub><mi>w</mi><mi>z</mi></msub></mtd><mtd><mn>0</mn></mtd><mtd><mrow><mo>-</mo><msub><mi>w</mi><mi>x</mi></msub></mrow></mtd></mtr><mtr><mtd><mrow><mo>-</mo><msub><mi>w</mi><mi>y</mi></msub></mrow></mtd><mtd><msub><mi>w</mi><mi>x</mi></msub></mtd><mtd><mn>0</mn></mtd></mtr></mtable></mfenced></mrow>]]></math><img file="FDA0000980356020000013.GIF" wi="534" he="230" /></maths>式中,w<sub>x</sub>,w<sub>y</sub>和w<sub>z</sub>分别为滚动轴姿态角速度、俯仰轴姿态角速度和偏航轴姿态角速度;在模态坐标系下,挠性附件振动的动力学方程为:<maths num="0003"><math><![CDATA[<mrow><mover><mi>η</mi><mo>··</mo></mover><mo>+</mo><mn>2</mn><msub><mi>ζ</mi><mi>f</mi></msub><msub><mi>w</mi><mi>f</mi></msub><mover><mi>η</mi><mo>·</mo></mover><mo>+</mo><msubsup><mi>w</mi><mi>f</mi><mn>2</mn></msubsup><mi>η</mi><mo>+</mo><mi>δ</mi><mover><mi>w</mi><mo>·</mo></mover><mo>=</mo><mn>0</mn></mrow>]]></math><img file="FDA0000980356020000014.GIF" wi="549" he="71" /></maths>式中,ζ<sub>f</sub>为挠性附件模态的阻尼比矩阵,w<sub>f</sub>为挠性附件模态的振动频率矩阵;融合卫星姿态的动力学方程、运动学方程及挠性附件振动的动力学方程,且定义新的状态变量x=[θ η w w<sub>η</sub>]<sup>T</sup>,获得非线性状态空间方程:<maths num="0004"><math><![CDATA[<mrow><mfenced open = "[" close = "]"><mtable><mtr><mtd><mover><mi>θ</mi><mo>·</mo></mover></mtd></mtr><mtr><mtd><mover><mi>η</mi><mo>·</mo></mover></mtd></mtr><mtr><mtd><mover><mi>w</mi><mo>·</mo></mover></mtd></mtr><mtr><mtd><msub><mover><mi>w</mi><mo>·</mo></mover><mi>η</mi></msub></mtd></mtr></mtable></mfenced><mo>=</mo><mo>-</mo><msup><mfenced open = "[" close = "]"><mtable><mtr><mtd><mi>I</mi></mtd><mtd><mn>0</mn></mtd><mtd><mn>0</mn></mtd><mtd><mn>0</mn></mtd></mtr><mtr><mtd><mn>0</mn></mtd><mtd><mi>I</mi></mtd><mtd><mn>0</mn></mtd><mtd><mn>0</mn></mtd></mtr><mtr><mtd><mn>0</mn></mtd><mtd><mn>0</mn></mtd><mtd><mi>J</mi></mtd><mtd><msup><mi>δ</mi><mi>T</mi></msup></mtd></mtr><mtr><mtd><mn>0</mn></mtd><mtd><mn>0</mn></mtd><mtd><mi>δ</mi></mtd><mtd><mi>I</mi></mtd></mtr></mtable></mfenced><mrow><mo>-</mo><mn>1</mn></mrow></msup><mfenced open = "[" close = "]"><mtable><mtr><mtd><mn>0</mn></mtd><mtd><mn>0</mn></mtd><mtd><mrow><mo>-</mo><mi>I</mi></mrow></mtd><mtd><mn>0</mn></mtd></mtr><mtr><mtd><mn>0</mn></mtd><mtd><mn>0</mn></mtd><mtd><mn>0</mn></mtd><mtd><mrow><mo>-</mo><mi>I</mi></mrow></mtd></mtr><mtr><mtd><mn>0</mn></mtd><mtd><mn>0</mn></mtd><mtd><mrow><mo>[</mo><mi>w</mi><mo>×</mo><mo>]</mo><mi>J</mi></mrow></mtd><mtd><mrow><mo>[</mo><mi>w</mi><mo>×</mo><mo>]</mo><msup><mi>δ</mi><mi>T</mi></msup></mrow></mtd></mtr><mtr><mtd><mn>0</mn></mtd><mtd><msubsup><mi>w</mi><mi>f</mi><mn>2</mn></msubsup></mtd><mtd><mn>0</mn></mtd><mtd><mrow><mn>2</mn><msub><mi>ζ</mi><mi>f</mi></msub><msub><mi>w</mi><mi>f</mi></msub></mrow></mtd></mtr></mtable></mfenced><mfenced open = "[" close = "]"><mtable><mtr><mtd><mi>θ</mi></mtd></mtr><mtr><mtd><mi>η</mi></mtd></mtr><mtr><mtd><mi>w</mi></mtd></mtr><mtr><mtd><msub><mi>w</mi><mi>η</mi></msub></mtd></mtr></mtable></mfenced><mo>+</mo><msup><mfenced open = "[" close = "]"><mtable><mtr><mtd><mi>I</mi></mtd><mtd><mn>0</mn></mtd><mtd><mn>0</mn></mtd><mtd><mn>0</mn></mtd></mtr><mtr><mtd><mn>0</mn></mtd><mtd><mi>I</mi></mtd><mtd><mn>0</mn></mtd><mtd><mn>0</mn></mtd></mtr><mtr><mtd><mn>0</mn></mtd><mtd><mn>0</mn></mtd><mtd><mi>J</mi></mtd><mtd><msup><mi>δ</mi><mi>T</mi></msup></mtd></mtr><mtr><mtd><mn>0</mn></mtd><mtd><mn>0</mn></mtd><mtd><mi>δ</mi></mtd><mtd><mi>I</mi></mtd></mtr></mtable></mfenced><mrow><mo>-</mo><mn>1</mn></mrow></msup><mfenced open = "[" close = "]"><mtable><mtr><mtd><mn>0</mn></mtd></mtr><mtr><mtd><mn>0</mn></mtd></mtr><mtr><mtd><mi>I</mi></mtd></mtr><mtr><mtd><mn>0</mn></mtd></mtr></mtable></mfenced><mi>T</mi></mrow>]]></math><img file="FDA0000980356020000021.GIF" wi="1716" he="303" /></maths>式中,θ表示卫星姿态角,w<sub>η</sub>为挠性附件在模态坐标系下的位移;I为单位矩阵;步骤二、对步骤一建立的非线性状态空间方程进行离散化后,根据当前时刻测量获得的卫星姿态四元数及姿态角速度信息,建立卫星姿态信息的预测输出方程,实现对预测时域内的卫星姿态及角速度信息的预测;步骤三、根据步骤二获得的卫星姿态信息预测输出方程,利用任务规划姿态机动导引律输出的期望四元数和期望角速度信息,建立兼顾卫星姿态机动快速性及挠性附件振动抑制性能的优化控制问题,经过对该优化控制问题的求解,获得期望的非线性模型预测机动控制力矩;根据步骤一建立的挠性附件振动的动力学方程,采用输入成形技术,对所述期望的非线性模型预测机动控制力矩;步骤四、以所述的机动控制力矩作为输入,采用鲁棒违逆方法,建立求取金字塔构型CMG群框架角速度的优化控制问题,通过对优化控制问题求解,获得金字塔构型CMG群的框架角速度操纵律,根据金字塔构型CMG群的角动量在卫星姿态三轴的分解,获得驱动卫星姿态机动的实际控制力矩;步骤五、采用离散控制技术,在每个采样时刻重复步骤二至步骤四,通过逐步更新卫星姿态信息,实现挠性卫星姿态机动的滚动优化控制。 |