[发明专利]一种基于角度约束辅助测量的航天器自主天文导航方法

说明书

本发明涉及一种基于角度约束辅助测量的航天器自主天文导航方法，首先建立基于太阳和八大行星的轨道动力学模型作为航天器的状态模型；其次根据导航天体至航天器的单位矢量与导航天体之间的单位矢量获取方位角量测量，并建立量测量的角度约束模型，在对系统非线性不等式角度约束建模的基础上利用序列二次规划(SQP)非线性规划方法辅助减小航天器自主导航系统的量测误差，之后建立方位角量测模型作为航天器的量测模型；根据航天器的状态模型和量测模型都呈现非线性特性，且系统噪声为非高斯噪声的特点，采用UKF滤波方法，估计航天器位置、速度，获得相对于导航天体的航天器位置和速度。

技术领域

本发明属于航天导航技术领域，可在线估计航天器的位置和速度，适用于航天器的转移段和捕获段；具体涉及在航天器进行天文测量时，基于航天器和导航天体之间的角度约束信息，对量测量进行优化的自主天文导航方法，是一种非常适用于航天器的导航方法。

背景技术

21世纪初，世界主要航天集团都提出了未来的深空探测计划。我国的首个火星探测器“天问一号”已于2020年7月23日发射升空，并成功进入预定轨道。深空探测器距离地球较远，飞行速度较快，飞行距离远，时间长，环境未知性较强，传统上依靠地面测控的深空探测器导航与控制方法在实时性、成本和资源上受到种种限制，存在很多不足，很难满足深空探测一些特殊任务对高精度导航与控制的需要，因而对自主导航的要求更为迫切。自主天文导航已成为深空探测的关键技术。自主天文导航系统需要在同一时刻观测至少两个导航天体，通过两个天体的位置信息确定探测器的位置和速度。导航系统测量误差是制约深空探测自主天文导航精度的重要影响因素，因此，有效抑制敏感器的测量误差是深空探测器高精度自主天文导航的关键。

传统量测量误差修正方法主要有两种，一种是敏感器标定方法，可以去除敏感器测量中的常值误差，另一种是滤波方法，减小天文光学敏感器测量时的随机误差。但是这两种方法都没有利用航天器自主天文导航系统的内在系统约束，导航估计结果并不是最优的。

发明内容

本发明要解决的技术问题是：减小自主天文导航测量误差对导航精度的影响，弥补现有测量手段难以自主减小随机测量误差的不足，提供一种基于角度约束辅助测量的航天器自主天文导航方法，有效利用航天器自主天文导航系统满足的内在系统约束，为航天器提供一种高精度测量信息的自主天文导航方法。

本发明解决其技术问题所采用的技术方案为：一种基于角度约束辅助测量的航天器自主天文导航方法，首先建立基于太阳和八大行星的轨道动力学模型作为天文导航系统的状态模型；其次根据导航天体至航天器的单位矢量与导航天体之间的单位矢量获取方位角量测量，并建立量测量的角度约束模型，在对系统非线性不等式角度约束建模的基础上利用序列二次规划(SQP)非线性规划方法辅助减小航天器自主导航系统的量测误差，之后建立方位角量测模型作为天文导航系统的量测模型；根据航天器的状态模型和量测模型都呈现非线性特性，且系统噪声为非高斯噪声的特点，采用UKF滤波方法，估计航天器位置、速度，获得相对于导航天体的航天器位置和速度，提高航天器自主天文导航精度。

在实际航空任务中，航天器自主天文导航系统满足一定的内在系统约束。这些约束是实际复杂物理系统内在的固有特性，对这些内在约束建模将提高系统估计性能。已有航天器自主天文导航方法都尚未考虑导航系统量测量所满足的多种约束条件，更未对约束条件建模优化、导致系统模型中信息相互孤立，并未完全利用所含信息。因此需要对航天器自主天文导航系统量测量的角度约束条件进行建模、并针对约束模型，利用约束模型规划算法，辅助优化测量信息，进而可实现航天器高精度自主天文导航。

具体包括以下步骤：

1、建立航天器天文导航系统的状态模型

考虑太阳和火星、地球等八大行星对航天器的引力作用，建立基于太阳和八大行星引力轨道动力学模型，选取目标天体为中心的惯性坐标系，可得航天器在目标天体为中心的惯性坐标系中的状态模型：