双体小行星探测自主协同光学导航方法

摘要

本发明公开的双体小行星探测自主协同光学导航方法，属于自主导航领域。本发明实现方法为：当主星的位置已知，从星的位置不确知，在双小行星系统惯性坐标系下建立探测器的动力学方程；根据探测器所使用的导航系统建立主星和从星的视线观测模型和探测器间的测距测角模型，并设计双体小行星导航的无迹卡尔曼滤波器；以轨道预报给出两颗探测器位置速度和从星位置的先验估计值作为初始状态，结合动力学方程和观测方程，通过无迹卡尔曼滤波器进行估计，实时确定两颗探测器的位置速度和从星的位置。本发明具有实时性好、导航精度高的优点。本发明利用无迹卡尔曼滤波器进行估计，不需要将非线性系统线性化，也不需要计算雅可比矩阵，实现简单、收敛性好。