[发明专利]扫地机器人陀螺仪标定方法、装置、计算机设备及存储器在审

专利信息
申请号: 202110287961.5 申请日: 2021-03-17
公开(公告)号: CN113063442A 公开(公告)日: 2021-07-02
发明(设计)人: 李伟;谢涛 申请(专利权)人: 深圳市云鼠科技开发有限公司
主分类号: G01C25/00 分类号: G01C25/00
代理公司: 广州市南锋专利事务所有限公司 44228 代理人: 张鹏
地址: 518100 广东省深圳市龙岗区龙*** 国省代码: 广东;44
权利要求书: 查看更多 说明书: 查看更多
摘要:
搜索关键词: 扫地 机器人 陀螺仪 标定 方法 装置 计算机 设备 存储器
【权利要求书】:

1.扫地机器人陀螺仪标定方法,其特征在于,包括下述步骤:

连续检测参考陀螺仪产生的信号,直到检测到所述信号,进入校准模式;

调整步骤:在所述校准模式下,将参考陀螺仪和待测陀螺仪的初始角度调整为一致;

驱动机器人根据预设动作转动;

在静止状态下,分别获取参考陀螺仪和待测陀螺仪的角度值,如果所述参考陀螺仪的角度值和待测陀螺仪的角度变化量的差值大于预设阈值,则根据所述角度变化量的比例确定标定系数,并且根据标定系数调整待测陀螺仪的角度变化幅度;

转至调整步骤,直到所述参考陀螺仪的角度值和待测陀螺仪的角度变化量的差值小于所述阈值。

2.根据权利要求1所述的扫地机器人陀螺仪标定方法,其特征在于,所述步骤连续检测参考陀螺仪产生的信号,直到检测到所述信号,进入校准模式,具体包括:

控制扫地机器人开机或重启;

在预设时间内检测参考陀螺仪产生的所述信号,如果检测到了所述信号,进入校准模式。

3.根据权利要求1所述的扫地机器人陀螺仪标定方法,其特征在于,所述步骤将参考陀螺仪和待测陀螺仪的初始角度调整为一致,具体包括:

根据待测陀螺仪初始时间不为0,连续获取待测陀螺仪的角速度;

根据预设时间内所述待测陀螺仪的角速度小于预设值,确定扫地机器人静止;

在扫地机器人静止的状态下,将参考陀螺仪和待测陀螺仪的初始时间设定为0,并且将待测陀螺仪和参考陀螺仪的初始角度设定为0。

4.根据权利要求3所述的扫地机器人陀螺仪标定方法,其特征在于,所述步骤将参考陀螺仪和待测陀螺仪的初始角度调整为一致,还包括:

根据待测陀螺仪的初始时间为0,连续获取待测陀螺仪的角速度;

根据预设时间内所述待测陀螺仪的角速度小于预设值,确定扫地机器人静止;

在扫地机器人静止的状态下,获取所述待测陀螺仪或所述待测陀螺仪的当前角度,并且将所述参考陀螺仪和待测陀螺仪的初始角度设定为所述当前角度。

5.根据权利要求1所述的扫地机器人陀螺仪标定方法,其特征在于,所述步骤转至调整步骤,直到所述参考陀螺仪的角度值和待测陀螺仪的角度变化量的差值小于所述阈值之后,该方法还包括:

进入验证模式中,驱动机器人转动,并且根据参考陀螺仪和待测陀螺仪的角度变化量小于阈值验证待测陀螺仪正常。

6.根据权利要求5所述的扫地机器人陀螺仪标定方法,其特征在于,所述步骤进入验证模式中,驱动机器人转动,并且根据参考陀螺仪和待测陀螺仪的角度变化量小于阈值验证待测陀螺仪正常之后,该方法还包括:

预设时间之后,进入调整步骤,以周期性的标定所述待测陀螺仪。

7.扫地机器人陀螺仪标定装置,其特征在于,包括:

模式控制模块,用于连续检测参考陀螺仪产生的信号,直到检测到所述信号,进入校准模式;

调整模块,用于执行调整步骤:在所述校准模式下,将参考陀螺仪和待测陀螺仪的初始角度调整为一致;

驱动模块,用于驱动机器人根据预设动作转动;

标定模块,用于在静止状态下,分别获取参考陀螺仪和待测陀螺仪的角度值,如果所述参考陀螺仪的角度值和待测陀螺仪的角度变化量的差值大于预设阈值,则根据所述角度变化量的比例确定标定系数,并且根据标定系数调整待测陀螺仪的角度变化幅度;

循环模块,用于转至调整步骤,直到所述参考陀螺仪的角度值和待测陀螺仪的角度变化量的差值小于所述阈值。

8.根据权利要求7所述的扫地机器人陀螺仪标定方法,其特征在于,所述调整模块,具体包括:

角速度获取子模块,用于根据待测陀螺仪初始时间不为0,连续获取待测陀螺仪的角速度;

静止判定子模块,用于根据预设时间内所述待测陀螺仪的角速度小于预设值,确定扫地机器人静止;

初始值设定子模块,用于在扫地机器人静止的状态下,将参考陀螺仪和待测陀螺仪的初始时间设定为0,并且将待测陀螺仪和参考陀螺仪的初始角度设定为0。

下载完整专利技术内容需要扣除积分,VIP会员可以免费下载。

该专利技术资料仅供研究查看技术是否侵权等信息,商用须获得专利权人授权。该专利全部权利属于深圳市云鼠科技开发有限公司,未经深圳市云鼠科技开发有限公司许可,擅自商用是侵权行为。如果您想购买此专利、获得商业授权和技术合作,请联系【客服

本文链接:http://www.vipzhuanli.com/pat/books/202110287961.5/1.html,转载请声明来源钻瓜专利网。

×

专利文献下载

说明:

1、专利原文基于中国国家知识产权局专利说明书;

2、支持发明专利 、实用新型专利、外观设计专利(升级中);

3、专利数据每周两次同步更新,支持Adobe PDF格式;

4、内容包括专利技术的结构示意图流程工艺图技术构造图

5、已全新升级为极速版,下载速度显著提升!欢迎使用!

请您登陆后,进行下载,点击【登陆】 【注册】

关于我们 寻求报道 投稿须知 广告合作 版权声明 网站地图 友情链接 企业标识 联系我们

钻瓜专利网在线咨询

周一至周五 9:00-18:00

咨询在线客服咨询在线客服
tel code back_top