CN108592952A - 基于杆臂补偿与正反倍速率同时标定多mimu误差的方法 - Google Patents

基于杆臂补偿与正反倍速率同时标定多mimu误差的方法 Download PDF

Info

Publication number
CN108592952A
CN108592952A CN201810558490.5A CN201810558490A CN108592952A CN 108592952 A CN108592952 A CN 108592952A CN 201810558490 A CN201810558490 A CN 201810558490A CN 108592952 A CN108592952 A CN 108592952A
Authority
CN
China
Prior art keywords
error
acceleration
mimu
model
angular speed
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.)
Granted
Application number
CN201810558490.5A
Other languages
English (en)
Other versions
CN108592952B (zh
Inventor
李建利
刘全普
刘刚
房建成
曲春宇
邹思远
胡佳
Current Assignee (The listed assignees may be inaccurate. Google has not performed a legal analysis and makes no representation or warranty as to the accuracy of the list.)
Beihang University
Original Assignee
Beihang University
Priority date (The priority date 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 date listed.)
Filing date
Publication date
Application filed by Beihang University filed Critical Beihang University
Priority to CN201810558490.5A priority Critical patent/CN108592952B/zh
Publication of CN108592952A publication Critical patent/CN108592952A/zh
Application granted granted Critical
Publication of CN108592952B publication Critical patent/CN108592952B/zh
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Classifications

    • GPHYSICS
    • G01MEASURING; TESTING
    • G01CMEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
    • G01C25/00Manufacturing, calibrating, cleaning, or repairing instruments or devices referred to in the other groups of this subclass
    • G01C25/005Manufacturing, 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

Abstract

本发明公开一种基于杆臂补偿与正反倍速率同时标定多MIMU误差的方法,对于基于微机电系统设计的微小型惯性测量系统误差主要包括确定性误差和随机性误差两部分,且安装误差相对传统的惯性测量单元较大,根据MIMU误差漂移数学模型,设计了使用无需指北的单轴速率转台和六面体工装,利用基于杆臂补偿和正反倍速率的标定方法,建立了杆臂效应误差补偿模型和应用加权最小二乘法的误差解算统计模型,实现单次标定单个或多个IMU,确定标度因数、常值漂移、安装误差等误差系数。测试设备无需对北,可抵消地速及重力的误差影响,处理计算结果统计性强。且实验设备要求低,标定时间短、标定工作量小等优点。

Description

基于杆臂补偿与正反倍速率同时标定多MIMU误差的方法
技术领域
本发明涉及的是一种基于杆臂补偿与正反倍速率同时标定多MIMU误差的方法,属于误差标定技术领域。
背景技术
基于微机电系统(Micro-Electro-Mechanical System,MEMS)设计的微小型惯性测量系统(Micro Inertial Measurement Unit,MIMU)是包含多种惯性器件和测量传感器的捷联式位置姿态测量系统,主要包括微小型陀螺仪、加速度计、气压计、电子罗盘等传感器,通过运载体运动产生角速度和加速度等惯性信息结合气压、地磁场等环境信息达到对载体运动测量的目的。
惯性测量系统,是一种不依赖于任何外部信息,也不向外辐射能量的自主式捷联式导航系统,它不仅具有良好的隐蔽性,且其工作环境包括空中、地球表面和水下,可在个人移动终端,交通载具等领域使用,提供的导航数据十分安全,具有数据更新率高,短期精度和稳定性好的优点。这些使惯性导航系统在军事导航及民用导航领域中起着越来越大的作用。
由于生产工艺水平限制,惯性测量单元常存在零偏误差、标度因数误差、安装角误差和比例相关项误差等,使用前需要进行标定,求解出这些误差系数并补偿,提高IMU的测量精度。研发高效简易且适合多MIMU同时标定的标定方法,可大大减少标定过程的人力物力消耗,降低成本。
微小型惯性测量系统(Micro Inertial Measurement Unit,MIMU)的误差主要包括确定性误差和随机性误差两部分包括常值漂移误差、标度因数误差、安装误差及随机噪声等,其中常值漂移和标度因数误差对传感器输出误差带来的影响是最大的,由于制作工艺的原因,陀螺仪3个敏感轴并非完全正交而产生轴间非正交误差;同时传感器在安装过程中也会带来安装角误差;轴间非正交误差和安装角误差作用效果相似,可以统一规划为安装误差。其中,由于MIMU非正交装配、不等弹性变形的因素,在外部线、角运动以及温度变化等环境激励下就会产生各种确定性测量误差,确定性误差约占MIMU总误差的90%,是微小型捷联惯性导航系统的最主要误差来源。随机误差对标定结果影响较小且是一个随机小量,在标定时可忽略其影响。
现有MIMU标定方法中,通常将加速度通道与角速度通道分立标定。位置法标定加速度通道,角速率法标定角速度通道,标定方法复杂,数据量大,由于标定MIMU高阶误差模型需要复杂的实验,而且难以精准标定出高阶系数,因此工程中常用简化的一阶误差模型。
六方位正反速率法通过限定惯性测量单元(Inertial Measurement Unit,IMU)的测量中心在转台旋转轴上,来避免角速率运动对加速度通道输出的影响,仅用一组速率数据同时解算加速度和角速度通道误差系数,标定工作量较六方位24点法减少到2/5。但在MIMU标定应用中,需要单次实验标定多个MIMU,MIMU节点与转台旋转中心将存在杆臂。应用传统的六方位正反速率标定方法会受到杆臂效应引起的离心加速度影响、导致标定精度下降。
发明内容
针对上述缺陷,本发明提供了一种基于杆臂补偿与正反倍速率同时标定多MIMU误差的方法,针对多IMU标定精度下降的问题,依据误差模型和杆臂效应的影响分析,针对多MIMU标定过程中杆臂效应带来标定误差的影响机理进行了分析,设计了一种六方位倍速率标定方法,并建立了杆臂效应误差补偿模型和应用加权最小二乘法的误差解算模型,通过试验验证该方法的有效性。标定设备仅需单轴速率转台和六面体工装,可单次标定单个或多个MIMU惯性测量单元的同时提高微小型惯性测量系统的误差标定测量精度,为信息融合算法提供有效准确的测量数据。
为达到上述目的,本发明通过以下技术方案来具体实现:
本发明提供了一种基于杆臂补偿与正反倍速率同时标定多MIMU误差的方法,包括以下步骤:
步骤一、单轴速率转台安装平面调整为与地理水平面平行,其旋转轴向与地理水平面垂直,加工的六面体工装相邻两个面相互垂直;将多个MIMU安装在六面体工装上,上电后,静止预热30分钟;记录静态实验数据100秒;
步骤二、使MIMU的Z轴与转台旋转轴向(ZT)平行,方向与转台正向一致,采集1分钟的静止数据,分别输入一定倍数的转速如:0°/s、10°/s、20°/s、40°/s、80°/s、0°/s、-10°/s、-20°/s、-40°/s、-80°/s;每个转速保持100秒左右,并保证旋转整周数,分别采集每一转速下MIMU的输出数据,所述输出数据包括角速度通道的3个角速率、加速度通道的3个线加速度以及温度传感器输出;
步骤三、采集完所有输出数据后,旋转转台使MIMU转动到与初始静态位置相对称的位置,采集该静止位置下100秒的MIMU输出数据;利用六面体工装,分别设置MIMU六个位置,在每个位置重复步骤二的操作;
步骤四、根据采集的MIMU输出数据,基于杆臂效应误差补偿模型以及离心加速度降维解耦模型,去除离心加速度影响,补偿杆臂误差;
步骤五、利用加权最小二乘法的误差解算模型,计算求解出具有统计意义的陀螺及加速度计的标度因数、常值漂移、安装误差等误差系数并输出保存。
步骤二中,在每个方位输入不同的正反转速。将六位置每个速率下采集的正反转数据分别求平均,可求得六位置下每一转速MIMU角速度通道输出均值:
式中,1,…,6分别代表MIMU六个测量位置,i代表角速度通道三个轴向的陀螺仪编号,i=X,Y,Z,j代表MIMU正反转速编号,j=0,±10°/s,…,±80°/s,G(m,i,j,nd)代表第m个位置j转速下MIMU中第i轴向陀螺仪输出数据,nd代表采集数据的个数,通过数据平均处理,将任意转速下采集的MIMU角速度通道原始数据平均为G(6,3,2)。
所述步骤四中的杆臂效应误差补偿模型,包括:
使用转台标定多个MIMU时,由于MIMU测量中心与转台旋转中心之间存在杆臂r,当转台以角速率ω转动时,产生离心加速度αω
其中,杆臂r=[rx ry rz]T,角速率ω=[ωx ωy ωz]T
则加速度通道的实际输入ain为:
αin=g+αω
将加速度输入分解为已知加速度和未知加速度,所述已知加速度为重力加速度;所述未知加速度为离心加速度:
由于传统的六方位正反速率法的解算模型中加速度通道输入为重力加速度,用传统方法标定多MIMU会带来离心加速度引起的标定误差。解算误差系数进行补偿后结果为:
式中:ai为i轴实际加速度值,aei为i轴由于标定时的离心加速度引起的补偿误差;aei与标定时i轴离心加速度大小成正比。
加速度通道误差系数解算模型是根据实验数据对加速度通道误差模型进行扩维,得到加速度通道输出与输入关系为:
式中:为12组数据加速度计输出矩阵,AI为12组数据加速度输入矩阵,KA为加速度通道误差系数矩阵;
根据加速度通道输入输出方程,将其中AI分解为AI1和AI2(分解的AI2由于含全为0的行而进行降维),得到降维模型:
式中:AI1为12组数据重力加速度输入和元素1组成的矩阵,AI2为12组数据离心加速度输入矩阵,K′A为KA的降维矩阵;
步骤四中的离心加速度降维解耦模型为:
翻转MIMU后,以ω1和ω2两个n倍速率点采集数据,且位置不变情况下r是一定的,取ω2=nω1,则有翻转后加速度关系:
a2im=n2a1im
利用加速度关系对降维模型进行解耦,可消除离心加速度,得到去除离心加速度的降维模型:
其中,和A′I1如下,由测量数据分解得到:
步骤五中的加权最小二乘法的误差解算模型,消除离心加速度后,在实际应用中,Z轴向上为MIMU最常用工作状态。增大Z轴向上方位数据的权值,有助于抑制非线性和非对称性误差,从而提高导航系统性能。对误差系数在去除离心加速度的降维模型两边同时乘以六方位数据的权值矩阵σa,得到方程组:
式中:和A′I1乘权值矩阵σa后得到和A″I1,其中:
σa=Diag[σα1 σα2 σα3 σα4 σα5 σα6],其中σα5为Z轴向上方位权值,大于其他方位权值;再使用加权最小二乘法解算得到KA,最终角速度通道误差系数解算模型为:
加速度输入解算求解未知离心加速度,角速度通道误差系数包括比力相关项,求解未知离心加速度,进行消元,得到加速度输入位置离心加速度模型:
式中:
地球自转角速度水平分量经转台旋转调制为正弦信号,整周期均值为零;根据角速度通道误差模型,标定方法中角速度通道输出与输入关系为:
式中:为数据角速度计输出矩阵,GI为数据角速度和加速度输入矩阵,KG为角速度通道误差系数矩阵;
ωi+=ωiesin(φ),ωi-=-ωiesin(φ),其中Ωe表示地球自转角速度,为陀螺输出原始数据,ωi为输入角速率,φ为当地纬度;
应用加权最小二乘法,角速度通道输出与输入关系公式左右两边同时乘以六方位数据的权值矩阵σg,得到方程组:
式中:和GI乘权值矩阵σg后得到和G′I,其中:σg=Diag[σg1 σg2 … σg11 σg12],σg9和σg10为Z轴向上方位数据权值,大于其他方位权值。
根据加权最小二乘法解算陀螺标度因数KG得到完整角速度误差系数计算模型:
式中:和GI乘权值矩阵σg后得到和G′I,其中σg=Diag[σg1 σg2 … σg11 σg12],σg9和σg10为Z轴向上方位数据权值,大于其他方位权值。
综上,共得到MIMU陀螺仪和加速度计共计33个误差参数。可为后续补偿和信息融合算法提供误差修正指标。
本发明的原理:
本发明设计了一种针对微小型惯性测量系统多MIMU的基于杆臂补偿与正反倍速率误差标定方法,针对安装误差相对传统的惯性测量单元较大的问题,根据相应杆臂效应影响机理分析并结合误差漂移数学统计模型,应用加权最小二乘法,设计了使用单轴速率转台和六面体工装的标定方法,可抵消地速及重力的误差影响,测试设备无需对北,处理计算结果统计性强。且实验设备要求低,标定时间短、标定工作量小,适合同时标定多MIMU等优点。试验结果表明,本文提出的标定方法简易、高效。MIMU常用工作方位下,加速度通道和角速度通道系统误差的补偿精度均有较大提高。
本发明的优点在于:
(1)解决了应用传统的六方位正反速率标定方法会受到杆臂效应引起的离心加速度影响、导致标定精度下降的问题,使用正反倍速率使得结果较传统标定方法精度得到提高。
(2)可同时进行多MIMU标定,通过杆臂误差模型确定各IMU误差指标,提高标定效率。
(3)利用加权最小二乘法,有效抑制了数据发非线性和非对称性误差,加速度通道和角速度通道系统误差的补偿精度均有较大提高。
附图说明
图1所示为本发明提供的一种基于杆臂补偿与正反倍速率同时标定多MIMU误差的方法的实施例一流程图。
图2a所示为三轴惯性器件安装角误差示中陀螺仪安装角误差示意图。
图2b所示为三轴惯性器件安装角误差示中加速度通道安装角误差示意图。
图3a所示为六方位倍速率X轴正向标定示意图。
图3b所示为六方位倍速率X轴负向标定示意图。
图3c所示为六方位倍速率Y轴正向标定示意图。
图3d所示为六方位倍速率Y轴负向标定示意图。
图3e所示为六方位倍速率Z轴正向标定示意图。
图3f所示为六方位倍速率Z轴负向标定示意图。
图中:X,Y,Z为MIMU三个敏感轴,ZT为转台旋转轴向,每个方位分别以ω1和相应倍速率ω2(其中ω2=nω1且n≠±1)为角速度进行匀速转动。
具体实施方式
下面对本发明的技术方案进行具体阐述,需要指出的是,本发明的技术方案不限于实施例所述的实施方式,本领域的技术人员参考和借鉴本发明技术方案的内容,在本发明的基础上进行的改进和设计,应属于本发明的保护范围。
实施例一
本发明实施例一基于微机电系统(Micro-Electro-Mechanical System,MEMS)设计的微小型惯性测量系统(Micro Inertial Measurement Unit,MIMU),包含微小型陀螺仪、加速度计、气压计、电子罗盘等传感器,通过运载体运动产生角速度和加速度等信息达到对载体运动测量的目的。针对其安装误差相对传统的惯性测量单元较大的问题,根据相应杆臂效应影响机理分析并结合误差漂移数学统计模型,应用加权最小二乘法,设计了使用单轴速率转台和六面体工装的标定方法,可抵消地速及重力的误差影响,测试设备无需对北,处理计算结果统计性强。且实验设备要求低,标定时间短、标定工作量小,适合同时标定多MIMU等优点。试验结果表明,本文提出的标定方法简易、高效。MIMU常用工作方位下,加速度通道和角速度通道系统误差的补偿精度均有较大提高。具体如图1所示,该方案包括以下步骤:
步骤一、单轴速率转台安装平面调整为与地理水平面平行,其旋转轴向与地理水平面垂直,加工的六面体工装相邻两个面相互垂直;将多个MIMU安装在六面体工装上,上电后,静止预热30分钟;记录静态实验数据100秒;
步骤二、使MIMU的Z轴与转台旋转轴向(ZT)平行,方向与转台正向一致,采集1分钟的静止数据,分别输入一定倍数的转速如:0°/s、10°/s、20°/s、40°/s、80°/s、0°/s、-10°/s、-20°/s、-40°/s、-80°/s;每个转速保持100秒左右,并保证旋转整周数,分别采集每一转速下MIMU的输出数据,所述输出数据包括角速度通道的3个角速率、加速度通道的3个线加速度以及温度传感器输出;
步骤三、采集完所有输出数据后,旋转转台使MIMU转动到与初始静态位置相对称的位置,采集该静止位置下100秒的MIMU输出数据;利用六面体工装,分别设置MIMU六个位置,在每个位置重复步骤二的操作;
步骤四、根据采集的MIMU输出数据,按照实验流程依次读取并处理。基于杆臂效应误差补偿模型以及离心加速度降维解耦模型,去除离心加速度影响,补偿杆臂误差;
步骤五、利用加权最小二乘法的误差解算模型,计算求解出具有统计意义的陀螺及加速度计的标度因数、常值漂移、安装误差(见图2a、图2b)等误差系数并输出保存。
由于系统误差严重影响MIMU测量精度,使用前必须进行标定。MIMU标定是指在已知输入条件下,进行多组测试,从而构成输入输出关系的方程组,来解算出模型中的误差系数。
步骤二中,在每个方位输入不同的正反转速。将六位置每个速率下采集的正反转数据分别求平均,可求得六位置下每一转速MIMU角速度通道输出均值:
式中,1,…,6分别代表如图3a,图3b,图3c,图3d,图3e,图3f中所示的MIMU六个测量位置,i代表角速度通道三个轴向的陀螺仪编号,i=X,Y,Z,j代表MIMU正反转速编号,j=0,±10°/s,…,±80°/s,G(m,i,j,nd)代表第m个位置j转速下MIMU中第i轴向陀螺仪输出数据,nd代表采集数据的个数,通过数据平均处理,将任意转速下采集的MIMU角速度通道原始数据平均为G(6,3,2)。
所述步骤四中的杆臂效应误差补偿模型,包括:
在标定多个MIMU时,由于MIMU测量中心与转台旋转中心之间存在杆臂r,当转台以角速率ω转动时,产生离心加速度αω
其中,杆臂r=[rx ry rz]T,角速率ω=[ωx ωy ωz]T
则加速度通道的实际输入ain为:
αin=g+αω
将加速度输入分解为已知加速度和未知加速度,所述已知加速度为重力加速度;所述未知加速度为离心加速度:
由于传统的六方位正反速率法的解算模型中加速度通道输入为重力加速度,用传统方法标定多MIMU会带来离心加速度引起的标定误差。解算误差系数进行补偿后结果为:
式中:ai为i轴实际加速度值,aei为i轴由于标定时的离心加速度引起的补偿误差;aei与标定时i轴离心加速度大小成正比。
加速度通道误差系数解算模型是根据实验数据对加速度通道误差模型进行扩维,得到加速度通道输出与输入关系为:
式中:为12组数据加速度计输出矩阵,AI为12组数据加速度输入矩阵,KA为加速度通道误差系数矩阵;
根据加速度通道输入输出方程,将其中AI分解为AI1和AI2(分解的AI2由于含全为0的行而进行降维),得到降维模型:
式中:AI1为12组数据重力加速度输入和元素1组成的矩阵,AI2为12组数据离心加速度输入矩阵,K′A为KA的降维矩阵;
步骤四中的离心加速度降维解耦模型为:
建立离心加速度解耦模型是每次翻转MIMU后,在ω1和ω2两个n倍速率点采集数据,r是一定的,取ω2=nω1,则有翻转后加速度关系:
a2im=n2a1im
利用加速度关系对降维模型进行解耦,可消除离心加速度,得到去除离心加速度的降维模型:
其中,和A′I1如下,由测量数据分解得到:
建立加速度通道误差系数解算方法在消除离心加速度后,12项误差系数可由18个不相关方程组解出。在实际应用中,Z轴向上为MIMU最常用工作状态。增大Z轴向上方位数据的权值,有助于抑制非线性和非对称性误差,从而提高导航系统性能。在去除离心加速度的降维模型两边同时乘以六方位数据的权值矩阵,得到方程组:
式中:和A′I1乘权值矩阵σa后得到和A″I1,其中:
σa=Diag[σα1 σα2 σα3 σα4 σα5 σα6],其中σα5为Z轴向上方位权值,大于其他方位权值;再使用加权最小二乘法解算得到KA,最终角速度通道误差系数解算模型为:
加速度输入解算求解未知离心加速度,角速度通道误差系数包括比力相关项,求解未知离心加速度,进行消元,得到加速度输入位置离心加速度模型:
式中:
地球自转角速度水平分量经转台旋转调制为正弦信号,整周期均值为零;根据角速度通道误差模型,标定方法中角速度通道输出与输入关系为:
式中:为12组数据角速度计输出矩阵,GI为12组数据角速度和加速度输入矩阵,KG为角速度通道误差系数矩阵;
ωi+=ωiesin(φ),ωi-=-ωiesin(φ),Ωe表示地球自转角速度,为陀螺输出原始数据,ωi为输入角速率,φ为当地纬度;
角速度通道误差系数解算:
角速度误差模型中21项角速度通道误差系数可由36个不相关方程组解出,应用加权最小二乘法,角速度通道输出与输入关系公式左右两边同时乘以六方位数据的权值矩阵σg,得到方程组:
式中:和GI乘权值矩阵σg后得到和G′I,其中:σg=Diag[σg1 σg2 … σg11σg12],σg9和σg10为Z轴向上方位数据权值,大于其他方位权值。
根据加权最小二乘法解算陀螺标度因数KG得到完整角速度误差系数计算模型:
式中:和GI乘权值矩阵σg后得到和G′I,其中σg=Diag[σg1 σg2 … σg11 σg12],σg9和σg10为Z轴向上方位数据权值,大于其他方位权值。
综上,共得到MIMU陀螺仪和加速度计共计33个误差参数。可为后续补偿和信息融合算法提供误差修正指标。
本发明的原理:
本发明设计了一种针对微小型惯性测量系统多MIMU的基于杆臂补偿与正反倍速率误差标定方法,针对安装误差相对传统的惯性测量单元较大的问题,根据相应杆臂效应影响机理分析并结合误差漂移数学统计模型,应用加权最小二乘法,设计了使用单轴速率转台和六面体工装的标定方法,可抵消地速及重力的误差影响,测试设备无需对北,处理计算结果统计性强。且实验设备要求低,标定时间短、标定工作量小,适合同时标定多MIMU等优点。试验结果表明,本文提出的标定方法简易、高效。MIMU常用工作方位下,加速度通道和角速度通道系统误差的补偿精度均有较大提高。
本发明的优点在于:
(1)解决了应用传统的六方位正反速率标定方法会受到杆臂效应引起的离心加速度影响、导致标定精度下降的问题,使用正反倍速率使得结果较传统标定方法精度得到提高。
(2)可同时进行多MIMU标定,通过杆臂误差模型确定各IMU误差指标,提高标定效率。
(3)利用加权最小二乘法,有效抑制了数据发非线性和非对称性误差,加速度通道和角速度通道系统误差的补偿精度均有较大提高。
以上公开的仅为本发明的具体实施例,但是,本发明并非局限于上述实施例,任何本领域的技术人员能思之的变化都应落入本发明的保护范围。

Claims (4)

1.一种基于杆臂补偿与正反倍速率同时标定多MIMU误差的方法,其特征在于,包括以下步骤:
步骤一、单轴速率转台安装平面调整为与地理水平面平行,其旋转轴向与地理水平面垂直,加工的六面体工装相邻两个面相互垂直;将多个MIMU安装在六面体工装上,上电后,静止预热30分钟;记录静态实验数据100秒;
步骤二、使MIMU的Z轴与转台旋转轴向(ZT)平行,方向与转台正向一致,采集1分钟的静止数据,分别输入一定倍数的转速;每个转速保持100秒左右,并保证旋转整周数,分别采集每一转速下MIMU的输出数据,所述输出数据包括角速度通道的角速率、加速度通道的线加速度以及温度传感器输出;
步骤三、采集完所有输出数据后,旋转转台使MIMU转动到与初始静态位置相对称的位置,采集该静止位置下100秒的MIMU输出数据;利用六面体工装,分别设置MIMU六个位置,在每个位置重复步骤二的操作;
步骤四、根据采集的MIMU输出数据,基于杆臂效应误差补偿模型以及离心加速度降维解耦模型,去除离心加速度影响,补偿杆臂误差;
步骤五、利用加权最小二乘法的误差解算模型,计算求解出具有统计意义的陀螺及加速度计的标度因数、常值漂移、安装误差等误差系数并输出保存。
2.根据权利1要求所述的方法,其特征在于:所述步骤四中的杆臂效应误差补偿模型,包括:
使用转台标定多个MIMU时,由于MIMU测量中心与转台旋转中心之间存在杆臂r,当转台以角速率ω转动时,产生离心加速度αω
其中,杆臂r=[rx ry rz]T,角速率ω=[ωx ωy ωz]T
则加速度通道的实际输入αin为:
αιν=g+αω
将加速度输入分解为已知加速度和未知加速度,所述已知加速度为重力加速度;所述未知加速度为离心加速度:
解算误差系数进行补偿后结果为:
式中:ai为i轴实际加速度值,aei为i轴由于标定时的离心加速度引起的补偿误差;aei与标定时i轴离心加速度大小成正比。
3.根据权利要求1或2所述的方法,其特征在于:所述步骤四中的离心加速度降维解耦模型为:
翻转MIMU后,在ω1和ω2两个n倍速率点采集数据,取ω2=nω1,则有翻转后加速度关系:
a2im=n2a1im
利用加速度关系对降维模型进行解耦,可消除离心加速度,得到去除离心加速度的降维模型:
其中,和A′I1如下,由测量数据分解得到:
4.根据权利1要求所述的方法,其特征在于:所述步骤五中的加权最小二乘法的误差解算模型,对误差系数在去除离心加速度的降维模型两边同时乘以六方位数据的权值矩阵σa,得到方程组:
式中:和AI1乘权值矩阵σa后得到和A″I1,其中:
σa=Diag[σα1 σα2 σα3 σα4 σα5 σα6],其中σα5为Z轴向上方位权值,大于其他方位权值;再使用加权最小二乘法解算得到KA,角速度通道误差系数解算模型为:
角速度通道误差系数包括比力相关项,求解未知离心加速度,进行消元,得到加速度输入位置离心加速度模型:
式s中:
地球自转角速度水平分量经转台旋转调制为正弦信号,整周期均值为零;根据角速度通道误差模型,标定方法中角速度通道输出与输入关系为:
式中:为数据角速度计输出矩阵,GI为数据角速度和加速度输入矩阵,KG为角速度通道误差系数矩阵;
ωi+=ωiesin(φ),ωi-=-ωiesin(φ),Ωe表示地球自转角速度,为陀螺输出原始数据,ωi为输入角速率,φ为当地纬度;
应用加权最小二乘法,角速度通道输出与输入关系公式左右两边同时乘以六方位数据的权值矩阵σg,得到方程组:
根据加权最小二乘法解算陀螺标度因数KG为:
式中:和GI乘权值矩阵σg后得到和G′I,其中σg=Diag[σg1 σg2 … σg11 σg12],σg9和σg10为Z轴向上方位数据权值,大于其他方位权值。
CN201810558490.5A 2018-06-01 2018-06-01 基于杆臂补偿与正反倍速率同时标定多mimu误差的方法 Active CN108592952B (zh)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN201810558490.5A CN108592952B (zh) 2018-06-01 2018-06-01 基于杆臂补偿与正反倍速率同时标定多mimu误差的方法

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN201810558490.5A CN108592952B (zh) 2018-06-01 2018-06-01 基于杆臂补偿与正反倍速率同时标定多mimu误差的方法

Publications (2)

Publication Number Publication Date
CN108592952A true CN108592952A (zh) 2018-09-28
CN108592952B CN108592952B (zh) 2020-10-27

Family

ID=63630841

Family Applications (1)

Application Number Title Priority Date Filing Date
CN201810558490.5A Active CN108592952B (zh) 2018-06-01 2018-06-01 基于杆臂补偿与正反倍速率同时标定多mimu误差的方法

Country Status (1)

Country Link
CN (1) CN108592952B (zh)

Cited By (15)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN109684748A (zh) * 2018-12-27 2019-04-26 上海理工大学 一种除藻机防缠绕最小速度的优化设计方法
CN110031023A (zh) * 2019-05-16 2019-07-19 上海华测导航技术股份有限公司 一种工程机械姿态传感器系统误差标定方法
CN110987008A (zh) * 2019-12-10 2020-04-10 上海航天控制技术研究所 一种低精度mems陀螺组合零位偏置快速标定方法
CN111400842A (zh) * 2018-12-17 2020-07-10 北京华航无线电测量研究所 一种高精度框架角补偿算法
CN112197789A (zh) * 2020-08-14 2021-01-08 北京自动化控制设备研究所 一种基于quest的ins/dvl安装误差标定方法
CN112539766A (zh) * 2020-12-02 2021-03-23 北京航天光华电子技术有限公司 单轴速率陀螺回转台回转轴线垂直度误差测试装置及方法
CN112762964A (zh) * 2021-01-27 2021-05-07 广州小马智行科技有限公司 自动驾驶车辆的惯性测量单元的标定方法及装置、系统
CN113295887A (zh) * 2021-05-14 2021-08-24 北京开拓航宇导控科技有限公司 一种微机电三轴加速度计交叉耦合系数快速标定方法
CN113447960A (zh) * 2020-03-26 2021-09-28 千寻位置网络有限公司 基于gnss/mems组合车载导航系统的误差标定方法及系统
CN113916256A (zh) * 2021-09-03 2022-01-11 北京自动化控制设备研究所 三轴mems陀螺组合惯性测量单元标定方法
CN113945227A (zh) * 2021-09-13 2022-01-18 西安航天三沃机电设备有限责任公司 一种基于离心台的惯性测量单元全量程加速度标校方法
CN114061576A (zh) * 2021-12-08 2022-02-18 北京理工大学 一种多位置法mems加速度计标定补偿方法
CN114199280A (zh) * 2021-12-10 2022-03-18 中国兵器工业集团第二一四研究所苏州研发中心 微惯性测量组件的批量化标定与误差补偿系统及方法
CN114689901A (zh) * 2022-01-27 2022-07-01 北京邮电大学 加速度计现场标定方法和装置
CN113945227B (zh) * 2021-09-13 2024-04-23 西安航天三沃机电设备有限责任公司 一种基于离心台的惯性测量单元全量程加速度标校方法

Citations (10)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
GB2272974A (en) * 1992-11-27 1994-06-01 Gec Ferranti Defence Syst Inertial guidance system
CN102393201B (zh) * 2011-08-02 2013-05-15 北京航空航天大学 航空遥感用位置和姿态测量系统(pos)动态杆臂补偿方法
CN103245360A (zh) * 2013-04-24 2013-08-14 北京工业大学 晃动基座下的舰载机旋转式捷联惯导系统自对准方法
CN103256942A (zh) * 2013-04-26 2013-08-21 哈尔滨工程大学 传递对准中考虑杆臂补偿的变形角测量方法
CN103363989A (zh) * 2012-04-09 2013-10-23 北京自动化控制设备研究所 一种捷联惯导系统内杆臂的估计与误差补偿方法
CN103630146A (zh) * 2013-09-15 2014-03-12 北京航空航天大学 一种离散解析与Kalman滤波结合的激光陀螺IMU标定方法
CN102620748B (zh) * 2012-03-22 2014-09-10 东南大学 捷联惯导系统晃动基座条件下杆臂效应的估计和补偿方法
CN104697553A (zh) * 2015-03-13 2015-06-10 哈尔滨工程大学 光纤陀螺捷联惯导系统加速度计内杆臂标定方法
CN104697521A (zh) * 2015-03-13 2015-06-10 哈尔滨工程大学 一种采用陀螺冗余斜交配置方式测量高速旋转体姿态和角速度的方法
CN106482746A (zh) * 2016-11-25 2017-03-08 北京航空航天大学 一种用于混合式惯导系统的加速度计内杆臂标定与补偿方法

Patent Citations (10)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
GB2272974A (en) * 1992-11-27 1994-06-01 Gec Ferranti Defence Syst Inertial guidance system
CN102393201B (zh) * 2011-08-02 2013-05-15 北京航空航天大学 航空遥感用位置和姿态测量系统(pos)动态杆臂补偿方法
CN102620748B (zh) * 2012-03-22 2014-09-10 东南大学 捷联惯导系统晃动基座条件下杆臂效应的估计和补偿方法
CN103363989A (zh) * 2012-04-09 2013-10-23 北京自动化控制设备研究所 一种捷联惯导系统内杆臂的估计与误差补偿方法
CN103245360A (zh) * 2013-04-24 2013-08-14 北京工业大学 晃动基座下的舰载机旋转式捷联惯导系统自对准方法
CN103256942A (zh) * 2013-04-26 2013-08-21 哈尔滨工程大学 传递对准中考虑杆臂补偿的变形角测量方法
CN103630146A (zh) * 2013-09-15 2014-03-12 北京航空航天大学 一种离散解析与Kalman滤波结合的激光陀螺IMU标定方法
CN104697553A (zh) * 2015-03-13 2015-06-10 哈尔滨工程大学 光纤陀螺捷联惯导系统加速度计内杆臂标定方法
CN104697521A (zh) * 2015-03-13 2015-06-10 哈尔滨工程大学 一种采用陀螺冗余斜交配置方式测量高速旋转体姿态和角速度的方法
CN106482746A (zh) * 2016-11-25 2017-03-08 北京航空航天大学 一种用于混合式惯导系统的加速度计内杆臂标定与补偿方法

Cited By (25)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN111400842B (zh) * 2018-12-17 2023-08-15 北京华航无线电测量研究所 一种高精度框架角补偿方法
CN111400842A (zh) * 2018-12-17 2020-07-10 北京华航无线电测量研究所 一种高精度框架角补偿算法
CN109684748A (zh) * 2018-12-27 2019-04-26 上海理工大学 一种除藻机防缠绕最小速度的优化设计方法
CN109684748B (zh) * 2018-12-27 2022-12-27 上海理工大学 一种除藻机防缠绕最小速度的优化设计方法
CN110031023A (zh) * 2019-05-16 2019-07-19 上海华测导航技术股份有限公司 一种工程机械姿态传感器系统误差标定方法
CN110987008A (zh) * 2019-12-10 2020-04-10 上海航天控制技术研究所 一种低精度mems陀螺组合零位偏置快速标定方法
CN110987008B (zh) * 2019-12-10 2023-08-11 上海航天控制技术研究所 一种低精度mems陀螺组合零位偏置快速标定方法
CN113447960A (zh) * 2020-03-26 2021-09-28 千寻位置网络有限公司 基于gnss/mems组合车载导航系统的误差标定方法及系统
CN113447960B (zh) * 2020-03-26 2022-06-24 千寻位置网络有限公司 基于gnss/mems组合车载导航系统的误差标定方法及系统
CN112197789A (zh) * 2020-08-14 2021-01-08 北京自动化控制设备研究所 一种基于quest的ins/dvl安装误差标定方法
CN112197789B (zh) * 2020-08-14 2023-09-12 北京自动化控制设备研究所 一种基于quest的ins/dvl安装误差标定方法
CN112539766A (zh) * 2020-12-02 2021-03-23 北京航天光华电子技术有限公司 单轴速率陀螺回转台回转轴线垂直度误差测试装置及方法
CN112539766B (zh) * 2020-12-02 2023-03-28 北京航天光华电子技术有限公司 单轴速率陀螺回转台回转轴线垂直度误差测试装置及方法
CN112762964A (zh) * 2021-01-27 2021-05-07 广州小马智行科技有限公司 自动驾驶车辆的惯性测量单元的标定方法及装置、系统
CN112762964B (zh) * 2021-01-27 2024-03-15 广州小马智行科技有限公司 自动驾驶车辆的惯性测量单元的标定方法及装置、系统
CN113295887A (zh) * 2021-05-14 2021-08-24 北京开拓航宇导控科技有限公司 一种微机电三轴加速度计交叉耦合系数快速标定方法
CN113295887B (zh) * 2021-05-14 2024-04-05 开拓导航控制技术股份有限公司 一种微机电三轴加速度计交叉耦合系数快速标定方法
CN113916256A (zh) * 2021-09-03 2022-01-11 北京自动化控制设备研究所 三轴mems陀螺组合惯性测量单元标定方法
CN113916256B (zh) * 2021-09-03 2023-09-12 北京自动化控制设备研究所 三轴mems陀螺组合惯性测量单元标定方法
CN113945227A (zh) * 2021-09-13 2022-01-18 西安航天三沃机电设备有限责任公司 一种基于离心台的惯性测量单元全量程加速度标校方法
CN113945227B (zh) * 2021-09-13 2024-04-23 西安航天三沃机电设备有限责任公司 一种基于离心台的惯性测量单元全量程加速度标校方法
CN114061576A (zh) * 2021-12-08 2022-02-18 北京理工大学 一种多位置法mems加速度计标定补偿方法
CN114199280A (zh) * 2021-12-10 2022-03-18 中国兵器工业集团第二一四研究所苏州研发中心 微惯性测量组件的批量化标定与误差补偿系统及方法
CN114689901A (zh) * 2022-01-27 2022-07-01 北京邮电大学 加速度计现场标定方法和装置
CN114689901B (zh) * 2022-01-27 2023-09-05 北京邮电大学 加速度计现场标定方法和装置

Also Published As

Publication number Publication date
CN108592952B (zh) 2020-10-27

Similar Documents

Publication Publication Date Title
CN108592952A (zh) 基于杆臂补偿与正反倍速率同时标定多mimu误差的方法
CN107024674B (zh) 一种基于递推最小二乘法的磁强计现场快速标定方法
Rohac et al. Calibration of low-cost triaxial inertial sensors
CN106017507B (zh) 一种用于中低精度的光纤惯组快速标定方法
CN110160554B (zh) 一种基于寻优法的单轴旋转捷联惯导系统标定方法
CN107655493B (zh) 一种光纤陀螺sins六位置系统级标定方法
Deng et al. Analysis and calibration of the nonorthogonal angle in dual-axis rotational INS
CN109974749B (zh) 一种三轴转台综合指向误差的评定方法
CN104459828B (zh) 基于绕轴法的地磁矢量系统非对准校正方法
CN104764463B (zh) 一种惯性平台调平瞄准误差的自检测方法
CN101178313A (zh) 适合于光纤陀螺捷联惯性导航系统的地速检测方法
CN106813680A (zh) 一种高精度、高分辨率石英扰性传感器的静态标定方法
CN108458714A (zh) 一种姿态检测系统中不含重力加速度的欧拉角求解方法
CN112698055B (zh) 加速度计在精密离心机上的参数标定方法
Wang et al. An improve hybrid calibration scheme for strapdown inertial navigation system
CN111076748A (zh) 基于mems加速度计的水平倾角仪误差补偿方法及系统
CN110174122A (zh) 一种基于极大似然估计算法的mems三轴加速度计标定方法
CN115876225A (zh) 基于二自由度转台的mems imu标定方法及系统
CN113959464B (zh) 一种陀螺仪辅助的加速度计现场校准方法和系统
CN108716925A (zh) 一种九轴传感器的标定方法及装置
Hegazy et al. Calibration and compensation of scale factor non-linearity and non-orthogonality errors for dynamically tuned gyroscope (DTG)
CN111220817B (zh) 一种捷联惯组三轴加速度计的标定方法
Nikolaev et al. Strapdown inertial navigation system calibration
Goryanina et al. Recursive least squares method for identification of MEMS orientation sensors parameters
CN113790737B (zh) 一种阵列式传感器的现场快速标定方法

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
GR01 Patent grant
GR01 Patent grant