发明名称 一种编队卫星分布式有限时间跟踪控制方法
摘要 一种编队卫星分布式有限时间跟踪控制方法,涉及跟踪控制方法,尤其涉及一种编队卫星分布式有限时间跟踪控制方法。本发明是要解决现有的卫星编队控制方法中存在编队卫星间通信受限的问题,以及很难得到领航星控制输入上界信息的问题,且没有考虑到系统中各个卫星不可避免受到摄动的问题,以及完成编队构型时间较长的问题。本发明方法通过以下步骤进行:一、建立双星相对运动动力学模型;二、建立编队卫星相对参考点的相对运动动力学模型;三、设计分布式有限时间跟踪控制律。本发明解决了卫星编队控制方法中编队卫星间通信受限的问题,考虑了系统中各个卫星不可避免受到摄动的问题,能较短时间内成编队构型。本发明可应用于跟踪控制领域。
申请公布号 CN105138010A 申请公布日期 2015.12.09
申请号 CN201510546955.1 申请日期 2015.08.31
申请人 哈尔滨工业大学 发明人 王俊;孙延超;李传江;常雅杰;吕腾;马广富
分类号 G05D1/10(2006.01)I;B64G1/24(2006.01)I;G06F17/50(2006.01)I 主分类号 G05D1/10(2006.01)I
代理机构 哈尔滨市松花江专利商标事务所 23109 代理人 杨立超
主权项 一种编队卫星分布式有限时间跟踪控制方法,其特征在于它是通过以下步骤实现的:一、建立双星相对运动动力学模型:一.一、定义地心惯性坐标系:以地心为原点,O<sub>i</sub>X<sub>i</sub>轴沿地球赤道平面与黄道平面的交线,指向春分点γ,O<sub>i</sub>Z<sub>i</sub>轴指向北极,O<sub>i</sub>Y<sub>i</sub>轴与其余两轴形成右手系;一.二、定义轨道坐标系:以卫星质心为原点,O<sub>o</sub>Z<sub>o</sub>轴由卫星质心指向地心方向,O<sub>o</sub>X<sub>o</sub>轴在轨道平面上与O<sub>o</sub>Z<sub>o</sub>轴垂直,沿着卫星飞行方向,O<sub>o</sub>Y<sub>o</sub>轴垂直于轨道平面并与其余两轴形成右手坐标系;一.三、定义相对运动坐标系:参考星记为s,伴随星记为c,相对运动坐标系原点与参考卫星的质心固连并随其沿轨道运动,x轴与参考卫星的地心矢量r<sub>s</sub>重合,由地心指向s,y轴在参考卫星的轨道面内垂直于x轴,并指向运动方向,z轴由右手规则确定;一.四、建立参考星与伴随星的相对运动动力学方程:参考星运行于近圆轨道时,在相对运动坐标系中建立参考星与伴随星的相对运动动力学方程如下所示:<maths num="0001" id="cmaths0001"><math><![CDATA[<mrow><mfenced open = "{" close = ""><mtable><mtr><mtd><mover><mi>x</mi><mo>&CenterDot;&CenterDot;</mo></mover><mo>-</mo><mn>2</mn><msub><mi>&omega;</mi><mi>s</mi></msub><mover><mi>y</mi><mo>&CenterDot;</mo></mover><mo>+</mo><mo>(</mo><mfrac><mi>&mu;</mi><msubsup><mi>r</mi><mi>c</mi><mn>3</mn></msubsup></mfrac><mo>-</mo><msup><msub><mi>&omega;</mi><mi>s</mi></msub><mn>2</mn></msup><mo>)</mo><mo>(</mo><mi>x</mi><mo>+</mo><msub><mi>r</mi><mi>s</mi></msub><mo>)</mo><mo>=</mo><msub><mi>f</mi><mi>x</mi></msub></mtd></mtr><mtr><mtd><mrow><mover><mi>y</mi><mo>&CenterDot;&CenterDot;</mo></mover><mo>+</mo><mn>2</mn><msub><mi>&omega;</mi><mi>s</mi></msub><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><msub><mi>&omega;</mi><mi>s</mi></msub><mn>2</mn></msup><mo>)</mo></mrow><mi>y</mi><mo>=</mo><msub><mi>f</mi><mi>y</mi></msub></mrow></mtd></mtr><mtr><mtd><mover><mi>z</mi><mo>&CenterDot;&CenterDot;</mo></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></mrow>]]></math><img file="FDA0000792468280000011.GIF" wi="674" he="479" /></maths>式中,x,y,z;<img file="FDA0000792468280000012.GIF" wi="224" he="78" />以及<img file="FDA0000792468280000013.GIF" wi="220" he="78" />分别为伴随星与参考星在轨道坐标系中的相对位置矢量,相对速度矢量和相对加速度矢量在相对运动坐标系的三轴投影;ω<sub>s</sub>为参考星的平均角速度<img file="FDA0000792468280000014.GIF" wi="277" he="98" />μ为地心引力常数,r<sub>s</sub>为参考星s沿近圆轨道运动的轨道半径,r<sub>c</sub>为伴随卫星到地心的距离;f<sub>x</sub>,f<sub>y</sub>和f<sub>z</sub>分别为两星除地心引力外的其他作用力的合力的加速度矢量之差在相对运动坐标系三轴的投影;二、建立编队卫星相对参考点的相对运动动力学模型:定义参考轨道坐标系即LVLH坐标系:x轴由地心指向参考点,y轴沿着参考点运行轨迹的切线方向,z轴垂直于参考轨道平面,三轴构成右手螺旋系;由参考星与伴随星的相对运动动力学方程,在考虑广义干扰的情况下,建立卫星编队系统的编队卫星i相对参考点的相对轨道动力学模型为:<maths num="0002" id="cmaths0002"><math><![CDATA[<mrow><mfenced open = "{" close = ""><mtable><mtr><mtd><msub><mover><mi>x</mi><mo>&CenterDot;&CenterDot;</mo></mover><mi>i</mi></msub><mo>-</mo><mn>2</mn><msub><mi>&omega;</mi><mn>0</mn></msub><msub><mover><mi>y</mi><mo>&CenterDot;</mo></mover><mi>i</mi></msub><mo>-</mo><msup><msub><mi>&omega;</mi><mn>0</mn></msub><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><mrow><mi>o</mi><mi>i</mi><mi>x</mi></mrow></msub><mo>+</mo><msub><mi>d</mi><mrow><mi>o</mi><mi>i</mi><mi>x</mi></mrow></msub></mrow><msub><mi>m</mi><mrow><mi>o</mi><mi>i</mi></mrow></msub></mfrac></mtd></mtr><mtr><mtd><mrow><msub><mover><mi>y</mi><mo>&CenterDot;&CenterDot;</mo></mover><mi>i</mi></msub><mo>+</mo><mn>2</mn><msub><mi>&omega;</mi><mn>0</mn></msub><msub><mover><mi>x</mi><mo>&CenterDot;</mo></mover><mi>i</mi></msub><mo>-</mo><msup><msub><mi>&omega;</mi><mn>0</mn></msub><mn>2</mn></msup><msub><mi>y</mi><mi>i</mi></msub><mo>+</mo><mfrac><mrow><msub><mi>&mu;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><mrow><mi>o</mi><mi>i</mi><mi>y</mi></mrow></msub><mo>+</mo><msub><mi>d</mi><mrow><mi>o</mi><mi>i</mi><mi>y</mi></mrow></msub></mrow><msub><mi>m</mi><mrow><mi>o</mi><mi>i</mi></mrow></msub></mfrac></mrow></mtd></mtr><mtr><mtd><msub><mover><mi>z</mi><mo>&CenterDot;&CenterDot;</mo></mover><mi>i</mi></msub><mo>+</mo><mfrac><mrow><msub><mi>&mu;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><mrow><mi>o</mi><mi>i</mi><mi>z</mi></mrow></msub><mo>+</mo><msub><mi>d</mi><mrow><mi>o</mi><mi>i</mi><mi>z</mi></mrow></msub></mrow><msub><mi>m</mi><mrow><mi>o</mi><mi>i</mi></mrow></msub></mfrac></mtd></mtr></mtable></mfenced><mo>,</mo></mrow>]]></math><img file="FDA0000792468280000021.GIF" wi="969" he="437" /></maths>式中:x,y,z;<img file="FDA0000792468280000022.GIF" wi="212" he="70" />以及<img file="FDA0000792468280000023.GIF" wi="208" he="71" />分别为编队卫星i相对参考点的相对位置矢量,相对速度矢量和相对加速度矢量在参考轨道坐标系的三个坐标轴的分量;ω<sub>0</sub>为参考点的平均角速度,<img file="FDA0000792468280000024.GIF" wi="297" he="95" />μ为地心引力常数,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上的控制输入,d<sub>oi</sub>=[d<sub>oix</sub> d<sub>oiy</sub> d<sub>oiz</sub>]<sup>T</sup>为加载在编队卫星i上的广义干扰,i=1,2,3,…,n;令p<sub>i</sub>=(x<sub>i</sub>,y<sub>i</sub>,z<sub>i</sub>)<sup>T</sup>,<maths num="0003" id="cmaths0003"><math><![CDATA[<mrow><msub><mi>C</mi><mrow><mi>o</mi><mi>i</mi></mrow></msub><mo>=</mo><mn>2</mn><msub><mi>m</mi><mrow><mi>o</mi><mi>i</mi></mrow></msub><mfenced open = "[" close = "]"><mtable><mtr><mtd><mn>0</mn></mtd><mtd><mrow><mo>-</mo><msub><mi>&omega;</mi><mn>0</mn></msub></mrow></mtd><mtd><mn>0</mn></mtd></mtr><mtr><mtd><msub><mi>&omega;</mi><mn>0</mn></msub></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="FDA0000792468280000025.GIF" wi="521" he="221" /></maths><maths num="0004" id="cmaths0004"><math><![CDATA[<mrow><msub><mi>g</mi><mrow><mi>o</mi><mi>i</mi></mrow></msub><mo>=</mo><msub><mi>m</mi><mrow><mi>o</mi><mi>i</mi></mrow></msub><mfenced open = "[" close = "]"><mtable><mtr><mtd><mrow><mo>-</mo><msup><msub><mi>&omega;</mi><mn>0</mn></msub><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></mrow></mtd></mtr><mtr><mtd><mrow><mo>-</mo><msup><msub><mi>&omega;</mi><mn>0</mn></msub><mn>2</mn></msup><msub><mi>y</mi><mi>i</mi></msub><mo>+</mo><msub><mi>&mu;y</mi><mi>i</mi></msub><mo>/</mo><msubsup><mi>R</mi><mi>i</mi><mn>3</mn></msubsup></mrow></mtd></mtr><mtr><mtd><mrow><msub><mi>&mu;z</mi><mi>i</mi></msub><mo>/</mo><msubsup><mi>R</mi><mi>i</mi><mn>3</mn></msubsup></mrow></mtd></mtr></mtable></mfenced><mo>;</mo></mrow>]]></math><img file="FDA0000792468280000026.GIF" wi="846" he="260" /></maths>卫星编队系统的编队卫星i相对参考点的相对轨道动力学模型简化为:<img file="FDA0000792468280000027.GIF" wi="578" he="70" />三、设计分布式有限时间跟踪控制律:基于步骤一和步骤二,结合图论的相关理论,设计分布式有限时间跟踪控制律;首先,定义如下辅助变量和误差函数:<maths num="0005" id="cmaths0005"><math><![CDATA[<mrow><msub><mi>p</mi><mrow><mi>&alpha;</mi><mi>i</mi></mrow></msub><mo>=</mo><msub><mi>p</mi><mi>i</mi></msub><mo>+</mo><msubsup><mi>&alpha;&Sigma;</mi><mrow><mi>j</mi><mo>=</mo><mn>0</mn></mrow><mi>n</mi></msubsup><msub><mi>a</mi><mrow><mi>i</mi><mi>j</mi></mrow></msub><mrow><mo>(</mo><msub><mi>p</mi><mi>i</mi></msub><mo>-</mo><msub><mi>p</mi><mi>j</mi></msub><mo>)</mo></mrow><mo>,</mo></mrow>]]></math><img file="FDA0000792468280000028.GIF" wi="621" he="93" /></maths><maths num="0006" id="cmaths0006"><math><![CDATA[<mrow><msub><mi>e</mi><mi>i</mi></msub><mo>=</mo><msub><mi>p</mi><mrow><mi>&alpha;</mi><mi>i</mi></mrow></msub><mo>-</mo><msub><mi>p</mi><mi>i</mi></msub><mo>=</mo><mo>-</mo><msubsup><mi>&alpha;&Sigma;</mi><mrow><mi>j</mi><mo>=</mo><mn>0</mn></mrow><mi>n</mi></msubsup><msub><mi>a</mi><mrow><mi>i</mi><mi>j</mi></mrow></msub><mrow><mo>(</mo><msub><mi>p</mi><mi>i</mi></msub><mo>-</mo><msub><mi>p</mi><mi>j</mi></msub><mo>)</mo></mrow><mo>,</mo></mrow>]]></math><img file="FDA0000792468280000029.GIF" wi="726" he="100" /></maths>其中:i=1,2,…,n;p<sub>i</sub>=(x<sub>i</sub>,y<sub>i</sub>,z<sub>i</sub>)<sup>T</sup>为编队卫星i相对参考点的相对位置矢量;a<sub>ij</sub>用于描述编队卫星i获取编队卫星j信息的情况,当编队卫星i能获得编队卫星j的信息时a<sub>ij</sub>=1否则a<sub>ij</sub>=0,α为待设计的参数且α&gt;0;p<sub>αi</sub>为辅助中间变量;e<sub>i</sub>为辅助跟踪误差变量;定义如下终端滑模变量:<maths num="0007" id="cmaths0007"><math><![CDATA[<mrow><mtable><mtr><mtd><mrow><msub><mi>s</mi><mi>i</mi></msub><mo>=</mo><msub><mover><mi>e</mi><mo>&CenterDot;</mo></mover><mi>i</mi></msub><mo>+</mo><msub><mi>&Lambda;</mi><mi>i</mi></msub><msubsup><mi>e</mi><mi>i</mi><msub><mi>p</mi><mi>s</mi></msub></msubsup></mrow></mtd></mtr><mtr><mtd><mrow><mo>=</mo><msub><mover><mi>p</mi><mo>&CenterDot;</mo></mover><mrow><mi>r</mi><mi>i</mi></mrow></msub><mo>-</mo><msub><mover><mi>p</mi><mo>&CenterDot;</mo></mover><mi>i</mi></msub></mrow></mtd></mtr></mtable><mo>,</mo><mi>i</mi><mo>=</mo><mn>1</mn><mo>,</mo><mn>2</mn><mo>,</mo><mn>...</mn><mo>,</mo><mi>n</mi><mo>,</mo></mrow>]]></math><img file="FDA00007924682800000210.GIF" wi="661" he="148" /></maths>其中Λ<sub>i</sub>与p<sub>s</sub>为待设计的参数,且满足<img file="FDA00007924682800000211.GIF" wi="358" he="77" />且<img file="FDA00007924682800000212.GIF" wi="310" he="70" />β与<img file="FDA00007924682800000213.GIF" wi="43" he="57" />均为正奇数;<img file="FDA00007924682800000214.GIF" wi="330" he="93" />为辅助中间变量;<maths num="0008" id="cmaths0008"><math><![CDATA[<mrow><msubsup><mi>e</mi><mi>i</mi><msub><mi>p</mi><mi>s</mi></msub></msubsup><mo>=</mo><msup><mfenced open = "[" close = "]"><mtable><mtr><mtd><msubsup><mi>e</mi><mrow><mi>i</mi><mn>1</mn></mrow><msub><mi>p</mi><mi>s</mi></msub></msubsup></mtd><mtd><msubsup><mi>e</mi><mrow><mi>i</mi><mn>2</mn></mrow><msub><mi>p</mi><mi>s</mi></msub></msubsup></mtd><mtd><msubsup><mi>e</mi><mrow><mi>i</mi><mn>3</mn></mrow><msub><mi>p</mi><mi>s</mi></msub></msubsup></mtd></mtr></mtable></mfenced><mi>T</mi></msup><mo>;</mo></mrow>]]></math><img file="FDA00007924682800000215.GIF" wi="592" he="102" /></maths>同时定义<img file="FDA0000792468280000031.GIF" wi="557" he="85" />分布式有限时间跟踪控制律如下:<maths num="0009" id="cmaths0009"><math><![CDATA[<mrow><msub><mi>&tau;</mi><mrow><mi>o</mi><mi>i</mi></mrow></msub><mo>=</mo><msubsup><mover><mi>w</mi><mo>^</mo></mover><mi>i</mi><mi>T</mi></msubsup><msub><mi>&Phi;</mi><mi>i</mi></msub><mrow><mo>(</mo><msub><mi>x</mi><mrow><mi>p</mi><mi>i</mi></mrow></msub><mo>)</mo></mrow><mo>+</mo><msub><mi>k</mi><mi>i</mi></msub><msubsup><mi>s</mi><mi>i</mi><mi>r</mi></msubsup><mo>+</mo><msub><mi>&sigma;</mi><mrow><mn>2</mn><mi>i</mi></mrow></msub><mi>s</mi><mi>i</mi><mi>g</mi><mi>n</mi><mrow><mo>(</mo><msub><mi>s</mi><mi>i</mi></msub><mo>)</mo></mrow><mo>+</mo><msub><mi>&sigma;</mi><mrow><mn>3</mn><mi>i</mi></mrow></msub><mi>s</mi><mi>i</mi><mi>g</mi><mi>n</mi><mrow><mo>(</mo><msub><mi>s</mi><mi>i</mi></msub><mo>)</mo></mrow><mo>,</mo><mi>i</mi><mo>=</mo><mn>1</mn><mo>,</mo><mn>2</mn><mo>,</mo><mo>...</mo><mo>,</mo><mi>n</mi><mo>,</mo></mrow>]]></math><img file="FDA0000792468280000032.GIF" wi="1275" he="85" /></maths><maths num="0010" id="cmaths0010"><math><![CDATA[<mrow><msub><mover><mover><mi>w</mi><mo>^</mo></mover><mo>&CenterDot;</mo></mover><mi>i</mi></msub><mo>=</mo><msub><mi>&Gamma;</mi><mi>i</mi></msub><msub><mi>&Phi;</mi><mi>i</mi></msub><mrow><mo>(</mo><msub><mi>x</mi><mrow><mi>p</mi><mi>i</mi></mrow></msub><mo>)</mo></mrow><msubsup><mi>s</mi><mi>i</mi><mi>T</mi></msubsup><mo>,</mo></mrow>]]></math><img file="FDA0000792468280000033.GIF" wi="362" he="87" /></maths>其中:<img file="FDA0000792468280000034.GIF" wi="215" he="91" />为神经网络逼近系统,<img file="FDA0000792468280000035.GIF" wi="63" he="74" />为神经网络逼近的权值矩阵,Φ<sub>i</sub>(x<sub>pi</sub>)为神经网络激活函数,k<sub>i</sub>为正定对角矩阵,σ<sub>2i</sub>用于抵消广义干扰的影响且σ<sub>2i</sub>&gt;0,Γ<sub>i</sub>和σ<sub>3i</sub>均为正常数,且<img file="FDA0000792468280000036.GIF" wi="392" he="103" />r=r<sub>1</sub>/r<sub>2</sub>,且r<sub>1</sub>和r<sub>2</sub>均为正奇数,且满足r<sub>2</sub>&gt;r<sub>1</sub>,sign(·)表示符号函数,||·||<sub>F</sub>表示求F‑范数。
地址 150001 黑龙江省哈尔滨市南岗区西大直街92号
您可能感兴趣的专利