[发明专利]基于导航信息评价的双体小行星探测轨迹优化方法

摘要

本发明公开的基于导航信息评价的双体小行星探测轨迹优化方法，属于自主导航领域。本发明实现方法为：当主星的位置已知，从星的位置不确知，在双小行星系统惯性坐标系下建立探测器的动力学方程；根据探测器所使用的导航系统建立主星和从星的视线观测模型和探测器间的测距测角模型，并根据状态方程和观测方程构建可观测性矩阵，计算可观测度；选取轨迹优化性能指标并确定双体小行星探测的轨迹约束，采用优化算法进行轨迹优化，根据搜索到的两颗探测器最优的初始位置和速度能够得到两颗探测器最优的飞行轨迹，沿最优轨迹飞行能使两颗探测器整体的导航性能最优，并且准确地估计从星的位置。

主权项

1.基于导航信息评价的双体小行星探测轨迹优化方法，其特征在于：包括步骤如下，步骤1，在双小行星系统惯性坐标系下建立探测器的动力学方程；步骤2，根据光学导航系统建立探测器的观测方程；步骤3，根据状态方程和观测方程构建可观测性矩阵，计算可观测度；步骤4，选取轨迹优化性能指标；步骤5，确定双体小行星探测的轨迹约束；步骤6，采用优化算法进行轨迹优化，得到基于导航信息评价的双体小行星探测优化轨迹，沿最优轨迹飞行能使两颗探测器整体的位置、速度估计精度最优，并且从星位置的估计精度也最优。