专利名称:一种惯性测量单元的快速标定方法
技术领域:
本发明涉及微机电系统技术领域,尤其是一种惯性测量单元的快速标定方法。
背景技术:
近年来随着微机电系统MEMS (Micro-Electro Mechanical Systems)技术的发展而产生的MEMS MU(惯性测量单元)具有成本低(大批量时)、尺寸小、重量轻、功耗低、可靠性高等优点,使其广泛应用于人们生活的各方各面。越来越多的消费类产品中装入了三轴陀螺和加速度计,从而构成了 MEMS IMU,用户可以选择他们感兴趣的应用,如游戏、多媒体、个人导航等。
但是,MEMS传感器性能(尤其是零偏和比例因子)随着使用环境(尤其是温度) 变化大仍是一个明显问题。这个问题可以通过标定来解决,即通过标定来确定传感器的误差参数,并在IMU使用过程中进行补偿。
传统的标定方法大多依赖专业的标定设备,或耗时较长,难以满足针对消费类产品不依赖外部设备、快速、简单易行的要求。发明内容
本发明的技术解决问题是提供一种对惯性测量单元的快速标定的方法,该方法可以在没有任何外部设备、基准的情况下对惯性测量单元进行标定。使用该方法对惯性传感器的零偏和比例因子进行标定,提高其使用精度。
本发明的技术解决方案为一种惯性测量单元的快速标定方法,包括以下步骤
步骤1,在惯性测量系统开机预热后,判断是否已知惯性测量单元的初始水平姿态角,是则直接进入步骤3,否则进入步骤2 ;
步骤2,将惯性测量单元保持一段时间的静态,根据静态时段的加速度计测量信息和陀螺测量信息,近似计算惯性测量单元的初始水平姿态角;
步骤3,任意设定惯性测量单元的初始航向姿态角;
步骤4,将惯性测量单元绕其测量中心旋转,并基于已知的初始水平姿态角或步骤 2所得初始水平姿态角及步骤3所得初始航向姿态角,通过标定解算得到待估的陀螺参数和加速度计参数;计算时将惯性测量单元的位置变化量以及速度变化量均设定为零,分别作为伪位置观测信息和伪速度观测信息。
而且,步骤I中将惯性测量单元保持一段时间的静态和步骤2中将惯性测量单元绕其测量中心旋转,采用手工操作实现或者其它机器设备操作实现。
而且,步骤4采用卡尔曼滤波标定方法进行标定计算,具体实现方式如下,步骤4.1,对卡尔曼滤波标定方法的整个标定计算过程进行建模,得到标定模型;基于已知的初始水平姿态角或步骤2所得初始水平姿态角及步骤3所得初始航向姿态角设置标定模型中相关参数的初值,进行标定算法初始化;
步骤4. 2,将惯性测量单元绕其测量中心旋转,同时采用标定模型进行实时数据处理;
步骤4. 3,判断待估IMU参数是否已收敛至相应的预设精度,是则进入步骤4. 4,否则继续执行步骤4. 2 ;
步骤4. 4,标定动作完成,直接进入步骤4. 5,或者对数据进行一次反向平滑后进入步骤4. 5 ;
步骤4. 5,标定完成,获得待估的陀螺参数和加速度计参数。
本发明具有如下技术效果
I.本标定方法不需要任何外部设备或装置来辅助标定。对标定动作也没有严格要求,手持MU绕MU测量中心采用充足的无精度要求的旋转运动即可完成;另提供一些动作指导,可以进一步提闻标定效率和精度;
2.该标定方法可以在短时间内较精确地同时标定出加速度计和陀螺的零偏和比例因子,整个过程可以在30秒左右完成;若按照本方法中提供的动作指导,可进一步缩短时间;
3.本标定方法利用了 GPS (全球导航卫星系统)/INS (惯性导航系统)组合导航算法来对中低精度的IMU传感器零偏和比例因子进行标定。使用伪观测信息取代GPS测量信息来完成对参数的估计。
4.伪观测信息的提出是本标定方法的关键。伪观测信息包括伪位置观测和伪速度观测。二者的思想是认为MU的位置和线速度的变化范围是有限的。可同时使用伪位置和伪速度信息作为量测信息,也可只取其一。位置和速度的变化范围在系统的量测误差矩阵中体现,既可根据实际操作情况进行设置,也可由程序自适应地完成。伪位置和伪速度观测信息的采用省去了大多数标定方法对頂U在各个方向上静止一段时间的要求,提高了标定效率和标定操作的方便性。除了上述伪位置和伪速度观测信息外,本发明也可采用标定过程中IMU的其它运动特征作为伪观测量。
5.在本发明的基础上给出了一系列操作指导思想。用户并不一定需要严格按照这些指导思想进行操作,但按照这些指导思想进行操作可显著提高标定效率。这些指导思想是基于各种动作下对各个传感器参数进行估计的可观测性分析给出的。
6.算法可以用最优或次优(可根据用户兴趣选取)估计方法来完成。既可以用卡尔曼滤波,也可以是最小二乘(或加权最小二乘)或是其他估计手段。
7.本标定方法中体现出加速度和陀螺相互标定的思路。即可以将加速度计组合和陀螺组合视为两个系统,不但加速度计测量信息可以被用于标定和修正陀螺参数,陀螺测量信息也可以用来标定和修正加速度计参数。
8.若使用卡尔曼滤波或递推最小二乘作为估计工具,则在旋转操作的过程中,已经不断地采用卡尔曼滤波算法实时地对加速度计和陀螺的零偏和比例因子进行估计,并不断反馈修正。旋转动作完成后,即已经完成标定,不需要后处理;若在旋转动作完成后对数据进行一次反向平滑处理,可进一步提高结果精度。若选用其他估计手段,则可在用户做完动作后的短时间内,解算出被估IMU参数。
9.本发明中提到的惯性测量单元(MU)不限于低精度的MEMS MU,还包括其它不同精度的惯性传感器(即陀螺和加速度计)组成的IMU ;除了常见的三轴陀螺和三轴加速度计构成的MU之外,还包括带有冗余配置的IMU和不完整轴线配置的IMU,甚至是单轴惯性传感器。
10.本发明中的标定方法不限于手工标定方法,还包括采用其它机器设备(如转台)产生标定运动的标定。
图I是本发明实施例的流程图。
具体实施方式
本发明保持IMU —小段时间(数秒钟即可)的静态或准静态以用于惯性导航系统的初始对准,控制IMU绕其测量中心(或近似绕其测量中心)在空间内旋转,选择估计方法并针对该方法进行建模,使用本发明中提出的伪位置或伪速度信息作为量测信息来进行估计计算,提供IMU参数,按标定模型对后续陀螺仪和加速度计的直接测量值进行补偿后IMU 即可进入正常工作状态。本发明所提到的所有MU操作既可以手工进行,也可以采用其它机器设备(如转台)产生标定运动。本发明用于标定惯性测量单元(MU)。本发明中提到的惯性测量单元不限于低精度的MEMS MU,还包括其它不同精度的惯性传感器(即陀螺和加速度计)组成的IMU ;除了常见的三轴陀螺和三轴加速度计构成的MU之外,还包括带有冗余配置的IMU和不完整轴线配置的IMU,甚至是单轴惯性传感器。同时包括含有其他类型传感器的多传感器组合导航系统。
参见图1,实施例具体步骤如下
步骤1,在惯性测量系统开机预热后,判断是否已知惯性测量单元的初始水平姿态角,是则直接进入步骤3,否则进入步骤2。
本领域的姿态角包括水平姿态角和航向姿态角,具体实施时,也可以直接判断是否已知惯性测量单元的初始姿态角,是则直接进入步骤4,否则进入步骤2。
已知值的初始水平姿态角或初始姿态角采用精确值或近似值均可。
步骤2,将惯性测量单元保持一段时间的静态,根据静态时段的加速度计测量信息和陀螺测量信息,近似计算惯性测量单元的初始水平姿态角。本发明不要求严格保持静态, 因此将惯性测量单元保持一段时间的准静态也是可以的。
实施例在惯性测量系统开机预热后将IMU固定,保持一段时间(建议2-3秒钟即可)的静态或准静态(即大体上静止,允许由于操作造成的頂U振动、晃动等动态),用于惯性导航系统的初始对准。根据静态或准静态时段的加速度计及陀螺信息,求取IMU的初始姿态角。由加速度计输出信息可确定水平姿态角。这里选取公式roll = sign(fz) sirT1 (fy/g) ,pitch = -sign(fz) sirT1 (fx/g)来分别确定横滚角 roll 和俯仰角 pitch。这里 fx、fy及fz分别为x、y及z轴方向的比力输出,g为本地重力加速度值,sign( ·)为符号函数。这里的比例值即可取加速度计某一时间点的输出信息,也可使用某些时段的加速度计信息的平均值。
除该步骤中所述方法外,任何可以确定MU初始水平姿态角的方法均可。若是已经知道IMU的近似水平姿态角,则可以跳过步骤2。
步骤3,任意设定惯性测量单元的初始航向姿态角。
本发明中,对初始航向姿态角没有任何要求,也不需要求取,在算法中随意设定一个值即可(如零度),可以由程序自行随机生成;若已知航向姿态角,同样也可以直接采用; 也可由陀螺输出信息计算出初始航向姿态角。
步骤4,将惯性测量单元绕其测量中心旋转,并基于已知的初始水平姿态角或步骤2所得初始水平姿态角及步骤3所得初始航向姿态角,通过标定解算得到待估的陀螺参数(即误差系数,包括零偏和比例因子)和加速度计参数(即误差系数,包括零偏和比例因子)。所得陀螺参数和加速度计参数,即待估传感器参数,用于在惯性测量单元工作时补偿惯性测量单元直接得到的加速度计测量信息和陀螺测量信息。在本步骤完成后,IMU即可进入正常工作状态。
控制IMU绕其测量中心(或近似绕其测量中心)在空间内旋转时,本发明对旋转动作没有严格要求,不要求准确的旋转角度(如旋转90度)或指向(如某轴朝上),采用充足的无精度要求的旋转运动即可完成。旋转动作完成即代表整套MU操作部分即已完成。 只要能使IMU遍历各种姿态,即可相应地保证标定精度。
标定动作时间以保证所有待估IMU参数收敛至相应程度为准,建议半分钟左右即可。实际操作中既可以进行时间充分的操作以保证标定精度;也可以根据本发明中各参数信息的提示确定标定动作是否已经充分。比如,在标定过程中,实时地通过卡尔曼滤波器提供的信息(比如被估MU参数的标准差)来判断标定的完成进度。结合相应产品的精度需求,设定标定结果门限值。若系统提供的信息显示已达到该精度要求,则提示用户标定已完成,可停止标定动作。
本发明同时基于各种动作下对各个传感器参数进行估计的可观测性分析给出了一系列操作指导思想。用户并不一定需要严格按照这些指导思想进行操作,但按照这些指导思想进行操作可显著提高标定效率。
本发明的标定数据处理既可以在标定动作进行过程中实时进行,也可以在标定操作完成后进行事后处理。算法可以用最优或次优(可根据具体情况选取)估计方法来完成。 既可以用卡尔曼滤波,也可以是最小二乘(或加权最小二乘)或是其他估计手段。
若采用实时进行标定数据处理的方案,则可采用卡尔曼滤波或递推最小二乘作为估计 工具,则在标定操作的过程中,不断地对加速度计和陀螺的零偏和比例因子进行实时估计,并不断反馈修正。旋转动作完成后,即已经完成标定,不需要后处理。在标定过程中, 实时地通过卡尔曼滤波器提供的信息(比如被估MU参数的标准差)来判断标定的完成进度。结合相应产品的精度需求,设定标定结果门限值。若系统提供的信息显示已达到该精度要求,则提示用户标定已完成,可停止标定动作。在卡尔曼滤波计算完成后,也可使用滤波结果,结合整段标定数据,进行一次反向平滑。将反向平滑的结果和正向滤波的结果加权平均,可得到更为精确的传感器参数估计结果。
若采用事后处理,可在用户做完动作后的短时间内,解算出被估MU参数。可选用其他估计手段,比如最小二乘(或加权最小二乘)。
可以预先针对本发明中所选用的估计方法进行建模,得到相应的标定模型。以卡尔曼滤波器为例,状态参数包含导航状态(位置、速度、姿态角)或其中部分导航参数、惯性传感器参数以及其他参数(比如其他传感器提供的辅助信息)。惯性传感器参数可同时包含传感器的零偏、比例因子;也可仅包含零偏或比例因子。所有状态参数均可采用误差形式或非误差形式。可使用任何符合实际情况的随机过程对待估惯性传感器参数进行建模,如随机常数、随机游走、一阶高斯马尔可夫等。
标定计算时,由于基于惯性测量单元绕其测量中心旋转时,要求IMU测量中心位置变化范围有限,本发明在解算程序中将IMU的位置变化量以及速度变化量均设定为零, 以分别作为伪位置观测信息和伪速度观测信息。实际中可能的位置和速度变化范围用量测噪声的形式给出。量测误差矩阵设置由程序自适应地完成,也可根据实际操作情况进行设置。伪位置和伪速度观测信息的采用省去了大多数标定方法对IMU在各个方向上静止一段时间的要求,提高了标定效率和标定操作的方便性。
既可同时使用伪位置和伪速度信息作为量测信息,也可只取其一。除了上述伪位置和伪速度观测信息外,本发明也可采用标定过程中IMU的其它运动特征作为伪观测量。 上述伪观测信息不仅可以独立使用,也可与其他标定方法结合起来使用。若是所标定对象为多传感器组合导航系统,也可使用其他传感器提供的信息作为量测信息。由于伪观测是有一定的噪声范围的,使用时可采用量测噪声来体现观测值可能的不准确程度,比如量测噪声的形式给出可能的位置和速度变化范围。
本标定方法中体现出加速度和陀螺相互标定的思路。即可以将加速度计组合和陀螺组合视为两个系统,不但加速度计测量信息可以被用于标定和修正陀螺参数,陀螺测量信息也可以用来标定和修正加速度计参数。
详细步骤说明如下。主要结合卡尔曼滤波方法进行说明,最小二乘则一定程度上类似。
步骤4. 1,对卡尔曼滤波标定方法的整个标定计算过程进行建模,得到标定模型。 建模后,进行标定算法初始化(设置滤波过程中用到的各状态参数的初值和矩阵的初始状态),与具体选择的卡尔曼滤波方法有关,可由采用软件技术实现自动赋值。可以选用各种卡尔曼滤波,这里以采用增广卡尔曼滤波(augmented Kalman filter,AKF)的情况为例,其他卡尔曼滤波方法类似。滤波过程中用到的各状态参数,可采用向量形式,记为卡尔曼滤波状态向量X。建议卡尔曼滤波里的待估状态选用误差形式。实施例的卡尔曼滤波状态向量X的状态参数中包含导航误差状态参数(包括位置误差、速度误差及姿态角误差,实际使用中也可舍掉其中某些状态)以及传感器误差参数(即待估陀螺和加速度计参数的误差,包括加速度计及陀螺的零偏及比例因子的误差)。
一般的,进行卡尔曼滤波前,可给卡尔曼滤波状态向量X的状态参数赋初值,对各状态参数的方差构成的方差协方差阵、系统的状态噪声矩阵和量测噪声矩阵进行初始设置。卡尔曼滤波状态向量X的状态参数初值建议全设成O。各导航误差状态参数的方差构成的方差协方差阵代表的各状态参数的误差程度,其中各元素可按相应的实际情况设。待估传感器参数相应的元素建议参照传感器的性能指标来设。状态噪声矩阵参照传感器的性能指标来设。量测噪声矩阵代表了实际中IMU的位置、速度变化和实施例采用的伪位置观测信息和伪速度观测信息(O)可能有多大差异。可以通过软件技术事先的自动数据处理过程设置一个一般化的量测噪声阵进行一段时间的滤波计算,参照这段时间的滤波结果来设定量测噪声,再对整个滤波过程中的数据进行滤波计算,得到量测噪声矩阵的初值。卡尔曼滤波方法的具体实现可参见相关文献秦永元等,1998年,卡尔曼滤波与组合导航原理, 西北工业大学出版社。
整个标定过程所需要的模型如下
加速度计和陀螺输出误差可分别建模为
δ fb = ba+diag (fb) δ sa+wa (I)
^bib = bg + diag(mbib )Ssg + wg(2)
式中δ fb和分别为比力和角速度误差向量;bjPbg依次为加速度计和陀螺的零偏;δ \和δ sg分别为加速度计和陀螺的比例因子误差;fb和分别为真实比力和角速度。Wa和Wg为加速度计和陀螺的伪噪声项。符号diag(v)表示由向量V= [vx vy νζ]τ中元素组成的对角阵
建议位置初值根据当前的坐标赋初值,速度初值赋为O ;水平姿态角的初值采用已知的初始水平姿态角或步骤2所得初始水平姿态角,航向姿态角采用步骤3所得初始航向姿态角;陀螺和加速度计零偏初值建议设成O ;陀螺和加速度计比例因子建议设成I。本领域将水平姿态角和航向姿态角统称姿态角,若是已知初始姿态角,据此赋值给水平姿态角和航向姿态角作为初值。也就是说,实时数据处理时,第一历元用初始姿态角 ,后面都用前一历元求得的姿态角。
卡尔曼滤波的状态方程为
Src - -i^cecx Src + 5\c(4)
= FvAc - (2ω^ + oC)X W + Γ X ψ + CpbSfb(5)
Ψ = - + <c) X Ψ - CnbS(oblb(6)
bfl= -—bfl+Wfefl(7)Tba
^g= -T-b.+w%(8)Tbg
~—^a+(9):sa
^g=+wsg(10)
(4) (6)式为对导航误差参数的建模。这里仅选用各状态和物理量投影在c系 (计算坐标系)的情况进行分析,实际也可投影到任何坐标系,且分析类似。
其中δ r%分别为载体位置(纬度、经度、高程)误差、速度误差以及姿态角旋转矢量误差在c系(计算坐标系)中的投影;ba和\依次为加速度计和陀螺的零偏; Ssa和Ssg分别为加速度计和陀螺的比例因子误差;、δ<、ψ, ba、bg, Ssa, Ssg 依次为各量的时间微分;
f为c系中比力向量和《分别为地球自转角速度和c系相对e系的旋转角速度在c系中投影;τ ba,τ bg, τ sa及Tsg分别代表各传感器误差的相关时间;wba, wbg, Wsa及 Wsg为驱动白噪声;C〖和C〖分别为b系(载体坐标系)到P系(平台坐标系)和b系到η系 (导航坐标系)的方向余弦矩阵;符号X表示两向量的叉乘。
(5)式中Fvr可表示为
Fvr = [-g/ (RM+h) -g/ (RN+h) 2g/ (R+h) ](11)
其中Rs^P Rn依次为地球子午圈和卯酉圈曲率半径;A =;8和11分别为本地重力值和高程。
(7) (10)式为对待估传感器参数的建模。这里均选用一阶高斯马尔可夫过程建模。若采用随机常数、随机游走等随机过程来建模亦可。
卡尔曼滤波的量测信息可以选用伪位置约束或伪速度约束,对应的量测模型可依次写为
·zr=fc-fc=Jrc+nr(12)
zv = vc - vc = δν° +nv(13)
其中=constantly0 = O。
这里和Zv分别为卡尔曼滤波位置和速度量测向量为卡尔曼滤波状态方程预测的位置和速度为伪位置和伪速度观测向量;δF和δ<为状态向量中的位置误差和速度误差和ην为量测噪声。
若选用伪位置和伪速度信息共同约束,则(12)和(13)均用做量测方程。若仅用伪位置或伪速度信息,则仅选用(12)或(13)作为量测方程。
特别地,仅选用伪速度信息时,也可以从卡尔曼滤波器状态向量中去掉位置误差, 并从状态方程中去掉⑷式,以及(5)式中的FwS F项。
此外,考虑到本发明的使用对象及操作情况(MU位置近似不变,速度近似为零、 且针对中低精度IMU),也可对状态方程进行一些简化。
(5)、(6)式可简化为
SV = -(2ω; + to:c) X + fc X ψ + CpbSfb(14)
Ψ = - + <c) X Ψ -(15)
设置卡尔曼滤波相关参数。参照标定对象内置IMU的传感器性能参数来设定滤波状态误差方差阵(Q),以及初始状态向量(X)及初始状态方差阵(P)中与待估参数(加速度计和陀螺的零偏和比例因子)有关项。参照实际标定动作情况,来设定量测误差方差阵 (R),以及X和P初值中与导航误差参数(位置、速度、姿态角误差)有关项。IMU位置或速度可能的变化范围在量测误差方差阵R中体现。
若使用最小二乘作为估计方式,则相应地对平差过程建模。可将待估传感器参数作为待估参数;伪位置、伪速度信息可用作量测信息或限制条件,实际操作中可能的位置和速度变化范围在协方差矩阵中给出。
步骤4. 2,将惯性测量单元绕其测量中心旋转,同时采用标定模型进行实时数据处理。本发明在旋转过程中,即由卡尔曼滤波器不断进行状态预测以及量测更新,实时地对加速度计和陀螺的零偏和比例因子进行估计,并不断反馈修正。就是说,每一次滤波,会估计一组误差状态参数。然后对应地用这组参数值修正当前位置、速度、姿态角和传感器参数的值。这些值再作为系数参与下一次滤波计算。
若使用最小二乘作为估计手段,则在该步骤中不进行数据处理,储存各时刻的传感器输出即可。
步骤4. 3,根据卡尔曼滤波中提供的指标信息,判断参数收敛是否已收敛至相应的预设精度,是则进入步骤4. 4,否则继续执行步骤4. 2。若步骤4. 4在标定动作完成后使用反向平滑,则判断是否已收敛至相应程度的预设精度为A,否则预设精度为B,A大于B。即可适当放宽对目标收敛程度的要求。
若使用最小二乘作为估计手段,则在标定操作过程中无法获取指标信息,则需要旋转足够的时间,来保证标定精度。使用最小二乘,则必要的操作时间为C,使用卡尔曼滤波,必要的操作时间为D,C小于D。即是用最小二乘只需要较少的操作时间,即可保证与卡尔曼滤波相同的精度。
步骤4. 4,标定动作完成,直接进入步骤4. 5,或者对数据进行一次反向平滑后进入步骤4. 5。
在滤波计算完成后进行反向平滑,可进一步提高参数估计精度或缩短标定时间。 若需使用反向平滑,需将各时刻系统的状态参数量及其方差协方差阵保存下来。滤波过程中保存的数据在反向平滑算法中被利用,通过最大似然方法估计新系统的状态量。通过对正向滤波和反向平滑的结果加权可尽量保持结果的连续型和平滑性。
以固定时间间隔平滑(Fixed Interval Smoothing)算法为例,完整的RTS平滑方程如下
权利要求
1.一种惯性测量单元的快速标定方法,其特征在于,包括以下步骤步骤I,在惯性测量系统开机预热后,判断是否已知惯性测量单元的初始水平姿态角, 是则直接进入步骤3,否则进入步骤2 ;步骤2,将惯性测量单元保持一段时间的静态,根据静态时段的加速度计测量信息和陀螺测量信息,近似计算惯性测量单元的初始水平姿态角;步骤3,任意设定惯性测量单元的初始航向姿态角;步骤4,将惯性测量单元绕其测量中心旋转,并基于已知的初始水平姿态角或步骤2所得初始水平姿态角及步骤3所得初始航向姿态角,通过标定解算得到待估的陀螺参数和加速度计参数;计算时将惯性测量单元的位置变化量以及速度变化量均设定为零,分别作为伪位置观测信息和伪速度观测信息。
2.根据权利要求I所述惯性测量单元的快速标定方法,其特征在于步骤I中将惯性测量单元保持一段时间的静态和步骤2中将惯性测量单元绕其测量中心旋转,采用手工操作实现或者其它机器设备操作实现。
3.根据权利要求I或2所述惯性测量单元的快速标定方法,其特征在于步骤4采用卡尔曼滤波标定方法进行标定解算,具体实现方式如下,步骤4. 1,对卡尔曼滤波标定方法的整个标定计算过程进行建模,得到标定模型;基于已知的初始水平姿态角或步骤2所得初始水平姿态角及步骤3所得初始航向姿态角设置标定模型中相关参数的初值,进行标定算法初始化;步骤4. 2,将惯性测量单元绕其测量中心旋转,同时采用标定模型进行实时数据处理;步骤4. 3,判断待估IMU参数是否已收敛至相应的预设精度,是则进入步骤4. 4,否则继续执行步骤4. 2 ;步骤4. 4,标定动作完成,直接进入步骤4. 5,或者对数据进行一次反向平滑后进入步骤 4. 5 ;步骤4. 5,标定完成,获得待估的陀螺参数和加速度计参数。
全文摘要
本发明涉及一种惯性测量单元的快速标定方法。该方法可以在不使用任何外部设备的条件下,仅通过用户手持转动IMU遍历各方向的运动,即可在短时间内较精确地标定出陀螺零偏、比例因子、加速度计零偏和比例因子共十二个误差系数。本发明具有无硬件成本、高效率、简单易行的特点,且能保证一定的标定精度。本发明特别适合于对中低精度IMU的现场快速标定,有效解决微机械IMU参数的环境敏感性问题,促进MEMS惯性器件的推广应用。
文档编号G01C25/00GK102865881SQ201210056759
公开日2013年1月9日 申请日期2012年3月6日 优先权日2012年3月6日
发明者牛小骥, 李由, 张全, 刘川川, 章红平, 施闯 申请人:武汉大学