[发明专利]一种激光叉车路径搜索方法

说明书

本发明公开的一种激光叉车路径搜索方法，包括如下步骤：S1、基于激光叉车运行环境中的主站点及子站点分别构建主有向图和子有向图，多个子站点可以从属于同一个主站点，一个子站点不能从属于两个不同的主站点；S2、确定距激光叉车的起始站点V_start及任务站点V_task；S3、检测V_start、V_task的站点属性，若存在子站点，则基于主有向图及子有向图分别规划主站点间的最短主路径、子站点间的最短子路径，对最短主路径与最短子路径进行拼接，形成V_start到V_task的最短路径。针对不同属性的站点分别建立了主有向图和子有向图，从而分离了不同属性站点间的路径搜索，减少最短路径搜索过程中的节点数量，减少数据处理量，进而提高了任务路径搜索效率，并且灵活性更好。

技术领域

本发明属于路径规划技术领域，更具体地，本发明涉及一种激光叉车路径搜索方法。

背景技术

近年来，随着物料输送系统、自动化立体仓库等快速发展，叉车作为一种高效的装卸运输车辆，在制作业输送环节得到了较为广泛的应用。其中，激光叉车由于具有转弯半径小、自动化程度高等特点，在人工驾驶叉车应用场景中能够得到直接应用。

由于激光叉车应用环境通常较为复杂，不仅存在较多设备，同时还存在设备操作人员，因而在激光叉车自动工作前，通常需要人为设置叉车行驶路径站点及工作站点等，并设计叉车行驶路径。通常情况下，对叉车行驶路径端点与叉车工作站点并不直接进行区分，直接基于叉车工作环境模型中所有节点生成一张有向图，不仅导致激光叉车最短路径搜索时，需要遍历有向图中过多节点，数据冗余量过大，搜索效率较低，同时忽略了节点间的不同属性，无法将有向图中的节点设置与激光叉车工作站点对应。

发明内容

本发明提供一种激光叉车路径搜索方法，旨在改善上述问题。

本发明是这样实现的，一种激光叉车路径搜索方法，所述方法具体包括如下步骤：

S1、基于激光叉车运行环境中的主站点及子站点分别构建主有向图和子有向图，多个子站点可以从属于同一个主站点，同一个子站点不能从属于两个不同的主站点；

S2、确定激光叉车的起始站点V_start及任务站点V_task；

S3、检测V_start、V_task的站点属性，若存在子站点，则基于主有向图及子有向图分别规划主站点间的最短主路径、子站点间的最短子路径，对最短主路径与最短子路径进行拼接，形成V_start到V_task的最短路径。

进一步的，若V_start为子站点，V_task为主站点，V_start到V_task的最短路径获取方法具体如下：

11)获取起始站点V_start对应的主站点V_m_star；

12)基于主有向图G1搜索从起始主站点V_m_start到任务站点V_task之间的最短主路径Path_m；

13)起始主站点V_m_start沿路径Path_m方向向前一定距离dist后，确定从属于起始主站点V_m_star且距其最近的起始子节点V_p_start；

14)基于子有向图搜索从起始站点V_start到起始子站点V_p_start之间最短子路径Path_s1；

15)将主路径Path_m中起始子站点V_p_start之前路径进行剔除，并将子路径Path_s1拼接到剔除后的主路径Path_m之前，形成从起始站点V_start到任务站点V_task之间的最短行驶路径。

进一步的，若V_start为主站点，V_task为子站点，V_start到V_task的最短路径获取方法具体如下：

21)获取任务站点V_task对应的主站点V_m_task；