发明名称 一种挠性敏捷卫星姿态机动滚动优化控制方法
摘要 一种挠性敏捷卫星姿态机动滚动优化控制方法,涉及卫星姿态机动控制方法,解决现有针对挠性卫星姿态进行快速机动时,具有强非线性、受多种约束以及挠性附件易振动的特点,进而导致难以满足控制需求等问题,建立了包含卫星姿态动力学、运动学及挠性附件振动的非线性状态空间方程,用于进行卫星姿态未来信息的准确预测。建立了卫星姿态快速机动及抑制挠性附件振动的加权优化指标,利用非线性模型预测控制方法进行期望控制律的设计,基于输入成形技术,对规划的期望力矩进行成形,采用鲁棒伪逆法设计CMG群的操纵律,以输入成形后的期望控制力矩为输入,规划出每个CMG的框架角速度,实现抑制挠性附件振动的卫星姿态大角度快速机动控制。
申请公布号 CN104090489B 申请公布日期 2016.12.07
申请号 CN201410312779.0 申请日期 2014.07.02
申请人 中国科学院长春光学精密机械与物理研究所 发明人 金光;范国伟;戴路;徐开;杨秀彬;常琳
分类号 G05B13/04(2006.01)I 主分类号 G05B13/04(2006.01)I
代理机构 长春菁华专利商标代理事务所 22210 代理人 陶尊新
主权项 一种挠性敏捷卫星姿态机动滚动优化控制方法,其特征是,该方法由以下步骤实现:步骤一、选择惯性坐标系为参考坐标系,建立以金字塔构型CMG群为执行机构的具有挠性附件的卫星姿态动力学及运动学方程;以挠性附件的模态坐标系为基准,建立挠性附件振动的动力学方程,通过定义新的状态变量,基于建立的三个方程获得用于预测卫星姿态未来信息的非线性状态空间方程;具体过程为:建立的以金字塔构型CMG群为执行机构的具有挠性附件的卫星姿态动力学方程为:<maths num="0001"><math><![CDATA[<mrow><mi>J</mi><mover><mi>w</mi><mo>&CenterDot;</mo></mover><mo>+</mo><msup><mi>&delta;</mi><mi>T</mi></msup><mover><mi>&eta;</mi><mo>&CenterDot;&CenterDot;</mo></mover><mo>+</mo><mo>&lsqb;</mo><mi>w</mi><mo>&times;</mo><mo>&rsqb;</mo><mi>J</mi><mi>w</mi><mo>+</mo><mo>&lsqb;</mo><mi>w</mi><mo>&times;</mo><mo>&rsqb;</mo><msup><mi>&delta;</mi><mi>T</mi></msup><mover><mi>&eta;</mi><mo>&CenterDot;</mo></mover><mo>=</mo><mo>-</mo><msub><mover><mi>H</mi><mo>&CenterDot;</mo></mover><mrow><mi>C</mi><mi>M</mi><mi>G</mi></mrow></msub><mo>-</mo><mo>&lsqb;</mo><mi>w</mi><mo>&times;</mo><mo>&rsqb;</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>&lsqb;</mo><mi>w</mi><mo>&times;</mo><mo>&rsqb;</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>&eta;</mi><mo>&CenterDot;&CenterDot;</mo></mover><mo>+</mo><mn>2</mn><msub><mi>&zeta;</mi><mi>f</mi></msub><msub><mi>w</mi><mi>f</mi></msub><mover><mi>&eta;</mi><mo>&CenterDot;</mo></mover><mo>+</mo><msubsup><mi>w</mi><mi>f</mi><mn>2</mn></msubsup><mi>&eta;</mi><mo>+</mo><mi>&delta;</mi><mover><mi>w</mi><mo>&CenterDot;</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>&theta;</mi><mo>&CenterDot;</mo></mover></mtd></mtr><mtr><mtd><mover><mi>&eta;</mi><mo>&CenterDot;</mo></mover></mtd></mtr><mtr><mtd><mover><mi>w</mi><mo>&CenterDot;</mo></mover></mtd></mtr><mtr><mtd><msub><mover><mi>w</mi><mo>&CenterDot;</mo></mover><mi>&eta;</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>&delta;</mi><mi>T</mi></msup></mtd></mtr><mtr><mtd><mn>0</mn></mtd><mtd><mn>0</mn></mtd><mtd><mi>&delta;</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>&lsqb;</mo><mi>w</mi><mo>&times;</mo><mo>&rsqb;</mo><mi>J</mi></mrow></mtd><mtd><mrow><mo>&lsqb;</mo><mi>w</mi><mo>&times;</mo><mo>&rsqb;</mo><msup><mi>&delta;</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>&zeta;</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>&theta;</mi></mtd></mtr><mtr><mtd><mi>&eta;</mi></mtd></mtr><mtr><mtd><mi>w</mi></mtd></mtr><mtr><mtd><msub><mi>w</mi><mi>&eta;</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>&delta;</mi><mi>T</mi></msup></mtd></mtr><mtr><mtd><mn>0</mn></mtd><mtd><mn>0</mn></mtd><mtd><mi>&delta;</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群的角动量在卫星姿态三轴的分解,获得驱动卫星姿态机动的实际控制力矩;步骤五、采用离散控制技术,在每个采样时刻重复步骤二至步骤四,通过逐步更新卫星姿态信息,实现挠性卫星姿态机动的滚动优化控制。
地址 130033 吉林省长春市东南湖大路3888号