[发明专利]机器人的路径规划方法及装置有效
申请号: | 201910162350.0 | 申请日: | 2019-03-04 |
公开(公告)号: | CN109991977B | 公开(公告)日: | 2022-04-29 |
发明(设计)人: | 靳宝琪;李洪祥;孟祥鑫;杨佳;王永锟 | 申请(专利权)人: | 斯坦德机器人(深圳)有限公司 |
主分类号: | G05D1/02 | 分类号: | G05D1/02 |
代理公司: | 深圳中细软知识产权代理有限公司 44528 | 代理人: | 安秀梅 |
地址: | 518000 广东省*** | 国省代码: | 广东;44 |
权利要求书: | 查看更多 | 说明书: | 查看更多 |
摘要: | |||
搜索关键词: | 机器人 路径 规划 方法 装置 | ||
1.一种机器人的路径规划方法,其特征在于,包括:
接收待处理任务,基于所述待处理任务中的起点和终点确定目标机器人的运行路径;
根据所述目标机器人的运动方向确定其运行路径的方向,基于所述运行路径的方向对至少两个目标机器人的运行路径进行冲突检测;包括:获取所述至少两个目标机器人的运行路径所经过的节点,根据所述节点划分路径段;依次比较每个路径段的两个端点以及路径段的方向;当出现至少两个路径段的两个端点相同、且方向相反时,判断为目标机器人的运行路径存在冲突;
当至少两个目标机器人的运行路径存在冲突时,根据预设路径规划策略重新规划所述至少两个目标机器人的运行路径;包括:确定所述至少两个目标机器人的运行路径的冲突路径段;沿着每个目标机器人的运行路径计算到达所述冲突路径段的距离长度;当所述距离长度大于预设长度值时,更新所述目标机器人的运行路径为到达所述冲突路径段的路径;当所述距离长度小于等于预设长度值时,为所述目标机器人重新规划排除所述冲突路径段的运行路径。
2.根据权利要求1所述的方法,其特征在于,所述接收待处理任务,基于所述待处理任务中的起点和终点确定目标机器人的运行路径,包括:
读取所述待处理任务中的起点信息和终点信息;
根据所述起点信息和终点信息确定目标机器人的起点和终点,从预设地图数据中选取经过所述起点和终点的预设路径作为所述目标机器人的运行路径。
3.根据权利要求1所述的方法,其特征在于,所述为所述目标机器人重新规划排除所述冲突路径段的运行路径,包括:
根据所述目标机器人需要执行的待处理任务的起点和终点,从预设地图数据中选取出经过所述起点和终点、且排除所述冲突路径段的预设路径,作为所述目标机器人的运行路径。
4.根据权利要求1至3任一项所述的方法,其特征在于,包括:
当目标机器人开始运行时,将所述目标机器人与其运行路径进行绑定,以占有所述运行路径;
当所述目标机器人离开运行路径时,释放所述运行路径。
5.一种机器人的路径规划装置,其特征在于,包括:
路径确定模块,用于接收待处理任务,基于所述待处理任务中的起点和终点确定目标机器人的运行路径;
冲突检测模块,用于根据所述目标机器人的运动方向确定其运行路径的方向,基于所述运行路径的方向对至少两个目标机器人的运行路径进行冲突检测;包括:获取所述至少两个目标机器人的运行路径所经过的节点,根据所述节点划分路径段;依次比较每个路径段的两个端点以及路径段的方向;当出现至少两个路径段的两个端点相同、且方向相反时,判断为目标机器人的运行路径存在冲突;
路径规划模块,用于当至少两个目标机器人的运行路径存在冲突时,根据预设路径规划策略重新规划所述至少两个目标机器人的运行路径;包括:确定所述至少两个目标机器人的运行路径的冲突路径段;沿着每个目标机器人的运行路径计算到达所述冲突路径段的距离长度;当所述距离长度大于预设长度值时,更新所述目标机器人的运行路径为到达所述冲突路径段的路径;当所述距离长度小于等于预设长度值时,为所述目标机器人重新规划排除所述冲突路径段的运行路径。
6.一种终端,其特征在于,包括存储器及处理器,所述存储器中储存有计算机程序,所述计算机程序被所述处理器执行时,使得所述处理器执行如权利要求1至4中任一项所述的方法的步骤。
7.一种计算机可读存储介质,其上存储有计算机程序,其特征在于,所述计算机程序被处理器执行时实现如权利要求1至4中任一项所述的方法的步骤。
该专利技术资料仅供研究查看技术是否侵权等信息,商用须获得专利权人授权。该专利全部权利属于斯坦德机器人(深圳)有限公司,未经斯坦德机器人(深圳)有限公司许可,擅自商用是侵权行为。如果您想购买此专利、获得商业授权和技术合作,请联系【客服】
本文链接:http://www.vipzhuanli.com/pat/books/201910162350.0/1.html,转载请声明来源钻瓜专利网。