发明名称 空间飞行器主动段轨道估计方法
摘要 本发明提出了空间飞行器主动段轨道估计方法,所述方法利用北斗卫星获取目标空间飞行器在主动段初始位置信息,建立目标空间飞行器主动段简化运动方程与分解方程,从而建立其空间飞行器运行轨道的运动方程模型和基于三阶多项式表示的空间飞行器运行轨道的估计模型;对所建立的轨道的估计模型进行求解,得出目标空间飞行器在主动段各个时间点的估计位置和估计速度。本发明能对主动段的空间飞行器进行更精确、更可靠、更自主地轨道估计,能为判断目标空间飞行器的类别与飞行意图提供更好的信息基础,该方法简单易行,实用性极强。
申请公布号 CN103226660B 申请公布日期 2016.05.04
申请号 CN201310142716.0 申请日期 2013.04.23
申请人 南京航空航天大学 发明人 李洁;蒋雪峰;王正盛
分类号 G06F19/00(2011.01)I 主分类号 G06F19/00(2011.01)I
代理机构 南京经纬专利商标代理有限公司 32200 代理人 朱小兵
主权项 一种空间飞行器主动段轨道估计方法,其特征在于,包括如下步骤:步骤A,利用北斗卫星获取目标空间飞行器在主动段飞行一段时间内在基础坐标系下的初始位置信息;步骤B,根据变质量质点的动力学,建立目标空间飞行器在基础坐标系下的主动段的简化运动方程:<maths num="0001" id="cmaths0001"><math><![CDATA[<mfenced open = "{" close = ""><mtable><mtr><mtd><mrow><msub><mover><mover><mi>r</mi><mo>&RightArrow;</mo></mover><mo>&CenterDot;&CenterDot;</mo></mover><mi>c</mi></msub><mrow><mo>(</mo><mi>t</mi><mo>)</mo></mrow><mo>=</mo><msub><mover><mi>F</mi><mo>&RightArrow;</mo></mover><mi>e</mi></msub><mo>+</mo><msub><mover><mi>F</mi><mo>&RightArrow;</mo></mover><mi>T</mi></msub><mo>=</mo><mo>-</mo><mfrac><msub><mi>G</mi><mi>m</mi></msub><mrow><mo>|</mo><msub><mover><mi>r</mi><mo>&RightArrow;</mo></mover><mi>c</mi></msub><mrow><mo>(</mo><mi>t</mi><mo>)</mo></mrow><msup><mo>|</mo><mn>3</mn></msup></mrow></mfrac><msub><mover><mi>r</mi><mo>&RightArrow;</mo></mover><mi>c</mi></msub><mrow><mo>(</mo><mi>t</mi><mo>)</mo></mrow><mo>+</mo><msub><mover><mi>v</mi><mo>&RightArrow;</mo></mover><mi>r</mi></msub><mrow><mo>(</mo><mi>t</mi><mo>)</mo></mrow><mfrac><mrow><mover><mi>m</mi><mo>&CenterDot;</mo></mover><mrow><mo>(</mo><mi>t</mi><mo>)</mo></mrow></mrow><mrow><mi>m</mi><mrow><mo>(</mo><mi>t</mi><mo>)</mo></mrow></mrow></mfrac></mrow></mtd></mtr><mtr><mtd><mrow><msub><mi>r</mi><mi>c</mi></msub><mrow><mo>(</mo><mi>t</mi><mo>)</mo></mrow><mo>=</mo><msqrt><mrow><msubsup><mi>x</mi><mi>c</mi><mn>2</mn></msubsup><mrow><mo>(</mo><mi>t</mi><mo>)</mo></mrow><mo>+</mo><msubsup><mi>y</mi><mi>c</mi><mn>2</mn></msubsup><mrow><mo>(</mo><mi>t</mi><mo>)</mo></mrow><mo>+</mo><msubsup><mi>z</mi><mi>c</mi><mn>2</mn></msubsup><mrow><mo>(</mo><mi>t</mi><mo>)</mo></mrow></mrow></msqrt></mrow></mtd></mtr><mtr><mtd><mrow><msub><mi>G</mi><mi>m</mi></msub><mo>=</mo><mn>3.986005</mn><mo>&times;</mo><msup><mn>10</mn><mn>14</mn></msup></mrow></mtd></mtr></mtable></mfenced>]]></math><img file="FDA0000827145380000011.GIF" wi="758" he="407" /></maths>其中,向量<img file="FDA0000827145380000012.GIF" wi="48" he="77" />表示空间飞行器所受的外力加速度之和,<img file="FDA0000827145380000013.GIF" wi="55" he="86" />表示火箭产生的推力加速度,m(t)为瞬时质量;<img file="FDA0000827145380000014.GIF" wi="100" he="71" />是质量变化率;<img file="FDA0000827145380000015.GIF" wi="100" he="71" />为空间飞行器在基础坐标系下的位置矢量;r<sub>c</sub>(t)为<img file="FDA0000827145380000016.GIF" wi="96" he="71" />的绝对值<img file="FDA0000827145380000017.GIF" wi="151" he="71" />表示空间飞行器在基础坐标系下到坐标原点的距离;<img file="FDA0000827145380000018.GIF" wi="100" he="78" />表示<img file="FDA0000827145380000019.GIF" wi="94" he="71" />对时间t的二阶导数,即加速度;<img file="FDA00008271453800000110.GIF" wi="104" he="70" />是燃料相对于火箭尾部喷口的喷射速度,G<sub>m</sub>为地球引力常数,x<sub>c</sub>(t)、y<sub>c</sub>(t)、z<sub>c</sub>(t)为t时刻目标空间飞行器在基础坐标系下的位置;步骤C,将目标空间飞行器的简化运动方程进行分解,分解为以下方程组:<maths num="0002" id="cmaths0002"><math><![CDATA[<mfenced open = "{" close = ""><mtable><mtr><mtd><mfrac><mi>d</mi><mrow><mi>d</mi><mi>t</mi></mrow></mfrac><mfenced open = "[" close = "]"><mtable><mtr><mtd><msub><mover><mi>x</mi><mo>&CenterDot;</mo></mover><mi>c</mi></msub><mo>(</mo><mi>t</mi><mo>)</mo></mtd></mtr><mtr><mtd><msub><mover><mi>y</mi><mo>&CenterDot;</mo></mover><mi>c</mi></msub><mo>(</mo><mi>t</mi><mo>)</mo></mtd></mtr><mtr><mtd><msub><mover><mi>z</mi><mo>&CenterDot;</mo></mover><mi>c</mi></msub><mo>(</mo><mi>t</mi><mo>)</mo></mtd></mtr></mtable></mfenced><mo>=</mo><msub><mover><mi>F</mi><mo>&RightArrow;</mo></mover><mi>e</mi></msub><mo>+</mo><msub><mover><mi>F</mi><mo>&RightArrow;</mo></mover><mi>T</mi></msub></mtd></mtr><mtr><mtd><mrow><mfrac><mi>d</mi><mrow><mi>d</mi><mi>t</mi></mrow></mfrac><mfenced open = "[" close = "]"><mtable><mtr><mtd><msub><mi>x</mi><mi>c</mi></msub><mo>(</mo><mi>t</mi><mo>)</mo></mtd></mtr><mtr><mtd><msub><mi>y</mi><mi>c</mi></msub><mo>(</mo><mi>t</mi><mo>)</mo></mtd></mtr><mtr><mtd><msub><mi>z</mi><mi>c</mi></msub><mo>(</mo><mi>t</mi><mo>)</mo></mtd></mtr></mtable></mfenced><mo>=</mo><mfenced open = "[" close = "]"><mtable><mtr><mtd><msub><mover><mi>x</mi><mo>&CenterDot;</mo></mover><mi>c</mi></msub><mo>(</mo><mi>t</mi><mo>)</mo></mtd></mtr><mtr><mtd><msub><mover><mi>y</mi><mo>&CenterDot;</mo></mover><mi>c</mi></msub><mo>(</mo><mi>t</mi><mo>)</mo></mtd></mtr><mtr><mtd><msub><mover><mi>z</mi><mo>&CenterDot;</mo></mover><mi>c</mi></msub><mo>(</mo><mi>t</mi><mo>)</mo></mtd></mtr></mtable></mfenced></mrow></mtd></mtr></mtable></mfenced>]]></math><img file="FDA00008271453800000111.GIF" wi="436" he="471" /></maths>其中,<img file="FDA00008271453800000112.GIF" wi="421" he="71" />为t时刻目标空间飞行器在基础坐标系下的速度;步骤D,取m(t)为严格单调递减的非负函数,则选取m(t)模型为:<maths num="0003" id="cmaths0003"><math><![CDATA[<mrow><mi>m</mi><mrow><mo>(</mo><mi>t</mi><mo>)</mo></mrow><mo>=</mo><msub><mi>m</mi><mn>0</mn></msub><mo>-</mo><mover><mi>m</mi><mo>&CenterDot;</mo></mover><mrow><mo>(</mo><mi>t</mi><mo>)</mo></mrow></mrow>]]></math><img file="FDA00008271453800000113.GIF" wi="342" he="63" /></maths>其中,m<sub>0</sub>为目标初始质量;<img file="FDA0000827145380000021.GIF" wi="104" he="70" />是燃料相对于火箭尾部喷口的喷射速度,取<img file="FDA0000827145380000022.GIF" wi="100" he="70" />的方向与飞行器的速度方向反向共线,其大小稳定,则选取<img file="FDA0000827145380000023.GIF" wi="99" he="70" />模型为:<maths num="0004" id="cmaths0004"><math><![CDATA[<mrow><msub><mover><mi>v</mi><mo>&RightArrow;</mo></mover><mi>r</mi></msub><mrow><mo>(</mo><mi>t</mi><mo>)</mo></mrow><mo>=</mo><mo>-</mo><mover><mi>v</mi><mo>&RightArrow;</mo></mover><mrow><mo>(</mo><mi>t</mi><mo>)</mo></mrow></mrow>]]></math><img file="FDA0000827145380000024.GIF" wi="261" he="71" /></maths>其中,<img file="FDA0000827145380000025.GIF" wi="92" he="70" />为飞行器的速度;步骤E,将目标空间飞行器的简化运动方程与分解方程以及m(t)模型、<img file="FDA0000827145380000026.GIF" wi="110" he="69" />模型进行结合,建立其空间飞行器运行轨道的运动方程模型:<maths num="0005" id="cmaths0005"><math><![CDATA[<mfenced open = "{" close = ""><mtable><mtr><mtd><mrow><msub><mover><mover><mi>r</mi><mo>&RightArrow;</mo></mover><mo>&CenterDot;&CenterDot;</mo></mover><mi>c</mi></msub><mrow><mo>(</mo><mi>t</mi><mo>)</mo></mrow><mo>=</mo><msub><mover><mi>F</mi><mo>&RightArrow;</mo></mover><mi>e</mi></msub><mo>+</mo><msub><mover><mi>F</mi><mo>&RightArrow;</mo></mover><mi>T</mi></msub><mo>=</mo><mo>-</mo><mfrac><msub><mi>G</mi><mi>m</mi></msub><mrow><mo>|</mo><msub><mover><mi>r</mi><mo>&RightArrow;</mo></mover><mi>c</mi></msub><mrow><mo>(</mo><mi>t</mi><mo>)</mo></mrow><msup><mo>|</mo><mn>3</mn></msup></mrow></mfrac><msub><mover><mi>r</mi><mo>&RightArrow;</mo></mover><mi>c</mi></msub><mrow><mo>(</mo><mi>t</mi><mo>)</mo></mrow><mo>+</mo><msub><mover><mi>v</mi><mo>&RightArrow;</mo></mover><mi>r</mi></msub><mrow><mo>(</mo><mi>t</mi><mo>)</mo></mrow><mfrac><mrow><mover><mi>m</mi><mo>&CenterDot;</mo></mover><mrow><mo>(</mo><mi>t</mi><mo>)</mo></mrow></mrow><mrow><mi>m</mi><mrow><mo>(</mo><mi>t</mi><mo>)</mo></mrow></mrow></mfrac></mrow></mtd></mtr><mtr><mtd><mrow><mfrac><mi>d</mi><mrow><mi>d</mi><mi>t</mi></mrow></mfrac><mfenced open = "[" close = "]"><mtable><mtr><mtd><mrow><msub><mi>x</mi><mi>c</mi></msub><mrow><mo>(</mo><mi>t</mi><mo>)</mo></mrow></mrow></mtd></mtr><mtr><mtd><mrow><msub><mi>y</mi><mi>c</mi></msub><mrow><mo>(</mo><mi>t</mi><mo>)</mo></mrow></mrow></mtd></mtr><mtr><mtd><mrow><msub><mi>z</mi><mi>c</mi></msub><mrow><mo>(</mo><mi>t</mi><mo>)</mo></mrow></mrow></mtd></mtr></mtable></mfenced><mo>=</mo><mfenced open = "[" close = "]"><mtable><mtr><mtd><mrow><msub><mover><mi>x</mi><mo>&CenterDot;</mo></mover><mi>c</mi></msub><mrow><mo>(</mo><mi>t</mi><mo>)</mo></mrow></mrow></mtd></mtr><mtr><mtd><mrow><msub><mover><mi>y</mi><mo>&CenterDot;</mo></mover><mi>c</mi></msub><mrow><mo>(</mo><mi>t</mi><mo>)</mo></mrow></mrow></mtd></mtr><mtr><mtd><mrow><msub><mover><mi>z</mi><mo>&CenterDot;</mo></mover><mi>c</mi></msub><mrow><mo>(</mo><mi>t</mi><mo>)</mo></mrow></mrow></mtd></mtr></mtable></mfenced></mrow></mtd></mtr><mtr><mtd><mrow><mfrac><mi>d</mi><mrow><mi>d</mi><mi>t</mi></mrow></mfrac><mfenced open = "[" close = "]"><mtable><mtr><mtd><mrow><msub><mover><mi>x</mi><mo>&CenterDot;</mo></mover><mi>c</mi></msub><mrow><mo>(</mo><mi>t</mi><mo>)</mo></mrow></mrow></mtd></mtr><mtr><mtd><mrow><msub><mover><mi>y</mi><mo>&CenterDot;</mo></mover><mi>c</mi></msub><mrow><mo>(</mo><mi>t</mi><mo>)</mo></mrow></mrow></mtd></mtr><mtr><mtd><mrow><msub><mover><mi>z</mi><mo>&CenterDot;</mo></mover><mi>c</mi></msub><mrow><mo>(</mo><mi>t</mi><mo>)</mo></mrow></mrow></mtd></mtr></mtable></mfenced><mo>=</mo><msub><mover><mi>F</mi><mo>&RightArrow;</mo></mover><mi>e</mi></msub><mo>+</mo><msub><mover><mi>F</mi><mo>&RightArrow;</mo></mover><mi>T</mi></msub></mrow></mtd></mtr><mtr><mtd><mrow><mi>m</mi><mrow><mo>(</mo><mi>t</mi><mo>)</mo></mrow><mo>=</mo><msub><mi>m</mi><mn>0</mn></msub><mo>-</mo><mover><mi>m</mi><mo>&CenterDot;</mo></mover><mrow><mo>(</mo><mi>t</mi><mo>)</mo></mrow></mrow></mtd></mtr><mtr><mtd><mrow><msub><mover><mi>v</mi><mo>&RightArrow;</mo></mover><mi>r</mi></msub><mrow><mo>(</mo><mi>t</mi><mo>)</mo></mrow><mo>=</mo><mo>-</mo><mover><mi>v</mi><mo>&RightArrow;</mo></mover><mrow><mo>(</mo><mi>t</mi><mo>)</mo></mrow></mrow></mtd></mtr><mtr><mtd><mrow><msub><mi>r</mi><mi>c</mi></msub><mrow><mo>(</mo><mi>t</mi><mo>)</mo></mrow><mo>=</mo><msqrt><mrow><msubsup><mi>x</mi><mi>c</mi><mn>2</mn></msubsup><mrow><mo>(</mo><mi>t</mi><mo>)</mo></mrow><mo>+</mo><msubsup><mi>y</mi><mi>c</mi><mn>2</mn></msubsup><mrow><mo>(</mo><mi>t</mi><mo>)</mo></mrow><mo>+</mo><msubsup><mi>z</mi><mi>c</mi><mn>2</mn></msubsup><mrow><mo>(</mo><mi>t</mi><mo>)</mo></mrow></mrow></msqrt></mrow></mtd></mtr><mtr><mtd><mrow><msub><mi>G</mi><mi>m</mi></msub><mo>=</mo><mn>3.986005</mn><mo>&times;</mo><msup><mn>10</mn><mn>14</mn></msup></mrow></mtd></mtr></mtable></mfenced>]]></math><img file="FDA0000827145380000027.GIF" wi="877" he="1029" /></maths>步骤F,不考虑系统误差,在空间飞行器运行轨道的运动方程模型基础上,建立基于三阶多项式表示的空间飞行器运行轨道的估计模型:<maths num="0006" id="cmaths0006"><math><![CDATA[<mfenced open = "{" close = ""><mtable><mtr><mtd><mrow><msub><mi>x</mi><mi>c</mi></msub><mrow><mo>(</mo><mi>t</mi><mo>)</mo></mrow><mo>=</mo><msub><mi>a</mi><mn>1</mn></msub><mo>+</mo><msub><mi>a</mi><mn>2</mn></msub><mi>t</mi><mo>+</mo><msub><mi>a</mi><mn>3</mn></msub><msup><mi>t</mi><mn>2</mn></msup><mo>+</mo><msub><mi>a</mi><mn>4</mn></msub><msup><mi>t</mi><mn>3</mn></msup></mrow></mtd></mtr><mtr><mtd><mrow><msub><mi>y</mi><mi>c</mi></msub><mrow><mo>(</mo><mi>t</mi><mo>)</mo></mrow><mo>=</mo><msub><mi>a</mi><mn>6</mn></msub><mo>+</mo><msub><mi>a</mi><mn>6</mn></msub><mi>t</mi><mo>+</mo><msub><mi>a</mi><mn>7</mn></msub><msup><mi>t</mi><mn>2</mn></msup><mo>+</mo><msub><mi>a</mi><mn>8</mn></msub><msup><mi>t</mi><mn>3</mn></msup></mrow></mtd></mtr><mtr><mtd><mrow><msub><mi>z</mi><mi>c</mi></msub><mrow><mo>(</mo><mi>t</mi><mo>)</mo></mrow><mo>=</mo><msub><mi>a</mi><mn>9</mn></msub><mo>+</mo><msub><mi>a</mi><mn>10</mn></msub><mi>t</mi><mo>+</mo><msub><mi>a</mi><mn>11</mn></msub><msup><mi>t</mi><mn>2</mn></msup><mo>+</mo><msub><mi>a</mi><mn>12</mn></msub><msup><mi>t</mi><mn>3</mn></msup></mrow></mtd></mtr><mtr><mtd><mrow><msub><mover><mi>x</mi><mo>&CenterDot;</mo></mover><mi>c</mi></msub><mrow><mo>(</mo><mi>t</mi><mo>)</mo></mrow><mo>=</mo><msub><mi>a</mi><mn>2</mn></msub><mo>+</mo><mn>2</mn><msub><mi>a</mi><mn>3</mn></msub><mi>t</mi><mo>+</mo><mn>3</mn><msub><mi>a</mi><mn>4</mn></msub><msup><mi>t</mi><mn>2</mn></msup></mrow></mtd></mtr><mtr><mtd><mrow><msub><mover><mi>y</mi><mo>&CenterDot;</mo></mover><mi>c</mi></msub><mrow><mo>(</mo><mi>t</mi><mo>)</mo></mrow><mo>=</mo><msub><mi>a</mi><mn>6</mn></msub><mo>+</mo><mn>2</mn><msub><mi>a</mi><mn>7</mn></msub><mi>t</mi><mo>+</mo><mn>3</mn><msub><mi>a</mi><mn>8</mn></msub><msup><mi>t</mi><mn>2</mn></msup></mrow></mtd></mtr><mtr><mtd><mrow><msub><mover><mi>z</mi><mo>&CenterDot;</mo></mover><mi>c</mi></msub><mrow><mo>(</mo><mi>t</mi><mo>)</mo></mrow><mo>=</mo><msub><mi>a</mi><mn>10</mn></msub><mo>+</mo><mn>2</mn><msub><mi>a</mi><mn>11</mn></msub><mi>t</mi><mo>+</mo><mn>3</mn><msub><mi>a</mi><mn>12</mn></msub><msup><mi>t</mi><mn>2</mn></msup></mrow></mtd></mtr></mtable></mfenced>]]></math><img file="FDA0000827145380000028.GIF" wi="605" he="502" /></maths>其中,a<sub>1</sub>、a<sub>2</sub>…a<sub>12</sub>分别为待估计的参数;步骤G,利用北斗卫星获取的目标空间飞行器在飞行主动段在基础坐标系下的初始位置信息数据,对模型中待估计的参数进行求解,得到确切的空间飞行器运行轨道的估计模型,从而得出目标空间飞行器在主动段各个时间点的估计位置和速度,实现目标空间飞行器的轨道估计。
地址 210016 江苏省南京市白下区御道街29号