[发明专利]一种基于约束规划的小天体接近段制导控制方法

摘要

本发明为一种基于约束规划的小天体接近段制导控制方法，将目标天体引力模型引入轨迹规划过程中，同时加入接近过程中对状态与控制的约束，将具有控制约束与轨迹状态约束的非线性动力学路径规划问题转化为以优化燃耗为性能指标的二阶圆锥规划(SOCP)问题。进而，这一凸规划问题可通过内点法对其进行高效求解。由此规划产生的路径点不仅是传统意义上的目标跟踪状态，而且该状态是在考虑目标天体引力场影响情况下满足具有状态与控制约束动力学系统的可行解；此外，所得前馈控制输入满足星上设备和滤波估计所需的推力器关闭时间要求。

主权项

一种基于约束规划的小天体接近段制导控制方法，其特征在于，具体包括以下步骤：第一步：建立探测器接近小天体动力学模型；第二步：将系统模型进行离散化，并将所得模型用于后续凸规划制导；第三步：根据探测器当前状态、末端期望状态以及期望机动时间，通过线性或多项式拟合得到一条初始参考轨迹；第四步：由这一初始参考轨迹开始，引入状态约束与控制约束，通过反复迭代求解具有控制约束与轨迹状态约束的动力学路径规划，得到接近目标天体过程中可行的制导路径。