一种基于凸优化的火星着陆轨迹优化控制方法技术

本发明专利技术涉及一种基于凸优化的火星着陆轨迹优化控制方法，该方法包括如下步骤：(1)建立火星着陆动力学模型并进行凸优化；(2)以燃料最优为目标进行单次离线优化得到标称轨迹；(3)采用滚动时域的模型预测控制对标称轨迹进行跟踪完成着陆控制。与现有技术相比，本发明专利技术将凸优化和滚动时域的模型预测控制有效结合，有效降低建模误差和干扰引起的累计误差，提高了着陆精度。

An optimization control method for Mars Landing Trajectory Based on convex optimization

The present invention relates to an optimal control method for Mars landing trajectory based on convex optimization, which comprises the following steps: (1) establishing a dynamic model of Mars landing and convex optimization; (2) obtaining a nominal trajectory by a single off-line optimization with the objective of fuel optimization; (3) adopting a rolling time domain model predictive control for the nominal trajectory advance Line tracking completes landing control. Compared with the prior art, the invention effectively combines convex optimization with rolling time domain model predictive control, effectively reduces the cumulative error caused by modeling error and interference, and improves the landing accuracy.

【技术实现步骤摘要】
一种基于凸优化的火星着陆轨迹优化控制方法
本专利技术涉及一种火星着陆轨迹优化控制方法，尤其是涉及一种基于凸优化的火星着陆轨迹优化控制方法。
技术介绍
近年来随着科技的不断提升，人们对于太空资源的需求又迎来了一个高峰期，重新燃起了对火星探索的兴趣，在这种背景下，载人飞行器精确着陆等问题变得越来越重要。在航空领域中，航天着陆器在导引作用下以小于几百米的误差准确降落在给定目标地点的问题被称之为精确着陆问题，而轨迹优化是精确着陆中的关键技术。为了确保在火星上安全着陆，需要综合考虑各个地点的科学研究价值以及整体地形条件(例如坡度，粗糙度)。对于自然探索性质的任务，在预定误差范围内的具体着陆点并不是特别重要，比如在NASA的MarsExplorationRovers任务中，着陆误差可以大到35km。而另一方面，在某些科研任务的需求中，可能需要准确降落在危险地形之中，又或是需要着陆在燃料供应点等指定的地面位置。比如随着我国嫦娥工程与载人航天工程的持续深入，未来月球探测将是我国一个重要的研究方向，在这个背景下，可以预见，具有轨迹优化和高精度定点软着陆能力的探测器是必不可少的但与此同时，火星着陆任务中的难点在于其约束条件众多，存在大量非线性时变性项，因此用一般优化方法难以达到系统要求。对于具有附加状态和控制约束的一般三维问题其最优推力的解析解往往是难以求得的，因此能够适用于机载的快速轨迹优化算法尤为重要。在国内外相关研究中，常用的方法有使用直接配置法，直接多重打靶法和使用Legendre伪谱法的数值求解方法，以及传统的基于多项式的制导方法，其中基于时间上的四次多项式的轨迹在阿波罗任务中得到了应用。然而在相关算法收敛性不清楚的情况下，通过一般迭代算法得到的实时机载非线性规划解可能不是期望的结果。由于火星精确着陆需要机载实时计算最优轨迹，所以应该根据问题的结构来设计具有确定收敛性的保证收敛到全局最优的算法。凸优化具有全局最优的性质，因此基于凸优化的轨迹优化将是研究方向。
技术实现思路
本专利技术的目的就是为了克服上述现有技术存在的缺陷而提供一种基于凸优化的火星着陆轨迹优化控制方法。本专利技术的目的可以通过以下技术方案来实现：一种基于凸优化的火星着陆轨迹优化控制方法，其特征在于，该方法包括如下步骤：(1)建立火星着陆动力学模型并进行凸优化；(2)以燃料最优为目标进行单次离线优化得到标称轨迹；(3)采用滚动时域的模型预测控制对标称轨迹进行跟踪完成着陆控制。步骤(1)火星着陆动力学模型具体为：Tc＝(nTcosφ)e，其中，r∈IR3，v∈IR3，Tc∈IR3，r为航天器相对于目标点的位置矢量，v为航天器在地面固定坐标系中的速度矢量，Tc为航天器受到的推力矢量，IR3表示xyz三轴坐标系，为航天器相对于目标点位置矢量的导数在i轴方向上的分量，vi为航天器在地面固定坐标系中速度矢量在在i轴方向上的分量，i＝x,y,z，m为航天器质量，μ为火星的引力常量，α为燃料消耗速率的常量，g∈IR3，g为火星的重力加速度常量，Isp为推进器的比冲，e∈IR3，e为瞬时推力方向矢量，ge为地球重力常量，φ为推进器和瞬时推力方向矢量e之间的夹角，n为子推进器个数。步骤(1)凸优化具体为：(11)建立推力幅值约束：ρ1＝nT1cosφ，ρ2＝nT2cosφ，其中，ρ1和ρ2为推力幅值下界和上界，tf为动力下降着陆过程的终止时间，n为子推进器个数，T1为子推进器的非零最小推力，T2为子推进器最大推力；位移非负约束：rx＞0，其中，rx为航天器相对于目标点位置矢量在x轴方向上的分量；高度角约束：其中，为给定的安全角度，θalt(t)为航天器到目标点的高度角；(12)引入松弛变量Γ(t)和附加约束‖Tc(t)‖≤Γ(t)，进行变量代换进而得到凸优化后的推力约束条件：ρ1和ρ2为推力幅值下界和上界，z和z0表示变量替换后的质量变量和其初始值，σ表示松弛变量变换后的新变量。步骤(2)以燃料最优为目标进行单次离线优化后的优化模型为：0＜ρ1≤‖Tc(t)‖≤ρ2，‖SX‖+cTX≤0，m(0)＝mwet，r(0)＝r0r(tf)＝0，其中，S和c均为系数矩阵：mwet表示着陆器燃料满载时的初始质量，表示着陆器着陆时的最终质量，X表示包含航天器位置和速度信息的状态向量。步骤(2)获取标称轨迹具体为：采用以Mosek为求解器的CVX工具箱对所述的优化模型进行求解，得到表示包含航天器位置和速度信息的状态向量X。步骤(3)具体为：(31)建立预测模型：X(k+i|k)＝A(k+i-1|k)X(k+i-1|k)+B(k+i-1|k)U(k+i-1|k)，其中，X(k+i|k)表示在k时刻对k+i时刻的状态信息预测值，U(k+i-1|k)表示在k时刻的优化结果中得到的k+i-1时刻的输入量，A(k+i-1|k)表示在k时刻对k+i-1时刻的状态矩阵A的预测值，B(k+i-1|k)表示在k时刻对k+i-1时刻的输入矩阵B的预测值，所述的状态信息包括航天器位置和速度信息，所述的输入量为推力；(32)建立优化目标函数：其中，Xopt(k+i)表示k+i时刻轨迹跟踪的目标值，Q为对称正定的参数矩阵，p为滚动优化的步长，X(N|k)表示在k时刻对最终时刻的状态信息预测值，Xopt(N)表示最终时刻轨迹跟踪的目标值，R为对称正定的参数矩阵；(33)以步骤(31)中建立的预测模型作为约束条件，以(32)中的目标函数为优化指标，在任意时刻k进行步长为p的有限时域在线滚动优化，并在k时刻得到优化后的p个最优控制序列U(k+i|k)；(34)在每个当前时刻仅利用优化结果中当前时刻的控制量和位置信息带入火星着陆动力学模型求得下一时刻的真实位置信息，并作为下一时刻的优化初始信息，在整个时域上滚动优化直到结束，每次都用当前时刻的优化控制量作为输入，完成着陆器的控制工作。与现有技术相比，本专利技术具有如下优点：(1)本专利技术通过基于凸优化的优化算法，可以保证求解得到的结果为全局最优，避免了传统方法可能收敛至局部最优的不足，因此得到的燃料最优轨迹为全局最优的结果；(2)通过滚动时域的模型预测控制对标称轨迹进行跟踪，可以有效避免由建模误差或实际扰动引起的累计误差，减小了真实轨迹与优化轨迹之间的漂移，相比于单次离线优化的控制方法精度更；(3)将凸优化和滚动时域的模型预测控制有效结合，有效降低建模误差和干扰引起的累计误差，提高了着陆精度。附图说明图1为本专利技术基于凸优化的火星着陆轨迹优化控制方法的流程框图；图2为着陆过程中高度角约束锥形示意图；图3为模型预测控制算法流程图。具体实施方式下面结合附图和具体实施例对本专利技术进行详细说明。注意，以下的实施方式的说明只是实质上的例示，本专利技术并不意在对其适用物或其用途进行限定，且本专利技术并不限定于以下的实施方式。实施例如图1所示，一种基于凸优化的火星着陆轨迹优化控制方法，该方法包括如下步骤：(1)建立火星着陆动力学模型并进行凸优化；(2)以燃料最优为目标进行单次离线优化得到标称轨迹；(3)采用滚动时域的模型预测控制对标称轨迹进行跟踪完成着陆控制。步骤(1)火星着陆动力学模型具体为：Tc＝(nTcosφ)e，其中，r∈IR3，v∈IR3，Tc∈IR3，r为航天器相对于目标点的位置矢量本文档来自技高网...

【技术保护点】
1.一种基于凸优化的火星着陆轨迹优化控制方法，其特征在于，该方法包括如下步骤：(1)建立火星着陆动力学模型并进行凸优化；(2)以燃料最优为目标进行单次离线优化得到标称轨迹；(3)采用滚动时域的模型预测控制对标称轨迹进行跟踪完成着陆控制。

【技术特征摘要】
1.一种基于凸优化的火星着陆轨迹优化控制方法，其特征在于，该方法包括如下步骤：(1)建立火星着陆动力学模型并进行凸优化；(2)以燃料最优为目标进行单次离线优化得到标称轨迹；(3)采用滚动时域的模型预测控制对标称轨迹进行跟踪完成着陆控制。2.根据权利要求1所述的一种基于凸优化的火星着陆轨迹优化控制方法，其特征在于，步骤(1)火星着陆动力学模型具体为：Tc＝(nTcosφ)e，其中，r∈IR3，v∈IR3，Tc∈IR3，r为航天器相对于目标点的位置矢量，v为航天器在地面固定坐标系中的速度矢量，Tc为航天器受到的推力矢量，IR3表示xyz三轴坐标系，为航天器相对于目标点位置矢量的导数在i轴方向上的分量，vi为航天器在地面固定坐标系中速度矢量在在i轴方向上的分量，i＝x,y,z，m为航天器质量，μ为火星的引力常量，α为燃料消耗速率的常量，g∈IR3，g为火星的重力加速度常量，Isp为推进器的比冲，e∈IR3，e为瞬时推力方向矢量，ge为地球重力常量，φ为推进器和瞬时推力方向矢量e之间的夹角，n为子推进器个数。3.根据权利要求2所述的一种基于凸优化的火星着陆轨迹优化控制方法，其特征在于，步骤(1)凸优化具体为：(11)建立推力幅值约束：ρ1＝nT1cosφ，ρ2＝nT2cosφ，其中，ρ1和ρ2为推力幅值下界和上界，tf为动力下降着陆过程的终止时间，n为子推进器个数，T1为子推进器的非零最小推力，T2为子推进器最大推力；位移非负约束：rx＞0，其中，rx为航天器相对于目标点位置矢量在x轴方向上的分量；高度角约束：其中，为给定的安全角度，θalt(t)为航天器到目标点的高度角；(12)引入松弛变量Γ(t)和附加约束‖Tc(t)‖≤Γ(t)，进行变量代换进而得到凸优化后的推力约束条件：ρ1和ρ2为推力幅值下界和上界，z和z0表示变量替换后的质量变量和其初始值，σ表示松弛变量变换后的新变量。4.根据权利要求3所述的一种基于凸优化的火星着陆轨迹优化控制方法，其特征在于，步骤(2)以燃料最优为目标进行单...

【专利技术属性】
技术研发人员：贾泽华，张卫东，陆宇，孙志坚，张国庆，赵亚东，
申请(专利权)人：上海交通大学，
类型：发明
国别省市：上海,31