[发明专利]机器人路径调整方法及装置有效
申请号: | 201710029686.0 | 申请日: | 2017-01-16 |
公开(公告)号: | CN106598054B | 公开(公告)日: | 2019-10-11 |
发明(设计)人: | 李超;曹立冬;焦小亮;刘文泽;夏舸 | 申请(专利权)人: | 深圳优地科技有限公司 |
主分类号: | G05D1/02 | 分类号: | G05D1/02 |
代理公司: | 深圳中一专利商标事务所 44237 | 代理人: | 阳开亮 |
地址: | 518000 广东省深圳市南山区*** | 国省代码: | 广东;44 |
权利要求书: | 查看更多 | 说明书: | 查看更多 |
摘要: | |||
搜索关键词: | 机器人 路径 调整 方法 装置 | ||
1.一种机器人路径调整方法,其特征在于,所述机器人移动路径调整方法包括:
获取机器人的预设路径信息;
获取机器人的当前位置信息;
以机器人自身为中心,按预设更新时间间隔在机器人周围360°生成虚拟路径,或者,在移动过程中检测到新的障碍物信息时在机器人周围360°生成虚拟路径,所述虚拟路径为以机器人为中心,在机器人周围360°范围内生成的直线或曲线,所述虚拟路径包括机器人的移动速度信息,具体地,所述当前位置信息包括机器人的当前朝向,以机器人为中心,将机器人的当前朝向作为起始方向,在机器人周围360°按顺时针方向和/或逆时针方向,每隔预设间隔角度作为新的朝向;选取线速度,按预设时间在每一个新的朝向生成一条虚拟路径;
基于所述预设路径信息和所述当前位置信息,在生成的虚拟路径中选取一条虚拟路径作为新的行驶路径。
2.根据权利要求1所述的方法,其特征在于,所述预设路径信息包括预设初始朝向角度,基于所述预设路径信息和所述当前位置信息,在生成的虚拟路径中选取一条虚拟路径作为新的行驶路径,具体包括:
采集环境信息,基于所述环境信息获取障碍物信息,所述障碍物信息包括障碍物的位置信息;
基于所述障碍物信息,在地图上标记预设区间范围内的障碍物;
选取与标记的障碍物无交点,且与所述预设初始朝向角度最接近的虚拟路径作为新的行驶路径。
3.根据权利要求2所述的方法,其特征在于,所述选取与标记的障碍物无交点,且与所述预设初始朝向角度最接近的虚拟路径,具体包括:
在与标记的障碍物无交点,且与所述预设初始朝向角度最接近的虚拟路径位于第一障碍物和第二障碍物之间时,确定第一障碍物与第一虚拟路径相交的第一交点以及确定第二障碍物与第二虚拟路径相交的第二交点,所述第一虚拟路径是指机器人生成的全部虚拟路径中与第一障碍物相交且与机器人当前朝向最接近的虚拟路径,所述第二虚拟路径是指机器人生成的全部虚拟路径中与第二障碍物相交且与机器人当前朝向最接近的虚拟路径;
基于所述第一交点与所述第二交点的连线,计算所述第一障碍物与第二障碍物的空隙宽度信息;
获取机器人自身尺寸信息;
比较所述空隙宽度信息和所述尺寸信息的大小,判断机器人是否可以从所述第一障碍物和第二障碍物之间通过;
若判断机器人可以从所述第一障碍物和第二障碍物之间通过,则将所述虚拟路径作为选取的虚拟路径。
4.根据权利要求2所述的方法,其特征在于,在所述基于所述预设路径信息和所述当前位置信息,在生成的虚拟路径中选取一条虚拟路径作为新的行驶路径之后,还包括:
获取选取的虚拟路径朝向信息,所述朝向信息包括虚拟路径朝向角度;
基于所述机器人的当前朝向和所述虚拟路径朝向角度,调整机器人的朝向。
5.一种机器人路径调整装置,其特征在于,所述机器人路径调整装置包括:
预设路径信息获取单元,用于获取机器人的预设路径信息;
当前位置信息获取单元,用于获取机器人的当前位置信息;
虚拟路径生成单元,用于以机器人自身为中心,按预设更新时间间隔在机器人周围360°生成虚拟路径,或者,在移动过程中检测到新的障碍物信息时在机器人周围360°生成虚拟路径,所述虚拟路径为以机器人为中心,在机器人周围360°范围内生成的直线或曲线,所述虚拟路径包括机器人的移动速度信息;具体地,所述当前位置信息包括机器人的当前朝向,所述虚拟路径生成单元包括:
间隔朝向选取模块,用于以机器人为中心,将机器人的当前朝向作为起始方向,在机器人周围360°按顺时针方向和/或逆时针方向,每隔预设间隔角度作为新的朝向;虚拟路径生成模块,用于选取线速度,按预设时间在每一个新的朝向生成一条虚拟路径;
虚拟路径选取单元,基于所述预设路径信息和所述当前位置信息,在生成的虚拟路径中选取一条虚拟路径作为新的行驶路径。
该专利技术资料仅供研究查看技术是否侵权等信息,商用须获得专利权人授权。该专利全部权利属于深圳优地科技有限公司,未经深圳优地科技有限公司许可,擅自商用是侵权行为。如果您想购买此专利、获得商业授权和技术合作,请联系【客服】
本文链接:http://www.vipzhuanli.com/pat/books/201710029686.0/1.html,转载请声明来源钻瓜专利网。