发明名称 基于虚拟弹簧阻尼网络的卫星编队构形分布式控制方法
摘要 本发明介绍了一种基于虚拟弹簧阻尼网络的卫星编队构形分布式控制方法,包括下述步骤:(1)指定期望构形;(2)指定虚拟弹簧阻尼网络连接拓扑结构;(3)选定虚拟弹簧阻尼器系数;(4)各卫星通过相对运动测量和通信感知相对运动状态测量;(5)各卫星分别计算自身的控制加速度;(6)各卫星分别实施控制加速度。本方法能实现卫星编队期望相对运动状态的自组织建立和高精度保持;对卫星数量的增加具有良好的适应性;能节省燃料消耗;能抗干扰;稳定性得到理论保证,构形控制精度要求可通过调整虚拟弹簧阻尼器的参数来满足。
申请公布号 CN103984238A 申请公布日期 2014.08.13
申请号 CN201410245991.X 申请日期 2014.06.05
申请人 湖南大学 发明人 陈琪锋;王石;王耀南;张小刚
分类号 G05B13/04(2006.01)I 主分类号 G05B13/04(2006.01)I
代理机构 长沙正奇专利事务所有限责任公司 43113 代理人 陈立武
主权项 一种基于虚拟弹簧阻尼网络的卫星编队构形分布式控制方法,该方法包括下述步骤:(1)、指定期望构形,依据委托卫星编队的构形要求,使用常规方法,指定委托卫星编队的期望相对运动规律,该规律包括指定委托卫星编队的期望相对位置和指定委托卫星编队的期望相对速度,设委托卫星编队所有卫星为n个,则第i(i=2,3,…,n)个卫星相对于第1个卫星的期望相对位置为<img file="FDA0000516058460000011.GIF" wi="116" he="84" />给出第i(i=2,3,…,n)个卫星相对于第1个卫星的期望相对速度为<img file="FDA0000516058460000012.GIF" wi="106" he="84" />则期望相对位置向量<img file="FDA0000516058460000013.GIF" wi="663" he="149" />和期望相对速度向量<img file="FDA0000516058460000014.GIF" wi="657" he="149" />指定了卫星编队的期望构形,该二式中,P<sup>d</sup>为期望相对位置向量,<img file="FDA0000516058460000015.GIF" wi="66" he="70" />为期望相对速度向量,上标T表示向量转置;(2)、指定虚拟弹簧阻尼网络连接拓扑结构,依据步骤(1)所获期望相对位置向量和期望相对速度向量,采用无向图G=(V,E)来表示虚拟弹簧阻尼网络连接拓扑结构,式中G为无向图,V为顶点集,V={v<sub>1</sub>,v<sub>2</sub>,…,v<sub>n</sub>},v<sub>i</sub>(i=1,2,…,n)为G的第i个顶点,与卫星编队中的第i个卫星相对应;E为边集,E={e<sub>1</sub>,e<sub>2</sub>,…,e<sub>m</sub>},m为E中边的个数,e<sub>k</sub>(k=1,2,…,m)为G的第k条边,e<sub>k</sub>用其两个顶点表示为e<sub>k</sub>=(v<sub>i</sub>,v<sub>j</sub>),其中v<sub>i</sub>和v<sub>j</sub>是V中的两个不同的顶点,无向图G的边e<sub>k</sub>=(v<sub>i</sub>,v<sub>j</sub>)指定其顶点v<sub>i</sub>和顶点v<sub>j</sub>之间的连接关系、指定第i个卫星和第j个卫星之间建立一个虚拟的弹簧阻尼器连接、指定所有卫星之间的所有虚拟弹簧阻尼器的连接拓扑结构,任意一个连通的无向图树、环、链,都可作为虚拟弹簧阻尼网络连接拓扑结构,自由选定一个便于实施的连通无向图作为虚拟弹簧阻尼网络连接拓扑结构,将所述委托卫星编队中的卫星以虚拟的弹簧阻尼器连接起来形成网络,指定该委托卫星编队中各卫星之间的虚拟弹簧阻尼器的连接关系,然后,由虚拟弹簧阻尼网络连接拓扑结构无向图G=(V,E)确定各个卫星的邻居集合,第i个卫星的邻居集合为N<sub>i</sub>={j|(v<sub>i</sub>,v<sub>j</sub>)∈E},式中,N<sub>i</sub>为第i个卫星的邻居集合,并将N<sub>i</sub>存储在第i个卫星的内存中,i=1,2,…,n;(3)、选定虚拟弹簧阻尼器系数,依据委托卫星编队提出的构形控制稳态误差和稳定性要求,为步骤(2)所指定连接关系的委托卫星编队中各卫星之间的虚拟弹簧阻尼器选定虚拟弹簧阻尼器系数,设委托卫星编队提出的构形保持误差不能大于ε,则|P‑P<sup>d</sup>|<sub>∞</sub>≤ε,式中|·|<sub>∞</sub>表示向量各分量绝对值的最大值,P为卫星编队的实际相对位置向量;<img file="FDA0000516058460000021.GIF" wi="477" he="106" />式中p<sub>i</sub>为第i+1个卫星相对于第1个卫星的实际相对位置;p<sub>i</sub>=r<sub>i+1</sub>‑r<sub>1</sub>(i=1,2,…,n‑1),式中r<sub>i+1</sub>为第i+1个卫星的实际位置,r<sub>1</sub>为第1卫星的实际位置,使用如下不等式选取满足构形保持误差要求并能保证构形控制闭环系统稳定的弹性系数k<sub>s</sub>:<maths num="0001" id="cmaths0001"><math><![CDATA[<mrow><msub><mi>k</mi><mi>s</mi></msub><mo>&GreaterEqual;</mo><mfrac><mn>1</mn><mi>&epsiv;</mi></mfrac><munder><mi>max</mi><mrow><mi>t</mi><mo>&Element;</mo><mi>T</mi></mrow></munder><msub><mrow><mo>|</mo><mo>{</mo><msup><mrow><mo>[</mo><msup><mi>S</mi><mi>T</mi></msup><mi>D</mi><mrow><mo>(</mo><mi>G</mi><mo>)</mo></mrow><mi>D</mi><msup><mrow><mo>(</mo><mi>G</mi><mo>)</mo></mrow><mi>T</mi></msup><mi>S</mi><msup><mrow><mo>(</mo><msup><mi>S</mi><mi>T</mi></msup><mi>S</mi><mo>)</mo></mrow><mrow><mo>-</mo><mn>1</mn></mrow></msup><mo>]</mo></mrow><mrow><mo>-</mo><mn>1</mn></mrow></msup><mo>&CircleTimes;</mo><msup><mo>&dtri;</mo><mn>2</mn></msup><mi>Q</mi><mrow><mo>(</mo><msub><mi>r</mi><mn>0</mn></msub><mrow><mo>(</mo><mi>t</mi><mo>)</mo></mrow><mo>)</mo></mrow><mo>}</mo><msup><mi>P</mi><mi>d</mi></msup><mo>|</mo></mrow><mo>&infin;</mo></msub></mrow>]]></math><img file="FDA0000516058460000022.GIF" wi="1290" he="218" /></maths>式中:<img file="FDA0000516058460000025.GIF" wi="45" he="55" />表示矩阵的Kronecker乘积;Q为地球引力势函数,<img file="FDA0000516058460000023.GIF" wi="272" he="123" />r<sub>0</sub>(t)是已知的卫星编队所部署在的参考轨道的运动;t为时间;T为构形控制作用的时间区间;S=[‑1<sub>n‑1</sub> I<sub>n‑1</sub>]<sup>T</sup>,1<sub>n‑1</sub>为n‑1行1列且所有元素为1的向量,I<sub>n‑1</sub>为n‑1维的单位矩阵;D(G)为虚拟弹簧阻尼网络连接拓扑结构无向图G的关联矩阵,<img file="FDA0000516058460000024.GIF" wi="401" he="101" />是一个n‑1行m列的矩阵,式中d<sub>ik</sub>为D(G)的第i行第k列的元素,通过为G中每条边e<sub>k</sub>=(v<sub>i</sub>,v<sub>j</sub>)指定e<sub>k</sub>的顶点v<sub>i</sub>和顶点v<sub>j</sub>中任意一个顶点为头,另一个顶点为尾,按下式确定所述虚拟弹簧阻尼网络连接拓扑结构无向图G的关联矩阵D(G)的第i行k列的元素d<sub>ik</sub>的值(i=1,2,…,n‑1;k=1,2,…,m):<img file="FDA0000516058460000031.GIF" wi="593" he="232" />式中:d<sub>ik</sub>为D(G)的第i行第k列的元素;v<sub>i</sub>为无向图G的第i个顶点;e<sub>k</sub>为无向图G中的第k条边,构形控制闭环系统稳定性对阻尼系数k<sub>d</sub>的要求为k<sub>d</sub>&gt;0,据此选定k<sub>d</sub>;(4)、各卫星通过相对运动测量和通信感知相对运动状态,依据步骤(2)所指定的虚拟弹簧阻尼网络连接拓扑结构,使用常规方法,通过相对运动测量和通信获得委托卫星编队中各卫星与其邻居卫星即邻居集合中的卫星之间的相对运动状态,由每个卫星直接对其邻居卫星进行相对运动测量,获得邻居卫星对所述每个卫星的相对运动状态;或由邻居卫星对所述每个卫星进行相对运动测量,再通过所述每个卫星与邻居卫星的通信间接获取邻居卫星对所述每个卫星的相对运动状态;(5)、各卫星分别计算自身的控制加速度,使用步骤(3)所选定的虚拟弹簧阻尼器系数,依据步骤(4)所获各卫星与通过虚拟弹簧阻尼器连接的邻居卫星之间的相对运动状态,采用常规的沿三个坐标轴方向分别实施虚拟弹簧阻尼网络控制的方式,得到基于相对运动状态的线性控制律,依据所得线性控制律计算控制加速度,先按下述二式依次分别计算出由虚拟弹簧阻尼网络连接拓扑结构无向图G的所有边定义的卫星编队期望相对位置向量<img file="FDA0000516058460000032.GIF" wi="62" he="77" />和卫星编队期望相对速度向量<img file="FDA0000516058460000033.GIF" wi="102" he="81" /><maths num="0002" id="cmaths0002"><math><![CDATA[<mrow><msubsup><mi>P</mi><mi>G</mi><mi>d</mi></msubsup><mo>=</mo><mo>[</mo><mi>D</mi><msup><mrow><mo>(</mo><mi>G</mi><mo>)</mo></mrow><mi>T</mi></msup><mi>S</mi><msup><mrow><mo>(</mo><msup><mi>S</mi><mi>T</mi></msup><mi>S</mi><mo>)</mo></mrow><mrow><mo>-</mo><mn>1</mn></mrow></msup><mo>&CircleTimes;</mo><msub><mi>I</mi><mn>3</mn></msub><mo>]</mo><msup><mi>P</mi><mi>d</mi></msup></mrow>]]></math><img file="FDA0000516058460000034.GIF" wi="644" he="131" /></maths><maths num="0003" id="cmaths0003"><math><![CDATA[<mrow><msubsup><mover><mi>P</mi><mo>&CenterDot;</mo></mover><mi>G</mi><mi>d</mi></msubsup><mo>=</mo><mo>[</mo><mi>D</mi><msup><mrow><mo>(</mo><mi>G</mi><mo>)</mo></mrow><mi>T</mi></msup><mi>S</mi><msup><mrow><mo>(</mo><msup><mi>S</mi><mi>T</mi></msup><mi>S</mi><mo>)</mo></mrow><mrow><mo>-</mo><mn>1</mn></mrow></msup><mo>&CircleTimes;</mo><msub><mi>I</mi><mn>3</mn></msub><mo>]</mo><msup><mover><mi>P</mi><mo>&CenterDot;</mo></mover><mi>d</mi></msup></mrow>]]></math><img file="FDA0000516058460000041.GIF" wi="644" he="137" /></maths>该二式中I<sub>3</sub>为3维单位矩阵;<img file="FDA0000516058460000042.GIF" wi="706" he="151" /><img file="FDA0000516058460000043.GIF" wi="80" he="85" />为拓扑结构无向图G的第p条边e<sub>p</sub>所定义的期望相对位置(p=1,2,…,m);<img file="FDA0000516058460000044.GIF" wi="701" he="142" /><img file="FDA0000516058460000045.GIF" wi="85" he="85" />为拓扑结构无向图G的第p条边e<sub>p</sub>所定义的期望相对速度(p=1,2,…,m),若拓扑结构无向图G中第k条边e<sub>k</sub>的两个顶点分别为顶点v<sub>i</sub>和顶点v<sub>j</sub>,即e<sub>k</sub>=(v<sub>i</sub>,v<sub>j</sub>),则按下述二式分别计算出期望相对位置<img file="FDA0000516058460000046.GIF" wi="58" he="90" />和期望相对速度<img file="FDA0000516058460000047.GIF" wi="88" he="90" /><img file="FDA0000516058460000048.GIF" wi="550" he="200" /><img file="FDA0000516058460000049.GIF" wi="550" he="199" />该二式中:<img file="FDA00005160584600000410.GIF" wi="58" he="90" />为第i个卫星的第j个邻居卫星对第i个卫星的期望相对位置(i=1,2,…,n;j∈N<sub>i</sub>);e<sub>k</sub>为无向图G中的第k条边,k=1,2,…,m,e<sub>k</sub>的方向按照步骤(3)中的指定;<img file="FDA00005160584600000411.GIF" wi="86" he="93" />为无向图G的第k条边e<sub>k</sub>所定义的期望相对位置,k=1,2,…,m;v<sub>i</sub>为无向图G的第i个顶点,i=1,2,…,n;<img file="FDA00005160584600000412.GIF" wi="59" he="90" />为第i个卫星的第j个邻居卫星对第i个卫星的期望相对速度(i=1,2,…,n;j∈N<sub>i</sub>);<img file="FDA00005160584600000413.GIF" wi="88" he="94" />为无向图G的第k条边e<sub>k</sub>所定义的期望相对速度,k=1,2,…,m,然后,依据上述所得线性控制律按下式计算出第i个卫星的控制加速度u<sub>i</sub>:<maths num="0004" id="cmaths0004"><math><![CDATA[<mrow><msub><mi>u</mi><mi>i</mi></msub><mo>=</mo><msub><mrow><mo>-</mo><mi>k</mi></mrow><mi>s</mi></msub><munder><mi>&Sigma;</mi><mrow><mi>j</mi><mo>&Element;</mo><msub><mi>N</mi><mi>i</mi></msub></mrow></munder><mrow><mo>(</mo><msubsup><mi>r</mi><mi>ji</mi><mi>d</mi></msubsup><mo>-</mo><msub><mi>r</mi><mi>ji</mi></msub><mo>)</mo></mrow><mo>-</mo><msub><mi>k</mi><mi>d</mi></msub><munder><mi>&Sigma;</mi><mrow><mi>j</mi><mo>&Element;</mo><msub><mi>N</mi><mi>i</mi></msub></mrow></munder><mrow><mo>(</mo><msubsup><mover><mi>r</mi><mo>&CenterDot;</mo></mover><mi>ji</mi><mi>d</mi></msubsup><mo>-</mo><msub><mover><mi>r</mi><mo>&CenterDot;</mo></mover><mi>ji</mi></msub><mo>)</mo></mrow><mo>,</mo><mrow><mo>(</mo><mi>i</mi><mo>=</mo><mn>1,2</mn><mo>,</mo><mo>.</mo><mo>.</mo><mo>.</mo><mo>,</mo><mi>n</mi><mo>)</mo></mrow></mrow>]]></math><img file="FDA00005160584600000414.GIF" wi="1153" he="136" /></maths>式中r<sub>ji</sub>为第i个卫星的第j个邻居卫星对第i个卫星的相对位置,<img file="FDA00005160584600000415.GIF" wi="60" he="82" />为第i个卫星的第j个邻居卫星对第i个卫星的相对速度;(6)、各卫星分别实施控制加速度,第i个卫星使用其执行器实施步骤(5)计算所得的控制加速度u<sub>i</sub>,i=1,2,…,n,并在一个控制周期时间内保持该控制加速度,该控制周期结束时,若构形控制任务尚未完成,重复步骤(4)~(6);若构形控制任务业已完成,步骤结束。
地址 410082 湖南省长沙市岳麓区麓山南路2号
您可能感兴趣的专利