CN104121928A - 一种适用于低精度有方位基准单轴转位设备的惯性测量单元标定方法 - Google Patents
一种适用于低精度有方位基准单轴转位设备的惯性测量单元标定方法 Download PDFInfo
- Publication number
- CN104121928A CN104121928A CN201410232438.2A CN201410232438A CN104121928A CN 104121928 A CN104121928 A CN 104121928A CN 201410232438 A CN201410232438 A CN 201410232438A CN 104121928 A CN104121928 A CN 104121928A
- Authority
- CN
- China
- Prior art keywords
- error
- omega
- axis
- measurement unit
- inertial measurement
- 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
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
本发明公开了适用于低精度有方位基准单轴转位设备的惯性测量单元标定方法,属于惯性技术领域。该方法使用低精度单轴转位设备,共旋转编排五个位置,以各位置的速度误差和天向姿态误差拟合出一阶中间参数Δg和二阶中间参数依据中间参数与误差参数的关系以及最近的历史标定参数,由最小二乘法算出各器件误差参数,为了有效消除由转台引起的定位误差,将前一次迭代计算得到的误差参数和原有的惯性测量单元输出数据代入到导航方程,再进行一次观测量、中间参数和误差参数残差的解算,然后对误差参数进行残差补偿。依此类推,直至迭代计算得到的误差参数残差小于阈值。该方法大幅降低标定成本及标定对转台精度的依赖性,缩短标定时间,具有工程实用性。
Description
技术领域
本发明属于航空航天捷联惯性导航技术中的惯性测量组合测试技术领域,具体涉及一种适用于低精度有方位基准单轴转位设备的惯性测量单元标定方法,可用于对惯性测量组合部分参数的标定。
背景技术
捷联惯性导航系统具有反应时间短、可靠性高、体积小、重量轻等优点,广泛应用于飞机、舰船、导弹等军用和民用导航领域,具有重要的国防意义和巨大的经济效益。
惯性测量组合是捷联惯性导航系统的核心部件,主要由3个加速度计和3个陀螺组成。
标定技术是惯性导航领域的核心技术之一,是一种对误差的辨识技术,即建立惯性器件和惯导系统的误差模型,通过一系列的试验求解出误差模型中的误差项,进而通过软件算法对误差进行补偿。惯性测量组合的标定结果好坏直接影响捷联惯性导航系统的精度。
惯性测量组合标定方法按层次可分为分立式标定和系统级标定两种。当前分立式标定方法的研究已经非常成熟,而系统级标定方法是由20世纪80年代发展起来的,目前正成为标定技术研究的热点。
分立标定方法是根据陀螺和加速度计的误差模型,利用三轴转台提供的精确速率、姿态和位置,采集惯性测量组合的输出,然后利用最小二乘法辨识误差模型系数。然而分立式标定过分依赖转台的精度,当转台精度不高时,标定结果不理想。
系统级标定是建立捷联惯导系统导航输出误差与惯性器件误差参数之间的关系,充分考虑惯性器件误差系数的可辨识性,合理安排实验位置,进而辨识出惯性器件的各项误差系数。该方法可以大幅减小甚至克服标定对转台精度的依赖,适合现场标定使用。
早在上世纪80-90年代,国外的系统级标定方法就已经在工程中得到了推广应用。国内的相关研究起步较晚,近年随着捷联惯导技术的成熟度不断提高,国内也出现了很多介绍系统级标定的文献和资料,但大多数停留在理论研究和仿真验证的阶段。在公开的文献和资料中,国内一般采用低精度的三轴或双轴转台,在引北的条件下在实验室内进行系统级标定,但大多数停留在理论研究和仿真验证的阶段,缺乏工程实用性。尚未有发现单轴系统级标定算法的相关资料。
发明内容
本发明提供一种适用于低精度有方位基准单轴转位设备的惯性测量单元标定方法,与国内外其他系统级标定方法相比,该标定方法适用于低精度有方位基准单轴转位设备,可以大幅降低标定对转台精度的依赖性,具有很好的工程实用性。
本发明适用于低精度有方位基准单轴转位设备的惯性测量单元标定方法,包含如下步骤:
步骤一:将惯性测量单元安装在单轴转位设备上,惯性测量单元初始位置朝向为下-东-南,惯性测量单元通电预热后开始采集输出的原始数据,惯性测量单元先在第0个位置上静止3-5分钟,再转动到第1个位置静止3-5分钟,随后转动到第2个位置,依此类推,直至在第4个位置上静止3-5分钟后停止采集惯性测量单元输出的原始数据;
步骤二:利用步骤一采集的惯性测量单元数据,在第0位置上利用重力加速度和加速度计输出数据确定出惯性测量单元的水平姿态, 并将第0位置上惯性测量单元的导航起始时刻的天向转角直接设为0,进而得到首位置的初始对准结果具体计算公式如下:
其中,
c12=(c31c23-c21c22c11)/(1-c21 2),
c13=-(c31c22+c11c21c23)/(1-c21 2),
c32=-(c11c23+c21c22c31)/(1-c21 2),
c33=(c11c22+c21c31c23)/(1-c21 2),
式中,fx b、fy b和fz b分别为加速度计测得的比力fb在载体坐标系x轴、y轴和z轴上的投影;
然后利用对准结果和第0位置上的采集数据进行导航解算,进而得到第0位置上导航过程中的实时速度以及实时天向转角设第0位置上导航起始时刻的速度均为0,以速度和天向转角为观测结果拟合出第0位置上的和一阶中间参数所述包含和所述和分别为第0位置上的参数在x轴、y轴和z轴上投影的标量,所述包含和所述和分别为第0位置上的一阶中间参数在x轴、y轴和z轴上投影的标量;
步骤三:根据步骤一采集的第i个位置上的惯性测量单元原始数据,i=1,2,3,4,利用重力加速度和加速度计输出确定出惯性测量单元 在第i位置上的水平姿态,而第i位置上惯性测量单元的天向转角θn(i)由第i-1位置上的天向转角θn(i-1)及第i-1位置到第i个位置转动过程中的陀螺输出确定,利用以上各位置的对准结果以及由步骤二得到的第0位置的对准结果,在第i-1个位置到第i个位置的转动过程中以及第i个位置上的静止过程中进行连续导航,通过导航获取转动到达第i个位置瞬间的速度和天向转角以及转动完成后在第i个位置静止过程中的速度和天向转角
式中:g是重力加速度,T是实时时间,
ωvx、ωvy和ωvz分别为系数ωv在x轴、y轴和z轴上的分量,
以速度和天向转角为观测,拟合出第i位置上的和一阶中间参数其中,i=1,2,3,4,所述包含和包含 和所述和分别为第i位置上的参数在x轴、y轴和z轴上投影的标量,所述和分别为第i位置上的一阶中间参数在x轴、y轴和z轴上投影的标量;
步骤四:在惯性测量单元坐标系内,加速度计的误差模型为:
上述误差模型的向量形式为:
其中,
fb为载体坐标系下加速度计测得的比力,
fx b、fy b和fz b分别为fb在x轴、y轴和z轴上的投影,
为载体坐标系下的加速度计零偏,
Ka包括加速度计标度因数误差和加速度计失准角,
Ka2为加速度计二次项系数,
δfb为载体坐标系下加速度计测得的比力误差;
陀螺的误差模型为:
上述误差模型的向量形式为:
其中,
ωb为载体坐标系下陀螺测得的角速度,
为载体坐标系下陀螺零偏,
Kg包括陀螺标度因数误差和陀螺失准角,
εb为载体坐标系下陀螺测得的角速度误差;
然后将加速度计零偏Bax、Bay、Baz,加速度计标度因数Kaxx、Kayy、Kazz,加速度计失准角Kayx、Kazx、Kazy,加速度计二次项系数Kax2、Kay2、Kaz2,陀螺正向标度因数陀螺负向标度因数陀螺失准角Kgxy、Kgxz、Kgyx、Kgyz、Kgzx、Kgzy共计24个误差参数记为一阶误差参数K,其中,Bax、Bay、Baz分别为加速度计零偏Ba在x轴、y轴和z轴上投影的标量;
在每个位置上,依据Δg与一阶误差参数K的关系,利用步骤二得到的构建方程用步骤三中的构建方程 其中,i=1,2,3,4,均可得到一个方程将以上方程联立得到如下方程组:
最终构建如下方程:
Δg=AK
步骤五:根据一阶中间参数与一阶误差参数的关系式,设A=[a1 a2 … an]、K=[k1 k2 … kn]T,其中,ai为矩阵A的列向量,i=1,2…n,ki为向量K的各元素,i=1,2…n,[k1 k2 … kn]T为行向量[k1 k2 … kn]的转置,
K中包含Bay、Kayy、Kazy、Kax2、Kay2、Kaz2、Kgxy、Kgxz、Kgyx、Kgyz、Kgzx的15个误差参数直接由最近一次的完整标定结果给出,这些由外部给出的误差参数在向量K中的序号为el,l=1,2,…,ne,其余参与标定计算的误差参数在向量K中的序号为cj,j=1,2,…,nc,且nc+ne=n;然后将矩阵A中所有序号非cj的列置为零后形成的矩阵设为Acal,j=1,2,…,nc,将矩阵A中所有序号非el的列置为零后形成的矩阵设为Aext,l=1,2,…,ne,将向量K中所有序号非cj的元素置为零后形成的向量设为Kcal,j=1,2,…,nc,将向量K中所有序号非el的元素置为零后形成的向量设为Kext,l=1,2,…,ne,则Δg=AK可以记为:
然后将Acal去掉元素全为零的行和列得到Acalnz,并记下这些行和列的序号,接着求Acalnz的最小二乘逆矩阵并对扩充元 素全为零的行和列得到其中,扩充的行序号与Acal中全为零的列序号相同,列序号与Acal中全为零的行序号相同,
由下式求解参与标定的误差参数:
计算得到Kcal,其中,参与标定计算的误差参数序号上元素为相应的标定计算值,外部给出的误差参数序号上元素全为零,将Kcal与外部给出的Kext相加得到一阶误差参数K;
步骤六:利用步骤五计算出的K求解每个静止位置i对应的补偿分量其中i=0,1,2,3,4,计算方法如下:
其中:
为系数ωv为降低与误差参数耦合度而需剔除的系数,ωv为步骤三中的系数,
为上式中矩阵的第i列,其中,i=1,2,3,4,5,
L为纬度,
Ω为地球自转角速率,
K为一阶误差参数,
和分别为常数矩阵;
接着通过步骤二中的及步骤三中的计算出每个静止位置上的二阶中间参数其中,步骤三中的 中i=1,2,3,4,二阶中间参数求值公式中i=0,1,2,3,4;
步骤七:将各二阶误差参数:陀螺零偏Bgx、Bgy、Bgz及首个位置上的北向方位角误差记为列向量ω,依据二阶中间参数和二阶误差参数ω之间的关系,利用步骤五中构建 方程其中i=0,1,2,3,4,
将以上方程联立得到如下方程:
步骤八:根据二阶中间参数与二阶误差参数的关系式,设B=[b1 b2 … bn]、ω=[ω1 ω2 … ωn]T,其中,bi为矩阵B的列向量,i=1,2…n,ωi为向量ω的各元素,i=1,2…n,ω=[ω1 ω2 … ωn]T为行向量[ω1 ω2 … ωn]的转置,
ω中首个位置上的北向方位角误差直接由最近一次的完整标定结果给出,这些由外部给出的误差参数在向量ω中的序号为el,l=1,2,…,ne,其余参与标定计算的误差参数在向量ω中的序号为cj,j=1,2,…,nc且nc+ne=n;然后将矩阵B中所有序号非cj的列置为零后形成的矩阵设为Bcal,j=1,2,…,nc,将矩阵B中所有序号非el的列置为零后形成的矩阵设为Bext,l=1,2,…,ne,将向量ω中所有序号非cj的元素置为零后形成的向量设为ωcal,j=1,2,…,nc,将向量ω中所有序号非el的元素置为零后形成的向量设为ωext,l=1,2,…,ne,则可以记为:
然后将Bcal去掉元素全为零的行和列得到Bcalnz,并记下这些行和列的序号;接着求Bcalnz的最小二乘逆矩阵并对扩充元素全为零的行和列得到其中,扩充的行序号与Bcal中全为零的列序号相同,列序号与Bcal中全为零的行序号相同,
由下式求解参与标定的误差参数:
计算得到ωcal,其中,参与标定计算的误差参数序号上元素为相应的标定计算值,外部给出的误差参数序号上元素全为零,将ωcal与外部给出的ωext相加得到一阶误差参数ω;
步骤九:当一阶误差参数K和二阶误差参数ω的残差大于阈值时,用一阶误差参数K和二阶误差参数ω残差补偿前次标定的误差参数。然后将得到的一阶误差参数K和二阶误差参数ω以及步骤一中采集的惯性测量单元输出数据代入到导航方程中,再进行一次一阶中间参数Δg、二阶中间参数一阶误差参数K和二阶误差参数ω残差的解算,然后对一阶误差参数K和二阶误差参数ω进行残差补偿。依此类推,经过多次迭代直至某一次迭代计算得到的一阶误差参数K和二阶误差参数ω残差小于阈值。
在上述技术方案中,在步骤一中,标定旋转顺序如下表所示:
标定旋转顺序
旋转序号 | 旋转过程 |
1 | -90Y |
2 | -90Y |
3 | 270Y |
4 | -90Y |
在上述技术方案中,惯性测量单元坐标系是:X轴与X加速度计输入轴方向相同,Y轴位于X加速度计和Y加速度计输入轴构成的平面内,接近Y加速度计输入轴方向,Z轴方向由右手定则确定。
在上述技术方案中,在步骤三中,由第i-1位置上的天向转角θn(i-1)及第i-1位置到第i个位置转动过程中的陀螺输出通过四阶定 时增量算法确定第i位置上惯性测量单元的天向转角θn(i)。
在上述技术方案中,在步骤一中,所述的惯性测量单元通电预热时间为30分钟,原始数据的采样周期为0.01s。
在上述技术方案中,在步骤一中,停止采集惯性测量单元输出的原始数据后关闭惯性测量单元。
本方法原理描述如下:
标定方法利用采集的原始数据,在第i(i=0,1,2,3)位置上进行初始对准,然后在第i个位置到第i+1个位置的转动过程中以及第i+1个位置上的静止过程中进行连续导航。在每个静止位置上,天向的速度误差和姿态误差呈线性增长,水平方向的速度误差呈二次曲线增长。又在静止位置上,真实的速度和绕天向的转角为0,因此导航计算得到的速度增量即为速度误差增量,绕天向的转角增量即为天向的姿态误差增量。由此,可以将其作为观测量,按下式对第i个静止位置上导航计算得到的速度和天向转角进行拟合,即:
式中:
为到达静止位置瞬间的速度(带圆括号的上标i表示第i个位置,下同);
为到达静止位置瞬间的天向转角。
上式中的各个系数与误差参数相关,将Δg(包含Δgx、Δgy、Δgz)等系数称为一阶中间参数,它们与加速度计误差参数、陀螺的标度因数误差和失准角相关,加速度计误差参数、陀螺的标度因数误差和失 准角又称为一阶误差参数。为降低系数ωv(包含ωvx、ωvy、ωvz)与误差参数的耦合度,将其分解为和两个分量,称为二阶中间参数,它与陀螺的零偏误差相关,称后者为二阶误差参数。
具体来说,以各个位置上的速度误差和天向姿态误差拟合出一阶中间参数构成的列向量Δg以及二阶中间参数构成的列向量然后依据中间参数与误差参数的关系,由最小二乘法计算出各个器件误差参数。设各一阶误差参数构成列向量K,各二阶误差参数构成列向量ω。可以用矩阵形式将其关系表示为:
Δg=AK
为了有效消除由转台引起的定位误差,可将计算得到的误差参数K、ω以及采集的惯性测量单元原始数据代入到导航方程中,再进行一次观测量、中间参数和误差参数残差的解算,然后对误差参数进行残差补偿。依此类推,经过多次迭代直至某一次迭代计算得到的误差参数残差小于一定的阈值为止。
本发明适用于低精度有方位基准单轴转位设备的惯性测量单元标定方法的有益效果在于:
(1)由于该标定方法的标定旋转编排了5个位置,适用于低精度单轴转位设备,不需要高精度三轴或双轴转台,并可在给定历史标定参数的条件下经过多次迭代运算求解出部分所需标定的参数(这是考虑到部分惯性测量单元误差参数的长期稳定性较好,或者该部分惯性测量单元误差参数对惯性导航精度影响较小,采用单轴转位设备标定惯性测量单元主要的误差参数是可取的),大幅度降低了标定成本,缩短了标定时间。
(2)该标定方法采用迭代算法,采集的惯测组合原始数据可以重复利用,不仅减少了标定时间,还大幅降低了标定对转台精度的依赖性。另外,相对于双轴转位设备而言,本发明不仅对器材和采集的 原始数据要求低,而且单轴转位设备费用较低,大幅度降低了标定成本,意义重大。
附图说明
图1为本发明适用于低精度有方位基准单轴转位设备的惯性测量单元标定方法的流程图。
具体实施方式
下面结合附图和实施例对本发明作进一步详细说明。
本发明提供一种适用于低精度有方位基准单轴转位设备的惯性测量单元标定方法,具体标定步骤如下:
步骤一:将惯性测量单元安装在单轴转位设备上,惯性测量单元初始位置朝向为下-东-南,导航坐标系选取北天东(N-U-E,North-Up-East)坐标系,惯性测量单元通电预热30分钟后开始采集输出的原始数据,标定位置编排如表1所示:惯性测量单元先在第0个位置上静止3-5分钟后,再转动到第1个位置静止3-5分钟,随后转动到第2个位置,依此类推,直至在第4个位置上静止3-5分钟后停止采集惯性测量单元输出的原始数据并关闭惯性测量单元,原始数据的采样周期为0.01s。
表1标定旋转顺序
旋转序号 | 旋转过程 |
1 | -90Y |
2 | -90Y |
3 | 270Y |
4 | -90Y |
步骤二:利用步骤一采集的惯性测量单元数据,在第0位置上利用重力加速度和加速度计输出数据确定出惯性测量单元的水平姿态,并将第0位置上惯性测量单元的导航起始时刻的天向转角直接设 为0,进而得到首位置的初始对准结果具体计算公式如下:
其中,
c12=(c31c23-c21c22c11)/(1-c21 2),
c13=-(c31c22+c11c21c23)/(1-c21 2),
c32=-(c11c23+c21c22c31)/(1-c21 2),
c33=(c11c22+c21c31c23)/(1-c21 2),
式中,fx b、fy b和fz b分别为加速度计测得的比力fb在载体坐标系x轴、y轴和z轴上的投影;
然后利用上述对准结果和第0位置上的采集数据进行导航解算,进而得到第0位置上导航过程中的实时速度以及实时天向转角设第0位置上导航起始时刻的速度均为0,以速度和天向转角为观测结果拟合出第0位置上的和一阶中间参数所述包含和所述和分别为第0位置上的参数在x轴、y轴和z轴上投影的标量,所述包含和所述和分别为第0位置上的一阶中间参数在x轴、y轴和z轴上投影的标量。
步骤三:根据步骤一采集的第i个位置上的惯性测量单元原始数据,i=1,2,3,4,利用重力加速度和加速度计输出确定出惯性测量单元在第i位置上的水平姿态,而第i位置上惯性测量单元的天向转角θn(i) 由第i-1位置上的天向转角θn(i-1)及第i-1位置到第i个位置转动过程中的陀螺输出通过四阶定时增量算法确定;
利用以上各位置的对准结果以及直接由步骤二得到第0位置的对准结果,在第i-1个位置到第i个位置的转动过程中以及第i个位置上的静止过程中进行连续导航,通过导航获取转动到达第i个位置瞬间的速度和天向转角以及转动完成后在第i个位置静止过程中的速度和天向转角
式中:g是重力加速度,T是实时时间,
ωvx、ωvy和ωvz分别为系数ωv在x轴、y轴和z轴上的分量,
以速度和天向转角为观测,拟合出第i位置上的和一阶中间参数其中,i=1,2,3,4,所述包含和包含 和所述和分别为第i位置上的参数在x轴、y轴和z轴上投影的标量,所述和分别为第i位置上的一阶中间参数在x轴、y轴和z轴上投影的标量。
步骤四:惯性测量单元坐标系是:X轴与X加速度计输入轴方向相同,Y轴位于X加速度计和Y加速度计输入轴构成的平面内,接近Y加速度计输入轴方向,Z轴方向由右手定则确定;
在此坐标系内,加速度计的误差模型为:
上述误差模型的向量形式为:
其中,
fb为载体坐标系下加速度计测得的比力,
fx b、fy b和fz b分别为fb在x轴、y轴和z轴上的投影,
为载体坐标系下的加速度计零偏,
Ka包括加速度计标度因数误差和加速度计失准角,
Ka2为加速度计二次项系数,
δfb为载体坐标系下加速度计测得的比力误差;
陀螺的误差模型为:
上述误差模型的向量形式为:
其中,
ωb为载体坐标系下陀螺测得的角速度,
为载体坐标系下陀螺零偏,
Kg包括陀螺标度因数误差和陀螺失准角,
εb为载体坐标系下陀螺测得的角速度误差;
然后将各一阶误差参数:加速度计零偏Bax、Bay、Baz,加速度计标度因数Kaxx、Kayy、Kazz,加速度计失准角Kayx、Kazx、Kazy,加速度计二次项系数Kax2、Kay2、Kaz2,陀螺正向标度因数陀螺负向标度因数 陀螺失准角Kgxy、Kgxz、Kgyx、Kgyz、Kgzx、Kgzy共计24误差参数,记为列向量K,其中,Bax、Bay、Baz分别为加 速度计零偏Ba在x轴、y轴和z轴上投影的标量;
在每个位置上,依据Δg与一阶误差参数K的关系,利用步骤二得到的构建方程用步骤三中的构建方程 其中,i=1,2,3,4,均可得到一个方程将以上方程联立得到如下方程组:
最终构建如下方程:
Δg=AK
步骤五:根据一阶中间参数与一阶误差参数的关系式,设A=[a1 a2 … an]、K=[k1 k2 … kn]T,其中,ai为矩阵A的列向量,i=1,2…n,ki为向量K的各元素,i=1,2…n,[k1 k2 … kn]T为行向量[k1 k2… kn]的转置,
K中包含Bay、Kayy、Kazy、Kax2、Kay2、Kaz2、Kgxy、Kgxz、Kgyx、Kgyz、Kgzx的15个误差参数直接由最近一次的完整标定结果给出,这些由外部给出的误差参数在向量K中的序号为el,l=1,2,…,ne,其余参与标定计算的误差参数在向量K中的序号为cj,j=1,2,…,nc,且nc+ne=n;然后将矩阵A中所有序号非cj的列置为零后形成的矩阵设为Acal,j=1,2,…,nc,将矩阵A中所有序号非el的列置为零后形成的矩阵设为Aext,l=1,2,…,ne,将向量K中所有序号非cj的元素置为零后形成的向量设为Kcal,j=1,2,…,nc,将向量K中所有序号非el的元素置为零后形成的向量设为Kext,l=1,2,…,ne,则Δg=AK可以记为:
然后将Acal去掉元素全为零的行和列得到Acalnz,并记下这些行和列的序号,接着求Acalnz的最小二乘逆矩阵并对扩充元素全为零的行和列得到其中,扩充的行序号与Acal中全为零的列序号相同,列序号与Acal中全为零的行序号相同,
由下式求解参与标定的误差参数:
计算得到Kcal,其中,参与标定计算的误差参数序号上元素为相应的标定计算值,外部给出的误差参数序号上元素全为零,将Kcal与外部给出的Kext相加得到一阶误差参数K;其中,最小二乘逆矩阵和矩阵Aext中非零元素分别如表2和表3所示:
表2阵中非零元素
ACalInv(1,2)=-(2*g)/11 | ACalInv(1,5)=-(3*g)/22 |
ACalInv(1,7)=(3*g)/22 | ACalInv(1,8)=(4*g)/11 |
ACalInv(1,11)=(3*g)/22 | ACalInv(1,13)=-(3*g)/22 |
ACalInv(1,14)=-(2*g)/11 | ACalInv(3,2)=g/11 |
ACalInv(3,5)=(7*g)/22 | ACalInv(3,7)=(2*g)/11 |
ACalInv(3,8)=-(2*g)/11 | ACalInv(3,11)=-(7*g)/22 |
ACalInv(3,13)=-(2*g)/11 | ACalInv(3,14)=g/11 |
ACalInv(4,2)=3/11 | ACalInv(4,5)=-1/22 |
ACalInv(4,7)=1/22 | ACalInv(4,8)=5/11 |
ACalInv(4,11)=1/22 | ACalInv(4,13)=-1/22 |
ACalInv(4,14)=3/11 | ACalInv(6,5)=1/2 |
ACalInv(6,11)=1/2 | ACalInv(7,6)=1/4 |
ACalInv(7,9)=1/4 | ACalInv(7,12)=-1/4 |
ACalInv(7,15)=-1/4 | ACalInv(8,2)=3/22 |
ACalInv(8,4)=-1/2 | ACalInv(8,5)=5/22 |
ACalInv(8,7)=3/11 | ACalInv(8,8)=-3/11 |
ACalInv(8,11)=-5/22 | ACalInv(8,13)=5/22 |
ACalInv(8,14)=3/22 | ACalInv(14,2)=-3/(11*π) |
ACalInv(14,4)=1/(3*π) | ACalInv(14,5)=-5/(11*π) |
ACalInv(14,7)=-7/(33*π) | ACalInv(14,8)=6/(11*π) |
ACalInv(14,10)=-2/(3*π) | ACalInv(14,11)=5/(11*π) |
ACalInv(14,13)=-4/(33*π) | ACalInv(14,14)=-3/(11*π) |
ACalInv(17,2)=-3/(11*π) | ACalInv(17,4)=1/π |
ACalInv(17,5)=-5/(11*π) | ACalInv(17,7)=5/(11*π) |
ACalInv(17,8)=6/(11*π) | ACalInv(17,11)=5/(11*π) |
ACalInv(17,13)=6/(11*π) | ACalInv(17,14)=-3/(11*π) |
ACalInv(24,6)=1/4 | ACalInv(24,9)=-1/4 |
ACalInv(24,12)=-1/4 | ACalInv(24,15)=1/4 |
表3Aext阵中非零元素
AExt(2,10)=-g | AExt(5,12)=g | AExt(6,19)=1 |
AExt(8,10)=g | AExt(9,19)=1 | AExt(11,12)=-g |
AExt(12,19)=-1 | AExt(14,10)=-g | AExt(15,19)=-1 |
表中:
ACalInv(i,j)表示中第i行第j列元素,
AExt(i,j)表示Aext中第i行第j列元素,
π为圆周率,
g为重力加速度。
步骤六:利用步骤五计算出的K求解每个静止位置i对应的补偿分量其中i=0,1,2,3,4,计算方法如下:
其中:
为系数ωv为降低与误差参数耦合度而需剔除的系数,ωv为步骤三中的系数,
为上式中矩阵的第i列,其中,i=1……19,
L为纬度,
Ω为地球自转角速率,
K为一阶误差参数,
和分别为常数矩阵,和阵中非零元素分别见表4和表5:
表4阵中非零元素
betaCoef(1,3)=1/g | betaCoef(1,8)=-1 | betaCoef(2,3)=1/g |
betaCoef(2,8)=-1 | betaCoef(2,17)=π/2 | betaCoef(3,1)=1/g |
betaCoef(3,17)=π/2 | betaCoef(4,3)=-1/g | betaCoef(4,8)=-1 |
betaCoef(4,14)=-(3*π)/2 | betaCoef(5,1)=-1/g | betaCoef(5,17)=π/2 |
表5阵中非零元素
gammaCoef(1,2)=1/g | gammaCoef(1,7)=-1 |
gammaCoef(2,2)=1/g | gammaCoef(2,7)=-1 |
gammaCoef(2,19)=-1 | gammaCoef(2,24)=-1 |
gammaCoef(3,2)=1/g | gammaCoef(3,19)=-1 |
gammaCoef(3,24)=1 | gammaCoef(4,2)=1/g |
gammaCoef(4,7)=1 | gammaCoef(4,19)=1 |
gammaCoef(4,24)=1 | gammaCoef(5,2)=1/g |
gammaCoef(5,19)=1 | gammaCoef(5,24)=-1 |
其中:
betaCoef(i,j)表示βcoef中第i行第j列元素,
gammaCoef(i,j)表示γcoef中第i行第j列元素,
π为圆周率,
g为重力加速度,
接着通过步骤二中的及步骤三中的计算出每个静止位置上的二阶中间参数其中,步骤三中的中i=1,2,3,4,二阶中间参数求值公式中i=0,1,2,3,4。
步骤七:将各二阶误差参数:陀螺零偏Bgx、Bgy、Bgz及首个位置上的北向方位角误差记为列向量ω,依据二阶中间参数和二阶误差参数ω之间的关系,利用步骤五中构建方程其中i=0,1,2,3,4,
将以上方程联立得到如下方程:
步骤八:根据二阶中间参数与二阶误差参数的关系式,设B=[b1 b2 … bn]、ω=[ω1 ω2 … ωn]T,其中,bi为矩阵B的列向量,i=1,2…n,ωi为向量ω的各元素,i=1,2…n,ω=[ω1 ω2 … ωn]T为行向量[ω1 ω2 … ωn]的转置,
ω中首个位置上的北向方位角误差直接由最近一次的完整标定结果给出,这些由外部给出的误差参数在向量ω中的序号为el,l=1,2,…,ne,其余参与标定计算的误差参数在向量ω中的序号为cj,j=1,2,…,nc且nc+ne=n;然后将矩阵B中所有序号非cj的列置为零后形成的矩阵设为Bcal,j=1,2,…,nc,将矩阵B中所有序号非el的列置为零后形成的矩阵设为Bext,l=1,2,…,ne,将向量ω中所有序号非cj的元素置为零后形成的向量设为ωcal,j=1,2,…,nc,将向量ω中所有序号非el的元素置为零后形成的向量设为ωext,l=1,2,…,ne,则可以记为:
然后将Bcal去掉元素全为零的行和列得到Bcalnz,并记下这些行和列的序号;接着求Bcalnz的最小二乘逆矩阵并对扩充元素全为零的行和列得到其中,扩充的行序号与Bcal中全为零的列序号相同,列序号与Bcal中全为零的行序号相同,
由下式求解参与标定的误差参数:
计算得到ωcal,其中,参与标定计算 的误差参数序号上元素为相应的标定计算值,外部给出的误差参数序号上元素全为零,将ωcal与外部给出的ωext相加得到一阶误差参数ω,
其中,最小二乘逆矩阵和矩阵Bext中非零元素分别如表6和表7所示:
表6阵中非零元素
BCalInv(1,2)=1/5 | BCalInv(1,6)=-1/5 | BCalInv(1,8)=-1/5 |
BCalInv(1,12)=1/5 | BCalInv(1,14)=1/5 | BCalInv(2,1)=-1/5 |
BCalInv(2,4)=-1/5 | BCalInv(2,7)=-1/5 | BCalInv(2,10)=-1/5 |
BCalInv(2,13)=-1/5 | BCalInv(3,3)=-1/5 | BCalInv(3,5)=-1/5 |
BCalInv(3,9)=1/5 | BCalInv(3,11)=1/5 | BCalInv(3,15)=-1/5 |
表7Bext阵中非零元素
BExt(1,4)=-Ω*cos(L) | BExt(4,4)=-Ω*cos(L) | BExt(7,4)=-Ω*cos(L) |
BExt(10,4)=-Ω*cos(L) | BExt(13,4)=-Ω*cos(L) |
表中:
BCalInv(i,j)表示中第i行第j列元素,
BExt(i,j)表示Bext中第i行第j列元素,
L为纬度,
Ω为地球自转角速率。
步骤九:当一阶误差参数K和二阶误差参数ω的残差大于阈值时,用一阶误差参数K和二阶误差参数ω残差补偿前次标定的误差参数。然后将得到的一阶误差参数K和二阶误差参数ω以及步骤一中采集的惯性测量单元输出数据代入到导航方程中,再进行一次一阶中间参数Δg、二阶中间参数一阶误差参数K和二阶误差参数ω残差的解算,然后对一阶误差参数K和二阶误差参数ω进行残差补偿。依此类推,经过多次迭代直至某一次迭代计算得到的一阶误差参数K和二阶误差参数ω残差小于阈值。
Claims (6)
1.一种适用于低精度有方位基准单轴转位设备的惯性测量单元标定方法,其特征在于:包含如下步骤:
步骤一:将惯性测量单元安装在单轴转位设备上,惯性测量单元初始位置朝向为下-东-南,惯性测量单元通电预热后开始采集输出的原始数据,惯性测量单元先在第0个位置上静止3-5分钟,再转动到第1个位置静止3-5分钟,随后转动到第2个位置,依此类推,直至在第4个位置上静止3-5分钟后停止采集惯性测量单元输出的原始数据;
步骤二:利用步骤一采集的惯性测量单元数据,在第0位置上利用重力加速度和加速度计输出数据确定出惯性测量单元的水平姿态,并将第0位置上惯性测量单元的导航起始时刻的天向转角直接设为0,进而得到首位置的初始对准结果具体计算公式如下:
其中,
c12=(c31c23-c21c22c11)/(1-c21 2),
c13=-(c31c22+c11c21c23)/(1-c21 2),
c32=-(c11c23+c21c22c31)/(1-c21 2),
c33=(c11c22+c21c31c23)/(1-c21 2),
式中,fx b、fy b和fz b分别为加速度计测得的比力fb在载体坐标系x轴、y轴和z轴上的投影;
然后利用对准结果和第0位置上的采集数据进行导航解算,进而得到第0位置上导航过程中的实时速度以及实时天向转角θn(0),设第0位置上导航起始时刻的速度均为0,以速度和天向转角为观测结果拟合出第0位置上的和一阶中间参数所述包含和所述和分别为第0位置上的参数在x轴、y轴和z轴上投影的标量,所述包含和所述和分别为第0位置上的一阶中间参数在x轴、y轴和z轴上投影的标量;
步骤三:根据步骤一采集的第i个位置上的惯性测量单元原始数据,i=1,2,3,4,利用重力加速度和加速度计输出确定出惯性测量单元在第i位置上的水平姿态,而第i位置上惯性测量单元的天向转角θn(i)由第i-1位置上的天向转角θn(i-1)及第i-1位置到第i个位置转动过程中的陀螺输出确定,利用以上各位置的对准结果以及由步骤二得到的第0位置的对准结果,在第i-1个位置到第i个位置的转动过程中以及第i个位置上的静止过程中进行连续导航,通过导航获取转动到达第i个位置瞬间的速度和天向转角以及转动完成后在第i个位置静止过程中的速度和天向转角θn(i),
式中:g是重力加速度,T是实时时间,
ωvx、ωvy和ωvz分别为系数ωv在x轴、y轴和z轴上的分量,
以速度和天向转角为观测,拟合出第i位置上的和一阶中间参数其中,i=1,2,3,4,所述包含和包含 和所述和分别为第i位置上的参数在x轴、y轴和z轴上投影的标量,所述和分别为第i位置上的一阶中间参数在x轴、y轴和z轴上投影的标量;
步骤四:在惯性测量单元坐标系内,加速度计的误差模型为:
上述误差模型的向量形式为:
其中,
fb为载体坐标系下加速度计测得的比力,
fx b、fy b和fz b分别为fb在x轴、y轴和z轴上的投影,
为载体坐标系下的加速度计零偏,
Ka包括加速度计标度因数误差和加速度计失准角,
Ka2为加速度计二次项系数,
δfb为载体坐标系下加速度计测得的比力误差;
陀螺的误差模型为:
上述误差模型的向量形式为:
其中,
ωb为载体坐标系下陀螺测得的角速度,
为载体坐标系下陀螺零偏,
Kg包括陀螺标度因数误差和陀螺失准角,
εb为载体坐标系下陀螺测得的角速度误差;
然后将加速度计零偏Bax、Bay、Baz,加速度计标度因数Kaxx、Kayy、Kazz,加速度计失准角Kayx、Kazx、Kazy,加速度计二次项系数Kax2、Kay2、Kaz2,陀螺正向标度因数陀螺负向标度因数陀螺失准角Kgxy、Kgxz、Kgyx、Kgyz、Kgzx、Kgzy共计24个误差参数记为一阶误差参数K,其中,Bax、Bay、Baz分别为加速度计零偏Ba在x轴、y轴和z轴上投影的标量;
在每个位置上,依据Δg与一阶误差参数K的关系,利用步骤二得到的构建方程用步骤三中的构建方程其中,i=1,2,3,4,均可得到一个方程将以上方程联立得到如下方程组:
最终构建如下方程:
Δg=AK
步骤五:根据一阶中间参数与一阶误差参数的关系式,设A=[a1 a2 … an]、K=[k1 k2 … kn]T,其中,ai为矩阵A的列向量,i=1,2…n,ki为向量K的各元素,i=1,2…n,[k1 k2 … kn]T为行向量[k1 k2 … kn]的转置,
K中包含Bay、Kayy、Kazy、Kax2、Kay2、Kaz2、Kgxy、Kgxz、Kgyx、Kgyz、Kgzx的15个误差参数直接由最近一次的完整标定结果给出,这些由外部给出的误差参数在向量K中的序号为el,l=1,2,…,ne,其余参与标定计算的误差参数在向量K中的序号为cj,j=1,2,…,nc,且nc+ne=n;然后将矩阵A中所有序号非cj的列置为零后形成的矩阵设为Acal,j=1,2,…,nc,将矩阵A中所有序号非el的列置为零后形成的矩阵设为Aext,l=1,2,…,ne,将向量K中所有序号非cj的元素置为零后形成的向量设为Kcal,j=1,2,…,nc,将向量K中所有序号非el的元素置为零后形成的向量设为Kext,l=1,2,…,ne,则Δg=AK可以记为:
然后将Acal去掉元素全为零的行和列得到Acalnz,并记下这些行和列的序号,接着求Acalnz的最小二乘逆矩阵并对扩充元素全为零的行和列得到其中,扩充的行序号与Acal中全为零的列序号相同,列序号与Acal中全为零的行序号相同,
由下式求解参与标定的误差参数:
计算得到Kcal,其中,参与标定计算的误差参数序号上元素为相应的标定计算值,外部给出的误差参数序号上元素全为零,将Kcal与外部给出的Kext相加得到一阶误差参数K;
步骤六:利用步骤五计算出的K求解每个静止位置i对应的补偿分量其中i=0,1,2,3,4,计算方法如下:
其中:
为系数ωv为降低与误差参数耦合度而需剔除的系数,ωv为步骤三中的系数,
为上式中矩阵的第i列,其中,i=1,2,3,4,5,
L为纬度,
Ω为地球自转角速率,
K为一阶误差参数,
和分别为常数矩阵;
接着通过步骤二中的及步骤三中的计算出每个静止位置上的二阶中间参数其中,步骤三中的中i=1,2,3,4,二阶中间参数求值公式中i=0,1,2,3,4;
步骤七:将各二阶误差参数:陀螺零偏Bgx、Bgy、Bgz及首个位置上的北向方位角误差记为列向量ω,依据二阶中间参数和二阶误差参数ω之间的关系,利用步骤五中构建方程其中i=0,1,2,3,4,
将以上方程联立得到如下方程:
步骤八:根据二阶中间参数与二阶误差参数的关系式,设B=[b1 b2 … bn]、ω=[ω1 ω2 … ωn]T,其中,bi为矩阵B的列向量,i=1,2…n,ωi为向量ω的各元素,i=1,2…n,ω=[ω1 ω2 … ωn]T为行向量[ω1 ω2 … ωn]的转置,
ω中首个位置上的北向方位角误差直接由最近一次的完整标定结果给出,这些由外部给出的误差参数在向量ω中的序号为el,l=1,2,…,ne,其余参与标定计算的误差参数在向量ω中的序号为cj,j=1,2,…,nc且nc+ne=n;然后将矩阵B中所有序号非cj的列置为零后形成的矩阵设为Bcal,j=1,2,…,nc,将矩阵B中所有序号非el的列置为零后形成的矩阵设为Bext,l=1,2,…,ne,将向量ω中所有序号非cj的元素置为零后形成的向量设为ωcal,j=1,2,…,nc,将向量ω中所有序号非el的元素置为零后形成的向量设为ωext,l=1,2,…,ne,则可以记为:
然后将Bcal去掉元素全为零的行和列得到Bcalnz,并记下这些行和列的序号;接着求Bcalnz的最小二乘逆矩阵并对扩充元素全为零的行和列得到其中,扩充的行序号与Bcal中全为零的列序号相同,列序号与Bcal中全为零的行序号相同,
由下式求解参与标定的误差参数:
计算得到ωcal,其中,参与标定计算的误差参数序号上元素为相应的标定计算值,外部给出的误差参数序号上元素全为零,将ωcal与外部给出的ωext相加得到一阶误差参数ω;
步骤九:当一阶误差参数K和二阶误差参数ω的残差大于阈值时,用一阶误差参数K和二阶误差参数ω残差补偿前次标定的误差参数。然后将得到的一阶误差参数K和二阶误差参数ω以及步骤一中采集的惯性测量单元输出数据代入到导航方程中,再进行一次一阶中间参数Δg、二阶中间参数一阶误差参数K和二阶误差参数ω残差的解算,然后对一阶误差参数K和二阶误差参数ω进行残差补偿。依此类推,经过多次迭代直至某一次迭代计算得到的一阶误差参数K和二阶误差参数ω残差小于阈值。
2.根据权利要求1所述的适用于低精度有方位基准单轴转位设备的惯性测量单元标定方法,其特征在于:在步骤一中,标定旋转顺序如下表所示:
标定旋转顺序
3.根据权利要求1或2所述的适用于低精度有方位基准单轴转位设备的惯性测量单元标定方法,其特征在于:惯性测量单元坐标系是:X轴与X加速度计输入轴方向相同,Y轴位于X加速度计和Y加速度计输入轴构成的平面内,接近Y加速度计输入轴方向,Z轴方向由右手定则确定。
4.根据权利要求1或2所述的适用于低精度有方位基准单轴转位设备的惯性测量单元标定方法,其特征在于:在步骤三中,由第i-1位置上的天向转角θn(i-1)及第i-1位置到第i个位置转动过程中的陀螺输出通过四阶定时增量算法确定第i位置上惯性测量单元的天向转角θn(i)。
5.根据权利要求1或2所述的适用于低精度有方位基准单轴转位设备的惯性测量单元标定方法,其特征在于:在步骤一中,所述的惯性测量单元通电预热时间为30分钟,原始数据的采样周期为0.01s。
6.根据权利要求1或2所述的适用于低精度无方位基准单轴转位设备的惯性测量单元标定方法,其特征在于:在步骤一中,停止采集惯性测量单元输出的原始数据后关闭惯性测量单元。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201410232438.2A CN104121928B (zh) | 2014-05-29 | 2014-05-29 | 一种适用于低精度有方位基准单轴转位设备的惯性测量单元标定方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201410232438.2A CN104121928B (zh) | 2014-05-29 | 2014-05-29 | 一种适用于低精度有方位基准单轴转位设备的惯性测量单元标定方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN104121928A true CN104121928A (zh) | 2014-10-29 |
CN104121928B CN104121928B (zh) | 2016-09-28 |
Family
ID=51767439
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201410232438.2A Active CN104121928B (zh) | 2014-05-29 | 2014-05-29 | 一种适用于低精度有方位基准单轴转位设备的惯性测量单元标定方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN104121928B (zh) |
Cited By (8)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN109000644A (zh) * | 2018-06-15 | 2018-12-14 | 北京航天发射技术研究所 | 一种基于VxWorks的惯性测量单元系统级标定方法 |
CN109631941A (zh) * | 2018-12-09 | 2019-04-16 | 西安航天精密机电研究所 | 一种惯性平台系统加速度计安装误差精确标定方法 |
CN110160554A (zh) * | 2019-04-30 | 2019-08-23 | 东南大学 | 一种基于寻优法的单轴旋转捷联惯导系统标定方法 |
CN110440827A (zh) * | 2019-08-01 | 2019-11-12 | 北京神导科讯科技发展有限公司 | 一种参数误差的标定方法、装置及存储介质 |
CN110823255A (zh) * | 2019-11-25 | 2020-02-21 | 西安爱生技术集团公司 | 一种基于比力观测无需调平引北的系统级自标定方法 |
CN111238532A (zh) * | 2019-12-23 | 2020-06-05 | 湖北航天技术研究院总体设计所 | 一种适用于晃动基座环境的惯性测量单元标定方法 |
CN113008273A (zh) * | 2021-03-09 | 2021-06-22 | 北京小马智行科技有限公司 | 车辆的惯性测量单元的标定方法、装置与电子设备 |
CN116026370A (zh) * | 2023-03-30 | 2023-04-28 | 中国船舶集团有限公司第七〇七研究所 | 基于矩阵等价转换的光纤陀螺误差校准方法及系统 |
Citations (7)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP2007232443A (ja) * | 2006-02-28 | 2007-09-13 | Yokogawa Electric Corp | 慣性航法装置およびその誤差補正方法 |
CN101514899A (zh) * | 2009-04-08 | 2009-08-26 | 哈尔滨工程大学 | 基于单轴旋转的光纤陀螺捷联惯性导航系统误差抑制方法 |
CN101718560A (zh) * | 2009-11-20 | 2010-06-02 | 哈尔滨工程大学 | 基于单轴四位置转停方案的捷联系统误差抑制方法 |
CN102620734A (zh) * | 2012-04-09 | 2012-08-01 | 北京自动化控制设备研究所 | 一种单轴旋转调制微机械惯导方法 |
CN103063205A (zh) * | 2012-12-24 | 2013-04-24 | 陕西宝成航空仪表有限责任公司 | 一种用于寻北系统中四位置寻北测量的转位方法及机构 |
CN103148854A (zh) * | 2013-01-28 | 2013-06-12 | 辽宁工程技术大学 | 基于单轴正反转动的mems惯导系统姿态测量方法 |
KR20140030955A (ko) * | 2012-09-04 | 2014-03-12 | 한국생산기술연구원 | 센서 융합을 이용한 모바일 객체의 위치 인식방법 및 그 장치 |
-
2014
- 2014-05-29 CN CN201410232438.2A patent/CN104121928B/zh active Active
Patent Citations (7)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP2007232443A (ja) * | 2006-02-28 | 2007-09-13 | Yokogawa Electric Corp | 慣性航法装置およびその誤差補正方法 |
CN101514899A (zh) * | 2009-04-08 | 2009-08-26 | 哈尔滨工程大学 | 基于单轴旋转的光纤陀螺捷联惯性导航系统误差抑制方法 |
CN101718560A (zh) * | 2009-11-20 | 2010-06-02 | 哈尔滨工程大学 | 基于单轴四位置转停方案的捷联系统误差抑制方法 |
CN102620734A (zh) * | 2012-04-09 | 2012-08-01 | 北京自动化控制设备研究所 | 一种单轴旋转调制微机械惯导方法 |
KR20140030955A (ko) * | 2012-09-04 | 2014-03-12 | 한국생산기술연구원 | 센서 융합을 이용한 모바일 객체의 위치 인식방법 및 그 장치 |
CN103063205A (zh) * | 2012-12-24 | 2013-04-24 | 陕西宝成航空仪表有限责任公司 | 一种用于寻北系统中四位置寻北测量的转位方法及机构 |
CN103148854A (zh) * | 2013-01-28 | 2013-06-12 | 辽宁工程技术大学 | 基于单轴正反转动的mems惯导系统姿态测量方法 |
Cited By (11)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN109000644A (zh) * | 2018-06-15 | 2018-12-14 | 北京航天发射技术研究所 | 一种基于VxWorks的惯性测量单元系统级标定方法 |
CN109631941A (zh) * | 2018-12-09 | 2019-04-16 | 西安航天精密机电研究所 | 一种惯性平台系统加速度计安装误差精确标定方法 |
CN110160554A (zh) * | 2019-04-30 | 2019-08-23 | 东南大学 | 一种基于寻优法的单轴旋转捷联惯导系统标定方法 |
CN110160554B (zh) * | 2019-04-30 | 2022-10-14 | 东南大学 | 一种基于寻优法的单轴旋转捷联惯导系统标定方法 |
CN110440827A (zh) * | 2019-08-01 | 2019-11-12 | 北京神导科讯科技发展有限公司 | 一种参数误差的标定方法、装置及存储介质 |
CN110823255A (zh) * | 2019-11-25 | 2020-02-21 | 西安爱生技术集团公司 | 一种基于比力观测无需调平引北的系统级自标定方法 |
CN110823255B (zh) * | 2019-11-25 | 2023-04-14 | 西安爱生技术集团公司 | 一种基于比力观测无需调平引北的系统级自标定方法 |
CN111238532A (zh) * | 2019-12-23 | 2020-06-05 | 湖北航天技术研究院总体设计所 | 一种适用于晃动基座环境的惯性测量单元标定方法 |
CN111238532B (zh) * | 2019-12-23 | 2022-02-01 | 湖北航天技术研究院总体设计所 | 一种适用于晃动基座环境的惯性测量单元标定方法 |
CN113008273A (zh) * | 2021-03-09 | 2021-06-22 | 北京小马智行科技有限公司 | 车辆的惯性测量单元的标定方法、装置与电子设备 |
CN116026370A (zh) * | 2023-03-30 | 2023-04-28 | 中国船舶集团有限公司第七〇七研究所 | 基于矩阵等价转换的光纤陀螺误差校准方法及系统 |
Also Published As
Publication number | Publication date |
---|---|
CN104121928B (zh) | 2016-09-28 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN104121928A (zh) | 一种适用于低精度有方位基准单轴转位设备的惯性测量单元标定方法 | |
CN110160554B (zh) | 一种基于寻优法的单轴旋转捷联惯导系统标定方法 | |
CN110006450B (zh) | 一种激光捷联惯导系统在卧式三轴转台上的标定方法 | |
CN103575299B (zh) | 利用外观测信息的双轴旋转惯导系统对准及误差修正方法 | |
CN104121927A (zh) | 一种适用于低精度无方位基准单轴转位设备的惯性测量单元标定方法 | |
CN107525503B (zh) | 基于双天线gps和mimu组合的自适应级联卡尔曼滤波方法 | |
CN106969783A (zh) | 一种基于光纤陀螺惯性导航的单轴旋转快速标定技术 | |
CN104344836B (zh) | 一种基于姿态观测的冗余惯导系统光纤陀螺系统级标定方法 | |
CN104344837B (zh) | 一种基于速度观测的冗余惯导系统加速度计系统级标定方法 | |
CN101706284B (zh) | 提高船用光纤陀螺捷联惯导系统定位精度的方法 | |
CN101975872B (zh) | 石英挠性加速度计组件零位偏置的标定方法 | |
CN103852085B (zh) | 一种基于最小二乘拟合的光纤捷联惯导系统现场标定方法 | |
CN106885570A (zh) | 一种基于鲁棒sckf滤波的紧组合导航方法 | |
CN106885569A (zh) | 一种强机动条件下的弹载深组合arckf滤波方法 | |
CN103852086B (zh) | 一种基于卡尔曼滤波的光纤捷联惯导系统现场标定方法 | |
CN103076025B (zh) | 一种基于双解算程序的光纤陀螺常值误差标定方法 | |
CN104764463B (zh) | 一种惯性平台调平瞄准误差的自检测方法 | |
CN102519485B (zh) | 一种引入陀螺信息的二位置捷联惯性导航系统初始对准方法 | |
CN106940193A (zh) | 一种基于Kalman滤波的船舶自适应摇摆标定方法 | |
CN103245359A (zh) | 一种惯性导航系统中惯性传感器固定误差实时标定方法 | |
CN109766812B (zh) | 一种旋转加速度计重力梯度仪运动误差事后补偿方法 | |
CN103983274A (zh) | 一种适用于低精度无方位基准双轴转位设备的惯性测量单元标定方法 | |
CN106017452A (zh) | 双陀螺抗扰动寻北方法 | |
CN103994775A (zh) | 一种适用于低精度有方位基准双轴转位设备的惯性测量单元标定方法 | |
CN103954299B (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 |