[发明专利]机器人控制方法、装置、计算机可读存储介质及机器人有效
申请号: | 202010709703.7 | 申请日: | 2020-07-22 |
公开(公告)号: | CN112060077B | 公开(公告)日: | 2022-02-22 |
发明(设计)人: | 刘洪剑;刘志超;张思民;赵云;熊友军 | 申请(专利权)人: | 深圳市优必选科技股份有限公司 |
主分类号: | B25J9/16 | 分类号: | B25J9/16 |
代理公司: | 深圳中一联合知识产权代理有限公司 44414 | 代理人: | 刘永康 |
地址: | 518000 广东省深圳市南山区*** | 国省代码: | 广东;44 |
权利要求书: | 查看更多 | 说明书: | 查看更多 |
摘要: | |||
搜索关键词: | 机器人 控制 方法 装置 计算机 可读 存储 介质 | ||
1.一种机器人控制方法,其特征在于,包括:
根据预设定位模块实时获取机器人的位姿,并根据所述位姿和预设的目标点位置确定所述机器人行进的圆弧轨迹;
控制所述机器人按照所述圆弧轨迹行进;
在控制所述机器人按照所述圆弧轨迹行进的过程中,对所述机器人的位姿进行更新;
根据更新后的位姿和所述目标点位置对所述圆弧轨迹进行更新,并控制所述机器人按照更新后的圆弧轨迹行进;
在控制所述机器人按照更新后的圆弧轨迹行进的过程中,当所述机器人与所述目标点之间的距离小于预设的距离阈值时,根据最新记录的若干个历史半径对所述圆弧轨迹进行最后一次更新,并控制所述机器人按照最后一次更新后的圆弧轨迹行进。
2.根据权利要求1所述的机器人控制方法,其特征在于,所述根据所述位姿和预设的目标点位置确定所述机器人行进的圆弧轨迹包括:
根据所述位姿和所述目标点位置计算所述机器人与所述目标点之间的距离;
根据所述位姿和所述目标点位置计算所述机器人的朝向与目标连线之间的夹角,所述目标连线为所述机器人与所述目标点之间的连线;
根据所述距离和所述夹角计算所述圆弧轨迹的半径。
3.根据权利要求2所述的机器人控制方法,其特征在于,所述根据所述距离和所述夹角计算所述圆弧轨迹的半径包括:
根据下式计算所述圆弧轨迹的半径:
其中,s为所述距离,θ为所述夹角,R为所述圆弧轨迹的半径。
4.根据权利要求1所述的机器人控制方法,其特征在于,所述控制所述机器人按照所述圆弧轨迹行进包括:
控制所述机器人的线速度和角速度满足以下约束条件:
其中,v为所述线速度,ω为所述角速度,R为所述圆弧轨迹的半径。
5.根据权利要求1所述的机器人控制方法,其特征在于,还包括:
在控制所述机器人按照最后一次更新后的圆弧轨迹行进的过程中,当所述机器人的朝向与目标连线之间的夹角大于预设的角度阈值时,控制所述机器人停止行进,所述目标连线为所述机器人与所述目标点之间的连线。
6.一种机器人控制装置,其特征在于,包括:
轨迹确定模块,用于根据预设定位模块实时获取机器人的位姿,并根据所述位姿和预设的目标点位置确定所述机器人行进的圆弧轨迹;
行进控制模块,用于控制所述机器人按照所述圆弧轨迹行进;
位姿更新模块,用于在控制所述机器人按照所述圆弧轨迹行进的过程中,对所述机器人的位姿进行更新;
轨迹更新模块,用于根据更新后的位姿和所述目标点位置对所述圆弧轨迹进行更新,并控制所述机器人按照更新后的圆弧轨迹行进;
最终更新模块,用于在控制所述机器人按照更新后的圆弧轨迹行进的过程中,当所述机器人与所述目标点之间的距离小于预设的距离阈值时,根据最新记录的若干个历史半径对所述圆弧轨迹进行最后一次更新,并控制所述机器人按照最后一次更新后的圆弧轨迹行进。
7.一种计算机可读存储介质,所述计算机可读存储介质存储有计算机程序,其特征在于,所述计算机程序被处理器执行时实现如权利要求1至5中任一项所述的机器人控制方法的步骤。
8.一种机器人,包括存储器、处理器以及存储在所述存储器中并可在所述处理器上运行的计算机程序,其特征在于,所述处理器执行所述计算机程序时实现如权利要求1至5中任一项所述的机器人控制方法的步骤。
该专利技术资料仅供研究查看技术是否侵权等信息,商用须获得专利权人授权。该专利全部权利属于深圳市优必选科技股份有限公司,未经深圳市优必选科技股份有限公司许可,擅自商用是侵权行为。如果您想购买此专利、获得商业授权和技术合作,请联系【客服】
本文链接:http://www.vipzhuanli.com/pat/books/202010709703.7/1.html,转载请声明来源钻瓜专利网。