CN104501833A - 一种基准不确定情况下加速度计组合误差系数标定方法 - Google Patents
一种基准不确定情况下加速度计组合误差系数标定方法 Download PDFInfo
- Publication number
- CN104501833A CN104501833A CN201410746311.2A CN201410746311A CN104501833A CN 104501833 A CN104501833 A CN 104501833A CN 201410746311 A CN201410746311 A CN 201410746311A CN 104501833 A CN104501833 A CN 104501833A
- Authority
- CN
- China
- Prior art keywords
- mrow
- msub
- mtd
- mtr
- msup
- 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
Links
- 238000000034 method Methods 0.000 title claims abstract description 52
- 238000012360 testing method Methods 0.000 claims abstract description 13
- 238000009434 installation Methods 0.000 claims description 34
- 230000001133 acceleration Effects 0.000 claims description 29
- 238000005259 measurement Methods 0.000 claims description 24
- 238000012935 Averaging Methods 0.000 claims description 13
- 239000011159 matrix material Substances 0.000 claims description 9
- 230000005484 gravity Effects 0.000 claims description 7
- 238000005096 rolling process Methods 0.000 claims description 4
- 239000002105 nanoparticle Substances 0.000 claims description 2
- 238000004364 calculation method Methods 0.000 description 6
- 238000002474 experimental method Methods 0.000 description 2
- 238000012545 processing Methods 0.000 description 2
- 238000007792 addition Methods 0.000 description 1
- 230000009286 beneficial effect Effects 0.000 description 1
- 239000000969 carrier Substances 0.000 description 1
- 230000007547 defect Effects 0.000 description 1
- 238000010586 diagram Methods 0.000 description 1
- 230000009977 dual effect Effects 0.000 description 1
- 238000012986 modification Methods 0.000 description 1
- 230000004048 modification Effects 0.000 description 1
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
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
一种基准不确定情况下加速度计组合误差系数标定方法,通过建立基准数学模型,将双轴旋转机构进行转动,得到安装于转台上的惯性测量系统输出值。在惯性测量系统的误差方程中将初始俯仰和滚转角误差作为变量,对其进行估计,得到精确的俯仰和滚转角。传统的实验室标定方法中,若转台位置发生改变,或将转台转移到外场进行测试时,需要重新采用计量等方法进行转台的标校,费时费力,不利于机动情况下的快速标定。本发明通过建立数学精确基准来确保惯性测量系统误差分离的有效性,使水平基准精度指标满足使用要求。在基准不确定情况下也能标定加速度计组合误差系数,提高外场标定效率,并提高标定系数的精度,准确标定出加速度计组合误差系数。
Description
技术领域
本发明涉及一种误差系数标定方法,尤其涉及一种基准不确定情况下加速度计组合误差系数标定方法,属于捷联惯性组合标定技术,可用于标定捷联惯性组合中加速度计组合的场合。
背景技术
加速度计是惯性导航和惯性制导系统的基本测量元件之一,它安装在运载体内部,用于测量运载体的运动加速度,并通过对加速度的积分,求得其加速度和位置。因此,加速度计的性能和精度直接影响导航和制导系统的精度。当安装在运载体内部时,加速度计的测量值不仅包括加速度计壳体随运载体运动的加速度、运载体相对于地球运动引起的哥式加速度,还包括表观重力加速度。当加速度计的输入轴与地球重力方向一致时,则测量值为地球重力的负数。所以可以用地球重力场来标定加速度计。捷联惯性组合是将陀螺仪和加速度计集成在一起并直接安装在运载体上的惯性测量装置。在捷联惯性组合中,加速度计测得的信号是运载体相对于惯性空间的视加速度在该加速度计敏感轴方向上的分量。为了完全测量运载体在空间中的运动视加速度,捷联惯性组合中装有三个敏感轴互相垂直的加速度计,其敏感轴方向指向捷联惯性组合定义的X轴、Y轴、Z轴正方向。在高精度测量中,加速度计的输出为脉冲数,脉冲数输出频率可以按照以下公式与捷联惯性组合敏感到的视加速度建立关系,即捷联惯性组合加速度计组合误差模型。
在上式中,AX(f)、AY(f)、AZ(f)分别为捷联惯性组合中X轴、Y轴、Z轴输出的脉冲频率(单位:Pulse/s);kax、kay、kaz分别为X轴、Y轴、Z轴的标度因数(单位:Pulse/s/g0);k0x、k0y、k0z分别为X轴、Y轴、Z轴的零值偏差(单位:g0);kxy、kxz、kyx、kyz、kzx、kzy分别为Y轴相对于X轴的安装误差角、Z轴相对于X轴的安装误差角、X轴相对于Y轴的安装误差角、Z轴相对于Y轴的安装误差角、X轴相对于Z轴的安装误差角、Y轴相对于Z轴的安装误差角(单位:rad);δKax、δKay、δKaz分别为X轴、Y轴、Z轴的标度因数不对称性相对误差;abX、abY、abZ分别为捷联惯性组合X轴、Y轴、Z轴向视加速度分量(单位:g0);g0为测试地点地球重力加速度。
一般标定方法进行标定时使用的转台需要有精确的水平基准及方位基准,其中,水平基准精度±2″,方位基准精度±20″。在实验室中,若转台位置发生改变,或将转台转移到外场进行测试,需要采用计量等方法进行转台的标定,费时费力。这种标定方法只有在得到精确的水平基准和方位基准才能标定出加速度计的误差系数,限制了标定条件,不利于机动情况下的快速标定。
因此,为了能在基准不确定情况下也能将加速度计组合误差系数进行标定,提高外场标定效率,并提高标定系数的精度,需要研究一种新型的捷联惯性组合加速度计组合误差标定方法。
发明内容
本发明解决的技术问题是:克服现有技术的不足,提供一种基准不确定情况下加速度计组合误差系数标定方法,实现了对捷联惯性组合加速度计组合在基准不确定情况下误差系数的标定,降低了对基准精度的要求。
本发明的技术解决方案是:一种基准不确定情况下加速度计组合误差系数标定方法,步骤如下:
(1)将捷联惯性组合安装在双轴旋转机构上,调节双轴旋转机构的内框架旋转角度和外框架旋转角度,使得捷联惯性组合静置于16个不同的位置;
(2)在步骤(1)中确定的位置i,采集捷联惯性组合X轴、Y轴、Z轴加速度计经过Δt秒输出的脉冲数Nax(i)、Nay(i)和Naz(i),并记录该位置双轴旋转机构内框架α(i)和外框架旋转角β(i),计算X轴、Y轴、Z轴加速度计的脉冲数输出频率Ax(i)、Ay(i)和Az(i),其中i∈[1,16],Δt∈[60,90];
(3)结合预先多次测量取均值得到的加速度计组合的零次项、标度因数、安装误差角和标度因数不对称项误差,利用步骤(2)中得到的16个位置加速度计组合的脉冲数输出频率,计算各位置经补偿得到的捷联惯性组合X轴、Y轴、Z轴加速度abX′(i)、abY′(i)、abZ′(i);
(4)利用步骤(3)第一个位置经补偿得到的捷联惯性组合X轴、Y轴、Z轴加速度,计算得到捷联惯性组合在第一个位置的初始俯仰角θ0和初始滚转角γ0;
(5)根据步骤(2)中16个位置双轴旋转机构内框架α(i)和外框架旋转角β(i),步骤(3)中加速度计组合经过补偿后得到的捷联惯性组合X轴、Y轴、Z轴加速度,以及第一个位置的初始俯仰角θ0和初始滚转角γ0,计算捷联惯性组合加速度计组合误差模型中的误差系数偏差,包括标度因数偏差、零次项偏差、安装误差角偏差、标度因数不对称项误差偏差、初始俯仰角误差、滚转角误差;
(6)将第一个位置的初始俯仰角θ0更新为第一个位置的初始俯仰角θ0与步骤(5)中求得的初始俯仰角误差之和,并将第一个位置的初始滚转角γ0更新为第一个位置的初始滚转角γ0与步骤(5)中求得的初始滚转角误差之和,重复执行步骤(5)~步骤(6)N次,得到双轴旋转机构在第一个位置与地理坐标系间的夹角θ和γ,同时得到捷联惯性组合加速度计组合误差模型中的误差系数偏差;
(7)将通过步骤(6)得到的误差系数偏差与已知的加速度计组合的零次项、标度因数、安装误差角、标度因数不对称项误差对应求和,得到加速度计组合的误差系数精确值,实现基准不确定情况下加速度计组合误差系数标定。
所述步骤(1)中将捷联惯性组合安装在双轴旋转机构上,调节双轴旋转机构的内框架旋转角度和外框架旋转角度,使得捷联惯性组合静置于16个不同的位置,具体为:
位置1:调节旋转机构使捷联惯性组合静止于任意一个位置,记录此时的内框架旋转角α(1)和外框架旋转角β(1);
位置2:调节旋转机构使内框架旋转角度α(2)=α(1)+90°,外框架旋转角度β(2)=β(1);
位置3:调节旋转机构使内框架旋转角度α(3)=α(1)+180°,外框架旋转角度β(3)=β(1);
位置4:调节旋转机构使内框架旋转角度α(4)=α(1)+270°,外框架旋转角度β(4)=β(1);
位置5:调节旋转机构使内框架旋转角度α(5)=α(1),外框架旋转角度β(5)=β(1)+180°;
位置6:调节旋转机构使内框架旋转角度α(6)=α(1)+90°,外框架旋转角度β(6)=β(1)+180°;
位置7:调节旋转机构使内框架旋转角度α(7)=α(1)+180°,外框架旋转角度β(7)=β(1)+180°;
位置8:调节旋转机构使内框架旋转角度α(8)=α(1)+270°,外框架旋转角度β(8)=β(1)+180°;
位置9:调节旋转机构使内框架旋转角度α(9)=α(1)+90°,外框架旋转角度β(9)=β(1)+90°;
位置10:调节旋转机构使内框架旋转角度α(10)=α(1)+270°,外框架旋转角度β(10)=β(1)+90°;
位置11:调节旋转机构使内框架旋转角度α(11)=α(1),外框架旋转角度β(11)=β(1)+90°;
位置12:调节旋转机构使内框架旋转角度α(12)=α(1)+180°,外框架旋转角度β(12)=β(1)+90°;
位置13:调节旋转机构使内框架旋转角度α(13)=α(1)+270°,外框架旋转角度β(13)=β(1)+270°;
位置14:调节旋转机构使内框架旋转角度α(14)=α(1)+90°,外框架旋转角度β(14)=β(1)+270°;
位置15:调节旋转机构使内框架旋转角度α(15)=α(1)+180°,外框架旋转角度β(15)=β(1)+270°;
位置16:调节旋转机构使内框架旋转角度α(16)=α(1),外框架旋转角度β(16)=β(1)+270°。
所述步骤(2)中第i个位置脉冲数输出频率由公式
给出。
所述步骤(3)中各位置经补偿得到的捷联惯性组合X轴、Y轴、Z轴加速度abX′(i)、abY′(i)、abZ′(i),具体由公式:
给出,其中,为预先多次测量取均值得到的加速度计组合的标度因数不对称项误差;为预先多次测量取均值得到的加速度计组合安装误差角;为预先多次测量取均值得到的加速度计组合的零次项;为预先多次测量取均值得到的加速度计组合标度因数。
所述步骤(4)中捷联惯性组合在第一个位置的初始俯仰角θ0和初始滚转角γ0;具体由公式:
给出,其中abX′(1)、abY′(1)和abZ′(1)分别为第一个位置经补偿得到的捷联惯性组合X轴、Y轴、Z轴加速度,g0为测试地点地球重力加速度。
所述步骤(5)中计算捷联惯性组合加速度计组合误差模型中的误差系数偏差,具体为:
X轴的误差系数偏差估计式由公式:
xishu_x=(AaX TAaX)-1AaX TYax
给出,其中,xishu_x=[δk0x δkax ΔKax δkyx δkzx Δθ Δγ]T,δk0x为X轴加速度计的零次项偏差;δkax为X轴加速度计的标度因数偏差;ΔKax为X轴加速度计的标度因数不对称项误差偏差;δkyx为X轴相对于Y轴的安装误差角偏差;δkzx为X轴相对于Z轴的安装误差角偏差,
AaX为X轴加速度计结构矩阵,由公式:
给出,其中:
F13(i)=-cosα(i)sinγ0 cosθ0+sinα(i)cosβ(i)sinθ0+sinα(i)sinβ(i)cosθ0 cosγ0;
F23(i)=sinα(i)sinγ0 cosθ0+cosα(i)cosβ(i)sinθ0+cosα(i)sinβ(i)cosθ0 cosγ0;
F33(i)=-sinβ(i)sinθ0+cosβ(i)cosθ0 cosγ0;
g0为测试地点地球重力加速度;
Yax为X轴的观测向量,具体由公式:
Yax=[abX′(1)-F13(1)abX′(2)-F13(2)…abX′(16)-F13(16)]T
给出;
Y轴的误差系数偏差估计式由公式:
xishu_y=(AaY TAaY)-1AaY TYay
给出,其中,xishu_y=[δk0y δkxy δkay ΔKay δkzy Δθ Δγ]T,δk0y为Y轴加速度计的零次项偏差;δkxy为Y轴相对于X轴的安装误差角偏差;δkay为Y轴加速度计的标度因数偏差;ΔKay为Y轴加速度计的标度因数不对称项误差偏差;δkzy为Y轴相对于Z轴的安装误差角偏差;
AaY为Y轴加速度计结构矩阵,具体由公式:
给出,其中
Yay为Y轴的观测向量,具体由公式:
Yay=[abY′(1)-F23(1)abY′(2)-F23(2)…abY′(16)-F23(16)]T
给出;
Z轴的误差系数偏差估计式由公式:
xishu_z=(AaZ TAaZ)-1AaZ TYaz
给出,其中,xishu_z=[δk0z δkaz ΔKaz δkxz δkyz]T,δk0z为Z轴加速度计的零次项偏差;δkaz为Z轴加速度计的标度因数偏差;ΔKaz为Z轴加速度计的标度因数不对称项误差偏差;δkxz为Z轴相对于X轴的安装误差角偏差;δkyz为Z轴相对于Y轴的安装误差角偏差;
AaZ为Z轴加速度计结构矩阵,具体由公式:
给出;
Yaz为Z轴的观测向量,具体由公式:
Yaz=[abZ′(1)-F33(1)abZ′(2)-F33(2)…abZ′(16)-F33(16)]T
给出。
所述步骤(6)中N为大于等于10的自然数。
本发明与现有技术相比的优点如下:
(1)现有的捷联惯性组合加速度计组合标定算法只能在得到精确的水平基准和方位基准才能标定出加速度计的误差系数,限制了标定条件。本发明在基准不确定情况下也能将加速度计组合误差系数进行标定,提高外场标定效率,并提高标定系数的精度;
(2)现有的标定方法测试位置少,包含的测试信息也较少,本发明的方法测试位置多,包含更多的信息,这能够提高标定结果的精度和可靠性;
(3)与现有的标定方法相比,本发明的方法测试耗时少、计算简单,能够快速完成惯性组合加速度计组合的标定。
(4)现有的方法对已经安装在导弹等载体上的惯性组合进行标定时需要先进行拆卸等工作,需要有高精度转台及一些配套的设备,费时费力,本发明的方法惯性组合利用自身的双轴旋转机构便可以实现对加速度计组合误差系数自主标定,不需要依赖任何外界设备及信息。
附图说明
图1为本发明方法的试验过程流程图;
图2为本发明方法的数据处理流程图;
图3为本发明方法的双轴旋转机构及加速度计组合安装轴方向示意图;
图4为本发明方法的俯仰角θ和滚转角γ的误差经过十次迭代后的输出;
图5为本发明方法的一次标定试验中计算出的误差系数的相对误差。
具体实施方式
由于加速度计组合标定前需要高精度的水平基准及方位基准,使用本方法可以降低惯性测量系统标定时基准的精度要求。本发明方法的试验过程流程图如图1所示,数据处理流程图如图2所示,具体步骤如下:
1、将捷联惯性组合安装在双轴旋转机构上,双轴旋转机构如图3所示。调节旋转机构使捷联惯性组合静置于16个不同的位置。双轴旋转机构的安装基准不要求精确已知。且捷联惯性测量系统的16个位置分别为:
位置1:调节旋转机构使捷联惯性组合静止于某一任意位置,记录此时的内框架旋转角α(1)和外框架旋转角β(1);
位置2:调节旋转机构使内框架旋转角度α(2)=α(1)+90°,外框架旋转角度β(2)=β(1);
位置3:调节旋转机构使内框架旋转角度α(3)=α(1)+180°,外框架旋转角度β(3)=β(1);
位置4:调节旋转机构使内框架旋转角度α(4)=α(1)+270°,外框架旋转角度β(4)=β(1);
位置5:调节旋转机构使内框架旋转角度α(5)=α(1),外框架旋转角度β(5)=β(1)+180°;
位置6:调节旋转机构使内框架旋转角度α(6)=α(1)+90°,外框架旋转角度β(6)=β(1)+180°;
位置7:调节旋转机构使内框架旋转角度α(7)=α(1)+180°,外框架旋转角度β(7)=β(1)+180°;
位置8:调节旋转机构使内框架旋转角度α(8)=α(1)+270°,外框架旋转角度β(8)=β(1)+180°;
位置9:调节旋转机构使内框架旋转角度α(9)=α(1)+90°,外框架旋转角度β(9)=β(1)+90°;
位置10:调节旋转机构使内框架旋转角度α(10)=α(1)+270°,外框架旋转角度β(10)=β(1)+90°;
位置11:调节旋转机构使内框架旋转角度α(11)=α(1),外框架旋转角度β(11)=β(1)+90°;
位置12:调节旋转机构使内框架旋转角度α(12)=α(1)+180°,外框架旋转角度β(12)=β(1)+90°;
位置13:调节旋转机构使内框架旋转角度α(13)=α(1)+270°,外框架旋转角度β(13)=β(1)+270°;
位置14:调节旋转机构使内框架旋转角度α(14)=α(1)+90°,外框架旋转角度β(14)=β(1)+270°;
位置15:调节旋转机构使内框架旋转角度α(15)=α(1)+180°,外框架旋转角度β(15)=β(1)+270°;
位置16:调节旋转机构使内框架旋转角度α(16)=α(1),外框架旋转角度β(16)=β(1)+270°。
2、在第i个位置时,采集捷联惯性组合X轴、Y轴、Z轴加速度计经过Δt秒输出的脉冲数Nax(i)、Nay(i)和Naz(i),并且记录该位置双轴旋转机构内外框架的旋转角α(i)和β(i),计算X轴、Y轴、Z轴加速度计的脉冲数输出频率Ax(i)、Ay(i)和Az(i),其中i∈[1,16];所述第i个位置脉冲数输出频率由公式
给出。
3、结合原先多次测量取均值得到的加速度计组合的零次项、标度因数、安装误差角、标度因数不对称项误差,利用十六个位置的加速度计组合的脉冲数输出频率计算各位置经补偿得到的捷联惯性组合X轴、Y轴、Z轴加速度abX′(i)、abY′(i)、abZ′(i)。
其中,为原先多次测量取均值得到的加速度计组合的标度因数不对称项误差;为原先多次测量取均值得到的加速度计组合安装误差角;为原先多次测量取均值得到的加速度计组合的零次项;为原先多次测量取均值得到的加速度计组合标度因数。
4、计算得到捷联惯性组合在第一个位置的初始姿态角,即利用X轴、Y轴、Z轴加速度计组合补偿后得到的加速度abX′(1)、abY′(1)和abZ′(1)计算初始姿态角中的俯仰角θ0和滚转角γ0。
其中g0为测试地点地球重力加速度。
5、根据上面几个步骤得到的十六位置内外框架旋转角,加速度计组合经过补偿后得到的加速度以及第一位置的初始姿态角,计算捷联惯性组合加速度计组合误差模型中的误差系数偏差,包括标度因数偏差、零次项偏差、安装误差角偏差、标度因数不对称项误差偏差、初始姿态角误差,具体计算方法为:
定义X轴加速度计结构矩阵:
其中
F13(i)=-cosα(i)sinγ0 cosθ0+sinα(i)cosβ(i)sinθ0+sinα(i)sinβ(i)cosθ0 cosγ0;
F23(i)=sinα(i)sinγ0 cosθ0+cosα(i)cosβ(i)sinθ0+cosα(i)sinβ(i)cosθ0 cosγ0;
F33(i)=-sinβ(i)sinθ0+cosβ(i)cosθ0 cosγ0;
Δθ为初始姿态角θ0的误差;Δγ为初始姿态角γ0的误差。
定义Y轴加速度计结构矩阵:
其中
定义Z轴加速度计结构矩阵:
定义X轴的观测向量为
Yax=[abX′(1)-F13(1)abX′(2)-F13(2)…abX′(16)-F13(16)]T
定义Y轴的观测向量为
Yay=[abY′(1)-F23(1)abY′(2)-F23(2)…abY′(16)-F23(16)]T
定义Z轴的观测向量为
Yaz=[abZ′(1)-F33(1)abZ′(2)-F33(2)…abZ′(16)-F33(16)]T
X轴的误差系数偏差估计式为:
xishu_x=(AaX TAaX)-1AaX TYax
其中,xishu_x=[δk0x δkax ΔKax δkyx δkzx Δθ Δγ]T,δk0x为X轴加速度计的零次项偏差;δkax为X轴加速度计的标度因数偏差;ΔKax为X轴加速度计的标度因数不对称项误差偏差;δkyx为X轴相对于Y轴的安装误差角偏差;δkzx为X轴相对于Z轴的安装误差角偏差。
Y轴的误差系数偏差估计式为:
xishu_y=(AaY TAaY)-1AaY TYay
其中,xishu_y=[δk0y δkxy δkay ΔKay δkzy Δθ Δγ]T,δk0y为Y轴加速度计的零次项偏差;δkxy为Y轴相对于X轴的安装误差角偏差;δkay为Y轴加速度计的标度因数偏差;ΔKay为Y轴加速度计的标度因数不对称项误差偏差;δkzy为Y轴相对于Z轴的安装误差角偏差。
Z轴的误差系数偏差估计式为:
xishu_z=(AaZ TAaZ)-1AaZ TYaz
其中,xishu_z=[δk0z δkaz ΔKaz δkxz δkyz]T,δk0z为Z轴加速度计的零次项偏差;δkaz为Z轴加速度计的标度因数偏差;ΔKaz为Z轴加速度计的标度因数不对称项误差偏差;δkxz为Z轴相对于X轴的安装误差角偏差;δkyz为Z轴相对于Y轴的安装误差角偏差。
6、令姿态角为初始姿态角与其对应误差之和,代入步骤5中进行重新计算,得到新的姿态角误差。重复10次计算后得到双轴旋转机构在第1位置与地理坐标系间精确的夹角θ和γ,同时可得各误差系数偏差的值。具体计算步骤为:命θ0′=θ0+Δθ,γ0′=γ0+Δγ,使用步骤5中所述的计算步骤再次进行计算,重复九次此操作,此时,θ和γ趋于真实的姿态角。
7、将通过步骤7得到的误差系数偏差与已知的加速度计组合的零次项、标度因数、安装误差角、标度因数不对称项误差对应求和,得到加速度计组合的误差系数精确值,实现基准不确定情况下加速度计组合误差系数标定。误差系数精确值计算方法为:
实际应用中,首先,确定捷联惯性组合的X轴、Y轴、Z轴方向,并在标定前为加速度计组合进行充分预热。然后,调节双轴旋转机构将惯性组合静置于16个不同的位置,并在第i个位置时测量经过Δt秒后三个加速计输出的脉冲个数Ax(i)、Ay(i)和Az(i)。最后,按照公式逐个计算出捷联惯性组合加速度计组合误差模型中所有的误差项系数偏差,从而完成捷联惯性组合加速度计组合的标定。
下面通过利用具体实验对本发明加以说明。
在十六位置中,采集捷联惯性组合X轴、Y轴、Z轴加速度计经过60秒输出的脉冲数Nax(i)、Nay(i)和Naz(i),并记录该位置双轴旋转机构内框架α(i)和外框架旋转角β(i),计算X轴、Y轴、Z轴加速度计的脉冲数输出频率Ax(i)、Ay(i)和Az(i),其中i∈[1,16];结合预先多次测量取均值得到的加速度计组合的零次项、标度因数、标度因数不对称项误差和安装误差角,分别为
将第一个位置的初始俯仰角θ0更新为第一个位置的初始俯仰角θ0与求得的初始俯仰角误差之和,并将第一个位置的初始滚转角γ0更新为第一个位置的初始滚转角γ0与求得的初始滚转角误差之和,重复计算10次,俯仰角θ和滚转角γ的误差经过十次迭代后的输出如图4所示,从图4可知,经过迭代以后,俯仰角θ和滚转角γ的误差基本稳定,处于10-5量级,且均趋于0;
最终计算得到误差系数的相对误差如图5所示,可以看出,大部分标定结果的误差均趋于0,最大标定误差的绝对值小于4*10-3,标定结果非常可靠。
本发明可应用于对安装在双轴旋转机构上的惯性组合加速度计组合误差系数进行标定的场合。
以上所描述的标定方法只是本发明的一种情况,本领域技术人员可以根据不同的要求和参数在不偏离本发明的情况下进行各种增补、改进和更换,因此,本发明是广泛的。
本发明未详细描述内容为本领域技术人员公知技术。
Claims (7)
1.一种基准不确定情况下加速度计组合误差系数标定方法,其特征在于步骤如下:
(1)将捷联惯性组合安装在双轴旋转机构上,调节双轴旋转机构的内框架旋转角度和外框架旋转角度,使得捷联惯性组合静置于16个不同的位置;
(2)在步骤(1)中确定的位置i,采集捷联惯性组合X轴、Y轴、Z轴加速度计经过Δt秒输出的脉冲数Nax(i)、Nay(i)和Naz(i),并记录该位置双轴旋转机构内框架α(i)和外框架旋转角β(i),计算X轴、Y轴、Z轴加速度计的脉冲数输出频率Ax(i)、Ay(i)和Az(i),其中i∈[1,16],Δt∈[60,90];
(3)结合预先多次测量取均值得到的加速度计组合的零次项、标度因数、安装误差角和标度因数不对称项误差,利用步骤(2)中得到的16个位置加速度计组合的脉冲数输出频率,计算各位置经补偿得到的捷联惯性组合X轴、Y轴、Z轴加速度abX′(i)、abY′(i)、abZ′(i);
(4)利用步骤(3)第一个位置经补偿得到的捷联惯性组合X轴、Y轴、Z轴加速度,计算得到捷联惯性组合在第一个位置的初始俯仰角θ0和初始滚转角γ0;
(5)根据步骤(2)中16个位置双轴旋转机构内框架α(i)和外框架旋转角β(i),步骤(3)中加速度计组合经过补偿后得到的捷联惯性组合X轴、Y轴、Z轴加速度,以及第一个位置的初始俯仰角θ0和初始滚转角γ0,计算捷联惯性组合加速度计组合误差模型中的误差系数偏差,包括标度因数偏差、零次项偏差、安装误差角偏差、标度因数不对称项误差偏差、初始俯仰角误差、滚转角误差;
(6)将第一个位置的初始俯仰角θ0更新为第一个位置的初始俯仰角θ0与步骤(5)中求得的初始俯仰角误差之和,并将第一个位置的初始滚转角γ0更新为第一个位置的初始滚转角γ0与步骤(5)中求得的初始滚转角误差之和,重复执行步骤(5)~步骤(6)N次,得到双轴旋转机构在第一个位置与地理坐标系间的夹角θ和γ,同时得到捷联惯性组合加速度计组合误差模型中的误差系数偏差;
(7)将通过步骤(6)得到的误差系数偏差与已知的加速度计组合的零次项、标度因数、安装误差角、标度因数不对称项误差对应求和,得到加速度计组合的误差系数精确值,实现基准不确定情况下加速度计组合误差系数标定。
2.根据权利要求1所述的一种基准不确定情况下加速度计组合误差系数标定方法,其特征在于:所述步骤(1)中将捷联惯性组合安装在双轴旋转机构上,调节双轴旋转机构的内框架旋转角度和外框架旋转角度,使得捷联惯性组合静置于16个不同的位置,具体为:
位置1:调节旋转机构使捷联惯性组合静止于任意一个位置,记录此时的内框架旋转角α(1)和外框架旋转角β(1);
位置2:调节旋转机构使内框架旋转角度α(2)=α(1)+90°,外框架旋转角度β(2)=β(1);
位置3:调节旋转机构使内框架旋转角度α(3)=α(1)+180°,外框架旋转角度β(3)=β(1);
位置4:调节旋转机构使内框架旋转角度α(4)=α(1)+270°,外框架旋转角度β(4)=β(1);
位置5:调节旋转机构使内框架旋转角度α(5)=α(1),外框架旋转角度β(5)=β(1)+180°;
位置6:调节旋转机构使内框架旋转角度α(6)=α(1)+90°,外框架旋转角度β(6)=β(1)+180°;
位置7:调节旋转机构使内框架旋转角度α(7)=α(1)+180°,外框架旋转角度β(7)=β(1)+180°;
位置8:调节旋转机构使内框架旋转角度α(8)=α(1)+270°,外框架旋转角度β(8)=β(1)+180°;
位置9:调节旋转机构使内框架旋转角度α(9)=α(1)+90°,外框架旋转角度β(9)=β(1)+90°;
位置10:调节旋转机构使内框架旋转角度α(10)=α(1)+270°,外框架旋转角度β(10)=β(1)+90°;
位置11:调节旋转机构使内框架旋转角度α(11)=α(1),外框架旋转角度β(11)=β(1)+90°;
位置12:调节旋转机构使内框架旋转角度α(12)=α(1)+180°,外框架旋转角度β(12)=β(1)+90°;
位置13:调节旋转机构使内框架旋转角度α(13)=α(1)+270°,外框架旋转角度β(13)=β(1)+270°;
位置14:调节旋转机构使内框架旋转角度α(14)=α(1)+90°,外框架旋转角度β(14)=β(1)+270°;
位置15:调节旋转机构使内框架旋转角度α(15)=α(1)+180°,外框架旋转角度β(15)=β(1)+270°;
位置16:调节旋转机构使内框架旋转角度α(16)=α(1),外框架旋转角度β(16)=β(1)+270°。
3.根据权利要求1所述的一种基准不确定情况下加速度计组合误差系数标定方法,其特征在于:所述步骤(2)中第i个位置脉冲数输出频率由公式
给出。
4.根据权利要求1所述的一种基准不确定情况下加速度计组合误差系数标定方法,其特征在于:所述步骤(3)中各位置经补偿得到的捷联惯性组合X轴、Y轴、Z轴加速度abX′(i)、abY′(i)、abZ′(i),具体由公式:
给出,其中,为预先多次测量取均值得到的加速度计组合的标度因数不对称项误差;为预先多次测量取均值得到的加速度计组合安装误差角;为预先多次测量取均值得到的加速度计组合的零次项;为预先多次测量取均值得到的加速度计组合标度因数。
5.根据权利要求1所述的一种基准不确定情况下加速度计组合误差系数标定方法,其特征在于:所述步骤(4)中捷联惯性组合在第一个位置的初始俯仰角θ0和初始滚转角γ0;具体由公式:
给出,其中abX′(1)、abY′(1)和abZ′(1)分别为第一个位置经补偿得到的捷联惯性组合X轴、Y轴、Z轴加速度,g0为测试地点地球重力加速度。
6.根据权利要求1所述的一种基准不确定情况下加速度计组合误差系数标定方法,其特征在于:所述步骤(5)中计算捷联惯性组合加速度计组合误差模型中的误差系数偏差,具体为:
X轴的误差系数偏差估计式由公式:
xishu_x=(AaX TAaX)-1AaX TYax
给出,其中,xishu_x=[δk0x δkax ΔKax δkyx δkzx Δθ Δγ]T,δk0x为X轴加速度计的零次项偏差;δkax为X轴加速度计的标度因数偏差;ΔKax为X轴加速度计的标度因数不对称项误差偏差;δkyx为X轴相对于Y轴的安装误差角偏差;δkzx为X轴相对于Z轴的安装误差角偏差,
AaX为X轴加速度计结构矩阵,由公式:
给出,其中:
F13(i)=-cosα(i)sinγ0cosθ0+sinα(i)cosβ(i)sinθ0+sinα(i)sinβ(i)cosθ0cosγ0;
F23(i)=sinα(i)sinγ0cosθ0+cosα(i)cosβ(i)sinθ0+cosα(i)sinβ(i)cosθ0cosγ0;
F33(i)=-sinβ(i)sinθ0+cosβ(i)cosθ0cosγ0;
g0为测试地点地球重力加速度;
Yax为X轴的观测向量,具体由公式:
Yax=[abX′(1)-F13(1) abX′(2)-F13(2) … abX′(16)-F13(16)]T
给出;
Y轴的误差系数偏差估计式由公式:
xishu_y=(AaY TAaY)-1AaY TYay
给出,其中,xishu_y=[δk0y δkxy δkay ΔKay δkzy Δθ Δγ]T,δk0y为Y轴加速度计的零次项偏差;δkxy为Y轴相对于X轴的安装误差角偏差;δkay为Y轴加速度计的标度因数偏差;ΔKay为Y轴加速度计的标度因数不对称项误差偏差;δkzy为Y轴相对于Z轴的安装误差角偏差;
AaY为Y轴加速度计结构矩阵,具体由公式:
给出,其中
Yay为Y轴的观测向量,具体由公式:
Yay=[abY′(1)-F23(1) abY′(2)-F23(2) … abY′(16)-F23(16)]T
给出;
Z轴的误差系数偏差估计式由公式:
xishu_z=(AaZ TAaZ)-1AaZ TYaz
给出,其中,xishu_z=[δk0z δkaz ΔKaz δkxz δkyz]T,δk0z为Z轴加速度计的零次项偏差;δkaz为Z轴加速度计的标度因数偏差;ΔKaz为Z轴加速度计的标度因数不对称项误差偏差;δkxz为Z轴相对于X轴的安装误差角偏差;δkyz为Z轴相对于Y轴的安装误差角偏差;
AaZ为Z轴加速度计结构矩阵,具体由公式:
给出;
Yaz为Z轴的观测向量,具体由公式:
Yaz=[abZ′(1)-F33(1) abZ′(2)-F33(2) … abZ′(16)-F33(16)]T
给出。
7.根据权利要求1所述的一种基准不确定情况下加速度计组合误差系数标定方法,其特征在于:所述步骤(6)中N为大于等于10的自然数。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201410746311.2A CN104501833B (zh) | 2014-12-08 | 2014-12-08 | 一种基准不确定情况下加速度计组合误差系数标定方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201410746311.2A CN104501833B (zh) | 2014-12-08 | 2014-12-08 | 一种基准不确定情况下加速度计组合误差系数标定方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN104501833A true CN104501833A (zh) | 2015-04-08 |
CN104501833B CN104501833B (zh) | 2017-07-07 |
Family
ID=52943259
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201410746311.2A Active CN104501833B (zh) | 2014-12-08 | 2014-12-08 | 一种基准不确定情况下加速度计组合误差系数标定方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN104501833B (zh) |
Cited By (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN106705992A (zh) * | 2015-11-12 | 2017-05-24 | 北京自动化控制设备研究所 | 一种双轴光纤惯导系统快速自标定自对准方法 |
CN108982918A (zh) * | 2018-07-27 | 2018-12-11 | 北京航天控制仪器研究所 | 基准不确定情况下加速度计组合误差系数分离与标定方法 |
CN109029502A (zh) * | 2018-07-27 | 2018-12-18 | 北京航天控制仪器研究所 | 一种惯性平台系统石英加速度计输出值确定方法 |
CN110988400A (zh) * | 2019-12-11 | 2020-04-10 | 北京自动化控制设备研究所 | 一种mems加速度计组合标定方法及标定装置 |
Citations (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN101907638A (zh) * | 2010-06-11 | 2010-12-08 | 北京航空航天大学 | 一种无依托状态下加速度计的标定方法 |
US20110264393A1 (en) * | 2010-04-27 | 2011-10-27 | Dong An | System and method for calibrating a three-axis accelerometer |
CN103868527A (zh) * | 2014-02-28 | 2014-06-18 | 北京航天控制仪器研究所 | 一种标定捷联惯性组合加速度计组合的方法 |
-
2014
- 2014-12-08 CN CN201410746311.2A patent/CN104501833B/zh active Active
Patent Citations (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US20110264393A1 (en) * | 2010-04-27 | 2011-10-27 | Dong An | System and method for calibrating a three-axis accelerometer |
CN101907638A (zh) * | 2010-06-11 | 2010-12-08 | 北京航空航天大学 | 一种无依托状态下加速度计的标定方法 |
CN103868527A (zh) * | 2014-02-28 | 2014-06-18 | 北京航天控制仪器研究所 | 一种标定捷联惯性组合加速度计组合的方法 |
Non-Patent Citations (1)
Title |
---|
刘璠 等,: ""捷联惯性组合误差模型相关性分析方法"", 《中国惯性技术学报》 * |
Cited By (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN106705992A (zh) * | 2015-11-12 | 2017-05-24 | 北京自动化控制设备研究所 | 一种双轴光纤惯导系统快速自标定自对准方法 |
CN106705992B (zh) * | 2015-11-12 | 2020-08-21 | 北京自动化控制设备研究所 | 一种双轴光纤惯导系统快速自标定自对准方法 |
CN108982918A (zh) * | 2018-07-27 | 2018-12-11 | 北京航天控制仪器研究所 | 基准不确定情况下加速度计组合误差系数分离与标定方法 |
CN109029502A (zh) * | 2018-07-27 | 2018-12-18 | 北京航天控制仪器研究所 | 一种惯性平台系统石英加速度计输出值确定方法 |
CN109029502B (zh) * | 2018-07-27 | 2020-07-14 | 北京航天控制仪器研究所 | 一种惯性平台系统石英加速度计输出值确定方法 |
CN110988400A (zh) * | 2019-12-11 | 2020-04-10 | 北京自动化控制设备研究所 | 一种mems加速度计组合标定方法及标定装置 |
Also Published As
Publication number | Publication date |
---|---|
CN104501833B (zh) | 2017-07-07 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN106289246B (zh) | 一种基于位置和姿态测量系统的柔性杆臂测量方法 | |
CN103808331B (zh) | 一种mems三轴陀螺仪误差标定方法 | |
CN101290326B (zh) | 石英挠性加速度计测量组件的参数辨识标定方法 | |
US6876926B2 (en) | Method and system for processing pulse signals within an inertial navigation system | |
CN100516775C (zh) | 一种捷联惯性导航系统初始姿态确定方法 | |
CN104596543B (zh) | 一种基准不确定情况下陀螺仪组合误差系数标定方法 | |
CN101887068B (zh) | 三轴矢量传感器及两轴矢量传感器的标定补偿方法 | |
CN107655493B (zh) | 一种光纤陀螺sins六位置系统级标定方法 | |
CN103235328B (zh) | 一种gnss与mems组合导航的方法 | |
CN106969783B (zh) | 一种基于光纤陀螺惯性导航的单轴旋转快速标定技术 | |
EP2361369B1 (en) | Signal processing module, navigation device with the signal processing module, vehicle provided with a navigation device and method of providing navigation data | |
CN103630146B (zh) | 一种离散解析与Kalman滤波结合的激光陀螺IMU标定方法 | |
CN102486377A (zh) | 一种光纤陀螺捷联惯导系统初始航向的姿态获取方法 | |
CN103323625B (zh) | 一种mems-imu中加速度计动态环境下的误差标定补偿方法 | |
CN103453917A (zh) | 一种双轴旋转式捷联惯导系统初始对准与自标校方法 | |
CN103616035B (zh) | 一种激光捷联惯导系统性能参数标定方法 | |
CN102288133B (zh) | 一种陀螺间接稳定系统安装偏角标定方法 | |
CN102052921B (zh) | 一种单轴旋转捷联惯导系统初始航向的确定方法 | |
CN104501833B (zh) | 一种基准不确定情况下加速度计组合误差系数标定方法 | |
CN103697911A (zh) | 一种纬度未知情形下的捷联惯导系统初始姿态确定方法 | |
CN111189474A (zh) | 基于mems的marg传感器的自主校准方法 | |
CN105606093B (zh) | 基于重力实时补偿的惯性导航方法及装置 | |
CN105043414A (zh) | 一种三轴惯性稳定平台系统的台体控制参数计算方法 | |
Wu et al. | The calibration for inner and outer lever-arm errors based on velocity differences of two RINSs | |
JPH04231813A (ja) | 角度および角度特性曲線の測定方法 |
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 |