[发明专利]角速度的调整方法及装置、存储介质、电子装置在审

专利信息
申请号: 201910828626.4 申请日: 2019-09-03
公开(公告)号: CN112444269A 公开(公告)日: 2021-03-05
发明(设计)人: 张文平 申请(专利权)人: 纳恩博(北京)科技有限公司
主分类号: G01C25/00 分类号: G01C25/00;G01P21/02
代理公司: 北京康信知识产权代理有限责任公司 11240 代理人: 江舟
地址: 100192 北京市海淀区西小口路*** 国省代码: 北京;11
权利要求书: 查看更多 说明书: 查看更多
摘要:
搜索关键词: 角速度 调整 方法 装置 存储 介质 电子
【说明书】:

本公开实施例提供了一种角速度的调整方法及装置、存储介质、电子装置,所述方法包括:获取轮式设备的车轮角速度,其中,轮式设备包括至少两个车轮,车轮角速度表示使用车轮的轮速计算得到的角速度;获取惯性测量单元IMU的第一Z轴角速度,其中,IMU安装在轮式设备上;根据车轮角速度与IMU的第一Z轴角速度之间的差值计算得到零偏估计值;使用零偏估计值计算得到IMU的第二Z轴角速度,解决了现有技术中IMU在使用过程中因零偏发生变化影响测得的角速度准确度的问题。

技术领域

本公开涉及角速度测量技术领域,具体而言,涉及一种角速度的调整方法及装置、存储介质、电子装置。

背景技术

惯性测量单元(Inertial Measurement Unit,简称为IMU)包括陀螺仪和加速度计,其中,陀螺仪用于测量角速度,加速度计用于测量加速度,当IMU应用在轮式设备上时,在使用过程中其零偏会受到诸如温度等的影响,其零偏的变化,会影响陀螺仪测得的角速度值变化,进而导致控制出错。

针对相关技术中,IMU在使用过程中因零偏发生变化影响测得的角速度准确度的问题,目前尚未有合理的解决办法。

发明内容

本公开实施例提供了一种角速度的调整方法及装置、存储介质、电子装置,以至少解决相关技术中IMU在使用过程中因零偏发生变化影响测得的角速度准确度的问题。

根据本公开的一个实施例,提供了一种角速度的调整方法,包括:获取轮式设备的车轮角速度,其中,所述轮式设备包括至少两个车轮,所述车轮角速度表示使用所述车轮的轮速计算得到的角速度;获取惯性测量单元IMU的第一Z轴角速度,其中,所述IMU安装在所述轮式设备上;根据所述车轮角速度与所述IMU的第一Z轴角速度之间的差值计算得到零偏估计值;使用所述零偏估计值计算得到所述IMU的第二Z轴角速度。

可选地,所述使用所述零偏估计值计算得到所述IMU的第二Z轴角速度包括:使用第一公式计算得到所述IMU的第二Z轴角速度,所述第一公式如下:Wi′=Gz-(Zi+Z0),其中,Wi’为所述IMU的第二Z轴角速度,GZ为所述Z轴原始角速度,所述Gz由所述IMU的角速度测量模块获取,Z0为零偏估计值,Zi为初始零偏值,所述Zi为初始化所述IMU时计算的M次Z轴原始角速度的均值,M为正整数。

可选地,所述根据所述车轮角速度与所述IMU的第一Z轴角速度之间的差值计算得到零偏估计值包括:使用第二公式计算得到所述零偏估计值,所述第二公式如下:其中,Wi为所述IMU的第一Z轴角速度,Ws为所述车轮角速度,Wi与Ws的采集频率相同,N为预设控制周期内获取计算所述车轮角速度与所述IMU的Z轴角速度之间的差值的次数,Ki为积分系数。

可选地,所述获取轮式设备的车轮角速度包括:使用第三公式获取所述车轮角速度,所述第三公式如下:

其中,Ws为所述车轮角速度,V为所述车轮的线速度,r为所述两个车轮的轴距中心到任一车轮的距离,d为两个车轮之间的距离,Vl为左车轮线速度,Vr为右车轮线速度,所述车轮的旋转中心位于两个车轮的轴距中心。

可选地,所述获取惯性测量单元IMU的第一Z轴角速度包括:使用第四公式获取所述IMU的第一Z轴角速度,所述第四公式如下:Wi=Gz-Zi,其中,Wi为所述IMU的第一Z轴角速度,Gz为所述Z轴原始角速度,Zi为初始零偏值。

根据本公开的另一个实施例,还提供了一种角速度的调整装置,包括:第一获取模块,用于获取轮式设备的车轮角速度,其中,所述轮式设备包括至少两个车轮,所述车轮角速度表示使用所述车轮的轮速计算得到的角速度;第二获取模块,用于被获取惯性测量单元IMU的第一Z轴角速度,其中,所述IMU安装在所述轮式设备上;第一计算模块,用于根据所述车轮角速度与所述IMU的第一Z轴角速度之间的差值计算得到零偏估计值;第二计算模块,用于使用所述零偏估计值计算得到所述IMU的第二Z轴角速度。

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

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

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

×

专利文献下载

说明:

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

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

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

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

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

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

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

钻瓜专利网在线咨询

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

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