发明名称 编队卫星有限时间构型包含控制方法
摘要 编队卫星有限时间构型包含控制方法,涉及编队卫星构型包含控制方法。为了解决现有的多星系统编队控制方法的鲁棒性较差的问题和使用的卫星间通讯拓扑为无向图不能完全符合实际应用环境的问题。本发明根据建立的参考卫星和伴随卫星的相对运动动力学方程,建立卫星编队系统的编队卫星i与相对参考点的相对轨道动力学模型并简化为<img file="DDA0000708833540000011.GIF" wi="595" he="75" />根据各个编队卫星i的编队形式,给出卫星编队系统的有向图图论中的加权邻接矩阵A及Laplacian矩阵,设计多动态领航星卫星编队系统的分布式有限时间构形包含控制律,实现每个跟随星在有限时间内到达领航星形成的构型凸包内,完成编队卫星有限时间构型包含控制。本发明适用于编队卫星构型的控制领域。
申请公布号 CN104898691A 申请公布日期 2015.09.09
申请号 CN201510212461.X 申请日期 2015.04.29
申请人 哈尔滨工业大学 发明人 刘萌萌;孙延超;马广富;李传江;王文佳;梁峻博
分类号 G05D1/10(2006.01)I 主分类号 G05D1/10(2006.01)I
代理机构 哈尔滨市松花江专利商标事务所 23109 代理人 杨立超
主权项 编队卫星有限时间构型包含控制方法,其特征在于包括以下步骤:步骤一:建立参考卫星和伴随卫星的相对运动动力学方程;<maths num="0001" id="cmaths0001"><math><![CDATA[<mrow><mfenced open='{' close=''><mtable><mtr><mtd><mover><mi>x</mi><mrow><mo>&CenterDot;</mo><mo>&CenterDot;</mo></mrow></mover><mo>-</mo><mn>2</mn><mi>n</mi><mover><mi>y</mi><mo>&CenterDot;</mo></mover><mo>+</mo><mrow><mo>(</mo><mfrac><mi>&mu;</mi><msubsup><mi>r</mi><mi>c</mi><mn>3</mn></msubsup></mfrac><mo>-</mo><msup><mi>n</mi><mn>2</mn></msup><mo>)</mo></mrow><mrow><mo>(</mo><mi>x</mi><mo>+</mo><mi>a</mi><mo>)</mo></mrow><mo>=</mo><msub><mi>f</mi><mi>x</mi></msub></mtd></mtr><mtr><mtd><mover><mi>y</mi><mrow><mo>&CenterDot;</mo><mo>&CenterDot;</mo></mrow></mover><mo>+</mo><mn>2</mn><mi>n</mi><mover><mi>x</mi><mo>&CenterDot;</mo></mover><mo>+</mo><mrow><mo>(</mo><mfrac><mi>&mu;</mi><msubsup><mi>r</mi><mi>c</mi><mn>3</mn></msubsup></mfrac><mo>-</mo><msup><mi>n</mi><mn>2</mn></msup><mo>)</mo></mrow><mi>y</mi><mo>=</mo><msub><mi>f</mi><mi>y</mi></msub></mtd></mtr><mtr><mtd><mover><mi>z</mi><mrow><mo>&CenterDot;</mo><mo>&CenterDot;</mo></mrow></mover><mo>+</mo><mfrac><mi>&mu;</mi><msubsup><mi>r</mi><mi>c</mi><mn>3</mn></msubsup></mfrac><mi>z</mi><mo>=</mo><msub><mi>f</mi><mi>z</mi></msub></mtd></mtr></mtable></mfenced><mo>-</mo><mo>-</mo><mo>-</mo><mrow><mo>(</mo><mn>1</mn><mo>)</mo></mrow></mrow>]]></math><img file="FDA0000708833510000011.GIF" wi="1163" he="491" /></maths>式中:<img file="FDA0000708833510000012.GIF" wi="490" he="75" />和<img file="FDA0000708833510000013.GIF" wi="212" he="74" />分别为伴随卫星与参考卫星在轨道坐标系中的相对位置矢量,相对速度矢量和相对加速度矢量在轨道坐标系的三个坐标轴的分量;n为参考卫星的平均角速度<img file="FDA0000708833510000014.GIF" wi="263" he="96" />μ为地心引力常数,a为参考卫星沿近圆轨道运动的轨道半径,r<sub>c</sub>为伴随卫星到地心的距离;f<sub>x</sub>,f<sub>y</sub>和f<sub>z</sub>分别为伴随卫星和参考卫星除地心引力外的其他作用力的合力的加速度矢量之差在轨道坐标系的三个坐标轴的分量;步骤二:编队卫星i对应伴随卫星,相对参考点对应参考卫星,根据公式(1),建立卫星编队系统的编队卫星i与相对参考点的相对轨道动力学模型为:<maths num="0002" id="cmaths0002"><math><![CDATA[<mrow><mfenced open='{' close=''><mtable><mtr><mtd><msub><mover><mi>x</mi><mrow><mo>&CenterDot;</mo><mo>&CenterDot;</mo></mrow></mover><mi>i</mi></msub><mo>-</mo><mn>2</mn><mi>n</mi><msub><mover><mi>y</mi><mo>&CenterDot;</mo></mover><mi>i</mi></msub><mo>-</mo><msup><mi>n</mi><mn>2</mn></msup><msub><mi>x</mi><mi>i</mi></msub><mo>+</mo><mfrac><mrow><mi>&mu;</mi><mrow><mo>(</mo><msub><mi>R</mi><mn>0</mn></msub><mo>+</mo><msub><mi>x</mi><mi>i</mi></msub><mo>)</mo></mrow></mrow><msubsup><mi>R</mi><mi>i</mi><mn>3</mn></msubsup></mfrac><mo>-</mo><mfrac><mi>&mu;</mi><msubsup><mi>R</mi><mn>0</mn><mn>2</mn></msubsup></mfrac><mo>=</mo><mfrac><mrow><msub><mi>&tau;</mi><mi>oix</mi></msub><mo>+</mo><msub><mi>&tau;</mi><mi>doix</mi></msub></mrow><msub><mi>m</mi><mi>oi</mi></msub></mfrac></mtd></mtr><mtr><mtd><msub><mover><mi>y</mi><mrow><mo>&CenterDot;</mo><mo>&CenterDot;</mo></mrow></mover><mi>i</mi></msub><mo>+</mo><mn>2</mn><mi>n</mi><msub><mover><mi>x</mi><mo>&CenterDot;</mo></mover><mi>i</mi></msub><mo>-</mo><msup><mi>n</mi><mn>2</mn></msup><msub><mi>y</mi><mi>i</mi></msub><mo>+</mo><mfrac><mrow><mi>&mu;</mi><msub><mi>y</mi><mi>i</mi></msub></mrow><msubsup><mi>R</mi><mi>i</mi><mn>3</mn></msubsup></mfrac><mo>=</mo><mfrac><mrow><msub><mi>&tau;</mi><mi>oiy</mi></msub><mo>+</mo><msub><mi>&tau;</mi><mi>doiy</mi></msub></mrow><msub><mi>m</mi><mi>oi</mi></msub></mfrac></mtd></mtr><mtr><mtd><msub><mover><mi>z</mi><mrow><mo>&CenterDot;</mo><mo>&CenterDot;</mo></mrow></mover><mi>i</mi></msub><mo>+</mo><mfrac><mrow><mi>&mu;</mi><msub><mi>z</mi><mi>i</mi></msub></mrow><msubsup><mi>R</mi><mi>i</mi><mn>3</mn></msubsup></mfrac><mo>=</mo><mfrac><mrow><msub><mi>&tau;</mi><mi>oiz</mi></msub><mo>+</mo><msub><mi>&tau;</mi><mi>doiz</mi></msub></mrow><msub><mi>m</mi><mi>oi</mi></msub></mfrac></mtd></mtr></mtable></mfenced><mo>-</mo><mo>-</mo><mo>-</mo><mrow><mo>(</mo><mn>2</mn><mo>)</mo></mrow></mrow>]]></math><img file="FDA0000708833510000015.GIF" wi="1251" he="461" /></maths>式中:<img file="FDA0000708833510000016.GIF" wi="540" he="77" />和<img file="FDA0000708833510000017.GIF" wi="245" he="75" />分别为编队卫星i与参考点在轨道坐标系中的相对位置矢量,相对速度矢量和相对加速度矢量在轨道坐标系的三个坐标轴的分量;n为参考点的平均角速度<img file="FDA0000708833510000018.GIF" wi="278" he="100" />μ为地心引力常数,R<sub>0</sub>为参考点沿近圆轨道运动的轨道半径,R<sub>i</sub>为编队卫星i到地心的距离;m<sub>oi</sub>为编队卫星i的质量,τ<sub>oi</sub>=[τ<sub>oix</sub> τ<sub>oiy</sub> τ<sub>oiz</sub>]<sup>T</sup>为作用在编队卫星i上的控制输入;τ<sub>oix</sub>、τ<sub>oiy</sub>、τ<sub>oiz</sub>分别为控制输入在轨道坐标系的三个轴上的分量;τ<sub>doi</sub>=[τ<sub>doix</sub> τ<sub>doiy</sub> τ<sub>doiz</sub>]<sup>T</sup>为广义干扰;τ<sub>doix</sub>、τ<sub>doiy</sub>、τ<sub>doiz</sub>分别为广义干扰在轨道坐标系的三个轴上的分量;将得出的卫星编队系统的编队卫星i相对参考点的相对轨道动力学模型转化为如公式(3)的简化形式,<maths num="0003" id="cmaths0003"><math><![CDATA[<mrow><msub><mi>m</mi><mi>oi</mi></msub><msub><mover><mi>p</mi><mrow><mo>&CenterDot;</mo><mo>&CenterDot;</mo></mrow></mover><mi>i</mi></msub><mo>+</mo><msub><mi>c</mi><mi>oi</mi></msub><msub><mover><mi>p</mi><mo>&CenterDot;</mo></mover><mi>i</mi></msub><mo>+</mo><msub><mi>g</mi><mi>oi</mi></msub><mo>=</mo><msub><mi>&tau;</mi><mi>oi</mi></msub><mo>+</mo><msub><mi>&tau;</mi><mi>doi</mi></msub><mo>-</mo><mo>-</mo><mo>-</mo><mrow><mo>(</mo><mn>3</mn><mo>)</mo></mrow></mrow>]]></math><img file="FDA0000708833510000021.GIF" wi="1263" he="69" /></maths>其中p<sub>i</sub>=(x<sub>i</sub>,y<sub>i</sub>,z<sub>i</sub>)<sup>T</sup>,i<sub>1</sub>=1,…,N,<maths num="0004" id="cmaths0004"><math><![CDATA[<mrow><msub><mi>c</mi><mi>oi</mi></msub><mo>=</mo><msub><mrow><mn>2</mn><mi>m</mi></mrow><mi>oi</mi></msub><mfenced open='[' close=']'><mtable><mtr><mtd><mn>0</mn></mtd><mtd><mo>-</mo><mi>n</mi></mtd><mtd><mn>0</mn></mtd></mtr><mtr><mtd><mi>n</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><mn>0</mn></mtd></mtr></mtable></mfenced><mo>,</mo></mrow>]]></math><img file="FDA0000708833510000022.GIF" wi="607" he="234" /></maths><maths num="0005" id="cmaths0005"><math><![CDATA[<mrow><msub><mi>g</mi><mi>oi</mi></msub><mo>=</mo><msub><mi>m</mi><mi>oi</mi></msub><mfenced open='[' close=']'><mtable><mtr><mtd><mo>-</mo><msup><mi>n</mi><mn>2</mn></msup><msub><mi>x</mi><mi>i</mi></msub><mo>+</mo><mi>&mu;</mi><mrow><mo>(</mo><msub><mi>R</mi><mn>0</mn></msub><mo>+</mo><msub><mi>x</mi><mi>i</mi></msub><mo>)</mo></mrow><mo>/</mo><msubsup><mi>R</mi><mi>i</mi><mn>3</mn></msubsup><mo>-</mo><mi>&mu;</mi><mo>/</mo><msubsup><mi>R</mi><mn>0</mn><mn>2</mn></msubsup></mtd></mtr><mtr><mtd><mo>-</mo><msup><mi>n</mi><mn>2</mn></msup><msub><mi>y</mi><mi>i</mi></msub><mo>+</mo><mi>&mu;</mi><msub><mi>y</mi><mi>i</mi></msub><mo>/</mo><msubsup><mi>R</mi><mi>i</mi><mn>3</mn></msubsup></mtd></mtr><mtr><mtd><mi>&mu;</mi><msub><mi>z</mi><mi>i</mi></msub><mo>/</mo><msubsup><mi>R</mi><mi>i</mi><mn>3</mn></msubsup></mtd></mtr></mtable></mfenced><mo>;</mo></mrow>]]></math><img file="FDA0000708833510000023.GIF" wi="825" he="247" /></maths>设编队卫星i中有N个跟随星、m个领航星;跟随星记为i<sub>1</sub>,与i<sub>1</sub>对应的参数的角标均记为i<sub>1</sub>;领航星记为i<sub>2</sub>,与i<sub>2</sub>对应的参数的角标均记为i<sub>2</sub>;跟随星的数目大于领航星的数目;跟随星i<sub>1</sub>的相对轨道动力学模型为:<maths num="0006" id="cmaths0006"><math><![CDATA[<mrow><msub><mi>m</mi><msub><mi>oi</mi><mn>1</mn></msub></msub><msub><mover><mi>p</mi><mrow><mo>&CenterDot;</mo><mo>&CenterDot;</mo></mrow></mover><msub><mi>i</mi><mn>1</mn></msub></msub><mo>+</mo><msub><mi>c</mi><msub><mi>oi</mi><mn>1</mn></msub></msub><msub><mover><mi>p</mi><mo>&CenterDot;</mo></mover><msub><mi>i</mi><mn>1</mn></msub></msub><mo>+</mo><msub><mi>g</mi><msub><mi>oi</mi><mn>1</mn></msub></msub><mo>=</mo><msub><mi>&tau;</mi><msub><mi>oi</mi><mn>1</mn></msub></msub><mo>+</mo><msub><mi>&tau;</mi><msub><mi>d</mi><msub><mi>oi</mi><mn>1</mn></msub></msub></msub><mo>,</mo><msub><mi>i</mi><mn>1</mn></msub><mo>=</mo><mn>1</mn><mo>,</mo><mo>.</mo><mo>.</mo><mo>.</mo><mo>,</mo><mi>N</mi><mo>-</mo><mo>-</mo><mo>-</mo><mrow><mo>(</mo><mn>4</mn><mo>)</mo></mrow></mrow>]]></math><img file="FDA0000708833510000024.GIF" wi="1348" he="88" /></maths>领航星i<sub>2</sub>的相对动力学模型为:<maths num="0007" id="cmaths0007"><math><![CDATA[<mrow><msub><mi>m</mi><msub><mi>oi</mi><mn>2</mn></msub></msub><msub><mover><mi>p</mi><mrow><mo>&CenterDot;</mo><mo>&CenterDot;</mo></mrow></mover><msub><mi>i</mi><mn>2</mn></msub></msub><mo>+</mo><msub><mi>c</mi><msub><mi>oi</mi><mn>2</mn></msub></msub><msub><mover><mi>p</mi><mo>&CenterDot;</mo></mover><msub><mi>i</mi><mn>2</mn></msub></msub><mo>+</mo><msub><mi>g</mi><msub><mi>oi</mi><mn>2</mn></msub></msub><mo>=</mo><msub><mi>&tau;</mi><msub><mi>oi</mi><mn>2</mn></msub></msub><mo>,</mo><msub><mi>i</mi><mn>2</mn></msub><mo>=</mo><mi>N</mi><mo>+</mo><mn>1</mn><mo>,</mo><mo>.</mo><mo>.</mo><mo>.</mo><mo>,</mo><mi>N</mi><mo>+</mo><mi>m</mi><mo>-</mo><mo>-</mo><mo>-</mo><mrow><mo>(</mo><mn>5</mn><mo>)</mo></mrow></mrow>]]></math><img file="FDA0000708833510000025.GIF" wi="1367" he="92" /></maths>其中<img file="FDA0000708833510000026.GIF" wi="71" he="67" />为对应领航星的轨迹的控制输入与外界干扰的总和;步骤三:根据各个编队卫星i的编队形式,对于任意一个跟随星,当至少存在一个领航星有到该跟随星的有向路径,给出卫星编队系统的有向图图论中的加权邻接矩阵A及Laplacian矩阵;步骤四:根据步骤二得出的跟随星i<sub>1</sub>的相对轨道动力学模型(4),通过步骤三的拓扑结构中的加权邻接矩阵A及Laplacian矩阵的运算,设计多动态领航星卫星编队系统的分布式有限时间构形包含控制律,实现每个跟随星在有限时间内到达领航星形成的构型凸包内,完成编队卫星有限时间构型包含控制。
地址 150001 黑龙江省哈尔滨市南岗区西大直街92号