一种静态障碍物下室内多任务点路径规划方法技术

本发明专利技术属于物流机器人领域，尤其涉及一种静态障碍物下室内多任务点路径规划方法，包括以下步骤：S1、采集静态障碍地图，标注生成兴趣点集合M；S2、采用Floyd算法，生成兴趣点拓扑连接序列表；S3、输入兴趣点拓扑连接序列表；S4、输入任务点集合F；S5、查询兴趣点集合X；S6、采用模拟退火算法求解兴趣点集合X中的兴趣点，得到兴趣点的有效排列Q(X)；S7、组合求解出的兴趣点连接关系得到多任务最优组合序列。本发明专利技术有效解决了静态障碍地图复杂度对规划效率的影响，提高了规划效率以及多任务最优路径稳定性，从而提高了仓库搬运机器人的运送效率。从而提高了仓库搬运机器人的运送效率。从而提高了仓库搬运机器人的运送效率。

【技术实现步骤摘要】
一种静态障碍物下室内多任务点路径规划方法


[0001]本专利技术属于物流机器人领域，尤其涉及一种静态障碍物下室内多任务点路径规划方法。

技术介绍

[0002]静态障碍物下室内机器人多任务路径规划方法是指：机器人从等待区领取多个任务点，机器人对所要走的路径进行选择，该路径必须能够经过领取到的所有的任务点并在任务点执行任务，同时避开静态环境下的障碍物，最后在完成所有任务后回到等待区。路径选择的目标是要使求得的路径路程为所有路径之中的最小值并且避开静态障碍物。
[0003]目前机器人多任务规划方法主要有如下三种：（1）人工神经网络：将多任务问题理解为组合优化问题，通过构造能量函数，建立神经元，与任务节点数据集G建立联系，经过神经网络演化、迭代，逐渐趋于稳定状态，输出途经多任务点的路径；（2）动态规划法+可视图算法：使用环境地图模型，在所有任务点的点集之中，两两任务点间使用可视图算法，在环境地图模型中寻找到两点间最短路径，最短路径路程用任务点之间的代价矩阵表示，假设从顶点任务节点出发，逐级将多任务路径最优问题分解成多个子问题，通过先求解子问题，再由这些子问题的解，最终得到全局多任务路径最优解。
[0004]（3）遗传算法+Dijkstra算法（狄克斯特拉算法）：使用栅格法构建障碍地图模型，通过遗传算法获取到任务点序列，通过Dijkstra算法在栅格障碍地图模型中计算任务序列个体中任务点之间在栅格地图中避障最短路径，通过迭代多次的选优、交叉、变异，得到途经多个任务点并且避开静态障碍物的最短路径组合，输出最优路径。
[0005]上述三种方法中存在的不足分别是：（1）人工神经网络目前存在的问题：一是获得的多任务避障路径不是很理想，训练时间及次数对结果的质量有很大的影响，加大训练时间及次数会影响效率；二是存在不稳定性，在算法运算过程中会得到无效路径。
[0006]（2）动态规划法+可视图算法目前存在的问题：一是动态规划法能够稳定输出最短任务序列，但是耗费时间较大；二是动态规划法可能会陷入局部最优解；三是可视图法算法的复杂度与障碍物的数量以及障碍物形状成正比，影响规划难度。
[0007]（3）遗传算法+Dijkstra算法存在的弊端：一是遗传算法中交叉算法的设计极易影响结果，导致相同任务输出结果不一致；二是遗传算法选择时，当较优个体数值过大时，会导致后期慢，陷入局部最优，整体时间过长；三是输出结果仅是相对最优而非全局最优；四是Dijkstra算法中栅格地图模型地图可规划区域较大时，容易导致Dijkstra算法搜索范围增大从而影响效率。

技术实现思路

[0008]根据以上现有技术中的不足，专利技术提供了一种提高了规划效率以及多任务最优路
径稳定性，从而提高了仓库搬运机器人的运送效率的静态障碍物下室内多任务点路径规划方法。
[0009]本专利技术所述的静态障碍物下室内多任务点路径规划方法，包括以下步骤：S1、采集静态障碍地图，标注生成兴趣点集合M={1，2，
……
，m}，编辑兴趣点集合M中兴趣点之间的连接关系；S2、采用Floyd算法，利用多源最短路径算法计算兴趣点集合M中某一兴趣点i到其余兴趣点集合K中任一兴趣点可联通的路径距离最优以及次优解，生成兴趣点拓扑连接序列表，以id序列和序列表路径距离组成，其中，兴趣点集合K是指除兴趣点i以外的兴趣点的集合；S3、输入兴趣点拓扑连接序列表；S4、输入任务点集合F={f0，f1，f2，f3
……
fn}，其中机器人位置为起点f0；S5、查询兴趣点集合X={x0，x1，x2，x3
……
xn}，其中兴趣点集合X为兴趣点集合M中与任务点集合F中的任务点一一对应的兴趣点的集合；S6、采用模拟退火算法求解兴趣点集合X中的兴趣点，得到兴趣点的有效排列Q(X)={v1，v2
……
vn}；S7、组合求解出的兴趣点连接关系得到多任务最优组合序列。
[0010]其中，Floyd算法又称为插点法，是一种利用动态规划的思想寻找给定的加权图中多源点之间最短路径的算法，也称为多源最短路径算法。
[0011]所述的S2中，Floyd算法生成兴趣点拓扑连接序列表的具体步骤为：S21、通过拓扑地图表，获取兴趣点的相邻连接点关系，建立邻接矩阵dist储存路径，对相连两点之间的距离进行标记，如果两点没有直接相连则标记为无穷大；S22、将第1个兴趣点到第n个兴趣点依次加入拓扑地图表中，在每个兴趣点加入时试探是否有路径长度被更改；S23、遍历拓扑地图表中每一个兴趣点，用i，j表示其中两点，判断i，j两点之间距离是否因为新加入的点z而发生最小距离变化，如果状态发生改变，则更新i，j两点之间距离；S24、重复上述步骤S21
‑
S23直到最后加入兴趣点试探完成；S25、输出最短路径和次优路径的兴趣点联通序列，同时最终状态代表点与点之间的最短路径，建立兴趣点拓扑连接序列表。
[0012]其中S23中，状态发生改变的更新方法的方程为：dp[i][j]=min(dp[i][j]，dp[i][k]+dp[k][j])，其中dp[i][j]为i到j的最短路径，dp[i][k]为i到k的最短路径，dp[k][j]为k到j的最短路径。
[0013]所述的S6中，模拟退火算法包括以下步骤：S31、设置的主要控制参数包括：快速降温速率q1，快速降温高温阈值G，二次精准降温速率q2、初始温度T0、当前温度为T，结束温度Td、精度值K、计数值count以及链长L；S32、查询任务点对应的兴趣点序列，随机生成序列初始解Y1，计数值count设置为0，精度值K设置为1；S33、通过对当前解Y1进行变异，对构成新解的元素进行交换、位移、置换、倒置的多重方式变异，并用二零域变换法产生新的序列组合新解Y2；
S34、建立Metropolis准则，若路径长度函数为f(Y)，则当前解的路径长度为f(Y1)，新解的路径长度为f(Y2)，路径差为df=f(Y2)
‑
f(Y1)，则接受新解路径序列概率准则为：；S35、精度值K加1，判断K是否大于L，是则进行降温，否则返回S33继续迭代；S36、根据当前温度T是否大于快速降温高温阈值G，判断是否需要快速低精度降温，是则采用快速降温速率q1进行降温，即T=q1*T，继续迭代执行二次精准降温；否则采用二次精准降温速率q2进行降温，即T=q2*T，同时计数值count加1；S37、若T小于结束温度Td，则停止迭代输出当前状态，否则返回S32继续迭代；S38、得到有效排列Q(X)={v1，v2
……
vn}。
[0014]所述的S7中的最优组合序列的具体步骤为：通过离线兴趣点连接拓扑表查询获取N个任务点之间的距离，计算有效排列Q(X)={v1，v2
……
vn}并回到起点，使得：取得最小值，即全局多任务组合路径最短，其中表示兴趣点i到兴趣点i+1的路径距离，表示兴趣点vn到兴趣点v1的路径距离。
[0015]本专利技术所具有的有本文档来自技高网...

【技术保护点】

【技术特征摘要】
1.一种静态障碍物下室内多任务点路径规划方法，其特征在于包括以下步骤：S1、采集静态障碍地图，标注生成兴趣点集合M={1，2，
……
，m}，编辑兴趣点集合M中兴趣点之间的连接关系；S2、采用Floyd算法，利用多源最短路径算法计算兴趣点集合M中某一兴趣点i到其余兴趣点集合K中任一兴趣点可联通的路径距离最优以及次优解，生成兴趣点拓扑连接序列表，以id序列和序列表路径距离组成，其中，兴趣点集合K是指除兴趣点i以外的兴趣点的集合；S3、输入兴趣点拓扑连接序列表；S4、输入任务点集合F={f0，f1，f2，f3
……
fn}，其中机器人位置为起点f0；S5、查询兴趣点集合X={x0，x1，x2，x3
……
xn}，其中兴趣点集合X为兴趣点集合M中与任务点集合F中的任务点一一对应的兴趣点的集合；S6、采用模拟退火算法求解兴趣点集合X中的兴趣点，得到兴趣点的有效排列Q(X)={v1，v2
……
vn}；S7、组合求解出的兴趣点连接关系得到多任务最优组合序列。2.根据权利要求1所述的一种静态障碍物下室内多任务点路径规划方法，其特征在于：所述的S2中，Floyd算法生成兴趣点拓扑连接序列表的具体步骤为：S21、通过拓扑地图表，获取兴趣点的相邻连接点关系，建立邻接矩阵dist储存路径，对相连两点之间的距离进行标记，如果两点没有直接相连则标记为无穷大；S22、将第1个兴趣点到第n个兴趣点依次加入拓扑地图表中，在每个兴趣点加入时试探是否有路径长度被更改；S23、遍历拓扑地图表中每一个兴趣点，用i，j表示其中两点，判断i，j两点之间距离是否因为新加入的点z而发生最小距离变化，如果状态发生改变，则更新i，j两点之间距离；S24、重复上述步骤S21
‑
S23直到最后加入兴趣点试探完成；S25、输出最短路径和次优路径的兴趣点联通序列，同时最终状态代表点与点之间的最短路径，建立兴趣点拓扑连接序列表。3.根据权利要求2所述的一种静态障碍物下室内多任务点路径规划方法，其特征在于：所述的S23中，状态发生改变的更新方法...

【专利技术属性】
技术研发人员：郑勇飞，王维，
申请(专利权)人：睿羿科技山东有限公司，
类型：发明
国别省市：