基于dijkstra算法的工厂AGV路径规划方法

技术领域

本发明涉及人造金刚石加工车间自动运输路径规划技术领域，尤其涉及一种基于dijkstra算法的工厂AGV路径规划方法。

背景技术

AGV(Automated Guided Vehicle，自动导引运输车)是能按照作业任务需求结合自身状态，进行自主导航、避障的车辆。可以广泛运用于各种车间、物流、货运等企业。AGV小车替代了以前的人工搬运、极大的减少了人力资源的消耗。并且AGV所在工作环境的布局具有柔性，能方便的进行路径调整。再投入生产之前可方便的在仿真系统中调试，不影响生产。因此，在自动化物流系统中，最能体现出其自主性和柔性，实现高效、经济、灵活的自主化生产。

在自动化加工车间中，地图在相当一段时间不会改变。对于已经确定的拓扑图，任意两个节点之间的距离是固定的。因此对于AGV的动态调度首先对地图进行预计算，之后的路径规划时间会被大大降低。

发明内容

本发明目的就是为了弥补已有技术的缺陷，提供一种基于dijkstra算法的工厂AGV路径规划方法，在地图没有改变时，动态路径规划以响应不断新增的任务订单时，减少无用节点的搜索从而降低动态路径规划的时间消耗并能够使搜索出来的路径最优，即动态搜索路径等于实际最短路径；地图偶尔变化时，AGV能检测发现并搜索出最优路径。

本发明是通过以下技术方案实现的：

一种基于dijkstra算法的工厂AGV路径规划方法，包括下述步骤：

(1)预处理：把工厂地图信息以拓扑图形式存储并上传到本地；以工厂地图各个节点循环地调用dijkstra算法，计算出各节点到其他所有节点的最短距离，计算结果保存在节点间的距离矩阵D并上传到本地，其中元素d[i][j]表示节点i到节点j的最短距离；

(2)在某节点处产生任务订单后，需要生成由起点v

dist(v

其中μ(v

dist(v

若等式(1)成立，则边μ(v

(3)遍历工厂地图中所有以v

f(v

其中f(v

计算出以v

步骤(1)中，以工厂地图各个节点循环地调用dijkstra算法，计算出的各节点到其他所有节点的最短距离为以时间为权值的最短距离。

对于地图没有变化情况，任意两节点之间的地理最短距离确定不变，所以预处理阶段得到两点间距离d[i][j]所构成的矩阵D与实际车间地理最短距离一致。通过不断循环步骤(2)，逐步从源点向目标点扩展从而得到实际最短路径。该算法不用计算与理论最短路径无关的点，使得只需要搜索最短路径沿途的边以及沿途各点为起点的边。在动态调度中极大程度的降低了一次路径规划的时间成本。

对于地图有变化情况即μ(v

本发明的优点是：

(1)本发明使用预计算地图信息的路径规划方法，使得算法不用再计算大量的无用节点，极大提高了在工厂中AGV动态路径规划时的节点搜索效率。

(2)本发明能够在极短时间内动态的计算出从源点到目的点的最短路径。

(3)本发明在工厂地图环境发生变化时，及时做出调整并重新规划出从地图变化点到目的点的最优路线。

(4)使用此算法，能够在动态调度中极大地降低进行一次路径规划的时间成本，为融合路径算法提供了新的解决方案。

附图说明

图1为本发明实施例的整体实施流程图；

图2为本发明实施例的路径搜索过程中检索节点示意图；

图3为本发明实施例中最短距离示意图。

具体实施方式

如图1所示，一种基于dijkstra算法的工厂AGV路径规划方法，包括以下步骤：

步骤1：工厂地图以拓扑图形式构成表(outEdge List)，方便查询；

如图2所示，依次对每个节点使用标准Dijkstra算法，得出此点到其余各点的最短路径(以时间为权值)，构成矩阵Dst，方便查询；

步骤2：将当前点设置为起始点，累计距离S置0，从矩阵Dst中获取待规划路段的起点s到终点e的最短距离Dst

步骤3：判断S＝＝Dst

步骤4：获取以当前点t为起点的边表(outEdge List)，遍历；

步骤5：获取当前边的权值t

Dst

其中Dst

步骤6：判断是，当前点置为out,S＝S+t

步骤7：当遍历完所有当前节点t为起点的边都不能满足步骤5中的等式，则判定工厂地图发生改变即表(outEdge List)发生变化；

步骤8：在表(outEdge List)中遍历以当前节点t为起点的边，通过计算

f(t)＝t

得出最小f(t)代价值并得出该边的结束节点out；

步骤9：把节点out设为起始节点，并跳到步骤3。

经过上述步骤最终遍历到目的节点，算法结束。从该算法不难看出：本发明提供了一种通过预计算地图信息的动态路径规划方法，使得搜索效率极大提高并能够在工厂地图变化或未变化的情况下精确的检索到的最短路径。为今后的融合算法提供了一种新的解决思路。

上述的实施方案是为了帮助读者理解本发明的原理，应被理解为本发明的保护范围并不局限于这样的特别陈述和实施例。在本领域的普通技术人员所具备的知识范围内，还可以根据本发明公开的这些技术启示做出各种不脱离本发明实质的其它各种具体变形和组合，这些变形和组合仍然在本发明的保护范围内。