CN112444269A - 角速度的调整方法及装置、存储介质、电子装置 - Google Patents
角速度的调整方法及装置、存储介质、电子装置 Download PDFInfo
- Publication number
- CN112444269A CN112444269A CN201910828626.4A CN201910828626A CN112444269A CN 112444269 A CN112444269 A CN 112444269A CN 201910828626 A CN201910828626 A CN 201910828626A CN 112444269 A CN112444269 A CN 112444269A
- Authority
- CN
- China
- Prior art keywords
- angular velocity
- imu
- wheel
- axis
- zero offset
- Prior art date
- Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
- Pending
Links
- 238000000034 method Methods 0.000 title claims abstract description 49
- 238000005259 measurement Methods 0.000 claims abstract description 26
- 238000004590 computer program Methods 0.000 claims description 18
- 238000004364 calculation method Methods 0.000 claims description 4
- 230000008569 process Effects 0.000 abstract description 7
- 230000008859 change Effects 0.000 abstract description 6
- 230000005540 biological transmission Effects 0.000 description 7
- 238000010586 diagram Methods 0.000 description 6
- 238000005516 engineering process Methods 0.000 description 4
- 238000012545 processing Methods 0.000 description 3
- 238000004891 communication Methods 0.000 description 2
- 230000006870 function Effects 0.000 description 2
- 230000010354 integration Effects 0.000 description 2
- 238000010295 mobile communication Methods 0.000 description 2
- 230000004048 modification Effects 0.000 description 2
- 238000012986 modification Methods 0.000 description 2
- 238000005070 sampling Methods 0.000 description 2
- 230000001133 acceleration Effects 0.000 description 1
- 238000004422 calculation algorithm Methods 0.000 description 1
- 230000006872 improvement Effects 0.000 description 1
- 230000003287 optical effect Effects 0.000 description 1
Images
Classifications
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01C—MEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
- G01C25/00—Manufacturing, calibrating, cleaning, or repairing instruments or devices referred to in the other groups of this subclass
- G01C25/005—Manufacturing, calibrating, cleaning, or repairing instruments or devices referred to in the other groups of this subclass initial alignment, calibration or starting-up of inertial devices
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01P—MEASURING LINEAR OR ANGULAR SPEED, ACCELERATION, DECELERATION, OR SHOCK; INDICATING PRESENCE, ABSENCE, OR DIRECTION, OF MOVEMENT
- G01P21/00—Testing or calibrating of apparatus or devices covered by the preceding groups
- G01P21/02—Testing or calibrating of apparatus or devices covered by the preceding groups of speedometers
Landscapes
- Engineering & Computer Science (AREA)
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Manufacturing & Machinery (AREA)
- Radar, Positioning & Navigation (AREA)
- Remote Sensing (AREA)
- Navigation (AREA)
Abstract
本公开实施例提供了一种角速度的调整方法及装置、存储介质、电子装置,所述方法包括:获取轮式设备的车轮角速度,其中,轮式设备包括至少两个车轮,车轮角速度表示使用车轮的轮速计算得到的角速度;获取惯性测量单元IMU的第一Z轴角速度,其中,IMU安装在轮式设备上;根据车轮角速度与IMU的第一Z轴角速度之间的差值计算得到零偏估计值;使用零偏估计值计算得到IMU的第二Z轴角速度,解决了现有技术中IMU在使用过程中因零偏发生变化影响测得的角速度准确度的问题。
Description
技术领域
本公开涉及角速度测量技术领域,具体而言,涉及一种角速度的调整方法及装置、存储介质、电子装置。
背景技术
惯性测量单元(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轴角速度。
可选地,所述第二计算模块包括:第一计算单元,用于使用第一公式计算得到所述IMU的第二Z轴角速度,所述第一公式如下:Wi′=Gz-(Zi+Z0),其中,Wi’为所述IMU的第二Z轴角速度,Gz为所述Z轴原始角速度,所述Gz由所述IMU的角速度测量模块获取,Z0为零偏估计值,Zi为初始零偏值,所述Zi为初始化所述IMU时计算的M次Z轴原始角速度的均值,M为正整数。
可选地,所述第一计算模块包括:第二计算单元,用于使用第二公式计算得到所述零偏估计值,所述第二公式如下:
其中,Wi为所述IMU的第一Z轴角速度,Ws为所述车轮角速度,Wi与Ws的采集频率相同,N为预设控制周期内获取计算所述车轮角速度与所述IMU的Z轴角速度之间的差值的次数,Ki为积分系数。
可选地,所述第一获取模块包括:第一获取单元,用于使用第三公式获取所述车轮角速度,所述第三公式如下:
其中,Ws为所述车轮角速度,V为所述车轮的线速度,r为所述两个车轮的轴距中心到任一车轮的距离,d为两个车轮之间的距离,Vl为左车轮线速度,Vr为右车轮线速度,所述车轮的旋转中心位于两个车轮的轴距中心。
可选地,所述第二获取模块包括:第二获取单元使用第四公式获取所述IMU的第一Z轴角速度,所述第四公式如下:Wi=Gz-Zi,其中,Wi为所述IMU的第一Z轴角速度,Gz为所述Z轴原始角速度,Zi为初始零偏值。
根据本公开的另一个实施例,还提供了一种存储介质,所述存储介质中存储有计算机程序,其中,所述计算机程序被设置为运行时执行上述任一项方法实施例中的步骤。
根据本公开的另一个实施例,还提供了一种电子装置,包括存储器和处理器,其特征在于,所述存储器中存储有计算机程序,所述处理器被设置为运行所述计算机程序以执行上述任一项方法实施例中的步骤。
通过本公开实施例提供的角速度的调整方法及装置、存储介质、电子装置,获取轮式设备的车轮角速度,其中,轮式设备包括至少两个车轮,车轮角速度表示使用车轮的轮速计算得到的角速度;获取惯性测量单元IMU的第一Z轴角速度,其中,IMU安装在轮式设备上;根据车轮角速度与IMU的第一Z轴角速度之间的差值计算得到零偏估计值;使用零偏估计值计算得到IMU的第二Z轴角速度,通过车轮角速度和IMU的Z轴角速度来获取IMU的零偏估计值,进而可以调整IMU的零偏值,进而可以调整IMU的Z轴角速度,解决了相关技术中IMU在使用过程中因零偏发生变化影响测得的角速度准确度的问题,可以保证在IMU的使用过程中零偏值不断被修正,输出的角速度精度更高。
附图说明
此处所说明的附图用来提供对本公开的进一步理解,构成本申请的一部分,本公开的示意性实施例及其说明用于解释本公开,并不构成对本公开的不当限定。在附图中:
图1是本公开实施例的一种可选的角速度的调整方法的移动终端的硬件结构框图;
图2是本公开实施例的一种可选的角速度的调整方法的流程图;
图3是根据本公开实施例的一种可选的角速度的调整方法流程图;
图4是根据本公开实施例的一种可选的两轮设备转弯示意图;
图5是根据本公开实施例的一种可选的角速度的调整装置的结构框图;
图6为根据本发明实施例的一种可选地电子装置结构框图。
具体实施方式
下文中将参考附图并结合实施例来详细说明本公开。需要说明的是,在不冲突的情况下,本申请中的实施例及实施例中的特征可以相互组合。
需要说明的是,本公开的说明书和权利要求书及上述附图中的术语“第一”、“第二”等是用于区别类似的对象,而不必用于描述特定的顺序或先后次序。
实施例1
本申请实施例一所提供的角速度的调整方法实施例可以在移动终端、计算机终端或者类似的运算装置中执行。以运行在移动终端上为例,图1是本公开实施例的一种角速度的调整方法的移动终端的硬件结构框图。如图1所示,移动终端10可以包括一个或多个(图1中仅示出一个)处理器102(处理器102可以包括但不限于微处理器MCU或可编程逻辑器件FPGA等的处理装置)和用于存储数据的存储器104,可选地,上述移动终端还可以包括用于通信功能的传输设备106以及输入输出设备108。本领域普通技术人员可以理解,图1所示的结构仅为示意,其并不对上述移动终端的结构造成限定。例如,移动终端10还可包括比图1中所示更多或者更少的组件,或者具有与图1所示不同的配置。
存储器104可用于存储计算机程序,例如,应用软件的软件程序以及模块,如本公开实施例中的调度吞吐量的获取方法对应的计算机程序,处理器102通过运行存储在存储器104内的计算机程序,从而执行各种功能应用以及数据处理,即实现上述的方法。存储器104可包括高速随机存储器,还可包括非易失性存储器,如一个或者多个磁性存储装置、闪存、或者其他非易失性固态存储器。在一些实例中,存储器104可进一步包括相对于处理器102远程设置的存储器,这些远程存储器可以通过网络连接至移动终端10。上述网络的实例包括但不限于互联网、企业内部网、局域网、移动通信网及其组合。
传输装置106用于经由一个网络接收或者发送数据。上述的网络具体实例可包括移动终端10的通信供应商提供的无线网络。在一个实例中,传输装置106包括一个网络适配器(Network Interface Controller,简称为NIC),其可通过基站与其他网络设备相连从而可与互联网进行通讯。在一个实例中,传输装置106可以为射频(Radio Frequency,简称为RF)模块,其用于通过无线方式与互联网进行通讯。
本公开实施例提供了一种角速度的调整方法。图2是本公开实施例中角速度的调整方法的流程图,如图2所示,该方法包括:
步骤S202,获取轮式设备的车轮计算的角速度,其中,轮式设备包括至少两个车轮,所述车轮角速度表示使用所述车轮的轮速计算得到的角速度;
步骤S204,获取惯性测量单元IMU的第一Z轴角速度,其中,IMU安装在轮式设备上;
步骤S206,根据车轮角速度与IMU的第一Z轴角速度之间的差值计算得到零偏估计值;
步骤S208,使用零偏估计值计算得到IMU的第二Z轴角速度。
通过上述方法,获取轮式设备的车轮角速度,其中,轮式设备包括至少两个车轮,车轮角速度表示使用车轮的轮速计算得到的角速度;获取惯性测量单元IMU的第一Z轴角速度,其中,IMU安装在轮式设备上;根据车轮角速度与IMU的第一Z轴角速度之间的差值计算得到零偏估计值;使用零偏估计值计算得到IMU的第二Z轴角速度,通过车轮角速度和IMU的Z轴角速度来获取IMU的零偏估计值,进而可以调整IMU的零偏值,进而可以调整IMU的Z轴角速度,解决了相关技术中IMU在使用过程中因零偏发生变化影响测得的角速度准确度的问题,可以保证在IMU的使用过程中零偏值不断被修正,输出的角速度精度更高。
需要说明的是,本公开实施例中涉及的轮式设备,可以是轮式机器人,可以是两轮车或四轮汽车等任意需要应用到IMU的设备,本公开实施例对此不作限定。IMU安装在轮式设备上,优选为安装在两轮轮轴的中心位置并且与两轮轴线平行。轮式设备上还可以安装传感器,包括但不限于磁编码器,用来获取车轮的速度。
可选地,所述使用所述零偏估计值计算得到所述IMU的第二Z轴角速度包括:使用第一公式计算得到所述IMU的第二Z轴角速度,所述第一公式如下:Wi′=Gz-(Zi+Z0),其中,Wi’为所述IMU的第二Z轴角速度,Gz为所述Z轴原始角速度,所述Gz由所述IMU的角速度测量模块获取,Z0为零偏估计值,Zi为初始零偏值,所述Zi为初始化所述IMU时计算的M次Z轴原始角速度的均值,M为正整数。通过多次获取Z轴原始角速度,其中每次获取的Z轴原始角速度可能不同,进一步根据多次获取到的原始角速度的均值,确定初始零偏值,可提高精度。
可选地,所述根据所述车轮角速度与所述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轴角速度之间的差值得到零偏估计值可以包括以下步骤:
S1,在预设控制周期内,分别获取N次所述车轮角速度与所述IMU的第一Z轴角速度,并计算每一次所述车轮角速度与所述第一Z轴角速度之间的差值,其中,所述第一Z轴角速度由Z轴原始角速度减初始零偏值得到,所述初始零偏值为初始化所述IMU时计算的M次Z轴原始角速度的均值,M为正整数;
S2,对预设控制周期内获得的N次差值C进行积分,得到CN;
S3,将所述CN乘以积分系数得到第一零偏估计值,其中,所述积分系数与预设控制周期的时间长度相关。
图3是根据本公开实施例的一种可选的角速度的调整方法流程图,如图3所示,开机后得到初始零偏值(Zi);当车基本静止不动时:正常情况下,陀螺仪计算的角速度(Wi)为0,两轮计算的车轮角速度(Ws)也为0,角速度做差积分后,新的零偏(Ze)也为Zi,无影响。但当陀螺仪零偏变化时,车基本静止不动,此时两轮计算的车轮角速度为(Ws)为0,陀螺仪计算的角速度(Wi)非0,两者做差积分后乘以系数Ki得到的值加上首次零偏(Zi),就得到估算的零偏(Ze)。IMU得到的原始角速度与新零偏做差,得到的角速度(Wi)就为0了,这样就可以修正IMU零偏变化的问题了。上述算法的执行频率与IMU的采样频率保持一致,其中,IMU在一个预设控制周期内的控制操作,可以认为是一次采样,一个预设控制周期后获取一次零偏估计值,对零偏值进行修正。
将CN乘以积分系数后与前一次的零偏值相加得到第二零偏估计值,可以通过以下公式实现:
Wi为IMU的Z轴角速度,Zi为初始零偏值,Ws为车轮角速度,Wi与Ws的采集频率相同,N为预设控制周期内获取计算所述车轮角速度与所述IMU的Z轴角速度之间的差值的次数,Ki为积分系数。
可选地,使用零偏估计值调整IMU的Z轴角速度包括:将所述第一零偏估计值与所述初始零偏值相加,得到第一零偏值,使用所述第一零偏值获取所述IMU的第二Z轴角速度。
可选地,得到的第一零偏估计值可以与初始零偏值相加得到调整后的零偏值,也可以将第一零偏估计值直接作为调整后的零偏值使用。
可选地,使用零偏估计值调整所述零偏值,进而调整IMU的Z轴角速度包括:通过第一公式获取调整后的所述IMU的Z轴角速度,第一公式如下:
其中,Wi’为调整后所述IMU的Z轴角速度,Wi为所述IMU的Z轴角速度,Gz为Z轴原始角速度,Zi为初始零偏值,Ws为所述车轮角速度,Wi与Ws的采集频率相同,N为预设控制周期内获取计算所述车轮角速度与所述IMU的Z轴角速度之间的差值的次数(即控制次数),Ki为积分系数。
可选地,获取轮式设备的车轮角速度包括:根据第二公式获取车轮角速度,第二公式如下:
其中,Ws为车轮角速度,V为所述车轮的线速度,可通过磁编码器或测速传感器得到,r为所述两个车轮的轴距中心到任一车轮的距离,d为两个车轮之间的距离,Vl为左车轮线速度,Vr为右车轮线速度。
图4是根据本公开实施例的一种可选的两轮设备转弯示意图,如图4所示,两轮轴距中心,即旋转圆心,Vl与Vr旋转时速度相同符号相反,故2*V=Vl-Vr。
通过第二公式可知,第一公式还可以包括以下两种衍生形式:
Wi=Gz-Ze
可选地,获取惯性测量单元IMU的Z轴角速度包括:根据第三公式获取IMU的Z轴角速度,所述第三公式如下:
Wi=Gz-Zi
其中,Wi为所述IMU的Z轴角速度,Gz为Z轴原始角速度,Zi为零偏值,所述Zi为初始化所述IMU时计算的M次Z轴原始角速度的均值,M为正整数。
本公开实施例中还提供了一种角速度的调整装置,该装置用于实现上述角速度的调整方法实施例及优选实施方式,已经进行过说明的不再赘述。如以下所使用的,术语“模块”可以实现预定功能的软件和/或硬件的组合。尽管以下实施例所描述的装置较佳地以软件来实现,但是硬件,或者软件和硬件的组合的实现也是可能并被构想的。
图5是根据本公开实施例的一种可选的角速度的调整装置的结构框图,如图5所示,包括:
第一获取模块502,用于获取轮式设备的车轮角速度,其中,轮式设备包括至少两个车轮,所述车轮角速度表示使用所述车轮的轮速计算得到的角速度;
第二获取模块504,用于获取惯性测量单元IMU的第一Z轴角速度,其中,IMU的Z轴角速度由Z轴原始角速度减零偏值得到,Z轴原始角速度由IMU的角速度测量模块获取,IMU安装在轮式设备上;
第三获取模块506,用于根据车轮角速度与IMU的第一Z轴角速度之间的差值得到零偏估计值;
调整模块508,用于使用零偏估计值计算得到IMU的第二Z轴角速度,其中,零偏估计值用于更新零偏值。
可选地,所述第二计算模块包括:第一计算单元,用于使用第一公式计算得到所述IMU的第二Z轴角速度,所述第一公式如下:Wi′=Gz-(Zi+Z0),其中,Wi’为所述IMU的第二Z轴角速度,Gz为所述Z轴原始角速度,所述Gz由所述IMU的角速度测量模块获取,Z0为零偏估计值,Zi为初始零偏值,所述Zi为初始化所述IMU时计算的M次Z轴原始角速度的均值,M为正整数。
可选地,所述第一计算模块包括:第二计算单元,用于使用第二公式计算得到所述零偏估计值,所述第二公式如下:
其中,Wi为所述IMU的第一Z轴角速度,Ws为所述车轮角速度,Wi与Ws的采集频率相同,N为预设控制周期内获取计算所述车轮角速度与所述IMU的Z轴角速度之间的差值的次数,Ki为积分系数。
可选地,所述第一获取模块包括:第一获取单元,用于使用第三公式获取所述车轮角速度,所述第三公式如下:
其中,Ws为所述车轮角速度,V为所述车轮的线速度,r为所述两个车轮的轴距中心到任一车轮的距离,d为两个车轮之间的距离,Vl为左车轮线速度,Vr为右车轮线速度,所述车轮的旋转中心位于两个车轮的轴距中心。
可选地,所述第二获取模块包括:第二获取单元使用第四公式获取所述IMU的第一Z轴角速度,所述第四公式如下:Wi=Gz-Zi,其中,Wi为所述IMU的第一Z轴角速度,Gz为所述Z轴原始角速度,Zi为初始零偏值。
本公开的实施例还提供了一种存储介质,该存储介质中存储有计算机程序,其中,该计算机程序被设置为运行时执行上述任一项方法实施例中的步骤。
可选地,在本实施例中,上述存储介质可以被设置为存储用于执行以下步骤的计算机程序:
S1,获取轮式设备的车轮计算的角速度,其中,轮式设备包括至少两个车轮,所述车轮角速度表示使用所述车轮的轮速计算得到的角速度;
S2,获取惯性测量单元IMU的第一Z轴角速度,其中,IMU安装在轮式设备上;
S3,根据车轮角速度与IMU的第一Z轴角速度之间的差值得到零偏估计值;
S4,使用零偏估计值计算得到IMU的第二Z轴角速度。
可选地,在本实施例中,上述存储介质可以包括但不限于:U盘、只读存储器(Read-Only Memory,简称为ROM)、随机存取存储器(Random Access Memory,简称为RAM)、移动硬盘、磁碟或者光盘等各种可以存储计算机程序的介质。
根据本发明实施例的又一个方面,还提供了一种用于实施上述角速度的调整方法的电子装置。如图6所示,该电子装置包括存储器1002和处理器1004,该存储器1002中存储有计算机程序,该处理器1004被设置为通过计算机程序执行上述任一项方法实施例中的步骤。
可选地,在本实施例中,上述电子装置可以位于计算机网络的多个网络设备中的至少一个网络设备。
可选地,在本实施例中,上述处理器可以被设置为通过计算机程序执行以下步骤:
S1,获取轮式设备的车轮计算的角速度,其中,轮式设备包括至少两个车轮,所述车轮角速度表示使用所述车轮的轮速计算得到的角速度;
S2,获取惯性测量单元IMU的第一Z轴角速度,其中,IMU安装在轮式设备上;
S3,根据车轮角速度与IMU的第一Z轴角速度之间的差值得到零偏估计值;
S4,使用零偏估计值计算得到IMU的第二Z轴角速度。
可选地,本领域普通技术人员可以理解,图6所示的结构仅为示意,电子装置也可以是智能手机(如Android手机、iOS手机等)、平板电脑、掌上电脑以及移动互联网设备(Mobile Intemet Devices,MID)、PAD等终端设备。图6其并不对上述电子装置的结构造成限定。例如,电子装置还可包括比图6中所示更多或者更少的组件(如网络接口等),或者具有与图6所示不同的配置。
其中,存储器1002可用于存储软件程序以及模块,如本发明实施例中的角速度的调整方法和装置对应的程序指令/模块,处理器1004通过运行存储在存储器1002内的软件程序以及模块,从而执行各种功能应用以及数据处理,即实现上述的角速度的调整方法。存储器1002可包括高速随机存储器,还可以包括非易失性存储器,如一个或者多个磁性存储装置、闪存、或者其他非易失性固态存储器。在一些实例中,存储器1002可进一步包括相对于处理器1004远程设置的存储器,这些远程存储器可以通过网络连接至终端。上述网络的实例包括但不限于互联网、企业内部网、局域网、移动通信网及其组合。其中,存储器1002具体可以但不限于用于储存角速度的调整方法的程序步骤。作为一种示例,如图6所示,上述存储器1002中可以但不限于包括上述角速度的调整装置中的第一获取模块502、第二获取模块504、第一计算模块506和第二计算模块508。此外,还可以包括但不限于上述可疑帐号的确定装置中的其他模块单元,本示例中不再赘述。
可选地,上述的传输装置1006用于经由一个网络接收或者发送数据。上述的网络具体实例可包括有线网络及无线网络。在一个实例中,传输装置1006包括一个网络适配器(Network Interface Controller,NIC),其可通过网线与其他网络设备与路由器相连从而可与互联网或局域网进行通讯。在一个实例中,传输装置1006为射频(Radio Frequency,RF)模块,其用于通过无线方式与互联网进行通讯。
此外,上述电子装置还包括:显示器1008,用于显示可疑帐号的告警推送;和连接总线1010,用于连接上述电子装置中的各个模块部件。
本实施例中的具体示例可以参考上述实施例及可选实施方式中所描述的示例,本实施例在此不再赘述。
显然,本领域的技术人员应该明白,上述的本公开的各模块或各步骤可以用通用的计算装置来实现,它们可以集中在单个的计算装置上,或者分布在多个计算装置所组成的网络上,可选地,它们可以用计算装置可执行的程序代码来实现,从而,可以将它们存储在存储装置中由计算装置来执行,并且在某些情况下,可以以不同于此处的顺序执行所示出或描述的步骤,或者将它们分别制作成各个集成电路模块,或者将它们中的多个模块或步骤制作成单个集成电路模块来实现。这样,本公开不限制于任何特定的硬件和软件结合。
以上所述仅为本公开的优选实施例而已,并不用于限制本公开,对于本领域的技术人员来说,本公开可以有各种更改和变化。凡在本公开的原则之内,所作的任何修改、等同替换、改进等,均应包含在本公开的保护范围之内。
Claims (10)
1.一种角速度的调整方法,其特征在于,包括:
获取轮式设备的车轮角速度,其中,所述轮式设备包括至少两个车轮,所述车轮角速度表示使用所述车轮的轮速计算得到的角速度;
获取惯性测量单元IMU的第一Z轴角速度,其中,所述IMU安装在所述轮式设备上;
根据所述车轮角速度与所述IMU的第一Z轴角速度之间的差值计算得到零偏估计值;
使用所述零偏估计值计算得到所述IMU的第二Z轴角速度。
2.根据权利要求1所述的方法,其特征在于,所述使用所述零偏估计值计算得到所述IMU的第二Z轴角速度包括:
使用第一公式计算得到所述IMU的第二Z轴角速度,所述第一公式如下:
Wi′=Gz-(Zi+Z0)
其中,Wi’为所述IMU的第二Z轴角速度,Gz为所述Z轴原始角速度,所述Gz由所述IMU的角速度测量模块获取,Z0为零偏估计值,Zi为初始零偏值,所述Zi为初始化所述IMU时计算的M次Z轴原始角速度的均值,M为正整数。
5.根据权利要求1至3任一项所述的方法,其特征在于,所述获取惯性测量单元IMU的第一Z轴角速度包括:
使用第四公式获取所述IMU的第一Z轴角速度,所述第四公式如下:
Wi=Gz-Zi,
其中,Wi为所述IMU的第一Z轴角速度,Gz为所述Z轴原始角速度,Zi为初始零偏值。
6.一种角速度的调整装置,其特征在于,包括:
第一获取模块,用于获取轮式设备的车轮角速度,其中,所述轮式设备包括至少两个车轮,所述车轮角速度表示使用所述车轮的轮速计算得到的角速度;
第二获取模块,用于被获取惯性测量单元IMU的第一Z轴角速度,其中,所述IMU安装在所述轮式设备上;
第一计算模块,用于根据所述车轮角速度与所述IMU的第一Z轴角速度之间的差值计算得到零偏估计值;
第二计算模块,用于使用所述零偏估计值计算得到所述IMU的第二Z轴角速度。
7.根据权利要求6所述的装置,其特征在于,所述第二计算模块包括:
第一计算单元,用于使用第一公式计算得到所述IMU的第二Z轴角速度,所述第一公式如下:
Wi′=Gz-(Zi+Z0)
其中,Wi’为所述IMU的第二Z轴角速度,Gz为所述Z轴原始角速度,所述Gz由所述IMU的角速度测量模块获取,Z0为零偏估计值,Zi为初始零偏值,所述zi为初始化所述IMU时计算的M次Z轴原始角速度的均值,M为正整数。
9.一种存储介质,其特征在于,所述存储介质中存储有计算机程序,其中,所述计算机程序被设置为运行时执行所述权利要求1至5任一项中所述的方法。
10.一种电子装置,包括存储器和处理器,其特征在于,所述存储器中存储有计算机程序,所述处理器被设置为运行所述计算机程序以执行所述权利要求1至5任一项中所述的方法。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201910828626.4A CN112444269A (zh) | 2019-09-03 | 2019-09-03 | 角速度的调整方法及装置、存储介质、电子装置 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201910828626.4A CN112444269A (zh) | 2019-09-03 | 2019-09-03 | 角速度的调整方法及装置、存储介质、电子装置 |
Publications (1)
Publication Number | Publication Date |
---|---|
CN112444269A true CN112444269A (zh) | 2021-03-05 |
Family
ID=74735414
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201910828626.4A Pending CN112444269A (zh) | 2019-09-03 | 2019-09-03 | 角速度的调整方法及装置、存储介质、电子装置 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN112444269A (zh) |
Cited By (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN114485721A (zh) * | 2021-12-31 | 2022-05-13 | 上海西井信息科技有限公司 | 车辆里程测量方法、系统、设备及存储介质 |
Citations (7)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP2004251671A (ja) * | 2003-02-18 | 2004-09-09 | Sanyo Electric Co Ltd | 誤差蓄積抑制方法、誤差蓄積抑制装置、姿勢制御装置、及び台車 |
JP2008292247A (ja) * | 2007-05-23 | 2008-12-04 | Denso Corp | 車載用角速度検出装置 |
CN102906575A (zh) * | 2010-06-01 | 2013-01-30 | 本田技研工业株式会社 | 横向角速度检测装置 |
CN106123908A (zh) * | 2016-09-08 | 2016-11-16 | 北京京东尚科信息技术有限公司 | 车辆导航方法和系统 |
CN107830871A (zh) * | 2017-10-12 | 2018-03-23 | 歌尔科技有限公司 | 一种补偿陀螺仪角速度数据的方法、装置、陀螺仪和系统 |
CN108501768A (zh) * | 2018-03-29 | 2018-09-07 | 南京航空航天大学 | 一种基于z轴陀螺仪及轮速差的两轮速度控制方法 |
CN110031019A (zh) * | 2019-04-18 | 2019-07-19 | 北京智行者科技有限公司 | 一种用于自动驾驶车辆的打滑检测处理方法 |
-
2019
- 2019-09-03 CN CN201910828626.4A patent/CN112444269A/zh active Pending
Patent Citations (7)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP2004251671A (ja) * | 2003-02-18 | 2004-09-09 | Sanyo Electric Co Ltd | 誤差蓄積抑制方法、誤差蓄積抑制装置、姿勢制御装置、及び台車 |
JP2008292247A (ja) * | 2007-05-23 | 2008-12-04 | Denso Corp | 車載用角速度検出装置 |
CN102906575A (zh) * | 2010-06-01 | 2013-01-30 | 本田技研工业株式会社 | 横向角速度检测装置 |
CN106123908A (zh) * | 2016-09-08 | 2016-11-16 | 北京京东尚科信息技术有限公司 | 车辆导航方法和系统 |
CN107830871A (zh) * | 2017-10-12 | 2018-03-23 | 歌尔科技有限公司 | 一种补偿陀螺仪角速度数据的方法、装置、陀螺仪和系统 |
CN108501768A (zh) * | 2018-03-29 | 2018-09-07 | 南京航空航天大学 | 一种基于z轴陀螺仪及轮速差的两轮速度控制方法 |
CN110031019A (zh) * | 2019-04-18 | 2019-07-19 | 北京智行者科技有限公司 | 一种用于自动驾驶车辆的打滑检测处理方法 |
Cited By (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN114485721A (zh) * | 2021-12-31 | 2022-05-13 | 上海西井信息科技有限公司 | 车辆里程测量方法、系统、设备及存储介质 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN109959381B (zh) | 一种定位方法、装置、机器人及计算机可读存储介质 | |
US10088333B2 (en) | Method and system for gyroscope real-time calibration | |
CN105300379B (zh) | 一种基于加速度的卡尔曼滤波姿态估计方法及系统 | |
JP5243956B2 (ja) | リアルタイムバイアス推定器に基づく慣性機器のための自己較正 | |
CN110986988B (zh) | 融合多传感器数据的轨迹推算方法、介质、终端和装置 | |
US20110264393A1 (en) | System and method for calibrating a three-axis accelerometer | |
US20200286245A1 (en) | Posture estimation method, posture estimation apparatus and computer readable storage medium | |
CN108592952A (zh) | 基于杆臂补偿与正反倍速率同时标定多mimu误差的方法 | |
US20160116302A1 (en) | Method for comparing two inertial units integral with a same carrier | |
AU2020332884B2 (en) | Systems and methods for measuring the rate of angular displacement using magnetic field sensing | |
CN109556606A (zh) | 基于模糊补偿和卡尔曼滤波的传感器角度测量优化方法 | |
CN112304337B (zh) | 基于陀螺仪和加速度计的运动角度估计方法和系统 | |
CN111207740A (zh) | 车辆定位的方法、装置、设备和计算机可读介质 | |
CN112444269A (zh) | 角速度的调整方法及装置、存储介质、电子装置 | |
CN106931965B (zh) | 一种确定终端姿态的方法及装置 | |
Venkatesh et al. | CAN network based longitudinal velocity measurement using accelerometer and GPS receiver for automobiles | |
CN108225368B (zh) | 计步装置和计步方法 | |
CN113959464A (zh) | 一种陀螺仪辅助的加速度计现场校准方法和系统 | |
CN112327006A (zh) | 一种imu中加速度计的标定方法及相关装置 | |
CN110879066A (zh) | 一种姿态解算算法、装置及车载惯性导航系统 | |
CN112506190A (zh) | 一种机器人定位方法、机器人定位装置及机器人 | |
JP4287975B2 (ja) | 姿勢計測装置 | |
CN108731675B (zh) | 待定位物航向变化量的测量方法、测量装置和电子设备 | |
CN113984090B (zh) | 一种轮式机器人imu误差在线标定与补偿方法及装置 | |
GB2534417B (en) | Multiple sensor integration |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
PB01 | Publication | ||
PB01 | Publication | ||
SE01 | Entry into force of request for substantive examination | ||
SE01 | Entry into force of request for substantive examination | ||
RJ01 | Rejection of invention patent application after publication |
Application publication date: 20210305 |
|
RJ01 | Rejection of invention patent application after publication |