[发明专利]机器人被卡的检测方法和脱卡的控制方法及芯片有效
申请号: | 201810457864.4 | 申请日: | 2018-05-14 |
公开(公告)号: | CN108628312B | 公开(公告)日: | 2021-11-19 |
发明(设计)人: | 李永勇;肖刚军 | 申请(专利权)人: | 珠海一微半导体股份有限公司 |
主分类号: | G05D1/02 | 分类号: | G05D1/02 |
代理公司: | 暂无信息 | 代理人: | 暂无信息 |
地址: | 519000 广东省珠海*** | 国省代码: | 广东;44 |
权利要求书: | 查看更多 | 说明书: | 查看更多 |
摘要: | 本发明涉及一种机器人被卡的检测方法和脱卡的控制方法及芯片。所述机器人被卡的检测方法,通过将第一预设时间段内所记录的仰角数据与机器人中预先存储的参考仰角数据进行比较,并结合时间和打滑情况的综合判断,准确得出机器人是否被卡的检测结果。在检测到机器人被卡时,通过机器人脱卡的控制方法,先分析机器人是被什么类型的物体卡住,然后针对不同的物体控制机器人的驱动轮采取不同的运转方式来进行脱卡,从而实现机器人的快速脱卡。由于所述芯片具有控制机器人进行被卡检测和脱卡控制的程序,使得装配该芯片的机器人在不需要增加其它的硬件传感器的基础上,具有能够准确检测自身是否被物体卡住以及能够快速控制自身进行脱卡操作的功能。 | ||
搜索关键词: | 机器人 检测 方法 控制 芯片 | ||
【主权项】:
1.一种机器人被卡的检测方法,其特征在于,包括如下步骤:步骤S1:记录机器人检测到的仰角数据,并进入步骤S2;步骤S2:将第一预设时间段内所记录的仰角数据与机器人中预先存储的参考仰角数据进行比较,判断所记录的仰角数据是否在参考仰角数据的误差范围内,如果是,则进入步骤S3,如果否,则将所述第一预设时间段内所记录的仰角数据中的第一个记录的数据删除,并返回步骤S1;步骤S3:持续记录机器人检测到的仰角数据,并判断所记录的仰角数据在参考仰角数据的误差范围内的持续时间是否达到第二预设时间段,如果是,则进入步骤S4,如果否,则确定机器人没有被卡;步骤S4:判断在所述第二预设时间段内是否检测到机器人打滑,如果检测到机器人打滑,则确定机器人被卡,如果没有检测到机器人打滑,则进入步骤S5;步骤S5:持续记录机器人检测到的仰角数据,并判断所记录的仰角数据在参考仰角数据的误差范围内的持续时间是否达到第三预设时间段,如果是,则确定机器人被卡,如果否,则确定机器人没有被卡。
下载完整专利技术内容需要扣除积分,VIP会员可以免费下载。
该专利技术资料仅供研究查看技术是否侵权等信息,商用须获得专利权人授权。该专利全部权利属于珠海一微半导体股份有限公司,未经珠海一微半导体股份有限公司许可,擅自商用是侵权行为。如果您想购买此专利、获得商业授权和技术合作,请联系【客服】
本文链接:http://www.vipzhuanli.com/patent/201810457864.4/,转载请声明来源钻瓜专利网。