CN103868527A - 一种标定捷联惯性组合加速度计组合的方法 - Google Patents

一种标定捷联惯性组合加速度计组合的方法 Download PDF

Info

Publication number
CN103868527A
CN103868527A CN201410073606.8A CN201410073606A CN103868527A CN 103868527 A CN103868527 A CN 103868527A CN 201410073606 A CN201410073606 A CN 201410073606A CN 103868527 A CN103868527 A CN 103868527A
Authority
CN
China
Prior art keywords
axis
delta
inertial navigation
computing formula
down inertial
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
CN201410073606.8A
Other languages
English (en)
Other versions
CN103868527B (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.)
China Aerospace Times Electronics Corp
Beijing Aerospace Control Instrument Institute
Original Assignee
China Aerospace Times Electronics Corp
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 China Aerospace Times Electronics Corp filed Critical China Aerospace Times Electronics Corp
Priority to CN201410073606.8A priority Critical patent/CN103868527B/zh
Publication of CN103868527A publication Critical patent/CN103868527A/zh
Application granted granted Critical
Publication of CN103868527B publication Critical patent/CN103868527B/zh
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Images

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
    • 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

Landscapes

  • Engineering & Computer Science (AREA)
  • Manufacturing & Machinery (AREA)
  • Physics & Mathematics (AREA)
  • General Physics & Mathematics (AREA)
  • Radar, Positioning & Navigation (AREA)
  • Remote Sensing (AREA)
  • Navigation (AREA)

Abstract

本发明公开了一种标定捷联惯性组合加速度计组合的方法,将捷联惯性组合静置于18个位置,根据在一定测量时间内的脉冲输出值计算得到捷联惯性组合加速度计组合误差模型中的所有项系数,从而完成加速度计组合的标定。相比其他误差系数的标定方法,本发明完成了捷联惯性组合三个坐标轴加速度计的误差系数标定,实现了对加速度计二阶误差系数的标定,不仅提高了误差系数的标定精度,而且标定过程简单、所需时间短。

Description

一种标定捷联惯性组合加速度计组合的方法
技术领域
本发明涉及一种误差系数标定方法,尤其涉及一种标定捷联惯性组合加速度计组合的方法,属于捷联惯性组合标定技术,可用于标定捷联惯性组合加速度计组合的场合。
背景技术
加速度计是惯性导航和惯性制导系统的基本测量元件之一,它安装在运载体内部,用于测量运载体的运动加速度,并通过对加速度的积分,求得其加速度和位置。因此,加速度计的性能和精度直接影响导航和制导系统的精度。当安装在运载体内部时,加速度计的测量值不仅包括加速度计壳体随运载体运动的加速度、运载体相对于地球运动引起的哥式加速度,还包括表观重力加速度。当加速度计的输入轴与地球重力方向一致时,则测量值为地球重力的负数。所以可以用地球重力场来标定加速度计。捷联惯性组合是将陀螺仪和加速度计集成在一起并直接安装在运载体上的惯性测量装置。在捷联惯性组合中,加速度计测得的信号是运载体相对于惯性空间的视加速度在该加速度计敏感轴方向上的分量。为了完全测量运载体在空间中的运动视加速度,捷联惯性组合中装有三个敏感轴互相垂直的加速度计,其敏感轴方向指向捷联惯性组合定义的X、Y、Z轴正方向。在高精度测量中,加速度计的输出为脉冲数,脉冲数输出频率可以按照以下公式与捷联惯性组合敏感轴的视加速度建立关系,即捷联惯性组合加速度计组合误差模型。
A xp A yp A zp = K ax 0 0 0 K ay 0 0 0 K az { K 0 x K 0 y K 0 z + 1 + δK ax ′ sign ( a x ) E xy E xz E yx 1 + δK ay ′ sign ( a y ) E yz E zx E zy 1 + δK ax ′ sign ( a z ) a x a y a z + K 2 x + δK 2 x ′ sign ( a x ) 0 0 0 K 2 y + δK 2 y ′ sign ( a y ) 0 0 0 K 2 z + δK 2 z ′ sign ( a z ) a x 2 a y 2 a z 2
+ K xy K xz 0 K yx 0 K yz 0 K zx K zy a x a y a x a z a y a z }
在上式中,Axp、Ayp、Azp分别为捷联惯性组合中X、Y、Z轴输出的脉冲频率(单位:Pulse/s);Kax、Kay、Kaz分别为X、Y、Z轴的标度因数(单位:Pulse/s/g0);K0x、K0y、K0z分别为X、Y、Z轴的零值偏差(单位:g0);Exy、Exz、Eyx、Eyz、Ezx、Ezy分别为Y轴相对于X轴的安装误差角、Z轴相对于X轴的安装误差角、X轴相对于Y轴的安装误差角、Z轴相对于Y轴的安装误差角、X轴相对于Z轴的安装误差角、Y轴相对于Z轴的安装误差角(单位:rad);δK'ax、δK'ay、δK'az分别为X、Y、Z轴的标度因数不对称性相对误差;ax、ay、az分别为捷联惯性组合X、Y、Z轴向视加速度分量(单位:g0);K2x、K2y、K2z分别为X、Y、Z轴的二次项误差系数(单位:g0 -1);δK'2x、δK'2y、δK'2z分别为X、Y、Z轴奇二次项系数误差(单位:g0 -1);Kxy、Kxz、Kyx、Kyz、Kzx、Kzy分别为X、Y轴向乘积对X轴的交叉耦合项系数、X、Z轴向乘积对X轴的交叉耦合项系数、X、Y轴向乘积对Y轴的交叉耦合项系数、Y、Z轴向乘积对Y轴的交叉耦合项系数、X、Z轴向乘积对Z轴的交叉耦合项系数、Y、Z轴向乘积对Z轴的交叉耦合项系数(单位:g0 -1);g0为测试地点地球重力加速度。
一般标定方法只能标定出视加速度零次项和一次项的系数,即无法标定出加速度计二次项、奇二次项和交叉耦合项系数。这种标定方法将降低标定出系数的有效性,并且导致运载体处在非测量位置时,解算出的视加速度出现偏差。
因此,为了标定出捷联惯性组合误差模型中所有的误差项系数,并提高标定系数的精度,需要研究一种新型的捷联惯性组合加速度计组合误差标定方法。
发明内容
本发明解决的技术问题是:克服现有技术的不足,提供一种标定捷联惯性组合加速度计组合的方法,实现了对捷联惯性组合加速度计组合误差模型中所有误差项系数的标定,提高了标定出的误差项系数的精度。
本发明的技术解决方案是:一种标定捷联惯性组合加速度计组合的方法,用于计算捷联惯性组合加速度计组合误差模型中的系数,捷联惯性组合加速度计组合误差模型为
A xp A yp A zp = K ax 0 0 0 K ay 0 0 0 K az { K 0 x K 0 y K 0 z + 1 + δK ax ′ sign ( a x ) E xy E xz E yx 1 + δK ay ′ sign ( a y ) E yz E zx E zy 1 + δK ax ′ sign ( a z ) a x a y a z + K 2 x + δK 2 x ′ sign ( a x ) 0 0 0 K 2 y + δK 2 y ′ sign ( a y ) 0 0 0 K 2 z + δK 2 z ′ sign ( a z ) a x 2 a y 2 a z 2 K xy K xz 0 K yx 0 K yz 0 K zx K zy a x a y a x a z a y a z }
其中,Kax、Kay、Kaz分别为X、Y、Z轴的标度因数,K0x、K0y、K0z分别为X、Y、Z轴的零值偏差,Exy为Y轴相对于X轴的安装误差角、Exz为Z轴相对于X轴的安装误差角、Eyx为X轴相对于Y轴的安装误差角、Eyz为Z轴相对于Y轴的安装误差角、Ezx为X轴相对于Z轴的安装误差角、Ezy为Y轴相对于Z轴的安装误差角,δK'ax、δK'ay、δK'az分别为X、Y、Z轴的标度因数不对称性相对误差,K2x、K2y、K2z分别为X、Y、Z轴的二次项误差系数,δK'2x、δK'2y、δK'2z分别为X、Y、Z轴的奇二次项系数误差,Kxy为X、Y轴向乘积对X轴的交叉耦合项系数、Kxz为X、Z轴向乘积对X轴的交叉耦合项系数、Kyx为X、Y轴向乘积对Y轴的交叉耦合项系数、Kyz为Y、Z轴向乘积对Y轴的交叉耦合项系数、Kzx为X、Z轴向乘积对Z轴的交叉耦合项系数、Kzy为Y、Z轴向乘积对Z轴的交叉耦合项系数;Axp、Ayp、Azp分别为捷联惯性组合中X、Y、Z轴输出的脉冲频率,每一个位置的脉冲频率由该位置的测量时间和X、Y、Z轴输出的脉冲个数决定;ax、ay、az分别为捷联惯性组合X、Y、Z轴向视加速度分量;其特征在于步骤如下:
(1)将捷联惯性组合静置于18个不同的位置;
(2)在第i个位置时,采集捷联惯性组合的X、Y、Z轴加速度计经过Δt秒输出的脉冲个数Ax(i)、Ay(i)和Az(i),其中i∈[1,18];
(3)根据步骤(2)中经过测量时间Δt输出的脉冲个数,计算捷联惯性组合加速度计组合误差模型中的误差系数,包括标度因数、零值偏差、安装误差角、标度因数不对称性相对误差、二次项误差系数、奇二次项系数误差、交叉耦合项系数;
(4)将通过步骤(3)得到的系数反馈到捷联惯性组合加速度计组合误差模型中,完成捷联惯性组合加速度计组合的标定。
所述步骤(1)中捷联惯性组合的18个位置分别为:
位置1:将捷联惯性组合X、Y、Z轴加速度计分别指向测试点地理坐标系的东、天、南方向;
位置2:对位置1中的捷联惯性组合位置绕X轴正转45°,此时X轴指向东,Y轴指向南偏天45°,Z轴指向南偏地45°;
位置3:对位置2中的捷联惯性组合位置绕X轴正转180°,此时X轴指向东,Y轴指向北偏地45°,Z轴指向北偏天45°;
位置4:使捷联惯性组合X、Y、Z轴加速度计分别指向测试点地理坐标系的天、南、东方向;
位置5:对位置4中的捷联惯性组合位置绕Z轴正转45°,此时Z轴指向东,X轴指向南偏天45°,Y轴指向南偏地45°;
位置6:对位置5中的捷联惯性组合位置绕Z轴正转180°,此时Z轴指向东,X轴指向北偏地45°,Y轴指向北偏天45°;
位置7:使捷联惯性组合X、Y、Z轴加速度计分别指向测试点地理坐标系的南、东、天方向;
位置8:对位置7中的捷联惯性组合位置绕Y轴正转45°,此时Y轴指向东,Z轴指向南偏天45°,X轴指向南偏地45°;
位置9:对位置8中的捷联惯性组合位置绕Y轴正转180°,此时Y轴指向东,Z轴指向北偏地45°,X轴指向北偏天45°;
位置10:使捷联惯性组合X、Y、Z轴加速度计分别指向测试点地理坐标系的北、地、西方向;
位置11:对位置10中的捷联惯性组合位置绕Z轴正转45°,此时Z轴指向西,X轴指向北偏地45°,Y轴指向南偏地45°;
位置12:对位置11中的捷联惯性组合位置绕Z轴正转180°,此时Z轴指向西,X轴指向南偏天45°,Y轴指向北偏天45°;
位置13:使捷联惯性组合X、Y、Z轴加速度计分别指向测试点地理坐标系的西、北、地方向;
位置14:对位置13中的捷联惯性组合位置绕X轴正转45°,此时X轴指向西,Y轴指向北偏地45°,Z轴指向南偏地45°;
位置15:对位置14中的捷联惯性组合位置绕X轴正转180°,此时X轴指向西,Y轴指向南偏天45°,Z轴指向北偏天45°;
位置16:使捷联惯性组合X、Y、Z轴加速度计分别指向测试点地理坐标系的地、西、北方向;
位置17:对位置16中的捷联惯性组合位置绕Y轴正转45°,此时Y轴指向西,Z轴指向北偏地45°,X轴指向南偏地45°;
位置18:对位置17中的捷联惯性组合位置绕Y轴正转180°,此时Y轴指向西,Z轴指向南偏天45°,X轴指向北偏天45°。
所述步骤(3)中各误差项系数的计算公式为:
X轴的标度因数Kax的计算公式为:
K ax = ( 2 + 1 ) 4 Δt { 2 [ - A x ( 4 ) + A x ( 16 ) ] + A x ( 5 ) - A x ( 6 ) - A x ( 8 ) + A x ( 9 ) - A x ( 11 ) + A x ( 12 ) - A x ( 17 ) + A x ( 18 ) }
X轴的零值偏差K0x的计算公式为:
K 0 x = 1 8 K ax Δt [ A x ( 1 ) + A x ( 2 ) + A x ( 3 ) + A x ( 7 ) + A x ( 10 ) + A x ( 13 ) + A x ( 14 ) + A x ( 15 ) ]
Y轴相对于X轴的安装误差角Exy的计算公式为:
E xy = 2 12 K ax Δt { 2 [ A x ( 1 ) - A x ( 10 ) ] + A x ( 2 ) - A x ( 3 ) - A x ( 5 ) + A x ( 6 ) - A x ( 11 ) + A x ( 12 ) - A x ( 14 ) + A x ( 15 ) }
Z轴相对于X轴的安装误差角Exz的计算公式为:
E xz = 2 12 K ax Δt { 2 [ A x ( 7 ) - A x ( 13 ) ] - A x ( 2 ) + A x ( 3 ) + A x ( 8 ) - A x ( 9 ) - A x ( 14 ) + A x ( 15 ) - A x ( 17 ) + A x ( 18 ) }
X轴的标度因数不对称性相对误差δK'ax的计算公式为:
δK ax ′ = 2 + 1 8 K ax Δt { 4 [ - A x ( 4 ) - A x ( 16 ) ] + 2 [ A x ( 5 ) + A x ( 6 ) + A x ( 8 ) + A x ( 9 ) + A x ( 11 ) + A x ( 12 ) + A x ( 17 ) + A x ( 18 ) ] - A x ( 1 ) - A x ( 2 ) - A x ( 3 ) - A x ( 7 ) - A x ( 10 ) - A x ( 13 ) - A x ( 14 ) - A x ( 15 ) }
X轴的二次项误差系数K2x的计算公式为:
K 2 x = 2 8 K ax Δt { ( 4 2 + 4 ) [ A x ( 4 ) + A x ( 16 ) ] + ( 2 + 2 ) [ - A x ( 5 ) - A x ( 6 ) - A x ( 8 ) - A x ( 9 ) - A x ( 11 ) - A x ( 12 ) - A x ( 17 ) - A x ( 18 ) ] + A x ( 1 ) + A x ( 2 ) + A x ( 3 ) + A x ( 7 ) + A x ( 10 ) + A x ( 13 ) + A x ( 14 ) + A x ( 15 )
X轴的奇二次项系数误差δK'2x的计算公式为:
δK 2 x ′ = 2 + 1 4 K ax Δt { 2 2 [ A x ( 4 ) - A x ( 16 ) ] - A x ( 5 ) + A x ( 6 ) + A x ( 8 ) - A x ( 9 ) + A x ( 11 ) - A x ( 12 ) + A x ( 17 ) - A x ( 18 ) }
X、Y轴向乘积对X轴的交叉耦合项系数Kxy的计算公式为:
K xy = 1 2 K ax Δt [ - A x ( 5 ) - A x ( 6 ) + A x ( 11 ) + A x ( 12 ) ]
X、Z轴向乘积对X轴的交叉耦合项系数Kxz的计算公式为:
K xz = 1 2 K ax Δt [ - A x ( 8 ) - A x ( 9 ) + A x ( 17 ) + A x ( 18 ) ]
Y轴的标度因数Kay的计算公式为:
K ay = ( 2 + 1 ) 4 Δt { 2 [ - A y ( 1 ) + A y ( 10 ) ] + A y ( 2 ) - A y ( 3 ) - A y ( 5 ) + A y ( 6 ) - A y ( 11 ) + A y ( 12 ) - A y ( 14 ) + A y ( 15 ) }
Y轴的零值偏差K0y的计算公式为:
K 0 y = 1 8 K ay Δt [ A y ( 4 ) + A y ( 7 ) + A y ( 8 ) + A y ( 9 ) + A y ( 13 ) + A y ( 16 ) + A y ( 17 ) + A y ( 18 ) ]
X轴相对于Y轴的安装误差角Eyx的计算公式为:
E yx = 2 12 K ay Δt { 2 [ A y ( 4 ) - A y ( 16 ) ] + A y ( 5 ) - A y ( 6 ) - A y ( 8 ) + A y ( 9 ) - A y ( 11 ) + A y ( 12 ) - A y ( 17 ) + A y ( 18 ) }
Z轴相对于Y轴的安装误差角Eyz的计算公式为:
E yz = 2 12 K ay Δt { 2 [ A y ( 7 ) - A y ( 13 ) ] - A y ( 2 ) + A y ( 3 ) + A y ( 8 ) - A y ( 9 ) - A y ( 14 ) + A y ( 15 ) - A y ( 17 ) + A y ( 18 ) }
Y轴的标度因数不对称性相对误差δK'ay的计算公式为:
δK ay ′ = 2 + 1 8 K ay Δt { 4 [ - A y ( 1 ) - A y ( 10 ) ] + 2 [ A y ( 2 ) + A y ( 3 ) + A y ( 5 ) + A y ( 6 ) + A y ( 11 ) + A y ( 12 ) + A y ( 14 ) + A y ( 15 ) ] - A y ( 4 ) - A y ( 7 ) - A y ( 8 ) - A y ( 9 ) - A y ( 13 ) - A y ( 16 ) - A y ( 17 ) - A y ( 18 ) }
Y轴的二次项误差系数K2y的计算公式为:
K 2 y = 2 8 K ay Δt 4 { ( 4 2 + 4 ) [ A y ( 1 ) + A y ( 10 ) ] + ( 2 + 2 ) [ - A y ( 2 ) - A y ( 3 ) - A y ( 5 ) - A y ( 6 ) - A y ( 11 ) - A y ( 12 ) - A y ( 14 ) - A y ( 15 ) ] + A y ( 4 ) + A y ( 7 ) + A y ( 8 ) + A y ( 9 ) + A y ( 13 ) + A y ( 16 ) + A y ( 17 ) + A y ( 18 )
Y轴的奇二次项系数误差δK'2y的计算公式为:
δK 2 y ′ = 2 + 1 4 K ay Δt { 2 2 [ A y ( 1 ) - A y ( 10 ) ] - A y ( 2 ) + A y ( 3 ) + A y ( 5 ) - A y ( 6 ) + A y ( 11 ) - A y ( 12 ) + A y ( 14 ) - A y ( 15 ) }
X、Y轴向乘积对Y轴的交叉耦合项系数Kyx的计算公式为:
K yx = 1 2 K ay Δt [ - A y ( 5 ) - A y ( 6 ) + A y ( 11 ) + A y ( 12 ) ]
Y、Z轴向乘积对Y轴的交叉耦合项系数Kyz的计算公式为:
K yz = 1 2 K ay Δt [ - A y ( 2 ) - A y ( 3 ) + A y ( 14 ) + A y ( 15 ) ]
Z轴的标度因数Kaz的计算公式为:
K az = ( 2 + 1 ) 4 Δt { 2 [ - A z ( 7 ) + A z ( 13 ) ] - A z ( 2 ) + A z ( 3 ) + A z ( 8 ) - A z ( 9 ) - A z ( 14 ) + A z ( 15 ) - A z ( 17 ) + A z ( 18 ) }
Z轴的零值偏差K0z的计算公式为:
K 0 z = 1 8 K az Δt [ A z ( 1 ) + A z ( 4 ) + A z ( 5 ) + A z ( 6 ) + A z ( 10 ) + A z ( 11 ) + A z ( 12 ) + A z ( 16 ) ]
X轴相对于Z轴的安装误差角Ezx的计算公式为:
E zx = 2 12 K az Δt { 2 [ A z ( 4 ) - A z ( 16 ) ] + A z ( 5 ) - A z ( 6 ) - A z ( 8 ) + A z ( 9 ) - A z ( 11 ) + A z ( 12 ) - A z ( 17 ) + A z ( 18 ) }
Y轴相对于Z轴的安装误差角Ezy的计算公式为:
E zy = 2 12 K az Δt { 2 [ A z ( 1 ) - A z ( 10 ) ] + A z ( 2 ) - A z ( 3 ) - A z ( 5 ) + A z ( 6 ) - A z ( 11 ) + A z ( 12 ) - A z ( 17 ) + A z ( 18 ) }
Z轴的标度因数不对称性相对误差δK'az的计算公式为:
δK az ′ = 2 + 1 8 K az Δt { 4 [ - A z ( 7 ) - A z ( 13 ) ] + 2 [ A z ( 2 ) + A z ( 3 ) + A z ( 8 ) + A z ( 9 ) + A z ( 14 ) + A z ( 15 ) + A z ( 17 ) + A z ( 18 ) ] - A z ( 1 ) - A z ( 4 ) - A z ( 5 ) - A z ( 6 ) - A z ( 10 ) - A z ( 11 ) - A z ( 12 ) - A z ( 16 ) }
Z轴的二次项误差系数K2z的计算公式为:
K 2 z = 2 8 K az Δt { ( 4 2 + 4 ) [ A z ( 7 ) + A z ( 13 ) ] + ( 2 + 2 ) [ - A z ( 2 ) - A z ( 3 ) - A z ( 8 ) - A z ( 9 ) - A z ( 14 ) - A z ( 15 ) - A z ( 17 ) - A z ( 18 ) ] + A z ( 1 ) + A z ( 4 ) + A z ( 5 ) + A z ( 6 ) + A z ( 10 ) + A z ( 11 ) + A z ( 12 ) + A z ( 16 )
Z轴的奇二次项系数误差δK'2z的计算公式为:
δK 2 z ′ = 2 + 1 4 K az Δt { 2 2 [ A z ( 7 ) - A z ( 13 ) ] + A z ( 2 ) - A z ( 3 ) - A z ( 8 ) + A z ( 9 ) + A z ( 14 ) - A z ( 15 ) + A z ( 17 ) - A z ( 18 ) }
X、Z轴向乘积对Z轴的交叉耦合项系数Kzx的计算公式为:
K zx = 1 2 K az Δt [ - A z ( 8 ) - A z ( 9 ) + A z ( 17 ) + A z ( 18 ) ]
Y、Z轴向乘积对Z轴的交叉耦合项系数Kzy的计算公式为:
K zy = 1 2 K az Δt [ - A z ( 2 ) - A z ( 3 ) + A z ( 14 ) + A z ( 15 ) ]
本发明与现有技术相比的优点如下:
(1)现有的捷联惯性组合加速度计组合标定算法只能标定捷联惯性组合加速度计误差模型中视加速度的零次项和一次项,本发明的方法可以完成误差模型中所有误差项系数的标定,因为同时考虑到误差模型中所有项系数对输出的影响,使用本方法计算得到的误差系数拥有更高的标定精度;
(2)现有的标定方法测试位置少,包含的测试信息也较少,本发明的方法测试位置多,包含更多的信息,这能够提高标定结果的精度和可靠性;
(3)与现有的标定方法相比,本发明的方法测试耗时少、计算简单,能够快速完成惯性组合加速度计组合的标定。
附图说明
图1为本发明方法的标定过程流程图;
图2为本发明方法的标定位置编排图。
具体实施方式
由于得到捷联惯性组合加速度计组合输出后,需要进行误差补偿才能得到惯性组合所在运载体的视加速度,而补偿所使用误差模型中的系数需要进行标定才能获得足够高精度的数值。
如图1所示,本发明提供了一种标定捷联惯性组合加速度计组合的方法,用于计算捷联惯性组合加速度计组合误差模型中的系数,捷联惯性组合加速度计组合误差模型为
A xp A yp A zp = K ax 0 0 0 K ay 0 0 0 K az { K 0 x K 0 y K 0 z + 1 + δK ax ′ sign ( a x ) E xy E xz E yx 1 + δK ay ′ sign ( a y ) E yz E zx E zy 1 + δK ax ′ sign ( a z ) a x a y a z
+ K 2 x + δK 2 x ′ sign ( a x ) 0 0 0 K 2 y + δK 2 y ′ sign ( a y ) 0 0 0 K 2 z + δK 2 z ′ sign ( a z ) a x 2 a y 2 a z 2 K xy K xz 0 K yx 0 K yz 0 K zx K zy a x a y a x a z a y a z }
其中,Kax、Kay、Kaz分别为X、Y、Z轴的标度因数,K0x、K0y、K0z分别为X、Y、Z轴的零值偏差,Exy为Y轴相对于X轴的安装误差角、Exz为Z轴相对于X轴的安装误差角、Eyx为X轴相对于Y轴的安装误差角、Eyz为Z轴相对于Y轴的安装误差角、Ezx为X轴相对于Z轴的安装误差角、Ezy为Y轴相对于Z轴的安装误差角,δK'ax、δK'ay、δK'az分别为X、Y、Z轴的标度因数不对称性相对误差,K2x、K2y、K2z分别为X、Y、Z轴的二次项误差系数,δK'2x、δK'2y、δK'2z分别为X、Y、Z轴的奇二次项系数误差,Kxy为X、Y轴向乘积对X轴的交叉耦合项系数、Kxz为X、Z轴向乘积对X轴的交叉耦合项系数、Kyx为X、Y轴向乘积对Y轴的交叉耦合项系数、Kyz为Y、Z轴向乘积对Y轴的交叉耦合项系数、Kzx为X、Z轴向乘积对Z轴的交叉耦合项系数、Kzy为Y、Z轴向乘积对Z轴的交叉耦合项系数;Axp、Ayp、Azp分别为捷联惯性组合中X、Y、Z轴输出的脉冲频率,每一个位置的脉冲频率由该位置的测量时间和X、Y、Z轴输出的脉冲个数决定;ax、ay、az分别为捷联惯性组合X、Y、Z轴向视加速度分量;
本发明方法的步骤如下:
(1)将捷联惯性组合静置于18个不同的位置;
(2)在第i个位置时,采集捷联惯性组合的X、Y、Z轴加速度计经过Δt秒输出的脉冲个数Ax(i)、Ay(i)和Az(i),其中i∈[1,18];
位置1:使捷联惯性组合X、Y、Z轴加速度计分别指向测试点地理坐标系的东、天、南方向,记录X、Y、Z轴加速度计经过Δt秒输出的脉冲个数,分别为Ax(1)、Ay(1)和Az(1);
位置2:对位置1中的捷联惯性组合位置绕X轴正转45°,此时X轴指向东,Y轴指向南偏天45°,Z轴指向南偏地45°,记录X、Y、Z轴加速度计经过Δt秒输出的脉冲个数,分别为Ax(2)、Ay(2)和Az(2);
位置3:对位置2中的捷联惯性组合位置绕X轴正转180°,此时X轴指向东,Y轴指向北偏地45°,Z轴指向北偏天45°,记录X、Y、Z轴加速度计经过Δt秒输出的脉冲个数,分别为Ax(3)、Ay(3)和Az(3);
位置4:使捷联惯性组合X、Y、Z轴加速度计分别指向测试点地理坐标系的天、南、东方向,记录X、Y、Z轴加速度计经过Δt秒输出的脉冲个数,分别为Ax(4)、Ay(4)和Az(4);
位置5:对位置4中的捷联惯性组合位置绕Z轴正转45°,此时Z轴指向东,X轴指向南偏天45°,Y轴指向南偏地45°,记录X、Y、Z轴加速度计经过Δt秒输出的脉冲个数,分别为Ax(5)、Ay(5)和Az(5);
位置6:对位置5中的捷联惯性组合位置绕Z轴正转180°,此时Z轴指向东,X轴指向北偏地45°,Y轴指向北偏天45°,记录X、Y、Z轴加速度计经过Δt秒输出的脉冲个数,分别为Ax(6)、Ay(6)和Az(6);
位置7:使捷联惯性组合X、Y、Z轴加速度计分别指向测试点地理坐标系的南、东、天方向,记录X、Y、Z轴加速度计经过Δt秒输出的脉冲个数,分别为Ax(7)、Ay(7)和Az(7);
位置8:对位置7中的捷联惯性组合位置绕Y轴正转45°,此时Y轴指向东,Z轴指向南偏天45°,X轴指向南偏地45°,记录X、Y、Z轴加速度计经过Δt秒输出的脉冲个数,分别为Ax(8)、Ay(8)和Az(8);
位置9:对位置8中的捷联惯性组合位置绕Y轴正转180°,此时Y轴指向东,Z轴指向北偏地45°,X轴指向北偏天45°,记录X、Y、Z轴加速度计经过Δt秒输出的脉冲个数,分别为Ax(9)、Ay(9)和Az(9);
位置10:使捷联惯性组合X、Y、Z轴加速度计分别指向测试点地理坐标系的北、地、西方向,记录X、Y、Z轴加速度计经过Δt秒输出的脉冲个数,分别为Ax(10)、Ay(10)和Az(10);
位置11:对位置10中的捷联惯性组合位置绕Z轴正转45°,此时Z轴指向西,X轴指向北偏地45°,Y轴指向南偏地45°,记录X、Y、Z轴加速度计经过Δt秒输出的脉冲个数,分别为Ax(11)、Ay(11)和Az(11);
位置12:对位置11中的捷联惯性组合位置绕Z轴正转180°,此时Z轴指向西,X轴指向南偏天45°,Y轴指向北偏天45°,记录X、Y、Z轴加速度计经过Δt秒输出的脉冲个数,分别为Ax(12)、Ay(12)和Az(12);
位置13:使捷联惯性组合X、Y、Z轴加速度计分别指向测试点地理坐标系的西、北、地方向,记录X、Y、Z轴加速度计经过Δt秒输出的脉冲个数,分别为Ax(13)、Ay(13)和Az(13);
位置14:对位置13中的捷联惯性组合位置绕X轴正转45°,此时X轴指向西,Y轴指向北偏地45°,Z轴指向南偏地45°,记录X、Y、Z轴加速度计经过Δt秒输出的脉冲个数,分别为Ax(14)、Ay(14)和Az(14);
位置15:对位置14中的捷联惯性组合位置绕X轴正转180°,此时X轴指向西,Y轴指向南偏天45°,Z轴指向北偏天45°,记录X、Y、Z轴加速度计经过Δt秒输出的脉冲个数,分别为Ax(15)、Ay(15)和Az(15);
位置16:使捷联惯性组合X、Y、Z轴加速度计分别指向测试点地理坐标系的地、西、北方向,记录X、Y、Z轴加速度计经过Δt秒输出的脉冲个数,分别为Ax(16)、Ay(16)和Az(16);
位置17:对位置16中的捷联惯性组合位置绕Y轴正转45°,此时Y轴指向西,Z轴指向北偏地45°,X轴指向南偏地45°,记录X、Y、Z轴加速度计经过Δt秒输出的脉冲个数,分别为Ax(17)、Ay(17)和Az(17);
位置18:对位置17中的捷联惯性组合位置绕Y轴正转180°,此时Y轴指向西,Z轴指向南偏天45°,X轴指向北偏天45°,记录X、Y、Z轴加速度计经过Δt秒输出的脉冲个数,分别为Ax(18)、Ay(18)和Az(18)。
(3)根据步骤(2)中经过测量时间Δt输出的脉冲个数,计算捷联惯性组合加速度计组合误差模型中的误差系数,包括标度因数、零值偏差、安装误差角、标度因数不对称性相对误差、二次项误差系数、奇二次项系数误差、交叉耦合项系数;
各误差项系数的计算公式为:
X轴的标度因数Kax的计算公式为:
K ax = ( 2 + 1 ) 4 Δt { 2 [ - A x ( 4 ) + A x ( 16 ) ] + A x ( 5 ) - A x ( 6 ) - A x ( 8 ) + A x ( 9 ) - A x ( 11 ) + A x ( 12 ) - A x ( 17 ) + A x ( 18 ) }
X轴的零值偏差K0x的计算公式为:
K 0 x = 1 8 K ax Δt [ A x ( 1 ) + A x ( 2 ) + A x ( 3 ) + A x ( 7 ) + A x ( 10 ) + A x ( 13 ) + A x ( 14 ) + A x ( 15 ) ]
Y轴相对于X轴的安装误差角Exy的计算公式为:
E xy = 2 12 K ax Δt { 2 [ A x ( 1 ) - A x ( 10 ) ] + A x ( 2 ) - A x ( 3 ) - A x ( 5 ) + A x ( 6 ) - A x ( 11 ) + A x ( 12 ) - A x ( 14 ) + A x ( 15 ) }
Z轴相对于X轴的安装误差角Exz的计算公式为:
E xz = 2 12 K ax Δt { 2 [ A x ( 7 ) - A x ( 13 ) ] - A x ( 2 ) + A x ( 3 ) + A x ( 8 ) - A x ( 9 ) - A x ( 14 ) + A x ( 15 ) - A x ( 17 ) + A x ( 18 ) }
X轴的标度因数不对称性相对误差δK'ax的计算公式为:
δK ax ′ = 2 + 1 8 K ax Δt { 4 [ - A x ( 4 ) - A x ( 16 ) ] + 2 [ A x ( 5 ) + A x ( 6 ) + A x ( 8 ) + A x ( 9 ) + A x ( 11 ) + A x ( 12 ) + A x ( 17 ) + A x ( 18 ) ] - A x ( 1 ) - A x ( 2 ) - A x ( 3 ) - A x ( 7 ) - A x ( 10 ) - A x ( 13 ) - A x ( 14 ) - A x ( 15 ) }
X轴的二次项误差系数K2x的计算公式为:
K 2 x = 2 8 K ax Δt { ( 4 2 + 4 ) [ A x ( 4 ) + A x ( 16 ) ] + ( 2 + 2 ) [ - A x ( 5 ) - A x ( 6 ) - A x ( 8 ) - A x ( 9 ) - A x ( 11 ) - A x ( 12 ) - A x ( 17 ) - A x ( 18 ) ] + A x ( 1 ) + A x ( 2 ) + A x ( 3 ) + A x ( 7 ) + A x ( 10 ) + A x ( 13 ) + A x ( 14 ) + A x ( 15 )
X轴的奇二次项系数误差δK'2x的计算公式为:
δK 2 x ′ = 2 + 1 4 K ax Δt { 2 2 [ A x ( 4 ) - A x ( 16 ) ] - A x ( 5 ) + A x ( 6 ) + A x ( 8 ) - A x ( 9 ) + A x ( 11 ) - A x ( 12 ) + A x ( 17 ) - A x ( 18 ) }
X、Y轴向乘积对X轴的交叉耦合项系数Kxy的计算公式为:
K xy = 1 2 K ax Δt [ - A x ( 5 ) - A x ( 6 ) + A x ( 11 ) + A x ( 12 ) ]
X、Z轴向乘积对X轴的交叉耦合项系数Kxz的计算公式为:
K xz = 1 2 K ax Δt [ - A x ( 8 ) - A x ( 9 ) + A x ( 17 ) + A x ( 18 ) ]
Y轴的标度因数Kay的计算公式为:
K ay = ( 2 + 1 ) 4 Δt { 2 [ - A y ( 1 ) + A y ( 10 ) ] + A y ( 2 ) - A y ( 3 ) - A y ( 5 ) + A y ( 6 ) - A y ( 11 ) + A y ( 12 ) - A y ( 14 ) + A y ( 15 ) }
Y轴的零值偏差K0y的计算公式为:
K 0 y = 1 8 K ay Δt [ A y ( 4 ) + A y ( 7 ) + A y ( 8 ) + A y ( 9 ) + A y ( 13 ) + A y ( 16 ) + A y ( 17 ) + A y ( 18 ) ]
X轴相对于Y轴的安装误差角Eyx的计算公式为:
E yx = 2 12 K ay Δt { 2 [ A y ( 4 ) - A y ( 16 ) ] + A y ( 5 ) - A y ( 6 ) - A y ( 8 ) + A y ( 9 ) - A y ( 11 ) + A y ( 12 ) - A y ( 17 ) + A y ( 18 ) }
Z轴相对于Y轴的安装误差角Eyz的计算公式为:
E yz = 2 12 K ay Δt { 2 [ A y ( 7 ) - A y ( 13 ) ] - A y ( 2 ) + A y ( 3 ) + A y ( 8 ) - A y ( 9 ) - A y ( 14 ) + A y ( 15 ) - A y ( 17 ) + A y ( 18 ) }
Y轴的标度因数不对称性相对误差δK'ay的计算公式为:
δK ay ′ = 2 + 1 8 K ay Δt { 4 [ - A y ( 1 ) - A y ( 10 ) ] + 2 [ A y ( 2 ) + A y ( 3 ) + A y ( 5 ) + A y ( 6 ) + A y ( 11 ) + A y ( 12 ) + A y ( 14 ) + A y ( 15 ) ] - A y ( 4 ) - A y ( 7 ) - A y ( 8 ) - A y ( 9 ) - A y ( 13 ) - A y ( 16 ) - A y ( 17 ) - A y ( 18 ) }
Y轴的二次项误差系数K2y的计算公式为:
K 2 y = 2 8 K ay Δt 4 { ( 4 2 + 4 ) [ A y ( 1 ) + A y ( 10 ) ] + ( 2 + 2 ) [ - A y ( 2 ) - A y ( 3 ) - A y ( 5 ) - A y ( 6 ) - A y ( 11 ) - A y ( 12 ) - A y ( 14 ) - A y ( 15 ) ] + A y ( 4 ) + A y ( 7 ) + A y ( 8 ) + A y ( 9 ) + A y ( 13 ) + A y ( 16 ) + A y ( 17 ) + A y ( 18 )
Y轴的奇二次项系数误差δK'2y的计算公式为:
δK 2 y ′ = 2 + 1 4 K ay Δt { 2 2 [ A y ( 1 ) - A y ( 10 ) ] - A y ( 2 ) + A y ( 3 ) + A y ( 5 ) - A y ( 6 ) + A y ( 11 ) - A y ( 12 ) + A y ( 14 ) - A y ( 15 ) }
X、Y轴向乘积对Y轴的交叉耦合项系数Kyx的计算公式为:
K yx = 1 2 K ay Δt [ - A y ( 5 ) - A y ( 6 ) + A y ( 11 ) + A y ( 12 ) ]
Y、Z轴向乘积对Y轴的交叉耦合项系数Kyz的计算公式为:
K yz = 1 2 K ay Δt [ - A y ( 2 ) - A y ( 3 ) + A y ( 14 ) + A y ( 15 ) ]
Z轴的标度因数Kaz的计算公式为:
K az = ( 2 + 1 ) 4 Δt { 2 [ - A z ( 7 ) + A z ( 13 ) ] - A z ( 2 ) + A z ( 3 ) + A z ( 8 ) - A z ( 9 ) - A z ( 14 ) + A z ( 15 ) - A z ( 17 ) + A z ( 18 ) }
Z轴的零值偏差K0z的计算公式为:
K 0 z = 1 8 K az Δt [ A z ( 1 ) + A z ( 4 ) + A z ( 5 ) + A z ( 6 ) + A z ( 10 ) + A z ( 11 ) + A z ( 12 ) + A z ( 16 ) ]
X轴相对于Z轴的安装误差角Ezx的计算公式为:
E zx = 2 12 K az Δt { 2 [ A z ( 4 ) - A z ( 16 ) ] + A z ( 5 ) - A z ( 6 ) - A z ( 8 ) + A z ( 9 ) - A z ( 11 ) + A z ( 12 ) - A z ( 17 ) + A z ( 18 ) }
Y轴相对于Z轴的安装误差角Ezy的计算公式为:
E zy = 2 12 K az Δt { 2 [ A z ( 1 ) - A z ( 10 ) ] + A z ( 2 ) - A z ( 3 ) - A z ( 5 ) + A z ( 6 ) - A z ( 11 ) + A z ( 12 ) - A z ( 17 ) + A z ( 18 ) }
Z轴的标度因数不对称性相对误差δK'az的计算公式为:
δK az ′ = 2 + 1 8 K az Δt { 4 [ - A z ( 7 ) - A z ( 13 ) ] + 2 [ A z ( 2 ) + A z ( 3 ) + A z ( 8 ) + A z ( 9 ) + A z ( 14 ) + A z ( 15 ) + A z ( 17 ) + A z ( 18 ) ] - A z ( 1 ) - A z ( 4 ) - A z ( 5 ) - A z ( 6 ) - A z ( 10 ) - A z ( 11 ) - A z ( 12 ) - A z ( 16 ) }
Z轴的二次项误差系数K2z的计算公式为:
K 2 z = 2 8 K az Δt { ( 4 2 + 4 ) [ A z ( 7 ) + A z ( 13 ) ] + ( 2 + 2 ) [ - A z ( 2 ) - A z ( 3 ) - A z ( 8 ) - A z ( 9 ) - A z ( 14 ) - A z ( 15 ) - A z ( 17 ) - A z ( 18 ) ] + A z ( 1 ) + A z ( 4 ) + A z ( 5 ) + A z ( 6 ) + A z ( 10 ) + A z ( 11 ) + A z ( 12 ) + A z ( 16 )
Z轴的奇二次项系数误差δK'2z的计算公式为:
δK 2 z ′ = 2 + 1 4 K az Δt { 2 2 [ A z ( 7 ) - A z ( 13 ) ] + A z ( 2 ) - A z ( 3 ) - A z ( 8 ) + A z ( 9 ) + A z ( 14 ) - A z ( 15 ) + A z ( 17 ) - A z ( 18 ) }
X、Z轴向乘积对Z轴的交叉耦合项系数Kzx的计算公式为:
K zx = 1 2 K az Δt [ - A z ( 8 ) - A z ( 9 ) + A z ( 17 ) + A z ( 18 ) ]
Y、Z轴向乘积对Z轴的交叉耦合项系数Kzy的计算公式为:
K zy = 1 2 K az Δt [ - A z ( 2 ) - A z ( 3 ) + A z ( 14 ) + A z ( 15 ) ]
(4)将通过步骤(3)得到的系数反馈到捷联惯性组合加速度计组合误差模型中,完成捷联惯性组合加速度计组合的标定。
实际应用中,首先,确定捷联惯性组合的X、Y、Z轴方向,并在标定前为加速度计组合进行充分预热。然后,将惯性组合逐次排放为图2所示的位置,并在第i个位置时测量经过Δt秒后三个加速计输出的脉冲个数Ax(i)、Ay(i)和Az(i)。最后,按照公式逐个计算出捷联惯性组合加速度计组合误差模型中所有的误差项系数,从而完成捷联惯性组合加速度计组合的标定。
本发明未详细描述内容为本领域技术人员公知技术。

Claims (3)

1.一种标定捷联惯性组合加速度计组合的方法,用于计算捷联惯性组合加速度计组合误差模型中的系数,捷联惯性组合加速度计组合误差模型为
A xp A yp A zp = K ax 0 0 0 K ay 0 0 0 K az { K 0 x K 0 y K 0 z + 1 + δK ax ′ sign ( a x ) E xy E xz E yx 1 + δK ay ′ sign ( a y ) E yz E zx E zy 1 + δK ax ′ sign ( a z ) a x a y a z + K 2 x + δK 2 x ′ sign ( a x ) 0 0 0 K 2 y + δK 2 y ′ sign ( a y ) 0 0 0 K 2 z + δK 2 z ′ sign ( a z ) a x 2 a y 2 a z 2 K xy K xz 0 K yx 0 K yz 0 K zx K zy a x a y a x a z a y a z }
其中,Kax、Kay、Kaz分别为X、Y、Z轴的标度因数,K0x、K0y、K0z分别为X、Y、Z轴的零值偏差,Exy为Y轴相对于X轴的安装误差角、Exz为Z轴相对于X轴的安装误差角、Eyx为X轴相对于Y轴的安装误差角、Eyz为Z轴相对于Y轴的安装误差角、Ezx为X轴相对于Z轴的安装误差角、Ezy为Y轴相对于Z轴的安装误差角,δK'ax、δK'ay、δK'az分别为X、Y、Z轴的标度因数不对称性相对误差,K2x、K2y、K2z分别为X、Y、Z轴的二次项误差系数,δK'2x、δK'2y、δK'2z分别为X、Y、Z轴的奇二次项系数误差,Kxy为X、Y轴向乘积对X轴的交叉耦合项系数、Kxz为X、Z轴向乘积对X轴的交叉耦合项系数、Kyx为X、Y轴向乘积对Y轴的交叉耦合项系数、Kyz为Y、Z轴向乘积对Y轴的交叉耦合项系数、Kzx为X、Z轴向乘积对Z轴的交叉耦合项系数、Kzy为Y、Z轴向乘积对Z轴的交叉耦合项系数;Axp、Ayp、Azp分别为捷联惯性组合中X、Y、Z轴输出的脉冲频率,每一个位置的脉冲频率由该位置的测量时间和X、Y、Z轴输出的脉冲个数决定;ax、ay、az分别为捷联惯性组合X、Y、Z轴向视加速度分量;其特征在于步骤如下:
(1)将捷联惯性组合静置于18个不同的位置;
(2)在第i个位置时,采集捷联惯性组合的X、Y、Z轴加速度计经过Δt秒输出的脉冲个数Ax(i)、Ay(i)和Az(i),其中i∈[1,18];
(3)根据步骤(2)中经过测量时间Δt输出的脉冲个数,计算捷联惯性组合加速度计组合误差模型中的误差系数,包括标度因数、零值偏差、安装误差角、标度因数不对称性相对误差、二次项误差系数、奇二次项系数误差、交叉耦合项系数;
(4)将通过步骤(3)得到的系数反馈到捷联惯性组合加速度计组合误差模型中,完成捷联惯性组合加速度计组合的标定。
2.根据权利要求1所述的一种标定捷联惯性组合加速度计组合的方法,其特征在于:所述步骤(1)中捷联惯性组合的18个位置分别为:
位置1:将捷联惯性组合X、Y、Z轴加速度计分别指向测试点地理坐标系的东、天、南方向;
位置2:对位置1中的捷联惯性组合位置绕X轴正转45°,此时X轴指向东,Y轴指向南偏天45°,Z轴指向南偏地45°;
位置3:对位置2中的捷联惯性组合位置绕X轴正转180°,此时X轴指向东,Y轴指向北偏地45°,Z轴指向北偏天45°;
位置4:使捷联惯性组合X、Y、Z轴加速度计分别指向测试点地理坐标系的天、南、东方向;
位置5:对位置4中的捷联惯性组合位置绕Z轴正转45°,此时Z轴指向东,X轴指向南偏天45°,Y轴指向南偏地45°;
位置6:对位置5中的捷联惯性组合位置绕Z轴正转180°,此时Z轴指向东,X轴指向北偏地45°,Y轴指向北偏天45°;
位置7:使捷联惯性组合X、Y、Z轴加速度计分别指向测试点地理坐标系的南、东、天方向;
位置8:对位置7中的捷联惯性组合位置绕Y轴正转45°,此时Y轴指向东,Z轴指向南偏天45°,X轴指向南偏地45°;
位置9:对位置8中的捷联惯性组合位置绕Y轴正转180°,此时Y轴指向东,Z轴指向北偏地45°,X轴指向北偏天45°;
位置10:使捷联惯性组合X、Y、Z轴加速度计分别指向测试点地理坐标系的北、地、西方向;
位置11:对位置10中的捷联惯性组合位置绕Z轴正转45°,此时Z轴指向西,X轴指向北偏地45°,Y轴指向南偏地45°;
位置12:对位置11中的捷联惯性组合位置绕Z轴正转180°,此时Z轴指向西,X轴指向南偏天45°,Y轴指向北偏天45°;
位置13:使捷联惯性组合X、Y、Z轴加速度计分别指向测试点地理坐标系的西、北、地方向;
位置14:对位置13中的捷联惯性组合位置绕X轴正转45°,此时X轴指向西,Y轴指向北偏地45°,Z轴指向南偏地45°;
位置15:对位置14中的捷联惯性组合位置绕X轴正转180°,此时X轴指向西,Y轴指向南偏天45°,Z轴指向北偏天45°;
位置16:使捷联惯性组合X、Y、Z轴加速度计分别指向测试点地理坐标系的地、西、北方向;
位置17:对位置16中的捷联惯性组合位置绕Y轴正转45°,此时Y轴指向西,Z轴指向北偏地45°,X轴指向南偏地45°;
位置18:对位置17中的捷联惯性组合位置绕Y轴正转180°,此时Y轴指向西,Z轴指向南偏天45°,X轴指向北偏天45°。
3.根据权利要求1所述的一种标定捷联惯性组合加速度计组合的方法,其特征在于:所述步骤(3)中各误差项系数的计算公式为:
X轴的标度因数Kax的计算公式为:
K ax = ( 2 + 1 ) 4 Δt { 2 [ - A x ( 4 ) + A x ( 16 ) ] + A x ( 5 ) - A x ( 6 ) - A x ( 8 ) + A x ( 9 ) - A x ( 11 ) + A x ( 12 ) - A x ( 17 ) + A x ( 18 ) }
X轴的零值偏差K0x的计算公式为:
K 0 x = 1 8 K ax Δt [ A x ( 1 ) + A x ( 2 ) + A x ( 3 ) + A x ( 7 ) + A x ( 10 ) + A x ( 13 ) + A x ( 14 ) + A x ( 15 ) ]
Y轴相对于X轴的安装误差角Exy的计算公式为:
E xy = 2 12 K ax Δt { 2 [ A x ( 1 ) - A x ( 10 ) ] + A x ( 2 ) - A x ( 3 ) - A x ( 5 ) + A x ( 6 ) - A x ( 11 ) + A x ( 12 ) - A x ( 14 ) + A x ( 15 ) }
Z轴相对于X轴的安装误差角Exz的计算公式为:
E xz = 2 12 K ax Δt { 2 [ A x ( 7 ) - A x ( 13 ) ] - A x ( 2 ) + A x ( 3 ) + A x ( 8 ) - A x ( 9 ) - A x ( 14 ) + A x ( 15 ) - A x ( 17 ) + A x ( 18 ) }
X轴的标度因数不对称性相对误差δK'ax的计算公式为:
δK ax ′ = 2 + 1 8 K ax Δt { 4 [ - A x ( 4 ) - A x ( 16 ) ] + 2 [ A x ( 5 ) + A x ( 6 ) + A x ( 8 ) + A x ( 9 ) + A x ( 11 ) + A x ( 12 ) + A x ( 17 ) + A x ( 18 ) ] - A x ( 1 ) - A x ( 2 ) - A x ( 3 ) - A x ( 7 ) - A x ( 10 ) - A x ( 13 ) - A x ( 14 ) - A x ( 15 ) }
X轴的二次项误差系数K2x的计算公式为:
K 2 x = 2 8 K ax Δt { ( 4 2 + 4 ) [ A x ( 4 ) + A x ( 16 ) ] + ( 2 + 2 ) [ - A x ( 5 ) - A x ( 6 ) - A x ( 8 ) - A x ( 9 ) - A x ( 11 ) - A x ( 12 ) - A x ( 17 ) - A x ( 18 ) ] + A x ( 1 ) + A x ( 2 ) + A x ( 3 ) + A x ( 7 ) + A x ( 10 ) + A x ( 13 ) + A x ( 14 ) + A x ( 15 )
X轴的奇二次项系数误差δK'2x的计算公式为:
δK 2 x ′ = 2 + 1 4 K ax Δt { 2 2 [ A x ( 4 ) - A x ( 16 ) ] - A x ( 5 ) + A x ( 6 ) + A x ( 8 ) - A x ( 9 ) + A x ( 11 ) - A x ( 12 ) + A x ( 17 ) - A x ( 18 ) }
X、Y轴向乘积对X轴的交叉耦合项系数Kxy的计算公式为:
K xy = 1 2 K ax Δt [ - A x ( 5 ) - A x ( 6 ) + A x ( 11 ) + A x ( 12 ) ]
X、Z轴向乘积对X轴的交叉耦合项系数Kxz的计算公式为:
K xz = 1 2 K ax Δt [ - A x ( 8 ) - A x ( 9 ) + A x ( 17 ) + A x ( 18 ) ]
Y轴的标度因数Kay的计算公式为:
K ay = ( 2 + 1 ) 4 Δt { 2 [ - A y ( 1 ) + A y ( 10 ) ] + A y ( 2 ) - A y ( 3 ) - A y ( 5 ) + A y ( 6 ) - A y ( 11 ) + A y ( 12 ) - A y ( 14 ) + A y ( 15 ) }
Y轴的零值偏差K0y的计算公式为:
K 0 y = 1 8 K ay Δt [ A y ( 4 ) + A y ( 7 ) + A y ( 8 ) + A y ( 9 ) + A y ( 13 ) + A y ( 16 ) + A y ( 17 ) + A y ( 18 ) ]
X轴相对于Y轴的安装误差角Eyx的计算公式为:
E yx = 2 12 K ay Δt { 2 [ A y ( 4 ) - A y ( 16 ) ] + A y ( 5 ) - A y ( 6 ) - A y ( 8 ) + A y ( 9 ) - A y ( 11 ) + A y ( 12 ) - A y ( 17 ) + A y ( 18 ) }
Z轴相对于Y轴的安装误差角Eyz的计算公式为:
E yz = 2 12 K ay Δt { 2 [ A y ( 7 ) - A y ( 13 ) ] - A y ( 2 ) + A y ( 3 ) + A y ( 8 ) - A y ( 9 ) - A y ( 14 ) + A y ( 15 ) - A y ( 17 ) + A y ( 18 ) }
Y轴的标度因数不对称性相对误差δK'ay的计算公式为:
δK ay ′ = 2 + 1 8 K ay Δt { 4 [ - A y ( 1 ) - A y ( 10 ) ] + 2 [ A y ( 2 ) + A y ( 3 ) + A y ( 5 ) + A y ( 6 ) + A y ( 11 ) + A y ( 12 ) + A y ( 14 ) + A y ( 15 ) ] - A y ( 4 ) - A y ( 7 ) - A y ( 8 ) - A y ( 9 ) - A y ( 13 ) - A y ( 16 ) - A y ( 17 ) - A y ( 18 ) }
Y轴的二次项误差系数K2y的计算公式为:
K 2 y = 2 8 K ay Δt 4 { ( 4 2 + 4 ) [ A y ( 1 ) + A y ( 10 ) ] + ( 2 + 2 ) [ - A y ( 2 ) - A y ( 3 ) - A y ( 5 ) - A y ( 6 ) - A y ( 11 ) - A y ( 12 ) - A y ( 14 ) - A y ( 15 ) ] + A y ( 4 ) + A y ( 7 ) + A y ( 8 ) + A y ( 9 ) + A y ( 13 ) + A y ( 16 ) + A y ( 17 ) + A y ( 18 )
Y轴的奇二次项系数误差δK'2y的计算公式为:
δK 2 y ′ = 2 + 1 4 K ay Δt { 2 2 [ A y ( 1 ) - A y ( 10 ) ] - A y ( 2 ) + A y ( 3 ) + A y ( 5 ) - A y ( 6 ) + A y ( 11 ) - A y ( 12 ) + A y ( 14 ) - A y ( 15 ) }
X、Y轴向乘积对Y轴的交叉耦合项系数Kyx的计算公式为:
K yx = 1 2 K ay Δt [ - A y ( 5 ) - A y ( 6 ) + A y ( 11 ) + A y ( 12 ) ]
Y、Z轴向乘积对Y轴的交叉耦合项系数Kyz的计算公式为:
K yz = 1 2 K ay Δt [ - A y ( 2 ) - A y ( 3 ) + A y ( 14 ) + A y ( 15 ) ]
Z轴的标度因数Kaz的计算公式为:
K az = ( 2 + 1 ) 4 Δt { 2 [ - A z ( 7 ) + A z ( 13 ) ] - A z ( 2 ) + A z ( 3 ) + A z ( 8 ) - A z ( 9 ) - A z ( 14 ) + A z ( 15 ) - A z ( 17 ) + A z ( 18 ) }
Z轴的零值偏差K0z的计算公式为:
K 0 z = 1 8 K az Δt [ A z ( 1 ) + A z ( 4 ) + A z ( 5 ) + A z ( 6 ) + A z ( 10 ) + A z ( 11 ) + A z ( 12 ) + A z ( 16 ) ]
X轴相对于Z轴的安装误差角Ezx的计算公式为:
E zx = 2 12 K az Δt { 2 [ A z ( 4 ) - A z ( 16 ) ] + A z ( 5 ) - A z ( 6 ) - A z ( 8 ) + A z ( 9 ) - A z ( 11 ) + A z ( 12 ) - A z ( 17 ) + A z ( 18 ) }
Y轴相对于Z轴的安装误差角Ezy的计算公式为:
E zy = 2 12 K az Δt { 2 [ A z ( 1 ) - A z ( 10 ) ] + A z ( 2 ) - A z ( 3 ) - A z ( 5 ) + A z ( 6 ) - A z ( 11 ) + A z ( 12 ) - A z ( 17 ) + A z ( 18 ) }
Z轴的标度因数不对称性相对误差δK'az的计算公式为:
δK az ′ = 2 + 1 8 K az Δt { 4 [ - A z ( 7 ) - A z ( 13 ) ] + 2 [ A z ( 2 ) + A z ( 3 ) + A z ( 8 ) + A z ( 9 ) + A z ( 14 ) + A z ( 15 ) + A z ( 17 ) + A z ( 18 ) ] - A z ( 1 ) - A z ( 4 ) - A z ( 5 ) - A z ( 6 ) - A z ( 10 ) - A z ( 11 ) - A z ( 12 ) - A z ( 16 ) }
Z轴的二次项误差系数K2z的计算公式为:
K 2 z = 2 8 K az Δt { ( 4 2 + 4 ) [ A z ( 7 ) + A z ( 13 ) ] + ( 2 + 2 ) [ - A z ( 2 ) - A z ( 3 ) - A z ( 8 ) - A z ( 9 ) - A z ( 14 ) - A z ( 15 ) - A z ( 17 ) - A z ( 18 ) ] + A z ( 1 ) + A z ( 4 ) + A z ( 5 ) + A z ( 6 ) + A z ( 10 ) + A z ( 11 ) + A z ( 12 ) + A z ( 16 )
Z轴的奇二次项系数误差δK'2z的计算公式为:
δK 2 z ′ = 2 + 1 4 K az Δt { 2 2 [ A z ( 7 ) - A z ( 13 ) ] + A z ( 2 ) - A z ( 3 ) - A z ( 8 ) + A z ( 9 ) + A z ( 14 ) - A z ( 15 ) + A z ( 17 ) - A z ( 18 ) }
X、Z轴向乘积对Z轴的交叉耦合项系数Kzx的计算公式为:
K zx = 1 2 K az Δt [ - A z ( 8 ) - A z ( 9 ) + A z ( 17 ) + A z ( 18 ) ]
Y、Z轴向乘积对Z轴的交叉耦合项系数Kzy的计算公式为:
K zy = 1 2 K az Δt [ - A z ( 2 ) - A z ( 3 ) + A z ( 14 ) + A z ( 15 ) ] .
CN201410073606.8A 2014-02-28 2014-02-28 一种标定捷联惯性组合加速度计组合的方法 Active CN103868527B (zh)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN201410073606.8A CN103868527B (zh) 2014-02-28 2014-02-28 一种标定捷联惯性组合加速度计组合的方法

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN201410073606.8A CN103868527B (zh) 2014-02-28 2014-02-28 一种标定捷联惯性组合加速度计组合的方法

Publications (2)

Publication Number Publication Date
CN103868527A true CN103868527A (zh) 2014-06-18
CN103868527B CN103868527B (zh) 2017-04-05

Family

ID=50907309

Family Applications (1)

Application Number Title Priority Date Filing Date
CN201410073606.8A Active CN103868527B (zh) 2014-02-28 2014-02-28 一种标定捷联惯性组合加速度计组合的方法

Country Status (1)

Country Link
CN (1) CN103868527B (zh)

Cited By (4)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN104501833A (zh) * 2014-12-08 2015-04-08 北京航天控制仪器研究所 一种基准不确定情况下加速度计组合误差系数标定方法
CN105371868A (zh) * 2015-11-13 2016-03-02 北京航天控制仪器研究所 一种惯性稳定平台系统加速度计组合误差标定和补偿方法
RU2577806C1 (ru) * 2014-11-25 2016-03-20 Открытое акционерное общество "Радиоавионика" Способ калибровки акселерометрического трехосевого инклинометра
CN113916258A (zh) * 2021-09-07 2022-01-11 北京航天控制仪器研究所 一种加速度计组合高阶误差系数分离与补偿方法和系统

Citations (1)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN102680740A (zh) * 2012-05-07 2012-09-19 北京航空航天大学 一种加速度计二次项误差的系统级拟合标定方法

Patent Citations (1)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN102680740A (zh) * 2012-05-07 2012-09-19 北京航空航天大学 一种加速度计二次项误差的系统级拟合标定方法

Non-Patent Citations (3)

* Cited by examiner, † Cited by third party
Title
于海龙等: "激光捷联惯导系统高阶误差模型的建立与分析", 《红外与激光工程》, vol. 42, no. 9, 30 September 2013 (2013-09-30), pages 2375 - 2379 *
刘建波等: "石英加速度计二次项误差系数显著性分析", 《导弹与航天运载技术》, no. 324, 31 January 2013 (2013-01-31), pages 45 - 48 *
杨杰等: "激光陀螺捷联系统高精度加速度计非线性模型参数标定", 《中国惯性技术学报》, vol. 18, no. 5, 31 October 2010 (2010-10-31), pages 2 - 2 *

Cited By (6)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
RU2577806C1 (ru) * 2014-11-25 2016-03-20 Открытое акционерное общество "Радиоавионика" Способ калибровки акселерометрического трехосевого инклинометра
CN104501833A (zh) * 2014-12-08 2015-04-08 北京航天控制仪器研究所 一种基准不确定情况下加速度计组合误差系数标定方法
CN104501833B (zh) * 2014-12-08 2017-07-07 北京航天控制仪器研究所 一种基准不确定情况下加速度计组合误差系数标定方法
CN105371868A (zh) * 2015-11-13 2016-03-02 北京航天控制仪器研究所 一种惯性稳定平台系统加速度计组合误差标定和补偿方法
CN113916258A (zh) * 2021-09-07 2022-01-11 北京航天控制仪器研究所 一种加速度计组合高阶误差系数分离与补偿方法和系统
CN113916258B (zh) * 2021-09-07 2024-02-09 北京航天控制仪器研究所 一种加速度计组合高阶误差系数分离与补偿方法和系统

Also Published As

Publication number Publication date
CN103868527B (zh) 2017-04-05

Similar Documents

Publication Publication Date Title
CN101290326B (zh) 石英挠性加速度计测量组件的参数辨识标定方法
CN101975872B (zh) 石英挠性加速度计组件零位偏置的标定方法
CN100593689C (zh) 基于捷联惯性导航系统的姿态估计和融合的方法
CN101246024B (zh) 一种外场快速标定微型多传感器组合导航系统的方法
CN105607093B (zh) 一种组合导航系统及获取导航坐标的方法
CN102680004B (zh) 一种挠性陀螺位置姿态测量系统pos的标度因数误差标定与补偿方法
CN103323625B (zh) 一种mems-imu中加速度计动态环境下的误差标定补偿方法
CN103389114B (zh) 基于g敏感性的三轴MEMS陀螺非正交误差标定方法
CN103399335B (zh) 一种移动平台测试系统
CN102589573A (zh) 微型组合导航系统中的传感器野外标定方法
CN101021879A (zh) 惯性测量系统误差模型验证试验方法
CN101839719A (zh) 一种基于陀螺、地磁传感器的惯性测量装置
CN104197958B (zh) 一种基于激光测速仪航位推算系统的里程计标定方法
CN109507706B (zh) 一种gps信号丢失的预测定位方法
CN102279002A (zh) 星敏感器测量坐标系与载体坐标系转换矩阵的标定方法
CN104596543A (zh) 一种基准不确定情况下陀螺仪组合误差系数标定方法
CN110361031A (zh) 一种基于回溯理论的imu全参数误差快速标定方法
CN103868527A (zh) 一种标定捷联惯性组合加速度计组合的方法
CN103217699A (zh) 一种基于偏振信息的组合导航系统递推优化初始对准方法
CN106052719A (zh) 一种陀螺仪校准方法和装置
CN103884356A (zh) 一种标定捷联惯性组合陀螺仪组合的方法
CN103344252B (zh) 一种航空高光谱成像系统定位误差分析方法
CN103954299B (zh) 一种标定捷联惯性组合陀螺仪组合的方法
CN111679307B (zh) 一种卫星定位信号解算方法及装置
CN104297525A (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
GR01 Patent grant
GR01 Patent grant