[发明专利]一种规划机器人局部路径的方法及机器人在审
| 申请号: | 201911191113.3 | 申请日: | 2019-11-28 |
| 公开(公告)号: | CN110967019A | 公开(公告)日: | 2020-04-07 |
| 发明(设计)人: | 夏舸;李超;周唐凯 | 申请(专利权)人: | 深圳优地科技有限公司 |
| 主分类号: | G01C21/20 | 分类号: | G01C21/20;G01C21/00 |
| 代理公司: | 深圳中一联合知识产权代理有限公司 44414 | 代理人: | 李娟 |
| 地址: | 518000 广东省深圳市宝安区新安*** | 国省代码: | 广东;44 |
| 权利要求书: | 查看更多 | 说明书: | 查看更多 |
| 摘要: | |||
| 搜索关键词: | 一种 规划 机器人 局部 路径 方法 | ||
1.一种规划机器人局部路径的方法,其特征在于,包括:
规划所述机器人的全局路径;
获取所述机器人的当前位置,并确定包含所述当前位置的第一局部区域范围,将所述全局路径在所述第一局部区域范围内的部分作为第一参考路径;
生成与所述第一参考路径平行的至少一条第一候选局部路径;
根据预定的参数对生成的所述至少一条第一候选局部路径进行评分;
将评分最高的第一候选局部路径作为目标局部路径。
2.根据权利要求1所述的方法,其特征在于,生成与所述第一参考路径平行的至少一条第一候选局部路径包括:
沿预设方向对所述第一参考路径进行平移,得到初始第一候选局部路径;
对待连接的位置和所述当前位置进行平滑连接,所述待连接的位置为距离每条初始第一候选局部路径的起点为预设距离的位置;
将连接后的第一候选局部路径作为最终的第一候选局部路径。
3.根据权利要求1所述的方法,其特征在于,根据预定的参数对生成的所述至少一条第一候选局部路径进行评分包括:
获取所述机器人周围的环境信息;
根据获取的所述环境信息,确定所述机器人周围障碍物的位置信息;
根据所述机器人周围障碍物的位置信息,确定所述至少一条第一候选局部路径的可通行性;
计算至少一条可通行第一候选局部路径的长度;
计算至少一条可通行第一候选局部路径与所述第一参考路径的间距;
根据计算的所述长度和间距,对所述至少一条可通行第一候选局部路径进行评分。
4.根据权利要求3所述的方法,其特征在于,根据计算的所述长度和间距,对所述至少一条可通行第一候选局部路径进行评分包括:
根据预设公式、计算的所述长度和间距,对所述至少一条可通行第一候选局部路径进行评分,所述预设公式为F=α×A+β×B,其中F为所述至少一条可通行第一候选局部路径的评分,α为第一权重,A为所述至少一条可通行第一候选局部路径的长度,β为第二权重,B为所述至少一条可通行第一候选局部路径与所述第一参考路径的间距。
5.根据权利要求3所述的方法,其特征在于,所述方法还包括:
当第一候选局部路径的可通行性均为不可通行时,调整所述机器人的当前位置,并确定包含调整后的当前位置的第二局部区域范围,将所述全局路径在所述第二局部区域范围内的部分作为第二参考路径;
生成与所述第二参考路径平行的至少一条第二候选局部路径;
根据预定的参数对生成的所述至少一条第二候选局部路径进行评分。
6.根据权利要求5所述的方法,其特征在于,所述方法还包括:
当第二候选局部路径的可通行性均为不可通行时,以预设的方式进行报警提示。
7.根据权利要求5所述的方法,其特征在于,所述方法还包括:
当第二候选局部路径的可通行性均为不可通行时,继续检测所述第二候选局部路径的可通行性,并在所述第二候选局部路径为可通行时,再次对所述至少一条第二候选局部路径进行评分。
8.根据权利要求1至7任一项所述的方法,所述方法还包括:
获取所述目标局部路径的目标朝向和所述机器人的当前朝向;
调整所述机器人的当前朝向,以使得调整后的所述机器人沿所述目标朝向行走。
9.一种机器人,包括存储器、处理器以及存储在所述存储器中并可在所述处理器上运行的计算机程序,其特征在于,所述处理器执行所述计算机程序时实现如权利要求1至8任一项所述方法的步骤。
10.一种计算机可读存储介质,所述计算机可读存储介质存储有计算机程序,其特征在于,所述计算机程序被处理器执行时实现如权利要求1至8任一项所述方法的步骤。
该专利技术资料仅供研究查看技术是否侵权等信息,商用须获得专利权人授权。该专利全部权利属于深圳优地科技有限公司,未经深圳优地科技有限公司许可,擅自商用是侵权行为。如果您想购买此专利、获得商业授权和技术合作,请联系【客服】
本文链接:http://www.vipzhuanli.com/pat/books/201911191113.3/1.html,转载请声明来源钻瓜专利网。
- 上一篇:一种单环刺螠室内养殖装置与方法
- 下一篇:一种复合菌剂及其制备方法和应用





