[发明专利]机器人控制方法、机器人和可读存储介质有效
申请号: | 201911252566.2 | 申请日: | 2019-12-09 |
公开(公告)号: | CN110861094B | 公开(公告)日: | 2021-03-23 |
发明(设计)人: | 徐恩科;霍峰;陈侃;卜大鹏;秦宝星;程昊天 | 申请(专利权)人: | 上海高仙自动化科技发展有限公司 |
主分类号: | B25J9/16 | 分类号: | B25J9/16 |
代理公司: | 北京清亦华知识产权代理事务所(普通合伙) 11201 | 代理人: | 邵泳城 |
地址: | 201203 上海市浦东新区中国(上*** | 国省代码: | 上海;31 |
权利要求书: | 查看更多 | 说明书: | 查看更多 |
摘要: | |||
搜索关键词: | 机器人 控制 方法 机器 人和 可读 存储 介质 | ||
1.一种机器人控制方法,其特征在于,包括:
在接收到乘梯任务后,根据进梯点确定机器人的候梯区域,所述候梯区域到电梯的距离大于所述进梯点到所述电梯的距离;
检测所述候梯区域的候梯环境信息,所述候梯环境信息包括所述候梯区域内的障碍物信息;
根据所述候梯环境信息和所述候梯区域的中心位置确定所述机器人在所述候梯区域内等候所述电梯的目标位置,并控制所述机器人移动至所述目标位置;
其中,所述根据所述候梯环境信息和所述候梯区域的中心位置确定所述机器人在所述候梯区域内等候所述电梯的目标位置的步骤包括:
选择所述中心位置为所述目标位置,并根据所述障碍物信息判断所述机器人移动至所述目标位置是否安全;
在所述机器人移动至所述目标位置安全时,控制所述机器人移动至所述目标位置;或
在所述机器人移动至所述目标位置不安全时,在所述候梯区域内生成多个候梯点;
根据所述障碍物信息判断所述机器人移动至每个所述候梯点是否安全;
根据所述机器人的当前位置和所述中心位置确定每个判断结果为安全的所述进梯点的权重;
根据所述权重重新选择对应的候梯点为所述目标位置,并控制所述机器人移动至所述目标位置。
2.根据权利要求1所述的机器人控制方法,其特征在于,所述机器人控制方法包括:
根据扫描的楼层地图确定对应楼层的电梯位置;和
将所述机器人位于电梯门正前方且正对所述电梯方向的位置标记为所述进梯点,所述进梯点到所述电梯门的距离为0.1米至0.5米。
3.根据权利要求1所述的机器人控制方法,其特征在于,所述根据进梯点确定机器人的候梯区域的步骤包括:
根据配置参数和所述进梯点的位置确定所述候梯区域的大小和位置,所述配置参数包括所述候梯区域与所述进梯点之间的距离,所述候梯区域的形状和尺寸,所述中心位置相对所述进梯点的方向角。
4.根据权利要求1所述的机器人控制方法,其特征在于,所述权重为所述机器人的当前位置到判断结果为安全的每个所述候梯点之间的距离以及对应的所述候梯点到所述中心位置之间的距离之和,所述根据所述权重选择对应的候梯点为所述目标位置的步骤包括:
选择所述权重最小的所述候梯点为所述目标位置。
5.根据权利要求1所述的机器人控制方法,其特征在于,所述根据所述权重选择对应的候梯点为所述目标位置,并控制机器人移动至所述目标位置的步骤包括:
控制所述机器人移动并实时检测所述候梯区域的所述障碍物信息;
根据所述障碍物信息判断所述机器人移动至所述目标位置是否安全;和
在所述机器人移动过程中检测到所述目标位置不安全时,重新确定目标位置。
6.一种机器人,其特征在于,
候梯确定模块,所述候梯确定模块用于在接收到乘梯任务后,根据进梯点确定机器人的候梯区域,所述候梯区域到电梯的距离大于所述进梯点到所述电梯的距离;
检测模块,所述检测模块用于检测所述候梯区域的候梯环境信息,所述候梯环境信息包括所述候梯区域内的障碍物信息;和
控制模块,所述候梯确定模块还用于根据所述候梯环境信息和所述候梯区域的中心位置确定所述机器人在所述候梯区域内等候所述电梯的目标位置,所述控制模块用于控制所述机器人移动至所述目标位置;
其中,所述机器人还包括判断模块,所述判断模块用于选择所述中心位置为所述目标位置,并根据所述障碍物信息判断所述机器人移动至所述目标位置是否安全;
所述控制模块用于在所述机器人移动至所述目标位置安全时,控制所述机器人移动至所述目标位置;
所述判断模块用于在所述机器人移动至所述目标位置不安全时,在所述候梯区域内生成多个候梯点,及根据所述障碍物信息判断所述机器人移动至每个所述候梯点是否安全,以及根据所述机器人的当前位置和所述中心位置确定每个判断结果为安全的所述进梯点的权重;
所述判断模块还用于根据所述权重重新选择对应的候梯点为所述目标位置,所述控制模块用于控制所述机器人移动至所述目标位置。
该专利技术资料仅供研究查看技术是否侵权等信息,商用须获得专利权人授权。该专利全部权利属于上海高仙自动化科技发展有限公司,未经上海高仙自动化科技发展有限公司许可,擅自商用是侵权行为。如果您想购买此专利、获得商业授权和技术合作,请联系【客服】
本文链接:http://www.vipzhuanli.com/pat/books/201911252566.2/1.html,转载请声明来源钻瓜专利网。