一种激光叉车路径规划方法技术

本发明专利技术公开了一种激光叉车路径规划方法，包括以下步骤：构建激光叉车所处的环境模型；构建环境模型的环境拓扑图及有向图；根据任务列表获取激光叉车需要执行的任务；根据接收到激光叉车当前的位姿，判断激光叉车所处的位置，为子节点或主节点或路径上；若激光叉车处于子节点，则直接利用AStar算法规划子节点所处的主节点至目标节点的最短路径；若激光叉车处于主节点，首先利用AStar算法规划出一条最短路径。采用上述技术方案，建模简单，减少占用计算机的存储资源；提出了无需叉车原地掉头的路径规划，减少了场地路面的磨损，解决无法掉头的问题；提出了小车停靠在任意位置的路径规划，解决了以往叉车必须停靠在节点的问题。

A path planning method of laser forklift

【技术实现步骤摘要】
一种激光叉车路径规划方法
本专利技术属于物料输送机械设备自动控制的
更具体地，本专利技术涉及一种激光叉车路径规划方法，并可扩展用到所有自动运输车的

技术介绍
一、相关技术发展背景介绍：随着物料输送系统、柔性制造系统、自动化立体仓库系统等的发展，AGV(AutomatedGuidedVehicle，自动运输小车)作为物料输送系统和柔性制造系统中的重要组成部分，可以解决传统物流系统的弊端，在制造业输送环节得到了广泛的应用。近年来，激光叉车因其智能化程度高、柔性强的特点，越来越受到各类企业的青睐。激光叉车相比于其他导航方式的AGV，突破了固定路径导航方式轨迹不能改变和需要铺设导轨的弊端，其只需安装反光板和布置网络等简单的施工，具有转弯半径小、路径更改方便的优势，可直接应用在人工驾驶叉车的使用场景中。要实现叉车的自主完成堆、取货物，就涉及到激光叉车当前位置到目标点间的路径规划问题，现有的路径规划方法如Floyd，Dijstra，A-star算法已完成路径规划的最短路径的规划，但这些算法更多的是点到点的情况，并未考虑到叉车不在节点的情况，而且若规划的最短路径需要激光叉车原地掉头，这将会严重磨损地面，或因场地显示，无法使激光叉车完成原地掉头的动作，从而影响工厂的整体运行效率。二、现有技术的文献检索结果：1、中国专利文献：一种基于floyd算法的激光叉车路径搜索方法；(201811629622.5)，其记载的技术方案是：采用Floyd路径规划算法完成激光叉车的路径搜索，若激光叉车不在路径节点位置，则以距叉车当前位置最近的节点作为Floyd算法的起始节点，来规划叉车的任务路径。2、中国专利文献：一种基于A*算法的AGV路径规划方法；(201711494629.6)其记载的技术方案是：采用A*算法规划AGV的运行路线。三、最接近的现有技术及其存在的技术问题：以上检索到的申请号为201811629622.5的中国专利“一种基于Floyd算法的激光叉车路径搜索方法”，提出了采用Floyd算法完成激光叉车路径搜索方法，该方法使用的算法计算量大，不适应于路径节点过多的情况，且该方法提出激光叉车不在路径节点位置，则以距叉车当前位置最近的节点作为Floyd算法的起始节点，来规划叉车的任务路径，这将导致激光叉车出现陆续掉头的风险。Floy算法计算量大，若无向图节点过多，则消耗搜索路径的时间较多，当激光叉车不在节点时，若以最近的节点作为起始节点，将导致激光叉车可能出现连续掉头的情形。申请号为201711494629.6的中国专利“一种基于A*算法的AGV路径规划方法”，提出了通过构建拓扑环境地图，利用A*算法构建启发函数，并设定合理的估价函数后，从而求解AGV任务的行驶路径。但该方法只是适应于AGV处于路径节点位置下的路径规划，而在实际工厂应用中AGV可能停放在路径上的任意位置且专利中提出的方法并未考虑到因场地限制或因AGV掉头磨损地面等带来的AGV无法原地掉头的问题。只可用于AGV处于节点位置下的路径规划，且并未考虑到因场地限制或AGV掉头磨损地面等带来的AGV无法原地掉头的问题。
技术实现思路
本专利技术提供一种激光叉车路径规划方法，其目的是进行在复杂环境下小车停靠在任意位置时的路径规划，且解决了激光叉车无法掉头的问题。为了实现上述目的，本专利技术采取的技术方案为：本专利技术的激光叉车路径规划方法包括以下步骤：1)、构建激光叉车所处的环境模型；2)、构建环境模型的环境拓扑图及有向图；3)、根据任务列表获取激光叉车需要执行的任务；4)、根据接收到激光叉车当前的位姿(坐标(P(x0，y0))及方向(angle))，判断激光叉车所处的位置，为子节点或主节点或路径上；5)、若激光叉车处于子节点(S_sub)，则直接利用AStar算法规划子节点所处的主节点(S_main)至目标节点(S_goal)的最短路径；若激光叉车处于主节点(S_main)，首先利用AStar算法规划出一条最短路径，该最短路径是由一些列主节点组成的，获取规划的最短路径的首个主节点(S_1)(x1，y1)，判断激光叉车当前的方向(angle)与位置P(x0，y0)和S_1之间的夹角：当abs(θ)＜90°时，将该条最短路径派发至激光叉车；否则，将首个主节点(S_1)的障碍标注属性isObstacle设置为true，重新利用Astar搜索路径，再次搜索路径时，将自动跳过isObstacle为true的节点，从而搜索了一条无需掉头的最优路径。若激光叉车处于路径上，则先查找叉车前进方向最近的主节点S_main，然后规划出主节点至目标节点的最短路径；判断最短路径是否需要叉车掉头；若需要，则将最短路径的首个主节点的的障碍标注属性isObstacle设置为true，重新利用Astar搜索路径。步骤1)中所述的环境模型，包括激光叉车行驶的路径、充电点、主节点；并为每个主节点设置属性flag，flag＝0代表该位置为路径点，只包含了主节点坐标，叉车不可在该位置执行取放货的动作；flag＝1则代表激光叉车在该位置可完成取放货动作，包含了两个坐标(主节点坐标及子节点坐标)。所述的环境拓扑图包括：各个节点以及相通节点的信息，并将相邻节点存储至对方的节点列表中，命名为邻居节点。所述的有向图G＝(V，E)；其中，V代表图中所有的节点，E代表图中节点之间的边；节点之间的每一条边(u，v)都含有一个权值w(uv)，表示节点之间的欧式距离，两条相邻的边之间也有一个权值w(ab)，表示相邻的边的转弯大小。所述的Astar的具体步骤为：1)、建立两张表：openlist和表closelist；其中，表openlist用来存放已生成而未考察的节点；表closelist用来存放已经访问过的节点；2)、重复以下步骤：a、遍历表openlist，查找F值最小的节点，把它作为当前要处理的节点，并将此节点移至表closelist中；b、对该节点的邻居节点一一进行检查，若其是不可抵达的(即属性isObstacle为true)或已在表closelist中，则忽略它；否则，做如下操作：若该邻居节点不在表openlist中，将其加入表openlist中，并把当前节点设置成其父节点；若该邻居节点已在表openlist中，检查所选的路径是否更近；若更近，则将其父节点更改为当前方格，并重新计算节点的估价函数f(n)；重复以上步骤，直至将终点加入到openlist中，此时查找完毕；若查找终点失败，且表openlist为空，则表示起点至终点之间不存在可行的路径；3)、保存路径：所输出的路径为从终点开始，每个节点依次沿着父节点移动直至起点。所述的估价函数f(n)＝g(n)+h(n)；其中：f(n)为起点S经节点n到目的节点F的距离估计值；本文档来自技高网...

【技术保护点】
1.一种激光叉车路径规划方法，其特征在于：所述的路径规划方法包括以下步骤：/n1)、构建激光叉车所处的环境模型；/n2)、构建环境模型的环境拓扑图及有向图；/n3)、根据任务列表获取激光叉车需要执行的任务；/n4)、根据接收到激光叉车当前的位姿，判断激光叉车所处的位置，为子节点或主节点或路径上；/n5)、若激光叉车处于子节点S_sub，则直接利用AStar算法规划子节点所处的主节点S_main至目标节点S_goal的最短路径；/n若激光叉车处于主节点S_main，首先利用AStar算法规划出一条最短路径，该最短路径是由一些列主节点组成的，获取规划的最短路径的首个主节点S_1(x

【技术特征摘要】
1.一种激光叉车路径规划方法，其特征在于：所述的路径规划方法包括以下步骤：
1)、构建激光叉车所处的环境模型；
2)、构建环境模型的环境拓扑图及有向图；
3)、根据任务列表获取激光叉车需要执行的任务；
4)、根据接收到激光叉车当前的位姿，判断激光叉车所处的位置，为子节点或主节点或路径上；
5)、若激光叉车处于子节点S_sub，则直接利用AStar算法规划子节点所处的主节点S_main至目标节点S_goal的最短路径；
若激光叉车处于主节点S_main，首先利用AStar算法规划出一条最短路径，该最短路径是由一些列主节点组成的，获取规划的最短路径的首个主节点S_1(x1，y1)，判断激光叉车当前的方向angle与位置P(x0，y0)和S_1之间的夹角：



当abs(θ)＜90°时，将该条最短路径派发至激光叉车；否则，将首个主节点S_1的障碍标注属性isObstacle设置为true，重新利用Astar搜索路径，再次搜索路径时，将自动跳过isObstacle为true的节点，从而搜索了一条无需掉头的最优路径；
若激光叉车处于路径上，则先查找叉车前进方向最近的主节点(S_main)，然后规划出主节点至目标节点的最短路径；
判断最短路径是否需要叉车掉头；若需要，则将最短路径的首个主节点的的障碍标注属性isObstacle设置为true，重新利用Astar搜索路径。


2.按照权利要求1所述的激光叉车路径规划方法，其特征在于：步骤1)中所述的环境模型，包括激光叉车行驶的路径、充电点、主节点；并为每个主节点设置属性flag，flag＝0代表该位置为路径点，只包含了主节点坐标，叉车不可在该位置执行取放货的动作；flag＝1则代表激光叉车在该位置可完成取放货动作，包含了两个坐标：分别为主节点坐标及子节点坐标。


3.按照权利要求1所述的激光叉车路径规划方法，其特征在于：所述的环境拓扑图包括：各个节点以及相通节点的信息，并将相邻节点存储至对方的节点列表中，命名为邻居节点。


4.按照权利要求1所述的激光叉车路径规划方法，其特征在于：所述的有向图G＝(V，E)；其中，V代表图中所有的节点，E代表图中节点之间的边；节点之间的每一条边(...

【专利技术属性】
技术研发人员：陈双，郑亮，罗海南，林振辉，陆雪强，刘刚，高云峰，曹雏清，
申请(专利权)人：芜湖哈特机器人产业技术研究院有限公司，
类型：发明
国别省市：安徽;34