CN1330935C - 安装误差角与标度因数解耦的微惯性测量单元精确标定方法 - Google Patents

安装误差角与标度因数解耦的微惯性测量单元精确标定方法 Download PDF

Info

Publication number
CN1330935C
CN1330935C CNB2006100115763A CN200610011576A CN1330935C CN 1330935 C CN1330935 C CN 1330935C CN B2006100115763 A CNB2006100115763 A CN B2006100115763A CN 200610011576 A CN200610011576 A CN 200610011576A CN 1330935 C CN1330935 C CN 1330935C
Authority
CN
China
Prior art keywords
mimu
gyroscope
axle
constant multiplier
angle
Prior art date
Application number
CNB2006100115763A
Other languages
English (en)
Other versions
CN1818555A (zh
Inventor
房建成
李建利
盛蔚
刘百奇
张霄
孙宏伟
Original Assignee
北京航空航天大学
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 北京航空航天大学 filed Critical 北京航空航天大学
Priority to CNB2006100115763A priority Critical patent/CN1330935C/zh
Publication of CN1818555A publication Critical patent/CN1818555A/zh
Application granted granted Critical
Publication of CN1330935C publication Critical patent/CN1330935C/zh

Links

Abstract

安装误差角与标度因数解耦的微惯性测量单元精确标定方法,用于精确标定MIMU中所有误差系数,首先建立MIMU完备误差模型,分离加速度计及陀螺仪安装误差角与标度因数之间的耦合。进行10位置静态标定试验,采用位置误差相消法计算加速度计和陀螺仪的常值偏置,分离出加速度计的标度因数、安装误差角。通过3方位正负速率试验,采用最小二乘法、迭代法计算陀螺仪安装误差角、低动态情况下标度因数以及陀螺仪输出与比力有关误差项,最后利用插值法分段计算陀螺仪高动态情况下标度因数。该方法简单、快速、精度高,实验设备不需指北,实现了MIMU中陀螺仪、加速度计标度因数与安装误差角的解耦,标定出的安装误差角可为MIMU进一步安装调整提供指导。

Description

安装误差角与标度因数解耦的微惯性测量单元精确标定方法
技术领域
本发明涉及一种安装误差角与标度因数解耦的MIMU精确标定方法,用于计算MIMU完备误差模型中各项误差系数,特别适用于具有较大安装误差角的MIMU标定,该方法同样适用于挠性陀螺仪惯性测量单元(IMU)和液浮陀螺仪IMU。
背景技术
由三个正交设置的微机电陀螺仪和加速度计组成的MIMU是微惯性导航系统的核心部件,它的精度决定了微惯性导航系统的导航精度,MIMU误差源中确定性的系统误差约占总误差的90%左右,因此对确定性的系统误差进行分离、标定、补偿对提高MIMU精度具有决定性作用。
目前MIMU的标定基本采用传统的标定方法,主要包括多位置静态标定、动态速率标定以及动静混合标定等几种方法。其中静态标定是利用地球重力加速度和地球自转角速率在各轴方向的分量来求解MIMU误差系数,该方法包括12位置、24位置等多种标定方法,可以精确标定MIMU中加速度计误差系数,但陀螺仪的标定精度很低;动态速率标定方法提高了MIMU中陀螺仪的误差标定精度,但是只能标定出部分误差系数;动静混合标定方法克服了静、动两种标定方法的不足,不仅能标定出所有误差系数,同时提高了标定精度,成为目前MIMU标定主流方向。
现有的动静混合标定方法已广泛应用于MIMU的标定,都是基于现有的误差模型设计,现有MIMU误差模型中角速度通道误差模型为:ω-x=Kx1ωx+Kx2ωx2+Mxyωy+Mxzωz+Dx+Dxxfx+Dxyfy+Dxzfz]]>ω-y=Kylωy+Ky2ωy2+Myxωx+Myzωz+Dy+Dyxfx+Dyyfy+Dyzfz]]>
ω-z=Kz1ωz+Kz2ωz2+Mzxωx+Mzyωy+Dz+Dzxfx+Dzyfy+Dzxfz]]>其中 分别代表MIMU中x、y、z轴陀螺仪输出的模拟电压值;ωx、ωy和ωz分别代表x、y、z轴输入的实际角速度;Ki1、Ki2分别为陀螺仪标度因数一次项和二次项;Myx、Mxz、Mzx为安装误差项;Dx、Dy、Dz、代表x、y、z轴陀螺仪常值偏置;Dij代表i轴陀螺仪输出与j轴比力有关误差项;fx、fy和fz分别代表x、y、z轴输入的实际比力。现有MIMU误差模型中加速度通道误差模型为:f‾x=kax(fx+Bx+Ixyfy+Ixzfz)]]>f‾y=kay(fy+By+Iyxfx+Iyzfz)]]>f‾z=kaz(fz+Bz+Izyfy+Izxfx)]]>其中 分别代表MIMU中x、y、z轴加速度计输出的模拟电压值;kax、kay、kaz代表x、y、z轴加速度计标度因数;Iij代表i轴加速度计与j轴的安装误差项;Bx、By、Bz代表x、y、z轴加速度计常值偏置。上述角速度和加速度通道误差模型中的陀螺仪和加速度计安装误差项实际上是标度因数与安装误差角耦合系数,所以现有的动静混合标定方法不能精确计算安装误差角,因而无法为进一步修正安装误差角提供指导信息,同时该方法没有计算负转速下的陀螺仪标度因数,因而导致了陀螺仪标度因数不对称度误差;另外,该方法采用的标定试验设备要求寻北,因而增加了试验难度和工作量。
发明内容
本发明的技术解决问题是:克服现有MIMU标定方法的不足,提出一种安装误差角与标度因数解耦的微惯性测量单元精确标定方法,该方法简单、快速、精度高,实验设备不需指北,实现了MIMU中陀螺仪、加速度计标度因数与安装误差角的解耦。
本发明的技术解决方案为:安装误差角与标度因数解耦的微惯性测量单元精确标定方法,其特点在于通过下列步骤实现:(1)建立MIMU完备误差模型,采用安装误差角取代现有误差模型中的安装误差系数,分离标度因数与安装误差角耦合;(2)利用双轴位置台或转台(无需指北)进行10位置静态标定试验;(3)根据静态标定试验数据,采用对称位置误差相消法计算加速度计、陀螺仪常值偏置,利用加速度通道解耦法计算加速度计标度因数与安装误差角;(4)利用单轴速率转台(无需指北)及三面工装进行3方位正负速率试验;(5)根据3方位正负速率实验数据,采用最小二乘法及循环迭代法逐次分离MIMU中陀螺仪标度因数与安装误差角耦合,计算陀螺仪低动态情况下标度因数、陀螺仪安装误差角,结合静态标定试验数据求解陀螺仪输出与比力有关误差项,并采用插值法分段精确计算陀螺仪高动态情况下标度因数。
所述步骤(2)中的10位置静态标定试验方法为:设置MIMU中x、y、z轴分别与地理坐标系天向重合的三个位置,以及这三个位置分别绕天向轴水平转动180°的另外三个位置;设置MIMU中x、y、z任意一轴与地理坐标系地向重合以及该位置绕地向轴水平转动180°的二个位置;设置MIMU中z轴在地理水平面内,x、y轴都与地理坐标系天向成45°夹角的任意一个位置以及MIMU中y轴在地理水平面内,x、z轴都与地理坐标系天向成45°夹角的任意一个位置,实现共十个静态位置。
所述步骤(3)中加速度通道解耦法是利用MIMU中z轴在地理水平面内,x、y轴都与地理坐标系天向成45°夹角任意一个位置以及MIMU中y轴在地理水平面内,x、z轴都与地理坐标系天向成45°夹角的任意一个位置,根据加速度通道误差模型列出各轴加速度计输入输出状态方程,结合其它八个位置下各轴加速度计输入输出状态方程,通过相除法及反三角函数法先计算加速度计安装误差角,然后计算加速度计标度因数,最终实现加速度通道解耦。
所述步骤(5)的插值法分段计算陀螺仪高动态情况下标度因数方法:利用求得的安装误差角,计算高动态情况下各插值转速点的标度因数,采用线性插值法分段计算陀螺仪高动态情况下标度因数。
本发明的原理是:根据加速度计标度因数、安装误差角影响加速度计输出的误差机理,建立MIMU加速度通道误差模型。根据陀螺仪标度因数、安装误差角及陀螺仪输出与比力有关误差项影响陀螺仪输出的误差机理,建立了角速度通道误差模型。利用对称位置上MIMU的误差部分相同,部分相反的原理,通过简单的加或减实现误差的分离,计算出加速度计和陀螺仪常值偏置。利用改变一个安装误差角,其它误差项不变原理,通过相除法,消除其它误差项干扰,分离加速度计标度因数与安装误差角耦合。利用动态标定试验在转动整周过程中MIMU水平面内陀螺仪敏感地球自转角速率积分为零原理,消除地球自转角速率引起的标定误差。利用动态标定试验中输入的角速率远大于陀螺仪各项误差的原理,精确标定出的陀螺仪标度因数和安装误差角耦合系数。利用循环迭代法的逐次逼近原理,分离陀螺仪标度因数和安装误差角的耦合。
本发明与现有技术相比的优点在于:(1)本发明基于MIMU完备的误差模型,解决了安装误差角与标度因数耦合问题,标定出MIMU中加速度计和陀螺仪安装误差角,可以为进一步修正安装误差角提供指导。克服现有标定方法采用的误差模型无法分离出标度因数及安装误差角耦合的缺点。
(2)本发明采用的所有标定试验设备不需要寻北,减小了试验要求与难度,提高标定效率。
(3)较现有的标定方法,本发明涉及的标定方法简单,物理意义明确,工作量小、时间短,陀螺仪漂移对标定结果污染程度小。
(4)分别采用最小二乘法、循环迭代法计算陀螺仪低动态情况下标度因数,减小了低动态情况下工作时的计算量,采用插值法分段计算陀螺仪高动态情况下标度因数,减小了高动态情况下标度因数非线性误差。并且该方法利用正负速率实验数据,较现有的动静混合标定方法,减小了标度因数不对称度误差。
附图说明
图1为本发明安装误差角与标度因数解耦的MIMU精确标定方法流程图;图2为本发明涉及的双轴位置台坐标系以及该坐标系与地理坐标系东北天之间的关系示意图;图3为本发明涉及的速率转台坐标系以及该坐标系与地理坐标系东北天之间的关系示意图;图4为本发明涉及的MIMU坐标系示意图;图5为本发明中10位置静态标定试验步骤示意图。
具体实施方式
本发明技术解决方案的具体实施步骤如图1所示,首先定义具体实施过程中利用到的各坐标系,图2为双轴位置台坐标系OXYZ以及该坐标系与地理坐标系东北天之间的关系;图3为速率转台坐标系OTXTYTZT以及该坐标系与地理坐标系东北天之间的关系;图4为MIMU坐标系oxyz,具体实施步骤如下:1、建立MIMU完备误差模型,采用安装误差角取代现有误差模型中的安装误差系数,分离标度因数与安装误差角耦合,其中MIMU的角速度通道误差模型为:
式(1)~(3)中的 分别代表MIMU中x、y、z轴陀螺仪输出的模拟电压值;ωx、ωy和ωz分别代表x、y、z轴输入的实际角速度;Kx、Ky、Kz分别代表x、y、z轴陀螺仪标度因数;ij代表i轴陀螺仪偏向j轴的安装误差角;Dx、Dy、Dz分别代表x、y、z轴陀螺仪常值偏置;Dij代表i轴陀螺仪输出与j轴比力有关误差项;fx、fy和fz分别代表x、y、z轴输入的实际比力。MIMU加速度通道误差模型为:f‾x=kax[cos(θxy)cos(θxz)fx+sin(θxy)fy+sin(θxz)fz]+Bx---(4)]]>f‾y=kay[cos(θyx)cos(θyz)fy+sin(θyx)fx+sin(θyz)fz]+By---(5)]]>f‾z=kaz[cos(θzy)cos(θzx)fz+sin(θzy)fy+sin(θzx)fx]+Bz---(6)]]>式(4)~(6)中 分别代表MIMU中x、y、z轴加速度计输出的模拟电压值;kax、kay、kaz代表x、y、z轴加速度计标度因数;θij代表i轴加速度计偏向j轴的安装误差角;Bx、By、Bz代表x、y、z轴加速度计常值偏置。
2、利用双轴位置台(无需寻北)进行10位置静态标定试验,如图6所示,具体步骤如下:(1)将MIMU水平安装在双轴位置台上,旋转位置台外框使位置台坐标系Z轴与地理坐标系天向重合,旋转内框保证MIMU坐标系oxyz与位置台坐标系OXYZ重合,该位置为第1位置,待位置台完全稳定下来后启动MIMU对其预热20~30分钟,然后在该位置记录1~5分钟MIMU输出数据;(2)顺时针旋转位置台内框180。(俯视位置台),使MIMU的x、y、z轴分别与位置台坐标系-X、-Y、Z轴重合,该位置为第2位置,待位置台完全稳定下来后,在该位置记录1~5分钟MIMU输出数据;(3)逆时针旋转位置台外框90°(从-X轴向视位置台),使MIMU的x、y、z轴分别与位置台坐标系-X、Z、Y轴重合,该位置为第3位置,待位置台完全稳定下来后,在该位置记录1~5分钟MIMU输出数据;
(4)逆时针旋转位置台内框180°,使MIMU的x、y、z轴分别与位置台坐标系X、Z、-Y轴重合,该位置为第4位置,待位置台完全稳定下来后,在该位置记录1~5分钟MIMU输出数据;(5)逆时针旋转位置台内框90°,然后顺时针旋转位置台外框90°,使MIMU的x、y、z轴分别与位置台坐标系Z、-Y、X轴重合,该位置为第5位置,待位置台完全稳定下来后,在该位置记录1~5分钟MIMU输出数据;(6)顺时针旋转位置台内框架180°,使MIMU的x、y、z轴分别与位置台坐标系Z、Y、-X轴重合,该位置为第6位置,待位置台完全稳定下来后,在该位置记录1~5分钟MIMU输出数据;(7)顺时针旋转位置台外框180°,使MIMU的x、y、z轴分别与位置台坐标系-Z、-Y、-X轴重合,该位置为第7位置,待位置台完全稳定下来后,在该位置记录1~5分钟MIMU输出数据;(8)逆时针旋转内框180°,使MIMU的x、y、z轴分别与位置台坐标系-Z、Y、X轴重合,该位置为第8位置,待位置台完全稳定下来后,在该位置记录1~5分钟MIMU输出数据;(9)顺时针旋转内框180°,然后逆时针旋转位置台外框135°,使MIMU的z轴与位置台坐标系的-X重合,y轴处于位置台坐标系Z偏Y轴45°,x轴处于位置台坐标系Z偏-Y轴45°,该位置为第9位置,待位置台完全稳定下来后,在该位置记录1~5分钟数据;(10)逆时针旋转位置台外框45°,然后逆时针旋转位置台内框90°,再次逆时针旋转外框45°,使MIMU的y轴与位置台坐标系-X重合,x轴位于位置台坐标系Z偏Y轴45°,z轴位于位置台坐标系Z偏-Y轴45°,该位置为第10位置,待位置台完全稳定下来后,在该位置记录1~5分钟数据,至此,10位置静态试验全部完成。
3、利用10位置静态标定试验数据,计算陀螺仪常值偏置及加速度计所有误差系数。
(1)根据静态10位置标定试验中第1~8位置,采用对称位置误差相消法、计算MIMU中加速度计和陀螺仪常值偏置。
第5位置,即MIMU坐标系中x、y、z轴分别与位置台坐标系Z、-Y、X轴重合,假设位置台坐标系Y轴偏离地理坐标系北向的角度为Ψ,该位置下MIMU加速度通道输出为:f‾x5=kaxcos(θxy)cos(θxz)·g+Bx---(7)]]>f‾y5=kaysin(θyx)g+By---(8)]]>f‾y5=kazsin(θzx)g+Bz---(9)]]>式中 代表MIMU在第j位置时i轴加速度计模拟电压输出,g代表重力加速度。MIMU角速度通道输出为: 式中 代表MIMU在第j位置时i轴陀螺仪模拟电压输出,φ代表当地位置的纬度。
第6位置,即MIMU坐标系中x、y、z轴分别与MIMU坐标系Z、Y、-X轴重合,该位置MIMU加速度计通道输出为:f‾x6=kaxcos(θxy)cos(θxz)·g+Bx---(13)]]>f‾y6=kaysin(θyx)g+By---(14)]]>f‾y6=kazsin(θzx)g+Bz---(15)]]>由第5位置变化到第6位置后,水平方向初始偏离角由Ψ变为Ψ+180°,由于sin(Ψ+180°)=-sin(Ψ)、cos(Ψ+180°)=-cos(Ψ),第6位置角速度通道输出为:
联立方程(7)~(18),列出MIMU中加速度通道在5、6位置输出的平均值为:f‾x6/5=(f‾x6+f‾x5)/2=kaxcos(θxy)cos(θxz)·g+Bx---(19)]]>f‾y6/5=(f‾y6+f‾y5)/2=kaysin(θyx)+By---(20)]]>f‾z6/5=(f‾z6+f‾z5)/2=kaxsin(θzx)+Bz---(21)]]>式中 代表MIMU在第j、k两位置i轴加速度计模拟电压输出平均值,利用对称位置相消法消除地球自转角速率ωie对水平面轴向陀螺仪的影响,列出MIMU中角速度通道在5、6位置输出的平均值为: 式中 代表MIMU在第j、k两位置i轴陀螺仪模拟电压输出平均值,同理,可求得1~4、7~8位置下MIMU中加速度通道输出的平均值为:f‾x2/1=(f‾x2+f‾1)/2=kaxsin(θxz)·g+Bx---(25)]]>f‾y2/1=(f‾y2+f‾y1)/2=kaysin(θyz)g+By---(26)]]>f‾z2/1=(f‾z2+f‾z1)/2=kazcos(θzy)cos(θzx)g+Bz---(27)]]>f‾x4/3=(f‾x4+f‾3)/2=kaxsin(θxy)·g+Bx---(28)]]>f‾y4/3=(f‾y4+f‾y3)/2=kaycos(θyz)cos(θyx)g+By---(29)]]>f‾z4/3=(f‾z4+f‾z3)/2=kazsin(θzy)g+Bz---(30)]]>
f‾x8/7=(f‾x8+f‾x7)/2=kaxcos(θxy)cos(θxz)·(-g)+Bx---(31)]]>f‾y8/7=(f‾y8+f‾y7)/2=kaysin(θyx)(-g)+By---(32)]]>f‾z8/7=(f‾z8+f‾z7)/2=kazsin(θzx)(-g)+Bz---(33)]]>1~4、7~8位置下MIMU中角速度通道输出的平均值为: 联立方程(19)与(31)、(20)与(32)、(21)与(33),分别求得MIMU中x、y、z方向加速度计常值偏置分别为:Bx=(f‾x6/5+f‾x8/7)/2---(43)]]>By=(f‾y6/5+f‾y8/7)/2---(44)]]>Bz=(f‾z6/5+f‾z8/7)/2---(45)]]>联立方程(22)与(40)、(23)与(41)、(24)与(42),分别求得MIMU中x、y、z轴陀螺仪常值偏置分别为:Dx=(ω‾x6/5+ω‾x8/7)/2---(46)]]>Dy=(ω‾y6/5+ω‾y8/7)/2---(47)]]>Dz=(ω‾z6/5+ω‾z8/7)/2---(48)]]>((2)根据10位置静态标定试验中记录的加速度通道数据,利用加速度通道解耦法计算MIMU中加速度计安装误差角、标度因数。
在第9位置,即MIMU坐标系中z轴分别与位置台坐标系-X轴重合,x轴位于Z轴偏-Y轴45°,y轴位于Z轴偏Y轴45°,该位置下MIMU的x、y两轴向加速度计输出为: 在第10位置,即MIMU坐标系中y轴分别与位置台坐标系-X轴重合,z轴位于Z轴偏-Y轴45°,x轴位于Z轴偏Y轴45°,该位置下MIMU的z轴向加速度计输出为:联立式(25)、(19)和(49),解算方程组求得x轴加速度计安装误差角及标度因数为:θxz=arctan[(f‾x2/1-Bx)·cos(θxy)/(f‾x6/5-Bx)]---(53)]]>kax=(f‾x6/5-Bx)/cos(θxy)cos(θxz)---(54)]]>联立式(26)、(29)和(50),解算方程组求得y轴加速度计安装误差角及标度因数为:θyz=arctan[(f‾y2/1-By)·cos(θyx)/(f‾y4/3-By)]---(56)]]>kay=(f‾y4/3-By)/cos(θyx)cos(θyz)---(57)]]>联立式(27)、(30)和(51),解算方程组求得z轴加速度计安装误差角及标度因数为:θzy=arctan[(f‾z4/3-Bz)·cos(θzx)/(f‾z2/1-Bz)]---(59)]]>kaz=(f‾z2/1-Bz)/cos(θzx)cos(θzy)---(60)]]>4、利用单轴速率转台(无需指北)及三面工装进行3方位正负速率试验。
进行动态速率标定试验,俯视转台,设定转台以逆时针方向旋转时为正转,以顺时针方向旋转为反转。将MIMU通过三面正交工装夹具水平固定在单轴速率转台中心处,使MIMU的z轴与转台ZT轴重合。给MIMU供电预热20~30分钟后采集1~5分钟MIMU输出数据,之后旋转速率转台180°采集1~5分钟MIMU输出数据。然后设定转台正转,记录陀螺仪输出,停转;转台反转,记录陀螺仪输出,停转。转台输入角速率按从小到大的顺序改变,分别给速率转台输入n°/10/s、-n°/10/s、2n°/10/s、-2n°/10/s、3n°/10/s、-3n°/10/s、……、n°/s、-n°/s共20个角速率,n°/s表示MIMU测量范围的最大正转角速率,在保证采集转动整周数据的前提下,对每一个角速率都记录1~5分钟左右的MIMU输出的数据。最后在静止状态下采集1~5分钟MIMU输出数据,旋转速率转台180°再采集1~5分钟MIMU输出数据。
同理,翻转三面正交工装夹具,使MIMU的x轴、y轴分别与转台的ZT轴重合,重复以上的工作,完成3方位正负速率试验。
5、利用动态标定试验数据,采用最小二乘法及逐次迭代法计算陀螺仪安装误差角以及陀螺仪低、高动态情况下标度因数。
(1)计算MIMU中陀螺仪的安装误差角及低动态情况下标度因数。
当MIMU的z轴与转台ZT轴重合,转台以角速度Ωj旋转时,MIMU三个轴输入的角速度为:ωzz=Ωj+ωiesin(φ)             (61)ωzy=ωiecos(φ)cos(Ωjt+ΨT)    (62)ωzx=ωiecos(φ)sin(Ωjt+ΨT)    (63)其中ωzx、ωzy和ωzz分别为MIMU的z轴与转台ZT轴重合时,其x、y和z轴输入的角速度;Ωj代表转台输入角速度;t代表转动时间;ωie为地球自转角速度;φ为当地纬度;ΨT为转动初始时刻MIMU的y轴与北向的夹角。
当转台旋转数周后,所有包含cos(Ωjt+Ψ)和cos(Ωjt+Ψ)的各项积分为零。设 为为MIMU的z轴与转台ZT轴重合时,转台输入的第j个角速率Ωj时x、y、z轴向陀螺仪输出的平均值为: 设开始测试位置1时各陀螺仪输出平均值为 位置2时各陀螺仪输出平均值为 结束时测试位置1时各陀螺仪输出平均值为 位置2时各陀螺仪输出平均值为 可得测试开始时,MIMU中x、y、z轴陀螺仪输出平均值 和结束时各陀螺仪输出平均值 为: 消除地球自转角速率对陀螺仪的影响,MIMU各陀螺仪静止时输出的平均值 为:ω‾zxr=(ω‾zxs+ω‾zxe)/2---(73)]]>ω‾zxr=(ω‾zys+ω‾zye)/2---(74)]]>ω‾zzr=(ω‾zzs+ω‾zze)/2---(75)]]>在第j个输入角速率Ωj时,消除了地球自转角速率、陀螺仪常值偏置、陀螺仪输出与比力有关误差项干扰,求得MIMU中x、y、z陀螺仪输出值为:
同理,可求得当MIMU的x、y轴分别与转台z轴重合时,消除了地球自转角速率、陀螺仪常值偏置、陀螺仪输出与比力有关误差项干扰后,求得z轴陀螺仪输出值为: 根据式(76)、(79)和(80),用最小二乘法求MIMU中z轴陀螺仪标度因数与安装误差角耦合系数为: 采用迭代法分离陀螺仪安装误差角与标度因数耦合,具体步骤如下:a.首先取Kzcos(zx)cos(zy)做为陀螺仪低动态情况下标度因数的初始值Kz0,设置标度因数迭代精度域值ε;b.将标度因数Kiz分别代入方程(82)、(83),求得安装误差角zxi和zyi;c.将安装误差角zxi、zyi代入方程(81),求得标度因数Kzi;d.检验前后两次迭代计算出的标度因数值,当||Kzi-Kzi-1||≤ϵ]]>时,结束迭代,把Kzi、zxi、zyi分别作为最终求解的陀螺仪低动态情况下标度因数、安装误差值,否则计算返回至步骤(b)继续迭代;e.将求得的Kzi、zxi、zyi、Dz代入方程(34)、(39)、(24)中,可分别求得z轴陀螺仪输出与z轴比力有关误差项Dzz、与y轴比力有关误差项Dzy、与x轴比力有关误差项Dzx。
根据以上的方法,同理可以求得MIMU中x、y轴陀螺仪低动态情况下标度因数Kx、Ky,安装误差角xy、xz、yx、yz及角速度输出与轴向比力有关项Dxx、Dxy、Dxz、Dyy、Dyx、Dyz。至此,计算出MIMU所有标定系数。
(2)计算MIMU中陀螺仪的高动态情况下标度因数。
由于在高动态情况下,MIMU标度因数的非线性误差较大,采用插值法分段计算陀螺仪高动态情况下标度因数,提高MIMU精度。
首先,根据MIMU角速度通道动态范围、标度因数非线性特性、实际工作环境及精度要求等设置高低动态临界转速点,一般将‖Ωj‖=3n°/10/s作为高低动态临界转速点,将大于3n°/10/s各速率作为高动态分段插值的插值转速点,将已求得的安装误差代入方程(76)中,分别计算各插值转速点的标度因数,然后采用线性插值法分段计算陀螺仪高动态情况下标度因数Kzt为:Kz,t=Kz,i+(Kz,i+1-Kz,i)(Ωt-Ωi)/(Ωi+1-Ωi)    (84)式(84)中Kz,t代表z轴陀螺仪高动态情况下标度因数,Kz,i代表z轴第i转速插值点陀螺仪标度因数,Ωi代表第i转速插值点转速,Ωt代表计算的初始转速(Ωi≤Ωt≤ Ωi+1)。
同理可求得x、y轴陀螺仪高动态情况下标度因数,该方法减小了高动态情况下MIMU中陀螺仪标度因数非线性误差以及低动态情况下计算量。
本发明虽然是基于MIMU误差特性而设计的标定方法,但不仅适用于MIMU,同样适用于挠性陀螺仪IMU和液浮陀螺仪IMU。
本发明说明书中未作详细描述的内容属于本领域专业技术人员公知的现有技术。

Claims (4)

1.安装误差角与标度因数解耦的微惯性测量单元精确标定方法,其特点在于通过下列步骤实现:(1)建立MIMU完备误差模型,采用安装误差角取代现有误差模型中的安装误差系数,分离标度因数与安装误差角耦合;(2)利用双轴位置台或转台进行10位置静态标定试验;(3)根据静态标定试验数据,采用对称位置误差相消法计算加速度计、陀螺仪常值偏置,利用加速度通道解耦法计算加速度计标度因数与安装误差角;(4)利用单轴速率转台及三面工装进行3方位正负速率试验;(5)根据3方位正负速率实验数据,采用最小二乘法及循环迭代法逐次分离MIMU中陀螺仪标度因数与安装误差角耦合,计算陀螺仪低动态情况下标度因数、陀螺仪安装误差角,结合静态标定试验数据求解陀螺仪输出与比力有关误差项,并采用插值法分段精确计算陀螺仪高动态情况下标度因数。
2.根据权利要求1所述的安装误差角与标度因数解耦的微惯性测量单元精确标定方法,其特征在于:所述步骤(2)中的10位置静态标定试验方法为:设置MIMU中x、y、z轴分别与地理坐标系天向重合的三个位置,以及这三个位置分别绕天向轴水平转动180°的另外三个位置;设置MIMU中x、y、z任意一轴与地理坐标系地向重合以及该位置绕地向轴水平转动180°的二个位置;设置MIMU中z轴在地理水平面内,x、y轴都与地理坐标系天向成45°夹角的任意一个位置以及MIMU中y轴在地理水平面内,x、z轴都与地理坐标系天向成45°夹角的任意一个位置,实现共十个静态位置。
3.根据权利要求1所述的安装误差角与标度因数解耦的微惯性测量单元精确标定方法,其特征在于:所述步骤(3)中加速度通道解耦法是利用MIMU中z轴在地理水平面内,x、y轴都与地理坐标系天向成45°夹角的任意一个位置以及MIMU中y轴在地理水平面内,x、z轴都与地理坐标系天向成45°夹角的任意一个位置,根据加速度通道误差模型列出各轴加速度计输入输出状态方程,结合其它八个位置下各轴加速度计输入输出状态方程,通过相除法及反三角函数法先计算加速度计安装误差角,然后计算加速度计标度因数,最终实现加速度通道解耦。
4.根据权利要求1所述的安装误差角与标度因数解耦的微惯性测量单元精确标定方法,其特征在于:所述步骤(5)的插值法分段计算陀螺仪高动态情况下标度因数方法:利用求得的安装误差角,计算高动态情况下各插值转速点的标度因数,采用线性插值法分段计算陀螺仪高动态情况下标度因数。
CNB2006100115763A 2006-03-29 2006-03-29 安装误差角与标度因数解耦的微惯性测量单元精确标定方法 CN1330935C (zh)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CNB2006100115763A CN1330935C (zh) 2006-03-29 2006-03-29 安装误差角与标度因数解耦的微惯性测量单元精确标定方法

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CNB2006100115763A CN1330935C (zh) 2006-03-29 2006-03-29 安装误差角与标度因数解耦的微惯性测量单元精确标定方法

Publications (2)

Publication Number Publication Date
CN1818555A CN1818555A (zh) 2006-08-16
CN1330935C true CN1330935C (zh) 2007-08-08

Family

ID=36918666

Family Applications (1)

Application Number Title Priority Date Filing Date
CNB2006100115763A CN1330935C (zh) 2006-03-29 2006-03-29 安装误差角与标度因数解耦的微惯性测量单元精确标定方法

Country Status (1)

Country Link
CN (1) CN1330935C (zh)

Families Citing this family (22)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN101236083B (zh) * 2008-03-06 2010-11-03 浙江大学 一种快速切换光纤陀螺动静态输出数据的方法
CN101419080B (zh) * 2008-06-13 2011-04-20 哈尔滨工程大学 微型捷联惯性测量系统的零速校正方法
CN102135434B (zh) * 2010-01-25 2012-06-27 北京三驰科技发展有限公司 一种惯性测量单元误差补偿的方法
CN102288133B (zh) * 2011-04-29 2013-04-17 北京星网宇达科技股份有限公司 一种陀螺间接稳定系统安装偏角标定方法
CN102207380B (zh) * 2011-06-09 2013-12-04 中国人民解放军第二炮兵工程学院 一种高精度的横轴倾斜误差补偿方法
CN102564461A (zh) * 2012-02-29 2012-07-11 北京航空航天大学 一种基于双轴转台的光学捷联惯导系统的标定方法
CN102620735B (zh) * 2012-04-17 2013-12-25 华中科技大学 一种船用双轴旋转式捷联惯导系统的转位方法
CN102889076A (zh) * 2012-09-14 2013-01-23 西安思坦仪器股份有限公司 陀螺测斜仪标定方法
CN103983274B (zh) * 2014-04-11 2016-12-07 湖北航天技术研究院总体设计所 一种适用于低精度无方位基准双轴转位设备的惯性测量单元标定方法
CN104655132B (zh) * 2015-02-11 2017-08-25 北京航空航天大学 一种基于加速度计的机体弹性变形角估计方法
CN105157723A (zh) * 2015-07-14 2015-12-16 北京理工大学 一种基于光纤陀螺的捷联惯导系统的标定方法
CN105675018B (zh) * 2016-01-12 2018-07-13 中海石油(中国)有限公司 一种姿态检测系统标定方法
CN106017470B (zh) * 2016-05-12 2019-05-24 湖南格纳微信息科技有限公司 微惯性测量单元筛选方法及组合式微惯性测量装置
CN106052682B (zh) * 2016-05-13 2018-12-11 北京航空航天大学 一种混合式惯性导航系统及导航方法
CN107421537B (zh) * 2017-09-14 2020-07-17 桂林电子科技大学 基于惯性传感器刚体网格的物体运动姿态感知方法和系统
CN108168575A (zh) * 2017-11-30 2018-06-15 上海航天控制技术研究所 一种五轴冗余配置十表光纤惯组的标定方法和系统
CN108398576B (zh) * 2018-03-06 2020-02-07 中国人民解放军火箭军工程大学 一种静态误差标定系统及方法
CN108981746A (zh) * 2018-04-18 2018-12-11 北京航空航天大学 转台标校方法及装置
CN108982918B (zh) * 2018-07-27 2020-07-14 北京航天控制仪器研究所 基准不确定情况下加速度计组合误差系数分离与标定方法
CN109406826A (zh) * 2018-08-30 2019-03-01 南京理工大学 基于旋转运动体的加速度计安装方法
CN109342767A (zh) * 2018-10-25 2019-02-15 中国电子产品可靠性与环境试验研究所((工业和信息化部电子第五研究所)(中国赛宝实验室)) 加速度计标度因素的测试方法、装置以及系统
CN110501520A (zh) * 2019-08-29 2019-11-26 北京云庐科技有限公司 一种三轴加速度传感器的轴加速度获取方法及装置

Citations (2)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
EP0557592A1 (de) * 1992-02-26 1993-09-01 TELDIX GmbH Einrichtung zum Kalibrieren einer Messeinrichtung
US20040211238A1 (en) * 2001-11-06 2004-10-28 Honeywell International Inc. Method for calibrating an inertial measurement unit

Patent Citations (2)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
EP0557592A1 (de) * 1992-02-26 1993-09-01 TELDIX GmbH Einrichtung zum Kalibrieren einer Messeinrichtung
US20040211238A1 (en) * 2001-11-06 2004-10-28 Honeywell International Inc. Method for calibrating an inertial measurement unit

Non-Patent Citations (4)

* Cited by examiner, † Cited by third party
Title
《基于双轴转台的惯性器件自动标定系统研制》 李星海,李华容等,《压电与声光》,第26卷第4期 2004 *
《基于双轴转台的惯性器件自动标定系统研制》 李星海,李华容等,《压电与声光》,第26卷第4期 2004;《捷联惯导系统加速度计标度因数和安装误差的试验标定》 杨常松,徐晓苏,《测控技术》,第24卷第12期 2005;《捷联组合测试探讨》 曹宁生,《中国惯性技术学报》,第5卷第3期 1997 *
《捷联惯导系统加速度计标度因数和安装误差的试验标定》 杨常松,徐晓苏,《测控技术》,第24卷第12期 2005 *
《捷联组合测试探讨》 曹宁生,《中国惯性技术学报》,第5卷第3期 1997 *

Also Published As

Publication number Publication date
CN1818555A (zh) 2006-08-16

Similar Documents

Publication Publication Date Title
Wu et al. Observability of strapdown INS alignment: A global perspective
Wang et al. A self-calibration method for nonorthogonal angles between gimbals of rotational inertial navigation system
CN106289246B (zh) 一种基于位置和姿态测量系统的柔性杆臂测量方法
CN102980577B (zh) 一种微型捷联航姿系统及其工作方法
Ren et al. A multi-position self-calibration method for dual-axis rotational inertial navigation system
Nieminen et al. An enhanced multi-position calibration method for consumer-grade inertial measurement units applied and tested
Curey et al. Proposed IEEE inertial systems terminology standard and other inertial sensor standards
JP5639685B2 (ja) 自己較正型加速度計
CN102393210B (zh) 一种激光陀螺惯性测量单元的温度标定方法
CN103245359B (zh) 一种惯性导航系统中惯性传感器固定误差实时标定方法
CN103575299B (zh) 利用外观测信息的双轴旋转惯导系统对准及误差修正方法
CN102169184B (zh) 组合导航系统中测量双天线gps安装失准角的方法和装置
CN101514899B (zh) 基于单轴旋转的光纤陀螺捷联惯性导航系统误差抑制方法
CN102721417B (zh) 一种捷联惯性导航系统凝固惯性系粗对准误差抑制方法
CN103424225B (zh) 一种测试转动部件动静不平衡量的方法
CN104165641B (zh) 一种基于捷联惯导/激光测速仪组合导航系统的里程计标定方法
CN100367004C (zh) 一种陀螺仪标度因数和输入轴失准角的精确解耦测试方法
CN103900559B (zh) 一种基于干扰估计的高精度姿态解算系统
CN105180968B (zh) 一种imu/磁强计安装失准角在线滤波标定方法
CN102749079B (zh) 一种光纤捷联惯导双轴旋转调制方法及双轴旋转机构
CN100516778C (zh) 一种捷联mems陀螺动态误差标定方法
Wang et al. Estimation of information sharing error by dynamic deformation between inertial navigation systems
CN101271007B (zh) 一种基于速率转台的旋转变压器测角误差的标定补偿方法
CN105806367B (zh) 无陀螺惯性系统误差标定方法
CN100565115C (zh) 多位置捷联寻北系统方位效应的标定方法

Legal Events

Date Code Title Description
C06 Publication
PB01 Publication
C10 Entry into substantive examination
SE01 Entry into force of request for substantive examination
C14 Grant of patent or utility model
GR01 Patent grant