[发明专利]一种行星表面全局路径快速规划方法

摘要

本发明涉及一种行星表面全局路径快速规划方法,属于深空探测技术领域。首先获得待进行路径规划区域内的障碍分布信息图，并对其进行分析处理，在能避开障碍物的可行区域内选取多个可行节点，并根据选取的节点进行可行区域内的路径连通；获取节点坐标信息，创建采用Dijkstra算法进行路径规划所需网络拓扑结构,以路径的长度作为约束条件，规划出一条初始最优路径；将路径长度函数作为适应度函数，选取节点时所遵循的数学函数关系及坐标的约束范围，作为遗传算法的待优化目标及约束条件，采用遗传算法对初始最优路径进行优化处理，输出优化结果作为最终的规划路径。本方法具有算法简单、高效、通用性好、可扩展性强的优点。

主权项

一种行星表面全局路径快速规划方法，其特征在于：包括以下步骤：步骤1，获得待进行路径规划区域内的障碍分布信息图；分析处理后，在能避开障碍物的可行区域内选取多个可行节点，并根据选取的节点进行可行区域内的路径连通；节点的选取原则为：各节点横纵坐标满足同一种数学函数关系；可行区域内的路径连通遵循邻近节点连通的原则，且所连通的路径不能穿过障碍物、不能跨越多个可行节点；步骤2，对已连通的节点编号，获取节点坐标信息，并储存在数据信息矩阵U1和U2中，其中U1储存节点坐标信息，U2储存连通线段两端节点的编号信息； U 1 = 1 x 1 y 1 2 x 2 y 2 . . . k x k y k . . . n x n y n U 2 = 1 i 1 j 1 2 i 2 j 2 . . . l i l j l . . . m i m j m 式中，n为节点的编号总数，(xk,yk)为第k个节点的坐标信息；m为所有可行节点连通后形成的连通线段总数，(il,jl)为第l条连通线段两个端点对应的节点编号，且(il,jl)∈{(il,jl)|il,jl=1,2,…,n，il≠jl}；k=1,2,…,n，l=1,2,…,m；步骤3，将步骤2得到的数据矩阵U1和U2作为初始条件，创建采用Dijkstra算法进行路径规划所需网络拓扑结构,以路径的长度作为约束条件，规划出一条初始最优路径：f(s)=min(length(sstart→sgoal))其中：sstart为起始点，sgoal为目标点，f(s)为在所创建的网络拓扑结构中距离最短的一条路径；建立矩阵U3用以存储初始最优路径从起始点到达目标点过程中所经历的连通线段总数，以及连通线段两端对应的节点编号； U 3 = 1 e 1 f 1 2 e 2 f 2 . . . q e q f q . . . v e v f v 其中：v表示从起始点到达目标点过程中初始最优路径所经历的连通线段总数，(eq,fq)为第q条连通线段两端节点对应的编号，(eq,fq)满足如下关系：(eq,fq)∈{(eq,fq)|q=1,2,…v，eq≠fq}；步骤4，根据步骤3得到的矩阵U3中的节点编号，以及矩阵U1中对应节点的全局坐标信息，将路径长度函数f(S)作为适应度函数：f(S)=min(length(e1→f1)+length(e2→f2)+…+length(eq→fq))确定坐标约束范围：f(xk,yk)=0,(ak

下载完整专利技术内容需要扣除积分，VIP会员可以免费下载。 免登录下载普通用户下载升级VIP会员，免费下载

该专利技术资料仅供研究查看技术是否侵权等信息，商用须获得专利权人授权。该专利全部权利属于北京理工大学，未经北京理工大学许可，擅自商用是侵权行为。如果您想购买此专利、获得商业授权和技术合作，请联系【客服】

本文链接：http://www.vipzhuanli.com/patent/201210487551.6/，转载请声明来源钻瓜专利网。