一种基于A*算法的AGV路径规划方法与流程

本发明属于工业控制技术领域，具体是涉及一种基于A*算法的AGV路径规划方法。

背景技术：

随着生产物流自动化程度的提高，现代工业生产对物流系统提出了更高的要求。自动导引运输车(AGV)是一种能够在给定路径和场景信息布局中，完成指定运输任务的自动化运输设备。一个系统中AGV的数量的不断增加，给AGV系统路径规划带来不少困难。一个好的路径规划方法，不仅能够提高自动化生产效率，同时还能保证生产设备的利用率。传统的A*算法下的路径规划，利用栅格法建模，即增加了计算机资源不必要的内存损耗，同时还提高了计算的冗余度，不利于生产的高效性。

技术实现要素：

本发明的目的在于提供一种基于A*算法的AGV路径规划方法，简化了生产环境信息，提高了路径规划效率和准确度。

实现本发明目的的技术解决方案为：一种基于A*算法的AGV路径规划方法，包括如下步骤：

步骤一、对AGV工作环境建模：将搜索区域划分为拓扑结构，将各工作站点视为节点，将节点坐标和各个节点的连通信息存储在数据库中；

步骤二、创建两个链表分别储存待检测节点和已检测节点：分别创建OPEN链表和CLOSED链表，把起点A点放入OPEN表；

步骤三、判断OPEN表是否为空：判断OPEN表是否为空，若OPEN表中无节点，则表示路径规划失败，算法结束；若有节点，转步骤四；

步骤四、选取OPEN表具有最小F值的节点：选取OPEN表上评价函数F值最小0的节点n，放入CLOSED表；

步骤五、判断启发函数H(n)是否为0：判断启发函数H(n)是否为0，若H(n)为0，表示已到达目标节点，路径规划成功；否则，还未到目标节点，转步骤六；

步骤六、扩展节点n：选择不在CLOSED表的连接节点，计算其F值；

步骤七、确定扩展的连通子节点：判断扩展的连通子节点是否在OPEN表中，若子节点在OPEN表中，转步骤九；否则转步骤八。

步骤八、将扩展的连通子节点加入OPEN表：将扩展的连通子节点加入OPEN表作为节点n的子节点，将该节点的父节点指针指向节点n，接着转步骤三；

步骤九、确定扩展节点的F值：计算该节点经过节点n的F值，若大于自身的F值，转步骤十；否则，转步骤三；

步骤十、更新扩展节点的F值：用该节点自身的F值，更新OPEN表中该节点的F值，转步骤三。

本发明与现有技术相比，其显著优点为：(1)本发明环境建模简单，减少了计算机资源的数据存储量；(2)本发明减少计算冗余，能够更快更好的输出最优路径；(3)本发明便于后续的调度系统联调。

附图说明

图1是本发明基于A*算法的AGV路径规划方法的流程图。

图2是某工厂车间环境设备平面图。

图3是某工厂车间拓扑建模平面图。

图4是改进A*算法下与传统A*算法下的路径规划路线图。

具体实施方式

下面结合附图和具体实施例对本发明做进一步详细论述。

本发明适用于拓扑地图下基于A*算法的AGV路径规划方法，首先用拓扑法建立环境地图，将抽象的环境描述成具体的数据结构；其次，利用A*算法构建启发函数，并设定合理的估价函数，求解地图上节点间的路径；最后，根据AGV具体任务要求，制定合理的代价机制，来引导算法做出最优解。具体步骤如下：

步骤一、对AGV工作环境建模：将搜索区域划分为拓扑结构，将各工作站点视为节点，将节点坐标和各个节点的连通信息存储在数据库中；

步骤二、创建两个链表分别储存待检测节点和已检测节点：分别创建OPEN链表和CLOSED链表，一开始把起点A点放入OPEN表；

步骤三、判断OPEN表是否为空：判断OPEN表是否为空，若OPEN表中无节点，则表示路径规划失败，算法结束；若有节点，转步骤四；

步骤四、选取OPEN表具有最小F值的节点：选取OPEN表上评价函数F值最小0的节点n，放入CLOSED表；

步骤五、判断启发函数H(n)是否为0：判断启发函数H(n)是否为0，若H(n)为0，表示已到达目标节点，路径规划成功；否则，还未到目标节点，转步骤六；

步骤六、扩展节点n：选择不在CLOSED表的连接节点，计算其F值；

步骤七、确定扩展的连通子节点：判断扩展的连通子节点是否在OPEN表中，若子节点在OPEN表中，转步骤九；否则转步骤八。

步骤八、将扩展的连通子节点加入OPEN表：将扩展的连通子节点加入OPEN表作为节点n的子节点，将该节点的父节点指针指向节点n，接着转步骤三；

步骤九、确定扩展节点的F值：计算该节点经过节点n的F值，若大于自身的F值，转步骤十；否则，转步骤三；

步骤十、更新扩展节点的F值：用该节点自身的F值，更新OPEN表中该节点的F值，转步骤三。

步骤四的F值由以下公式求出：

F(n)＝G(n)+H(n)

其中，F(n)是节点n的评价函数，G(n)为节点n的实际代价函数，表示从起始节点到当前节点的实际移动开销，H(n)为节点n的启发函数，表示从当前节点到目标节点的估计移动开销。

步骤五启发函数采用曼哈顿距离估计，仅在X、Y坐标方向移动，用以表明两点在坐标系上的绝对轴距之和。

实施例1

图2为某工厂车间环境设备平面图，图3为车间拓扑建模平面图。该工厂车间中设置了29个节点站用于AGV输送任务停靠站，节点之间有连线的即是连通的，AGV只能在连通路段上行驶。设置节点1为任务起点A，终点是节点27，采用本发明方法进行AGV路径规划。

算法流程结束时输出最优路径，图4中加粗实线代表本发明的规划算法生成的路径，与传统A*算法采用栅格法建模生成的虚线路径相比，显然本发明的方法输出更平滑、安全可靠的路径，传统算法的路径比较粗糙，并且计算量大，不能保证是最优路径。