发明名称 一种星上相对运动状态获取方法
摘要 本发明公开了一种星上相对运动状态获取方法,首先根据C-W方程得出其解析解,以C-W方程解析解与时间无关的量作为未知量,将相对测量敏感器测量精度较高的相对位置作为测量量,通过最小二乘拟合的方法拟合求解与时间无关未知量,得到代表两星实际相对运动情况的相对运动状态高精度长时间预报解(简称拟合C-W解)。这种方法的好处是拟合C-W解预报结果受精度较高的实际测量量的约束,反映了两星实际相对运动状态,克服了C-W方程解析解的局限性,而且预报精度较高,解决了相对测量敏感器间歇不可用情况下高精度相对导航和星上长时间相对运动状态预报问题,具有较强的工程实践性。
申请公布号 CN104765373A 申请公布日期 2015.07.08
申请号 CN201510051446.1 申请日期 2015.01.30
申请人 北京控制工程研究所 发明人 李克行;苟兴宇;张斌;何英姿;魏春岭;白旭辉;董筠;汤亮;朱志斌
分类号 G05D1/10(2006.01)I 主分类号 G05D1/10(2006.01)I
代理机构 中国航天科技专利中心 11009 代理人 安丽
主权项 一种星上相对运动状态获取方法,其特征在于包括如下步骤: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>&CenterDot;</mo><mo>&CenterDot;</mo></mrow></mover><mo>-</mo><mn>2</mn><mi>&omega;</mi><mover><mi>z</mi><mo>&CenterDot;</mo></mover><mo>=</mo><msub><mi>a</mi><mi>x</mi></msub></mtd></mtr><mtr><mtd><mover><mi>y</mi><mrow><mo>&CenterDot;</mo><mo>&CenterDot;</mo></mrow></mover><mo>+</mo><msup><mi>&omega;</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>&CenterDot;</mo><mo>&CenterDot;</mo></mrow></mover><mo>-</mo><mn>3</mn><msup><mi>&omega;</mi><mn>2</mn></msup><mi>z</mi><mo>+</mo><mn>2</mn><mi>&omega;</mi><mover><mi>x</mi><mo>&CenterDot;</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>&epsiv;</mi><mn>0</mn></msub><mo>=</mo><msub><mi>x</mi><mn>0</mn></msub><mo>+</mo><mfrac><mn>2</mn><mi>&omega;</mi></mfrac><msub><mover><mi>z</mi><mo>&CenterDot;</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>&sigma;</mi><mo>=</mo><mn>6</mn><mi>&omega;</mi><msub><mi>z</mi><mn>0</mn></msub><mo>-</mo><mn>3</mn><msub><mover><mi>x</mi><mo>&CenterDot;</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>&CenterDot;</mo></mover><mn>0</mn></msub><mi>&omega;</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>&epsiv;</mi><mn>0</mn></msub><mo>+</mo><mi>&sigma;&tau;</mi><mo>+</mo><mn>2</mn><mi>d</mi><mi>sin</mi><mi>&omega;&tau;</mi><mo>-</mo><mn>2</mn><mi>c</mi><mi>cos</mi><mi>&omega;&tau;</mi></mtd></mtr><mtr><mtd><msub><mi>y</mi><mi>t</mi></msub><mo>=</mo><mi>h</mi><mi>sin</mi><mi>&omega;&tau;</mi><mo>+</mo><mi>k</mi><mi>cos</mi><mi>&omega;&tau;</mi></mtd></mtr><mtr><mtd><msub><mi>z</mi><mi>t</mi></msub><mo>=</mo><mfrac><mi>&sigma;</mi><mrow><mn>3</mn><mi>&omega;</mi></mrow></mfrac><mo>+</mo><mi>c</mi><mi>sin</mi><mi>&omega;&tau;</mi><mo>+</mo><mi>d</mi><mi>cos</mi><mi>&omega;&tau;</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>&CenterDot;</mo></mover><mi>t</mi></msub><mo>=</mo><mi>&sigma;</mi><mo>+</mo><mn>2</mn><mi>d&omega;</mi><mi>cos</mi><mi>&omega;&tau;</mi><mo>+</mo><mn>2</mn><mi>c&omega;</mi><mi>sin</mi><mi>&omega;&tau;</mi></mtd></mtr><mtr><mtd><msub><mover><mi>y</mi><mo>&CenterDot;</mo></mover><mi>t</mi></msub><mo>=</mo><mi>h&omega;</mi><mi>cos</mi><mi>&omega;&tau;</mi><mo>-</mo><mi>k&omega;</mi><mi>sin</mi><mi>&omega;&tau;</mi></mtd></mtr><mtr><mtd><msub><mover><mi>z</mi><mo>&CenterDot;</mo></mover><mi>t</mi></msub><mo>=</mo><mi>c&omega;</mi><mi>cos</mi><mi>&omega;&tau;</mi><mo>-</mo><mi>d&omega;</mi><mi>sin</mi><mi>&omega;&tau;</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>&Psi;</mi><mi>i</mi></msub><mo>=</mo><mfenced open='(' close=')'><mtable><mtr></mtr><mtr><mtd><mn>1</mn></mtd><mtd><msub><mi>&tau;</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>&omega;</mi><msub><mi>&tau;</mi><mi>i</mi></msub></mtd><mtd><mn>2</mn><mi>sin</mi><mi>&omega;</mi><msub><mi>&tau;</mi><mi>i</mi></msub></mtd></mtr><mtr><mtd><mn>0</mn></mtd><mtd><mn>0</mn></mtd><mtd><mi>sin</mi><mi>&omega;</mi><msub><mi>&tau;</mi><mi>i</mi></msub></mtd><mtd><mi>cos</mi><mi>&omega;</mi><msub><mi>&tau;</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>&omega;</mi></mrow></mfrac></mtd><mtd><mn>0</mn></mtd><mtd><mn>0</mn></mtd><mtd><mi>sin</mi><mi>&omega;</mi><msub><mi>&tau;</mi><mi>i</mi></msub></mtd><mtd><mi>cos</mi><mi>&omega;</mi><msub><mi>&tau;</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>&epsiv;</mi><mn>0</mn></msub></mtd></mtr><mtr><mtd><mi>&sigma;</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>&CenterDot;</mo></mtd></mtr><mtr><mtd><mo>&CenterDot;</mo></mtd></mtr><mtr><mtd><mo>&CenterDot;</mo></mtd></mtr><mtr><mtd><msub><mi>p</mi><mi>i</mi></msub></mtd></mtr></mtable></mfenced><mo>,</mo><mi>&Phi;</mi><mo>=</mo><mfenced open='(' close=')'><mtable><mtr><mtd><msub><mi>&psi;</mi><mn>1</mn></msub></mtd></mtr><mtr><mtd><mo>&CenterDot;</mo></mtd></mtr><mtr><mtd><mo>&CenterDot;</mo></mtd></mtr><mtr><mtd><mo>&CenterDot;</mo></mtd></mtr><mtr><mtd><msub><mi>&psi;</mi><mi>i</mi></msub></mtd></mtr></mtable></mfenced><mo>,</mo><mi>i</mi><mo>=</mo><mn>0</mn><mo>,</mo><mo>&CenterDot;</mo><mo>&CenterDot;</mo><mo>&CenterDot;</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>&CenterDot;</mo></mover><mi>t</mi></msub></mtd></mtr><mtr><mtd><msub><mover><mi>y</mi><mo>&CenterDot;</mo></mover><mi>t</mi></msub></mtd></mtr><mtr><mtd><msub><mover><mi>z</mi><mo>&CenterDot;</mo></mover><mi>t</mi></msub></mtd></mtr></mtable></mfenced><mo>=</mo><mfenced open='{' close='}'><mtable><mtr><mtd><mn>1</mn></mtd><mtd><mi>&tau;</mi></mtd><mtd><mn>0</mn></mtd><mtd><mn>0</mn></mtd><mtd><mo>-</mo><mn>2</mn><mi>cos</mi><mi>&omega;&tau;</mi></mtd><mtd><mn>2</mn><mi>sin</mi><mi>&omega;&tau;</mi></mtd></mtr><mtr><mtd><mn>0</mn></mtd><mtd><mn>0</mn></mtd><mtd><mi>sin</mi><mi>&omega;&tau;</mi></mtd><mtd><mi>cos</mi><mi>&omega;&tau;</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>&omega;</mi></mrow></mfrac></mtd><mtd><mn>0</mn></mtd><mtd><mn>0</mn></mtd><mtd><mi>sin</mi><mi>&omega;&tau;</mi></mtd><mtd><mi>cos</mi><mi>&omega;&tau;</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>&omega;</mi><mi>sin</mi><mi>&omega;&tau;</mi></mtd><mtd><mn>2</mn><mi>&omega;</mi><mi>cos</mi><mi>&omega;&tau;</mi></mtd></mtr><mtr><mtd><mn>0</mn></mtd><mtd><mn>0</mn></mtd><mtd><mi>&omega;</mi><mi>cos</mi><mi>&omega;&tau;</mi></mtd><mtd><mo>-</mo><mi>&omega;</mi><mi>sin</mi><mi>&omega;&tau;</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>&omega;</mi><mi>cos</mi><mi>&omega;&tau;</mi></mtd><mtd><mo>-</mo><mi>&omega;</mi><mi>sin</mi><mi>&omega;&tau;</mi></mtd></mtr></mtable></mfenced><mo>&CenterDot;</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时刻两星的相对运动状态;所述的目标卫星轨道角速度ω在编队飞行中由地面定轨或自主绝对导航给出。
地址 100080 北京市海淀区北京2729信箱