一种实时路径规划方法及AGV
Abstract:
本发明公开的一种实时路径规划方法,包括如下步骤:S1、构建车辆行驶环境的拓扑地图;S2、检测车辆当前位置P0是否处于固定路径上,若检测结果为否,则执行步骤S3;S3、确定固定路径上距当前位置最近的站点P1,规划站点P1到任务站点的最短路径R0;S4、计算当前位置P0与站点P1间的夹角θ,若abs(θ)>90°,执行步骤S5,S5、将站点P1在路径R0中的下一站点P2作为起始点,规划站点P2到任务节点Ps的最短路径R1,再规划当前位置P0到站点P2的最短行驶路径R2,路径R2与路径R1的拼接即形成当前位置P0到任务站点Ps的行驶路径R。在车辆偏离固定行驶路径时,在行驶路径上搜索距当前位置近且夹角小于90度的站点进行最短路径规划,避免车辆的掉头行驶。
Public/Granted literature
Patent Agency Ranking
0/0