发明名称 一种基于可观性分析的光学和脉冲星融合自主导航方法
摘要 本发明一种基于可观性分析的光学和脉冲星融合自主导航方法,首先在探测器上安装光学敏感器和脉冲星敏感器,分别用来测量单颗小行星的视线方向和脉冲到达探测器的时间;随后分别建立光学导航的观测方程和脉冲星导航的观测方程,并合成一个融合导航系统观测方程;最后选取一个可以探测到的小行星和一个脉冲星作为测量导航星,并利用标准的卡尔曼滤波进行导航位置和速度的解算。
申请公布号 CN103017772B 申请公布日期 2015.05.27
申请号 CN201210504879.4 申请日期 2012.11.30
申请人 北京控制工程研究所 发明人 王大轶;李茂登;黄翔宇;褚永辉;张晓文
分类号 G01C21/24(2006.01)I 主分类号 G01C21/24(2006.01)I
代理机构 中国航天科技专利中心 11009 代理人 安丽
主权项 一种基于可观性分析的光学和脉冲星融合自主导航方法,其特征在于步骤如下:(1)在探测器上安装光学敏感器和脉冲星敏感器,分别用来测量单颗小行星的视线方向和脉冲到达探测器的时间;(2)根据光学敏感器测得的信息建立光学导航的观测方程:<maths num="0001" id="cmaths0001"><math><![CDATA[<mrow><mover><mi>b</mi><mo>~</mo></mover><mo>=</mo><mi>Ar</mi><mo>+</mo><mi>v</mi><mo>,</mo></mrow>]]></math><img file="FSB0000135220470000011.GIF" wi="304" he="76" /></maths>其中<img file="FSB0000135220470000012.GIF" wi="29" he="55" />为敏感器测得的小行星视线方向向量;<img file="FSB0000135220470000013.GIF" wi="247" he="127" />为小行星视线方向向量在惯性系下的投影;R<sub>a</sub>、R分别为惯性系下小行星的位置矢量和探测器的位置矢量;A为惯性系到敏感器坐标系的姿态矩阵;v为光学敏感器的测量噪声,且v满足高斯分布;(3)根据脉冲星敏感器测得的信息建立脉冲星导航的观测方程:<maths num="0002" id="cmaths0002"><math><![CDATA[<mrow><mover><mi>z</mi><mo>~</mo></mover><mo>=</mo><msub><mi>t</mi><mi>sun</mi></msub><mo>-</mo><msub><mi>t</mi><mi>SC</mi></msub><mo>=</mo><mfrac><mn>1</mn><mi>c</mi></mfrac><mover><mi>n</mi><mo>^</mo></mover><mo>&CenterDot;</mo><mi>R</mi><mo>+</mo><msub><mi>v</mi><mi>t</mi></msub><mo>,</mo></mrow>]]></math><img file="FSB0000135220470000014.GIF" wi="523" he="136" /></maths>其中t<sub>sun</sub>为脉冲到达太阳系质心的时间;t<sub>SC</sub>为测量出的脉冲到达探测器的时间;<img file="FSB0000135220470000015.GIF" wi="28" he="44" />为敏感器测得的脉冲星视线方向向量;c为光速;v<sub>t</sub>为脉冲测量噪声,满足高斯分布;(4)根据步骤(2)和步骤(3)得到融合导航的观测方程为:<maths num="0003" id="cmaths0003"><math><![CDATA[<mrow><mfenced open='[' close=']'><mtable><mtr><mtd><mover><mi>b</mi><mo>~</mo></mover></mtd></mtr><mtr><mtd><mover><mi>z</mi><mo>~</mo></mover></mtd></mtr></mtable></mfenced><mo>=</mo><mfenced open='[' close=']'><mtable><mtr><mtd><mi>Ar</mi></mtd></mtr><mtr><mtd><mfrac><mn>1</mn><mi>c</mi></mfrac><mover><mi>n</mi><mo>^</mo></mover><mo>&CenterDot;</mo><mi>R</mi></mtd></mtr></mtable></mfenced><mo>+</mo><mfenced open='[' close=']'><mtable><mtr><mtd><mi>v</mi></mtd></mtr><mtr><mtd><msub><mi>v</mi><mi>t</mi></msub></mtd></mtr></mtable></mfenced><mo>;</mo></mrow>]]></math><img file="FSB0000135220470000016.GIF" wi="455" he="230" /></maths>(5)分别选取一个可以探测到的小行星和一个脉冲星作为测量导航星,测量获得小行星视线方向向量<img file="FSB0000135220470000017.GIF" wi="29" he="53" />以及脉冲到达探测器的时间t<sub>SC</sub>,利用标准的卡尔曼滤波进行导航位置和速度的解算;所述的步骤(5)中选取作为测量导航星的小行星到光学敏感器的视线方向与选取作为测量导航星的脉冲星到脉冲星敏感器的视线方向相互平行。
地址 100080 北京市2729信箱