不确定环境下行星着陆轨迹规划方法技术

本发明专利技术涉及一种不确定环境下行星着陆轨迹规划方法，属于深空探测技术领域。该方法针对行星着陆过程中地形环境不确知及动力学模型不准确两个问题，将在线轨迹规划分解为粗规划与精规划两个阶段：粗规划阶段，探测器结合最新环境观测信息，在其附近状态空间内快速搜索最优路径点序列；同时，考虑到下降过程中动力学模型的不确定性，在精规划阶段采用模型预测控制方法生成实际可行的局部最优着陆轨迹。探测器在下降过程中不断重复该过程，对着陆轨迹进行实时规划与调整，直至实现行星表面安全着陆。本发明专利技术有效降低了最优着陆轨迹求解难度，提高在线计算效率，在保证探测器下降过程安全性的同时，以较低的燃耗着陆在行星表面指定区域。

Planetary Landing Trajectory Planning in Uncertain Environment

The invention relates to a planetary landing trajectory planning method under uncertain environment, belonging to the field of deep space exploration technology. Aiming at the two problems of uncertain terrain environment and inaccurate dynamic model in the process of planetary landing, this method decomposes the online trajectory planning into two stages: rough planning stage, which combines the latest environmental observation information with the detector to search the optimal path point sequence quickly in its neighboring state space, and considering the uncertainties of dynamic model in the process of descent. The model predictive control method is used to generate the feasible local optimal landing trajectory in the precise planning stage. During the descent process, the probe repeats the process continuously, and the landing trajectory is planned and adjusted in real time until the safe landing of the planet surface is realized. The invention effectively reduces the difficulty of solving the optimal landing trajectory, improves the online calculation efficiency, ensures the safety of the descent process of the detector, and lands on the designated area of the planet surface with low fuel consumption.

【技术实现步骤摘要】
不确定环境下行星着陆轨迹规划方法
本专利技术涉及一种行星着陆轨迹规划方法，尤其涉及一种不确定环境下行星着陆轨迹规划方法，属于深空探测

技术介绍
深空探测任务环境复杂、风险极高，获取精确的天体模型对于实现探测器行星表面安全着陆尤为重要。然而在探索未知环境时，地面能够提前获取的目标天体引力场模型以及地形信息通常十分有限。在小天体着陆任务中，由于目标天体形状不规则、质量分布不均、引力场弱以及环境扰动作用显著，建立其附近精确的动力学模型常常需要在线长时间的近距离观测。同时，受在轨观测精度限制，天体表面地形起伏、障碍分布等情况仅在下降过程中探测器足够接近行星表面时才能够获得。针对行星表面复杂的地形，传统行星安全着陆轨迹规划方法可分为两类：一类通过探测器拍摄得到的光学图像或激光雷达扫描得到的三维地形数据选取地形平坦、远离障碍的着陆点，并采用在线制导方法生成到达该着陆点的下降轨迹；另一类则将检测得到的障碍视为不等式状态约束加入到着陆轨迹优化过程中，通过求解优化问题，生成绕开障碍且到达目标着陆点的下降轨迹。然而，在线选取着陆点对动力学模型精度及地形认知有很高的要求，实时优化的避障轨迹又多为开环方法，对环境扰动与系统导航精度十分敏感，且为规避障碍引入的状态约束常为非凸约束，极大的影响了优化问题的求解效率。为了降低在轨建模成本及环境不确定性对实际着陆性能的影响，未来探测任务要求探测器具备在线快速轨迹规划能力，即在下降过程中，探测器需结合实时观测得到的环境信息，不断对其着陆轨迹进行规划与调整，从而在动力学模型及天体表面地形情况不确知的前提下实现行星表面安全着陆。专利技术内容本专利技术的目的是为了提供一种不确定环境下行星着陆轨迹规划方法，该方法针对行星着陆过程中地形环境不确知及动力学模型不准确两个问题，将在线轨迹规划分解为粗规划与精规划两个阶段：粗规划阶段，探测器结合最新环境观测信息，在其附近状态空间内快速搜索最优路径点序列；同时，考虑到下降过程中动力学模型的不确定性，在精规划阶段采用模型预测控制方法生成实际可行的局部最优着陆轨迹。探测器在下降过程中不断重复该过程，对着陆轨迹进行实时规划与调整，直至实现行星表面安全着陆。本专利技术的目的是通过下述技术方案实现的。不确定环境下行星着陆轨迹规划方法，包括如下步骤：步骤一、将探测器附近空间离散成网格，根据最新环境观测信息与探测器当前状态设计转移代价估计函数，采用A*算法快速搜索前往目标着陆点的局部最优路径点序列。首先将探测器附近平面空间划分成a×b的网格。考虑到平面空间中既包含探测器可自由运动的区域，又有受地形环境因素探测器不可到达的区域，将网格中的节点分为可行与不可行两类。随着探测器不断接近行星表面，能够获取的环境信息越来越丰富，其附近网格中不可行节点数量也会随之改变。结合最新地形观测信息，在网格中标记出所有不可行节点。采用二值函数F(p)记录节点p是否可行，若节点p可行，F(p)＝0，否则F(p)＝1。在探测器下降过程中，离散网格随着探测器移动，各节点对应的函数F(p)的取值根据环境观测信息不断更新。从初始状态p0出发到达节点p所需的实际转移代价为g(p)，在所有可能路径中实际转移代价最小值为g*(p)。任务开始时g(p0)＝0，从节点p到达相邻节点p′时，实际转移代价为g(p′)＝g*(p)+c(p,p′)(1)其中，c(p,p′)为节点p,p′间的转移代价函数。对于不可行节点，F(p)＝1，设该节点向任意方向的转移代价为+∞；对于可行节点p的不可行相邻节点p′，即当F(p)＝0且F(p′)＝1时，同样设转移代价为+∞。即对于以上两种情况，式(1)中c(p,p′)＝+∞(2)对于可行节点p的可行相邻节点p′，即当F(p)＝0且F(p′)＝0时，由于探测器速度决定了探测器转移到相邻节点所需消耗的燃料大小，故根据当前速度在各方向的分量依次设置节点p与相邻节点间的转移代价函数c(p,·)。定义节点间距离为其中，(xp,yp)为节点p在天体表面固连系中的坐标，(xp',yp')为节点p′在天体表面固连系中的坐标。考虑节点p附近的2n个节点，n为大于1的正整数，设目标着陆点为pf，按以下方式分配各相邻节点的转移代价其中α,β为根据实际任务需求进行选取的转移代价函数系数。同时，从节点p到目标着陆点pf最优路径的估计代价为h(p)，h(p)的取值由欧几里得几何距离得到其中为目标着陆点pf在天体表面固连系中的坐标。结合式(1)与式(5)，从初始状态p0经由节点p到达目标状态pf的代价估计函数f(p)为f(p)＝g(p)+h(p)(6)根据式(6)，采用传统A*算法，通过在探测器当前位置附近a×b的离散网格空间中依次寻找代价估计函数最小的节点，即可在网格中快速生成一条避开障碍物前往目标着陆点的最优路径，即探测器需要跟踪的路径点序列，实现下降轨迹的粗规划。同时，为保证探测器在跟踪路径点过程中的安全，要求探测器由当前位置转移到下一目标路径点过程中，始终保持在含有路径点的网格中，即对实际飞行轨迹增加了额外的状态约束。步骤二、根据步骤一粗规划得到的最优路径点序列，考虑着陆过程中系统动力学模型的不确定性，采用模型预测控制方法，根据探测器当前状态生成实际可行的局部最优着陆轨迹，实现下降轨迹的精规划。由于目标天体引力场模型建模误差及探测器在下降过程中受到太阳光压、太阳引力及其他天体引力带来的环境扰动，导致星上动力学模型与实际动力学模型存在一定偏差，行星着陆离散线性化动力学方程为x(k+1)＝Ax(k)+Bu(k)+w(k)(7)其中，x(k)为探测器当前状态，x(k+1)为探测器下一时刻状态，u(k)为控制变量，w(k)∈W为有界动力学模型误差，A为状态系数矩阵，B为控制系数矩阵。步骤一粗规划得到的最优路径点序列给出了探测器由当前状态x(k)通过N步转移到下一路径点附近区域XN过程中所受到的状态约束，即x(k|k)＝x(k)(8)x(k+N|k)∈XN(10)式(8)中x(k|k)为探测器从k时刻起的初始状态，式(9)描述了转移过程中探测器状态始终位于指定区域的并集中，其中从k时刻起第j步的探测器状态x(k+j|k)所受到的约束X(j)由步骤一粗规划得到的最优路径点及网格大小决定，式(10)要求探测器状态x(k+N|k)在k+N时刻到达指定目标区域XN。此外，转移过程中控制变量u还需满足控制量约束Uu(k+j|k)∈U(11)u(k+j|k)为从k时刻起第j步采用的控制变量。根据步骤一生成的最优路径点，采用模型预测控制方法在滚动时域上对着陆轨迹进行优化，得到当前网格中的最优着陆轨迹，最优着陆轨迹能够保证探测器在动力学模型不确知的前提下以尽可能小的误差和燃耗转移至指定区域。所要解决的轨迹优化问题为s.t.x(k+j+1|k)＝Ax(k+j|k)+Bu(k+j|k)x(k|k)＝x(k)，x(k+N|k)∈XNx(k|k)＝x(k)为探测器从k时刻起的初始状态，j为当前滚动时域的第j步，xk+j＝x(k+j|k)为从k时刻起第j步的探测器状态，N为滚动时域的总步数，xk+N＝x(k+N|k)为从k时刻起第N步的探测器状态，uk+j＝u(k+j|k)为从k时刻起第j步的控制变量，X(j)为探测器状态在本文档来自技高网...

【技术保护点】
1.不确定环境下行星着陆轨迹规划方法，其特征在于：包括如下步骤：步骤一、将探测器附近空间离散成网格，根据最新环境观测信息与探测器当前状态设计转移代价估计函数，采用A*算法快速搜索前往目标着陆点的局部最优路径点序列；首先将探测器附近平面空间划分成a×b的网格；考虑到平面空间中既包含探测器可自由运动的区域，又有受地形环境因素探测器不可到达的区域，将网格中的节点分为可行与不可行两类；随着探测器不断接近行星表面，能够获取的环境信息越来越丰富，其附近网格中不可行节点数量也会随之改变；结合最新地形观测信息，在网格中标记出所有不可行节点；采用二值函数F(p)记录节点p是否可行，若节点p可行，F(p)＝0，否则F(p)＝1；在探测器下降过程中，离散网格随着探测器移动，各节点对应的函数F(p)的取值根据环境观测信息不断更新；从初始状态p0出发到达节点p所需的实际转移代价为g(p)，在所有可能路径中实际转移代价最小值为g*(p)；任务开始时g(p0)＝0，从节点p到达相邻节点p′时，实际转移代价为g(p′)＝g*(p)+c(p,p′)  (1)其中，c(p,p′)为节点p,p′间的转移代价函数；对于不可行节点，F(p)＝1，设该节点向任意方向的转移代价为+∞；对于可行节点p的不可行相邻节点p′，即当F(p)＝0且F(p′)＝1时，同样设转移代价为+∞；即对于以上两种情况，式(1)中c(p,p′)＝+∞  (2)对于可行节点p的可行相邻节点p′，即当F(p)＝0且F(p′)＝0时，由于探测器速度...

【技术特征摘要】
1.不确定环境下行星着陆轨迹规划方法，其特征在于：包括如下步骤：步骤一、将探测器附近空间离散成网格，根据最新环境观测信息与探测器当前状态设计转移代价估计函数，采用A*算法快速搜索前往目标着陆点的局部最优路径点序列；首先将探测器附近平面空间划分成a×b的网格；考虑到平面空间中既包含探测器可自由运动的区域，又有受地形环境因素探测器不可到达的区域，将网格中的节点分为可行与不可行两类；随着探测器不断接近行星表面，能够获取的环境信息越来越丰富，其附近网格中不可行节点数量也会随之改变；结合最新地形观测信息，在网格中标记出所有不可行节点；采用二值函数F(p)记录节点p是否可行，若节点p可行，F(p)＝0，否则F(p)＝1；在探测器下降过程中，离散网格随着探测器移动，各节点对应的函数F(p)的取值根据环境观测信息不断更新；从初始状态p0出发到达节点p所需的实际转移代价为g(p)，在所有可能路径中实际转移代价最小值为g*(p)；任务开始时g(p0)＝0，从节点p到达相邻节点p′时，实际转移代价为g(p′)＝g*(p)+c(p,p′)(1)其中，c(p,p′)为节点p,p′间的转移代价函数；对于不可行节点，F(p)＝1，设该节点向任意方向的转移代价为+∞；对于可行节点p的不可行相邻节点p′，即当F(p)＝0且F(p′)＝1时，同样设转移代价为+∞；即对于以上两种情况，式(1)中c(p,p′)＝+∞(2)对于可行节点p的可行相邻节点p′，即当F(p)＝0且F(p′)＝0时，由于探测器速度决定了探测器转移到相邻节点所需消耗的燃料大小，故根据当前速度在各方向的分量依次设置节点p与相邻节点间的转移代价函数c(p,·)；定义节点间距离为其中，(xp,yp)为节点p在天体表面固连系中的坐标，(xp',yp')为节点p′在天体表面固连系中的坐标；考虑节点p附近的2n个节点，n为大于1的正整数，设目标着陆点为pf，按以下方式分配各相邻节点的转移代价其中α,β为根据实际任务需求进行选取的转移代价函数系数；同时，从节点p到目标着陆点pf最优路径的估计代价为h(p)，h(p)的取值由欧几里得几何距离得到其中为目标着陆点pf在天体表面固连系中的坐标；结合式(1)与式(5)，从初始状态p0经由节点p到达目标状态pf的代价估计函数f(p)为f(p)＝g(p)+h(p)(6)根据式(6)，采用传统A*算法，通过在探测器当前位置附近a×b的离散网格空间中依次寻找代价估计函数最小的节点，即可在网格中快速生成一条避开障碍物前往目标着陆点的最优路径，即探测器需要跟踪的路径点序列，实现下降轨迹的粗规划；同时，为保证探测器在跟踪路径点过程中的安全，要求探测器由当前位置转移到下一目标路径点过程中，始终保持在含有路径点的网格中，即对实...

【专利技术属性】
技术研发人员：崔平远，葛丹桐，朱圣英，徐瑞，高艾，
申请(专利权)人：北京理工大学，
类型：发明
国别省市：北京,11