主权项 |
一种星上相对运动状态获取方法,其特征在于包括如下步骤:1)建立目标卫星轨道坐标系目标卫星轨道坐标系定义为(O‑X<sub>o</sub>Y<sub>o</sub>Z<sub>o</sub>):坐标原点位于目标卫星质心,Z轴在目标卫星轨道平面内由目标卫星质心指向地心;Y轴垂直轨道平面,指向轨道平面负法线,与轨道动量矩矢量<img file="FDA0000664908800000011.GIF" wi="49" he="69" />方向相反;X轴与Y、Z轴构成右手螺旋,指向卫星飞向方向;将两星的相对状态表述在目标卫星轨道坐标系下,定义两星相对位置、速度矢量在目标卫星轨道坐标系表示为<img file="FDA0000664908800000012.GIF" wi="358" he="235" /><img file="FDA0000664908800000013.GIF" wi="378" he="235" />2)在卫星轨道坐标系中求解C‑W方程解析解用C‑W方程描述两星相对运动动力学方程,则C‑W方程在目标卫星轨道坐标系中为:<maths num="0001" id="cmaths0001"><math><![CDATA[<mrow><mfenced open='{' close=''><mtable><mtr><mtd><mover><mi>x</mi><mrow><mo>·</mo><mo>·</mo></mrow></mover><mo>-</mo><mn>2</mn><mi>ω</mi><mover><mi>z</mi><mo>·</mo></mover><mo>=</mo><msub><mi>a</mi><mi>x</mi></msub></mtd></mtr><mtr><mtd><mover><mi>y</mi><mrow><mo>·</mo><mo>·</mo></mrow></mover><mo>+</mo><msup><mi>ω</mi><mn>2</mn></msup><mi>y</mi><mo>=</mo><msub><mi>a</mi><mi>y</mi></msub></mtd></mtr><mtr><mtd><mover><mi>z</mi><mrow><mo>·</mo><mo>·</mo></mrow></mover><mo>-</mo><mn>3</mn><msup><mi>ω</mi><mn>2</mn></msup><mi>z</mi><mo>+</mo><mn>2</mn><mi>ω</mi><mover><mi>x</mi><mo>·</mo></mover><mo>=</mo><msub><mi>a</mi><mi>z</mi></msub></mtd></mtr></mtable></mfenced><mo>;</mo><mo>-</mo><mo>-</mo><mo>-</mo><mrow><mo>(</mo><mn>1</mn><mo>)</mo></mrow></mrow>]]></math><img file="FDA0000664908800000014.GIF" wi="1595" he="233" /></maths>其中ω为目标卫星轨道角速度,a<sub>x</sub>、a<sub>y</sub>、a<sub>z</sub>为各轴施加的控制力,<img file="FDA0000664908800000015.GIF" wi="214" he="66" />为相对位置矢量在目标卫星轨道坐标系分量对时间的一阶导数,<img file="FDA0000664908800000016.GIF" wi="222" he="69" />为相对位置矢量在目标卫星轨道坐标系分量对时间的二阶导数;当目标卫星不作机动飞行时,即a<sub>x</sub>=a<sub>y</sub>=a<sub>z</sub>=0,已知t<sub>0</sub>时刻两星的相对位置(x<sub>0</sub>,y<sub>0</sub>,z<sub>0</sub>)和相对速度<img file="FDA0000664908800000017.GIF" wi="354" he="84" />令<maths num="0002" id="cmaths0002"><math><![CDATA[<mrow><msub><mi>ϵ</mi><mn>0</mn></msub><mo>=</mo><msub><mi>x</mi><mn>0</mn></msub><mo>+</mo><mfrac><mn>2</mn><mi>ω</mi></mfrac><msub><mover><mi>z</mi><mo>·</mo></mover><mn>0</mn></msub><mo>,</mo></mrow>]]></math><img file="FDA0000664908800000018.GIF" wi="308" he="133" /></maths><maths num="0003" id="cmaths0003"><math><![CDATA[<mrow><mi>σ</mi><mo>=</mo><mn>6</mn><mi>ω</mi><msub><mi>z</mi><mn>0</mn></msub><mo>-</mo><mn>3</mn><msub><mover><mi>x</mi><mo>·</mo></mover><mn>0</mn></msub><mo>,</mo></mrow>]]></math><img file="FDA0000664908800000019.GIF" wi="339" he="76" /></maths><maths num="0004" id="cmaths0004"><math><![CDATA[<mrow><mi>c</mi><mo>=</mo><mfrac><msub><mover><mi>z</mi><mo>·</mo></mover><mn>0</mn></msub><mi>ω</mi></mfrac><mo>,</mo></mrow>]]></math><img file="FDA00006649088000000110.GIF" wi="171" he="128" /></maths><img file="FDA00006649088000000111.GIF" wi="324" he="131" /><img file="FDA00006649088000000112.GIF" wi="179" he="133" />k=y<sub>0</sub>,则C‑W方程解析解表示为<maths num="0005" id="cmaths0005"><math><![CDATA[<mrow><mfenced open='{' close=''><mtable><mtr></mtr><mtr><mtd><msub><mi>x</mi><mi>t</mi></msub><mo>=</mo><msub><mi>ϵ</mi><mn>0</mn></msub><mo>+</mo><mi>στ</mi><mo>+</mo><mn>2</mn><mi>d</mi><mi>sin</mi><mi>ωτ</mi><mo>-</mo><mn>2</mn><mi>c</mi><mi>cos</mi><mi>ωτ</mi></mtd></mtr><mtr><mtd><msub><mi>y</mi><mi>t</mi></msub><mo>=</mo><mi>h</mi><mi>sin</mi><mi>ωτ</mi><mo>+</mo><mi>k</mi><mi>cos</mi><mi>ωτ</mi></mtd></mtr><mtr><mtd><msub><mi>z</mi><mi>t</mi></msub><mo>=</mo><mfrac><mi>σ</mi><mrow><mn>3</mn><mi>ω</mi></mrow></mfrac><mo>+</mo><mi>c</mi><mi>sin</mi><mi>ωτ</mi><mo>+</mo><mi>d</mi><mi>cos</mi><mi>ωτ</mi></mtd></mtr></mtable></mfenced><mo>;</mo><mo>-</mo><mo>-</mo><mo>-</mo><mrow><mo>(</mo><mn>2</mn><mo>)</mo></mrow></mrow>]]></math><img file="FDA0000664908800000021.GIF" wi="1839" he="356" /></maths><maths num="0006" id="cmaths0006"><math><![CDATA[<mrow><mfenced open='{' close=''><mtable><mtr><mtd><msub><mover><mi>x</mi><mo>·</mo></mover><mi>t</mi></msub><mo>=</mo><mi>σ</mi><mo>+</mo><mn>2</mn><mi>dω</mi><mi>cos</mi><mi>ωτ</mi><mo>+</mo><mn>2</mn><mi>cω</mi><mi>sin</mi><mi>ωτ</mi></mtd></mtr><mtr><mtd><msub><mover><mi>y</mi><mo>·</mo></mover><mi>t</mi></msub><mo>=</mo><mi>hω</mi><mi>cos</mi><mi>ωτ</mi><mo>-</mo><mi>kω</mi><mi>sin</mi><mi>ωτ</mi></mtd></mtr><mtr><mtd><msub><mover><mi>z</mi><mo>·</mo></mover><mi>t</mi></msub><mo>=</mo><mi>cω</mi><mi>cos</mi><mi>ωτ</mi><mo>-</mo><mi>dω</mi><mi>sin</mi><mi>ωτ</mi></mtd></mtr></mtable></mfenced><mo>;</mo><mo>-</mo><mo>-</mo><mo>-</mo><mrow><mo>(</mo><mn>3</mn><mo>)</mo></mrow></mrow>]]></math><img file="FDA0000664908800000022.GIF" wi="1833" he="237" /></maths>其中τ=t‑t<sub>0</sub>,(x<sub>t</sub>,y<sub>t</sub>,z<sub>t</sub>)表示t时刻两星的相对位置,<img file="FDA0000664908800000023.GIF" wi="325" he="84" />表示t时刻两星的相对速度;3)建立最小二乘拟合量测方程将系数ε<sub>0</sub>,σ,c,d,h,k作为状态量,将从相对导航敏感器获取的相对位置<img file="FDA0000664908800000024.GIF" wi="181" he="237" />作为测量量,则t<sub>i</sub>时刻C-W拟合相对运动预报的测量方程表示为p<sub>i</sub>=Ψ<sub>i</sub>X; (4)<maths num="0007" id="cmaths0007"><math><![CDATA[<mrow><msub><mi>p</mi><mi>i</mi></msub><mo>=</mo><mfenced open='(' close=')'><mtable><mtr><mtd><msub><mi>x</mi><mi>i</mi></msub></mtd></mtr><mtr><mtd><msub><mi>y</mi><mi>i</mi></msub></mtd></mtr><mtr><mtd><msub><mi>z</mi><mi>i</mi></msub></mtd></mtr></mtable></mfenced><mo>,</mo></mrow>]]></math><img file="FDA0000664908800000025.GIF" wi="226" he="241" /></maths><maths num="0008" id="cmaths0008"><math><![CDATA[<mrow><msub><mi>Ψ</mi><mi>i</mi></msub><mo>=</mo><mfenced open='(' close=')'><mtable><mtr></mtr><mtr><mtd><mn>1</mn></mtd><mtd><msub><mi>τ</mi><mi>i</mi></msub></mtd><mtd><mn>0</mn></mtd><mtd><mn>0</mn></mtd><mtd><mo>-</mo><mn>2</mn><mi>cos</mi><mi>ω</mi><msub><mi>τ</mi><mi>i</mi></msub></mtd><mtd><mn>2</mn><mi>sin</mi><mi>ω</mi><msub><mi>τ</mi><mi>i</mi></msub></mtd></mtr><mtr><mtd><mn>0</mn></mtd><mtd><mn>0</mn></mtd><mtd><mi>sin</mi><mi>ω</mi><msub><mi>τ</mi><mi>i</mi></msub></mtd><mtd><mi>cos</mi><mi>ω</mi><msub><mi>τ</mi><mi>i</mi></msub></mtd><mtd><mn>0</mn></mtd><mtd><mn>0</mn></mtd></mtr><mtr><mtd><mn>0</mn></mtd><mtd><mfrac><mn>2</mn><mrow><mn>3</mn><mi>ω</mi></mrow></mfrac></mtd><mtd><mn>0</mn></mtd><mtd><mn>0</mn></mtd><mtd><mi>sin</mi><mi>ω</mi><msub><mi>τ</mi><mi>i</mi></msub></mtd><mtd><mi>cos</mi><mi>ω</mi><msub><mi>τ</mi><mi>i</mi></msub></mtd></mtr></mtable></mfenced><mo>,</mo></mrow>]]></math><img file="FDA0000664908800000026.GIF" wi="1204" he="355" /></maths><maths num="0009" id="cmaths0009"><math><![CDATA[<mrow><mi>X</mi><mo>=</mo><mfenced open='(' close=')'><mtable><mtr><mtd><msub><mi>ϵ</mi><mn>0</mn></msub></mtd></mtr><mtr><mtd><mi>σ</mi></mtd></mtr><mtr><mtd><mi>h</mi></mtd></mtr><mtr><mtd><mi>k</mi></mtd></mtr><mtr><mtd><mi>c</mi></mtd></mtr><mtr><mtd><mi>d</mi></mtd></mtr></mtable></mfenced><mo>;</mo></mrow>]]></math><img file="FDA0000664908800000027.GIF" wi="226" he="457" /></maths>若有l个t<sub>i</sub>时刻的相对位置测量量,则总的C-W拟合相对运动预报的测量方程可以表示为P=ΦX; (5)<maths num="0010" id="cmaths0010"><math><![CDATA[<mrow><mi>P</mi><mo>=</mo><mfenced open='(' close=')'><mtable><mtr><mtd><msub><mi>p</mi><mn>1</mn></msub></mtd></mtr><mtr><mtd><mo>·</mo></mtd></mtr><mtr><mtd><mo>·</mo></mtd></mtr><mtr><mtd><mo>·</mo></mtd></mtr><mtr><mtd><msub><mi>p</mi><mi>i</mi></msub></mtd></mtr></mtable></mfenced><mo>,</mo><mi>Φ</mi><mo>=</mo><mfenced open='(' close=')'><mtable><mtr><mtd><msub><mi>ψ</mi><mn>1</mn></msub></mtd></mtr><mtr><mtd><mo>·</mo></mtd></mtr><mtr><mtd><mo>·</mo></mtd></mtr><mtr><mtd><mo>·</mo></mtd></mtr><mtr><mtd><msub><mi>ψ</mi><mi>i</mi></msub></mtd></mtr></mtable></mfenced><mo>,</mo><mi>i</mi><mo>=</mo><mn>0</mn><mo>,</mo><mo>·</mo><mo>·</mo><mo>·</mo><mo>,</mo><mi>l</mi><mo>-</mo><mn>1</mn><mrow><mo>(</mo><mi>l</mi><mo>></mo><mn>2</mn><mo>)</mo></mrow><mo>;</mo></mrow>]]></math><img file="FDA0000664908800000028.GIF" wi="1078" he="237" /></maths>4)求解拟合C‑W解系数根据最小二乘求解方法,则方程式(5)的解为X=(Φ<sup>T</sup>Φ)<sup>‑1</sup>Φ<sup>T</sup>P; (6)5)求解拟合C‑W解通过(6)式精确求解X后,则拟合C‑W解为<maths num="0011" id="cmaths0011"><math><![CDATA[<mrow><mfenced open='(' close=')'><mtable><mtr><mtd><msub><mi>x</mi><mi>t</mi></msub></mtd></mtr><mtr><mtd><msub><mi>y</mi><mi>t</mi></msub></mtd></mtr><mtr><mtd><msub><mi>z</mi><mi>t</mi></msub></mtd></mtr><mtr><mtd><msub><mover><mi>x</mi><mo>·</mo></mover><mi>t</mi></msub></mtd></mtr><mtr><mtd><msub><mover><mi>y</mi><mo>·</mo></mover><mi>t</mi></msub></mtd></mtr><mtr><mtd><msub><mover><mi>z</mi><mo>·</mo></mover><mi>t</mi></msub></mtd></mtr></mtable></mfenced><mo>=</mo><mfenced open='{' close='}'><mtable><mtr><mtd><mn>1</mn></mtd><mtd><mi>τ</mi></mtd><mtd><mn>0</mn></mtd><mtd><mn>0</mn></mtd><mtd><mo>-</mo><mn>2</mn><mi>cos</mi><mi>ωτ</mi></mtd><mtd><mn>2</mn><mi>sin</mi><mi>ωτ</mi></mtd></mtr><mtr><mtd><mn>0</mn></mtd><mtd><mn>0</mn></mtd><mtd><mi>sin</mi><mi>ωτ</mi></mtd><mtd><mi>cos</mi><mi>ωτ</mi></mtd><mtd><mn>0</mn></mtd><mtd><mn>0</mn></mtd></mtr><mtr><mtd><mn>0</mn></mtd><mtd><mfrac><mn>2</mn><mrow><mn>3</mn><mi>ω</mi></mrow></mfrac></mtd><mtd><mn>0</mn></mtd><mtd><mn>0</mn></mtd><mtd><mi>sin</mi><mi>ωτ</mi></mtd><mtd><mi>cos</mi><mi>ωτ</mi></mtd></mtr><mtr><mtd><mn>0</mn></mtd><mtd><mn>1</mn></mtd><mtd><mn>0</mn></mtd><mtd><mn>0</mn></mtd><mtd><mn>2</mn><mi>ω</mi><mi>sin</mi><mi>ωτ</mi></mtd><mtd><mn>2</mn><mi>ω</mi><mi>cos</mi><mi>ωτ</mi></mtd></mtr><mtr><mtd><mn>0</mn></mtd><mtd><mn>0</mn></mtd><mtd><mi>ω</mi><mi>cos</mi><mi>ωτ</mi></mtd><mtd><mo>-</mo><mi>ω</mi><mi>sin</mi><mi>ωτ</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><mtd><mn>0</mn></mtd><mtd><mi>ω</mi><mi>cos</mi><mi>ωτ</mi></mtd><mtd><mo>-</mo><mi>ω</mi><mi>sin</mi><mi>ωτ</mi></mtd></mtr></mtable></mfenced><mo>·</mo><mi>X</mi><mo>-</mo><mo>-</mo><mo>-</mo><mrow><mo>(</mo><mn>7</mn><mo>)</mo></mrow></mrow>]]></math><img file="FDA0000664908800000031.GIF" wi="1780" he="517" /></maths>6)根据当前时刻t,则τ=t‑t<sub>0</sub>,将τ和目标卫星轨道角速度ω带入公式(7),获得t时刻两星的相对运动状态;所述的目标卫星轨道角速度ω在编队飞行中由地面定轨或自主绝对导航给出。 |