[发明专利]扫地机陀螺仪的校准方法、装置、存储介质及计算机设备在审
申请号: | 202111170804.2 | 申请日: | 2021-10-08 |
公开(公告)号: | CN114001751A | 公开(公告)日: | 2022-02-01 |
发明(设计)人: | 黄纯;贾盛泽;韩淑婷 | 申请(专利权)人: | 深圳市无限动力发展有限公司 |
主分类号: | G01C25/00 | 分类号: | G01C25/00 |
代理公司: | 深圳市明日今典知识产权代理事务所(普通合伙) 44343 | 代理人: | 王杰辉 |
地址: | 518000 广东省深圳市南山区西丽*** | 国省代码: | 广东;44 |
权利要求书: | 查看更多 | 说明书: | 查看更多 |
摘要: | |||
搜索关键词: | 地机 陀螺仪 校准 方法 装置 存储 介质 计算机 设备 | ||
1.一种扫地机陀螺仪的校准方法,其特征在于,所述方法包括:
获取扫地机陀螺仪的零偏值,所述陀螺仪为单轴陀螺仪;
当扫地机处于运行状态时,获取陀螺仪在设定时长内采集的多个原始数据;
根据所述零偏值和多个所述原始数据,计算得到所述陀螺仪的角度值。
2.根据权利要求1所述的扫地机陀螺仪的校准方法,其特征在于,所述根据所述零偏值和多个所述原始数据,计算得到所述陀螺仪的角度值的步骤,包括:
计算每组所述原始数据的平均值得到多个原始数据平均值;
计算多个原始数据平均值的平均值得到原始平均值;
将所述原始平均值减去零偏值,得到所述陀螺仪的角度值。
3.根据权利要求1所述的扫地机陀螺仪的校准方法,其特征在于,所述根据所述零偏值和多个所述原始数据,计算得到所述陀螺仪的角度值的步骤,包括:
依次计算每组所述原始数据中每一个所述原始数据与所述零偏值的差值得到多组原始数据差值;
计算每组所述原始数据差值的平均值得到原始数据差均值;
计算多个所述原始数据差均值的平均值,得到所述陀螺仪的角度值。
4.根据权利要求1所述的扫地机陀螺仪的校准方法,其特征在于,所述获取扫地机陀螺仪的零偏值的步骤,包括:
获取到所述扫地机处于初始上电的状态时,采集陀螺仪的第一数据;
根据所述第一数据,计算得到初始零偏值,将所述初始零偏值作为所述零偏值。
5.根据权利要求4所述的扫地机陀螺仪的校准方法,其特征在于,所述根据所述第一数据,计算得到所述零偏值的步骤之后,包括:
检测到所述扫地机直行的前方具有障碍物;
控制所述扫地机停止运动;
当所述扫地机停止运动的时长超过预设时长时,采集陀螺仪的第二数据,根据所述第二数据,计算得到校正零偏值;
将所述校正零偏值替换所述初始零偏值,以更新零偏值。
6.根据权利要求5所述的扫地机陀螺仪的校准方法,其特征在于,所述将所述校正零偏值替换所述初始零偏值,以更新零偏值的步骤,包括:
计算所述校正零偏值与所述初始零偏值的零偏差值;
判断所述零偏差值是否小于等于预设的校正阈值;
若是,则将所述校正零偏值替换所述初始零偏值,以更新零偏值。
7.根据权利要求2所述的扫地机陀螺仪的校准方法,其特征在于,所述计算每组所述原始数据的平均值得到多个原始数据平均值的步骤,包括:
获取两个相邻的原始数据的差值;
若所述差值大于预设的原始差阈值,则将相邻的原始数据中的后者的数据修改为相邻的原始数据中的前者的数据;
基于修改后的原始数据,计算多个所述原始数据的原始平均值。
8.一种扫地机陀螺仪的校准装置,其特征在于,包括
第一获取单元,用于获取扫地机陀螺仪的零偏值;
第二获取单元,用于获取扫地机处于运行状态下陀螺仪在设定时长内采集的多个原始数据;
计算单元,根据所述零偏值和多个所述原始数据,计算得到所述陀螺仪的角度值。
9.一种存储介质,其特征在于,其为计算机可读的存储介质,其上存储有计算机程序,所述计算机程序被执行时实现如权利要求1~7任一项所述的扫地机陀螺仪的校准方法。
10.一种计算机设备,其特征在于,其包括处理器、存储器及存储于所述存储器上并可在所述处理器上运行的计算机程序,所述处理器执行所述计算机程序时实现如权利要求1~7任一项所述的扫地机陀螺仪的校准方法。
该专利技术资料仅供研究查看技术是否侵权等信息,商用须获得专利权人授权。该专利全部权利属于深圳市无限动力发展有限公司,未经深圳市无限动力发展有限公司许可,擅自商用是侵权行为。如果您想购买此专利、获得商业授权和技术合作,请联系【客服】
本文链接:http://www.vipzhuanli.com/pat/books/202111170804.2/1.html,转载请声明来源钻瓜专利网。
- 上一篇:骨传导扬声器及其磁路组件
- 下一篇:一种芯棒的制造方法、预制棒以及光纤