CN104121927B - 一种适用于低精度无方位基准单轴转位设备的惯性测量单元标定方法 - Google Patents
一种适用于低精度无方位基准单轴转位设备的惯性测量单元标定方法 Download PDFInfo
- Publication number
- CN104121927B CN104121927B CN201410232223.0A CN201410232223A CN104121927B CN 104121927 B CN104121927 B CN 104121927B CN 201410232223 A CN201410232223 A CN 201410232223A CN 104121927 B CN104121927 B CN 104121927B
- Authority
- CN
- China
- Prior art keywords
- coordinate system
- error
- omega
- delta
- accelerometer
- 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.)
- Active
Links
- 238000000034 method Methods 0.000 title claims abstract description 74
- 238000005259 measurement Methods 0.000 title claims abstract description 70
- 239000011159 matrix material Substances 0.000 claims description 58
- 238000004364 calculation method Methods 0.000 claims description 27
- 230000017105 transposition Effects 0.000 claims description 16
- 230000001133 acceleration Effects 0.000 claims description 15
- 230000005484 gravity Effects 0.000 claims description 15
- 230000005654 stationary process Effects 0.000 claims description 6
- 230000003068 static effect Effects 0.000 claims description 5
- 238000005070 sampling Methods 0.000 claims description 3
- 238000005516 engineering process Methods 0.000 abstract description 7
- 239000000306 component Substances 0.000 description 33
- 238000011160 research Methods 0.000 description 4
- 230000008901 benefit Effects 0.000 description 2
- FFBHFFJDDLITSX-UHFFFAOYSA-N benzyl N-[2-hydroxy-4-(3-oxomorpholin-4-yl)phenyl]carbamate Chemical compound OC1=C(NC(=O)OCC2=CC=CC=C2)C=CC(=C1)N1CCOCC1=O FFBHFFJDDLITSX-UHFFFAOYSA-N 0.000 description 2
- 238000004422 calculation algorithm Methods 0.000 description 2
- 238000012360 testing method Methods 0.000 description 2
- 230000009286 beneficial effect Effects 0.000 description 1
- 150000001875 compounds Chemical class 0.000 description 1
- 239000008358 core component Substances 0.000 description 1
- 230000008878 coupling Effects 0.000 description 1
- 238000010168 coupling process Methods 0.000 description 1
- 238000005859 coupling reaction Methods 0.000 description 1
- 230000007123 defense Effects 0.000 description 1
- 230000001419 dependent effect Effects 0.000 description 1
- 230000007774 longterm Effects 0.000 description 1
- 239000004579 marble Substances 0.000 description 1
- 230000035484 reaction time Effects 0.000 description 1
- 238000004904 shortening Methods 0.000 description 1
- 238000004088 simulation Methods 0.000 description 1
- 238000012795 verification Methods 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
本发明公开了一种适用于低精度无方位基准单轴转位设备的惯性测量单元标定方法,属于惯性技术领域。该方法使用单轴转位设备,标定旋转编排5个位置,然后以各位置上的速度误差和天向姿态误差拟合出一阶中间参数Δg以及二阶中间参数依据中间参数与误差参数以及最近的历史标定参数,由最小二乘法计算出各个器件误差参数,为了有效消除由转台引起的定位误差,将前一次迭代计算得到的误差参数和原有惯性测量单元输出数据代入导航方程,再进行一次观测量、中间参数和误差参数残差的解算,对误差参数进行残差补偿,依此类推,直至某一次迭代计算得到的误差参数残差小于阈值。该方法能降低标定成本及标定对转台精度的依赖,缩短标定时间,工程实用性好。
Description
技术领域
本发明属于航空航天捷联惯性导航技术中的惯性测量组合测试技术领域,具体涉及一种适用于低精度无方位基准单轴转位设备的惯性测量单元标定方法。与传统标定方法相比,该标定方法适用于单轴转位设备,对转位设备的基准精度要求低且不需要对北,可用于对惯性测量组合部分参数的标定。
背景技术
捷联惯性导航***具有反应时间短、可靠性高、体积小、重量轻等优点,广泛应用于飞机、舰船、导弹等军用和民用导航领域,具有重要的国防意义和巨大的经济效益。
惯性测量组合是捷联惯性导航***的核心部件,主要由3个加速度计和3个陀螺组成。
标定技术是惯性导航领域的核心技术之一,是一种对误差的辨识技术,即建立惯性器件和惯导***的误差模型,通过一系列的试验求解出误差模型中的误差项,进而通过软件算法对误差进行补偿。惯性测量组合的标定结果好坏直接影响捷联惯性导航***的精度。
惯性测量组合标定方法按层次可分为分立式标定和***级标定两种。当前分立式标定方法的研究已经非常成熟,而***级标定方法是由20世纪80年代发展起来的,目前正成为标定技术研究的热点。
分立标定方法是根据陀螺和加速度计的误差模型,利用三轴转台提供的精确速率、姿态和位置,采集惯性测量组合的输出,然后利用 最小二乘法辨识误差模型系数。然而分立式标定过分依赖转台的精度,当转台精度不高时,标定结果不理想。
***级标定是建立捷联惯导***导航输出误差与惯性器件误差参数之间的关系,充分考虑惯性器件误差系数的可辨识性,合理安排实验位置,进而辨识出惯性器件的各项误差系数。该方法可以大幅减小甚至克服标定对转台精度的依赖,适合现场标定使用。
早在上世纪80-90年代,***级标定方法就已经在国外的工程中得到了推广应用。国内的相关研究起步较晚,近年随着捷联惯导技术的成熟度不断提高,国内也出现了很多介绍***级标定的文献和资料,但大多数停留在理论研究和仿真验证的阶段。在公开的文献和资料中,国内一般采用低精度的三轴或双轴转台,在引北的条件下在实验室内进行***级标定。尚未有发现免对北单轴***级标定算法的相关资料。
发明内容
本发明提供一种适用于低精度无方位基准单轴转位设备的惯性测量单元标定方法,与国内外其他***级标定方法相比,该标定方法不需对北,同时可以大幅降低标定对转台精度的依赖性,具有很好的工程实用性。
本发明适用于低精度无方位基准单轴转位设备的惯性测量单元标定方法,包含如下步骤:
步骤一:将惯性测量单元安装在单轴转位设备上,所述惯性测量单元初始位置保证X轴朝上或朝下,惯性测量单元通电预热后开始采集输出的原始数据,所述惯性测量单元先在第0个位置上静止3-5分钟后,再转动到第1个位置静止3-5分钟,随后转动到第2个位置,依此类推,直至在第4个位置上静止3-5分钟后停止采集惯性测量单元输出的原始数据;
步骤二:利用步骤一采集的惯性测量单元原始数据,在第0位置上使用双矢量定姿法进行初始对准,进而得到第0位置上导航起始时刻的天向转角然后利用对准结果和第0位置上的采集数据进行导航解算,进而得到第0位置上导航过程中的实时速度以及实时天向转角θn(0),设第0位置上导航起始时刻的速度 均为0,以速度和天向转角为观测结果拟合出第0位置上的和一阶中间参数所述包含和所述和 分别为第0位置上的参数在x轴、y轴和z轴上投影的标量,所述包含和所述和分别为第0位置上的一阶中间参数在x轴、y轴和z轴上投影的标量;
步骤三:利用步骤一采集的惯性测量单元原始数据,在第i位置上使用双矢量定姿法进行初始对准,i=0,1,2,3,然后在第i个位置到第i+1个位置的转动过程中以及第i+1个位置上的静止过程中进行连续导航,通过导航获取转动到达第i+1个位置瞬间的速度和和瞬间的天向转角以及转动完成后在第i+1个位置静止过程中的实时速度和和实时的天向转角θn(i+1),
式中:g是重力加速度,T是实时时间,
ωvx、ωvy和ωvz分别为系数ωv在x轴、y轴和z轴上的分量,
以速度和天向转角为观测,拟合出第i+1位置上的和一阶中间参数其中,i=0,1,2,3,所述包含和 包含和所述和分别为第i+1位置 上的参数在x轴、y轴和z轴上投影的标量,所述和 分别为第i+1位置上的一阶中间参数在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,陀螺标度因数Kgxx、Kgyy、Kgzz,陀螺失准角Kgxy、Kgxz、Kgyx、Kgyz、Kgzx、Kgzy共计21个误差参数记为一阶误差参数K,其中,Bax、Bay、Baz分别为加速度计零偏Ba在x轴、y轴和z轴上投影的标量;
在每个位置上,依据一阶中间参数Δg与一阶误差参数K的关系,利用步骤二得到的构建方程即:
其中,
δfn(0)为导航坐标系(n系,navigation)下第0个位置的比力误差,
g是重力加速度,
是在第0个位置上从载体坐标系(b系,body)到导航坐标系的方向余弦矩阵,
是在第0个位置上从导航坐标系到载体坐标系的方向余弦矩阵,
为载体坐标系下的加速度计零偏,
fn为导航坐标系下的比力,
Ka包括加速度计标度因数误差和加速度计失准角,
Ka2为加速度计二次项系数,
[X]V表示垂直分量与X相同,水平分量为0的矢量;
用步骤三得到的构建方程其中,中i=0,1,2,3,中i=1,2,3,4,即:
其中,
δfn(i-1)和δfn(i)分别为导航坐标系下第i-1和第i个位置下的比力误差,
fn为导航坐标系下的比力,
ΔΦn(i-1~i)为在导航坐标系下从第i-1到第i个位置旋转过程中引入的姿态误差,
g是重力加速度,
和分别是在第i-1个和第i个位置上从载体坐标系到导航坐标系的方向余弦矩阵,
和分别是在第i-1个和第i个位置上从导航坐标系到载体坐标系的方向余弦矩阵,
为载体坐标系下的加速度计零偏,
Ka包括加速度计标度因数误差和加速度计失准角,
Ka2为加速度计二次项系数,
[X]H代表水平分量与X相同,垂直分量为0的矢量,
为从第i-1个位置到第i个位置的旋转过程中,载体坐标系到导航坐标系的方向余弦矩阵,
εn为导航坐标系下陀螺测得的角速度误差,
εb为载体坐标系下陀螺测得的角速度误差,
ωb为载体坐标系下陀螺测得的角速度,
为载体坐标系下陀螺零偏,
Kg包括陀螺标度因数误差和陀螺失准角,
T是实时时间;
将以上方程联立得到如下方程:
最终构建如下方程:
Δg=AK
步骤五:根据一阶中间参数与一阶误差参数的关系式,设A=[a1 a2 … an]、K=[k1 k2 … kn]T,其中,ai为矩阵A的列向量,i=1,2…n,ki为向量K的各元素,i=1,2…n,[k1k2 … kn]T为行向量[k1 k2 … kn]的转置,
K中包含Bay、Kayy、Kazy、Kax2、Kay2、Kaz2、Kgxx、Kgzz、Kgxy、Kgxz、Kgyx、Kgyz、Kgzx13个误差参数直接由最近一次的完整标定结果给出,这些由外部给出的误差参数在向量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去掉元素全为零的行和列得到Aca ln z,并记下这些行和列的序号,接着求Aca ln z的最小二乘逆矩阵并对扩充元素全为零的行和列得到其中,扩充的行序号与Acal中全为零的列序号相同,列序号与Acal中全为零的行序号相同,
由下式求解参与标定的误差参数:
计算得到Kcal,其中,参与标定计算的误差参数序号上元素为相应的标定计算值,外部给出的误差参数序号上元素全为零,将Kcal与外部给出的Kext相加得到一阶误差参数K;
步骤六:利用步骤五计算的K求解每个静止位置i对应的补偿分量其中i=0,1,2,3,4,计算方法如下:
当i=0时,的计算方法如下:
其中,
为在第0个位置上的
fn为导航坐标系下的比力,
为导航坐标系下第0个位置的姿态误差,包括第0个位置上初始对准引入的姿态误差,
为中与一阶误差参数相关的项,
为地球自转角速度在导航坐标系下的投影,
g是重力加速度,
[X]H代表水平分量与X相同,垂直分量为0的矢量,
[X]V代表垂直分量与X相同,水平分量为0的矢量,
[X]T为矩阵X或向量X的转置,
和分别为导航坐标系下第0个位置计算的比力误差在X轴和Z轴的分量,
L为纬度;
当i=1,2,3,4时,的计算方法如下:
其中,
为在第i个位置上的
fn为导航坐标系下的比力,
为导航坐标系下第i个位置的姿态误差,包括第i-1个位置上初始对准引入的姿态误差及第i-1个位置到第i个位置旋转过程中引入的姿态误差,
为中与一阶误差参数相关的项,
为地球自转角速度在导航坐标系下的投影,
g是重力加速度,
[X]H代表水平分量与x轴相同,垂直分量为0的矢量,
[X]V代表垂直分量与x轴相同,水平分量为0的矢量,
[X]T为矩阵X或向量X的转置,
和分别为导航坐标系下第i-1个位置计算的比力误差在X轴和Z轴的分量,
L为纬度,
ΔΦn(i-1~i)为在导航坐标系下从第i-1到第i个位置旋转过程中引入的姿态误差,
δfn(i-1)为导航坐标系下第i-1个位置下的比力误差,
是在第i-1个位置上从载体坐标系到导航坐标系的方向余弦矩阵,
是在第i-1个位置上从导航坐标系到载体坐标系的方向余弦矩阵,
为载体坐标系下的加速度计零偏,
Ka包括加速度计标度因数误差和加速度计失准角,
Ka2为加速度计二次项系数,
εn为导航坐标系下陀螺测得的角速度误差,
εb为载体坐标系下陀螺测得的角速度误差,
为从第i-1个位置到第i个位置的旋转过程中,载体坐标系到导航坐标系的方向余弦矩阵,
ωb为载体坐标系下陀螺测得的角速度,
为载体坐标系下陀螺零偏,
Kg包括陀螺标度因数误差和陀螺失准角,
T是实时时间;
然后通过步骤二中的及步骤三中的计算出每个静止位置上的二阶中间参数其中由i=0,1,2,3,由i=0,1,2,3,4;
步骤七:将二阶误差参数即陀螺零偏Bgx、Bgy、Bgz记为列向 量ω,依据二阶中间参数和二阶误差参数ω之间的关系,利用步骤六中构建方程其中i=0,1,2,3,4,即:
其中,
表示第i个位置的二阶中间参数,
fn为导航坐标系下的比力,
为导航坐标系下第i个位置的姿态误差,包括第i-1个位置上初始对准引入的姿态误差及第i-1个位置到第i个位置旋转过程中引入的姿态误差,
为中与二阶误差参数相关的项,
为地球自转角速度在导航坐标系下的投影,
和分别为导航坐标系下第i-1个和第i个位置的等效陀螺零偏,
导航坐标系下第i-1个位置的等效陀螺零偏在Z轴上的投影,
ωie为地球自转角速率,
是在第i-1个位置上从载体坐标系到导航坐标系的方向余弦矩阵,
为载体坐标系下的陀螺零偏;
将以上方程联立得到如下方程:
步骤八:利用步骤七中的联立方程计算B的最小二乘逆矩阵进而通过计算出二阶误差参数ω;
步骤九:当一阶误差参数K和二阶误差参数ω的残差大于阈值时,用一阶误差参数K和二阶误差参数ω残差补偿前次标定的误差参数,然后将得到的一阶误差参数K和二阶误差参数ω以及步骤一中采集的惯性测量单元原始数据代入到导航方程中,再进行一次一阶中间参数Δg、二阶中间参数、一阶误差参数K和二阶误差参数ω残差的解算,然后对一阶误差参数K和二阶误差参数ω进行残差补偿,依此类推,经过多次迭代直至某一次迭代计算得到的一阶误差参数K和二阶误差参数ω残差小于阈值。
在上述技术方案中,在步骤一中,所述惯性测量单元初始位置保证Y轴朝向与东西向夹角为15~90°。
在上述技术方案中,当步骤一中惯性测量单元初始位置的Y轴朝向与东西向夹角为0~15°时,步骤八中的B接近奇异,此时二阶误差参数ω中的Bgy项可由外部给出,然后按照步骤五的方法求取B的最小二乘逆矩阵,进而得到ω中的另外两个需标定的误差参数Bgx、Bgz。
在上述技术方案中,在步骤一中,导航坐标系选取北天东(N-U-E,North-Up-East)坐标系。
在上述技术方案中,在步骤一中,标定旋转顺序如下表所示:
标定旋转顺序
旋转序号 | 旋转过程 |
1 | -90Y |
2 | -90Y |
3 | 270Y |
4 | -90Y |
在上述技术方案中,惯性测量单元坐标系是:X轴与X加速度计输入轴方向相同,Y轴位于X加速度计和Y加速度计输入轴构成的平面内,接近Y加速度计输入轴方向,Z轴方向由右手定则确定。
在上述技术方案中,在步骤一中,所述的惯性测量单元通电预热时间为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)该标定方法使用双矢量定姿法进行初始对准(采用g及g×ωie作为参考矢量),所以不用对北,适用于在低精度单轴转位设 备上进行标定,同时标定旋转只需通过编排5个位置,并可在给定历史标定参数的条件下经过多次迭代运算求解出部分所需标定的参数(这是考虑到部分惯性测量单元误差参数的长期稳定性较好,或者该部分惯性测量单元误差参数对惯性导航精度影响较小,采用单轴转位设备标定惯性测量单元主要的误差参数是可取的),可以大幅度降低标定成本,缩短标定时间;
(2)该标定方法采用迭代算法,可以大幅降低标定对转台精度的依赖性。
与国内外其他***级标定方法相比,免对北单轴***级标定方法不需对北,且只需在单轴转位设备上标定,甚至在不依赖单轴转位设备的情况下,直接在大理石平台上进行手动翻转标定即可,这样惯性测量组合就可以直接在外场标定,标定场所不必局限于实验室。这种外场标定将给工程人员带来极大的便利,同时彻底摆脱了标定对转台的依赖。另外,相对于双轴转位设备而言,本发明不仅对器材和采集的原始数据要求低,而且单轴转位设备费用较低,大幅度降低了标定成本,意义重大。
附图说明
图1为本发明适用于低精度无方位基准单轴转位设备的惯性测量单元标定方法的流程图。
具体实施方式
下面结合附图和实施例对本发明作进一步详细说明。
本发明提供一种适用于低精度无方位基准单轴转位设备的惯性测量单元标定方法,具体标定步骤如下:
步骤一:将惯性测量单元安装在单轴转位设备上,所述惯性测量单元初始位置保证X轴朝上或朝下且Y轴朝向与东西向夹角为15~90°,优选的,导航坐标系选取北天东坐标系;惯性测量单元通 电预热30分钟开始采集输出的原始数据,采样周期为0.01s,标定旋转顺序如表一所示:所述惯性测量单元先在第0个位置上静止3-5分钟后,再转动到第1个位置静止3-5分钟,随后转动到第2个位置,依此类推,直至在第4个位置上静止3-5分钟后停止采集惯性测量单元输出的原始数据,然后关闭惯性测量单元。
表一 标定旋转顺序
旋转序号 | 旋转过程 |
1 | -90Y |
2 | -90Y |
3 | 270Y |
4 | -90Y |
步骤二:利用步骤一采集的惯性测量单元原始数据,在第0位置上使用双矢量定姿法进行初始对准,进而得到第0位置上导航起始时刻的天向转角然后利用对准结果和第0位置上的采集数据进行导航解算,进而得到第0位置上导航过程中的实时速度以及实时天向转角θn(0),设第0位置上导航起始时刻的速度 均为0,以速度和天向转角为观测结果拟合出第0位置上的和一阶中间参数所述包含和所述和 分别为第0位置上的参数在x轴、y轴和z轴上投影的标量,所述包含和所述和分别为第0位置上的一阶中间参数在x轴、y轴和z轴上投影的标量;
步骤三:利用步骤一采集的惯性测量单元数据,在第i位置上使用双矢量定姿法进行初始对准,i=0,1,2,3,然后在第i个位置到第i+1个位置的转动过程中以及第i+1个位置上的静止过程中进行连续导航,通过导航获取转动到达第i+1个位置瞬间的速度和 和瞬间的天向转角以及转动完成后在第i+1个位置静止过 程中的实时速度和和实时的天向转角θn(i+1),
式中:g是重力加速度,T是实时时间,
ωvx、ωvy和ωvz分别为系数ωv在x轴、y轴和z轴上的分量,
以速度和天向转角为观测,拟合出第i+1位置上的和一阶中间参数其中,i=0,1,2,3,所述包含和包含和所述和分别为第i+1位置上的参数在x轴、y轴和z轴上投影的标量,所述和 分别为第i+1位置上的一阶中间参数在x轴、y轴和z轴上投影的标量。
步骤四:惯性测量单元坐标系是:X轴与X加速度计输入轴方向相同,Y轴位于X加速度计和Y加速度计输入轴构成的平面内,接近Y加速度计输入轴方向,Z轴方向由右手定则确定;
在此坐标系内,加速度计的误差模型为:
上述误差模型的向量形式为:
其中,
fb为载体坐标系下加速度计测得的比力,
和分别为fb在x轴、y轴和z轴上的投影,
为载体坐标系下的加速度计零偏,
Ka包括加速度计标度因数误差和加速度计失准角,
Ka2为加速度计二次项系数,
δfb为载体坐标系下加速度计测得的比力误差;
陀螺的误差模型为:
上述误差模型的向量形式为:
其中,
ω b为载体坐标系下陀螺测得的角速度,
为载体坐标系下陀螺零偏,
Kg包括陀螺标度因数误差和陀螺失准角,
εb为载体坐标系下陀螺测得的角速度误差;
然后将各一阶误差参数:加速度计零偏Bax、Bay、Baz,加速度计标度因数Kaxx、Kayy、Kazz,加速度计失准角Kayx、Kazx、Kazy,加速度计二次项系数Kax2、Kay2、Kaz2,陀螺标度因数Kgxx、Kgyy、Kgzz,陀螺失准角Kgxy、Kgxz、Kgyx、Kgyz、Kgzx、Kgzy共计21个误差参数记为列向量K,其中,Bax、Bay、Baz分别为加速度计零偏Ba在x轴、y轴和z轴上投影的标量;
在每个位置上,依据一阶中间参数Δg和一阶误差参数K之间的关系,利用步骤二得到的构建方程即:
其中,
δfn(0)为导航坐标系(n系,navigation)下第0个位置的比力误差,
g是重力加速度,
是的第0个位置上从载体坐标系(b系,body)到导航坐标系的方向余弦矩阵,
是在第0个位置上从导航坐标系到载体坐标系的方向余弦矩阵,
为载体坐标系下的加速度计零偏,
fn为导航坐标系下的比力,
Ka包括加速度计标度因数误差和加速度计失准角,
Ka2为加速度计二次项系数,
[X]v表示垂直分量与X相同,水平分量为0的矢量;
用步骤三得到的构建方程其中,中i=0,1,2,3,中i=1,2,3,4,即:
其中,
δfn(i-1)和δfn(i)分别为导航坐标系下第i-1和第i个位置下的比力误差;
fn为导航坐标系下的比力,
ΔΦn(i-1~i)为在导航坐标系下从第i-1到第i个位置旋转过程中引入 的姿态误差,
g是重力加速度,
和分别是在第i-1个和第i个位置上从载体坐标系到导航坐标系的方向余弦矩阵,
和分别是在第i-1个和第i个位置上从导航坐标系到载体坐标系的方向余弦矩阵,
为载体坐标系下的加速度计零偏,
Ka包括加速度计标度因数误差和加速度计失准角,
Ka2为加速度计二次项系数,
[X]H代表水平分量与X相同,垂直分量为0的矢量,
为从第i-1个位置到第i个位置的旋转过程中,载体坐标系到导航坐标系的方向余弦矩阵,
εn为导航坐标系下陀螺测得的角速度误差,
εb为载体坐标系下陀螺测得的角速度误差,
ωb为载体坐标系下陀螺测得的角速度,
为载体坐标系下陀螺零偏,
Kg包括陀螺标度因数误差和陀螺失准角,
T是实时时间;
将以上方程联立得到如下方程:
最终构建如下方程:
Δg=AK
步骤五:根据一阶中间参数与一阶误差参数的关系式,设A=[a1 a2 … an]、K=[k1 k2 … kn]T,其中,ai为矩阵A的列向量,i=1,2…n,ki为向量K的各元素,i=1,2…n,[k1k2 … kn]T为行向量[k1 k2 … kn]的转置,
K中包含Bay、Kayy、Kazy、Kax2、Kay2、Kaz2、Kgxx、Kgzz、Kgxy、Kgxz、Kgyx、Kgyz、Kgzx的13个误差参数直接由最近一次的完整标定结果给出,这些由外部给出的误差参数在向量K中的序号为el,l=1,2,...,ne,其余参与标定计算的误差参数在向量K中的序号为cj,j=1,2,...,nc,且nc+ne=n;然后将矩阵A中所有序号非cj的列置为零后形成的矩阵设为Acdl,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去掉元素全为零的行和列得到Aca ln z,并记下这些行和列的序号,接着求Aca ln z的最小二乘逆矩阵并对扩充元素全为零的行和列得到其中,扩充的行序号与Acal中全为零的列序号相同,列序号与Acal中全为零的行序号相同,
由下式求解参与标定的误差参数:
计算得到Kcal,其中,参与标定计算的误差参数序号上元素为相应的标定计算值,外部给出的误差参数序号上元素全为零,将Kcal与外部给出的Kext相加得到一阶误差参数K。
步骤六:利用步骤五中的K计算出每个静止位置i对应的补偿分量其中i=0,1,2,3,4,计算方法如下:
当i=0时,的计算方法如下:
其中,
为在第0个位置上的
fn为导航坐标系下的比力,
为导航坐标系下第0个位置的姿态误差,包括第0个位置上初始对准引入的姿态误差,
为中与一阶误差参数相关的项,
为地球自转角速度在导航坐标系下的投影,
g是重力加速度,
[X]H代表水平分量与X相同,垂直分量为0的矢量,
[X]V代表垂直分量与X相同,水平分量为0的矢量,
[X]T为矩阵X或向量X的转置,
和分别为导航坐标系下第0个位置计算的比力误差在X轴和Z轴的分量,
L为纬度;
当i=1,2,3,4时,的计算方法如下:
其中,
为在第i个位置上的
fn为导航坐标系下的比力,
为导航坐标系下第i个位置的姿态误差,包括第i-1个位置上初始对准引入的姿态误差及第i-1个位置到第i个位置旋转过程中引入的姿态误差,
为中与一阶误差参数相关的项,
为地球自转角速度在导航坐标系下的投影,
g是重力加速度,
[X]H代表水平分量与x轴相同,垂直分量为0的矢量,
[X]V代表垂直分量与x轴相同,水平分量为0的矢量,
[X]T为矩阵X或向量X的转置,
和分别为导航坐标系下第i-1个位置计算的比力误差在X轴和Z轴的分量,
L为纬度,
ΔΦn(i-1~i)为在导航坐标系下从第i-1到第i个位置旋转过程中引入的姿态误差,
δfn(i-1)为导航坐标系下第i-1个位置下的比力误差,
是在第i-1个位置上从载体坐标系到导航坐标系的方向余弦矩阵,
是在第i-1个位置上从导航坐标系到载体坐标系的方向余弦矩阵,
为载体坐标系下的加速度计零偏,
Ka包括加速度计标度因数误差和加速度计失准角,
Ka2为加速度计二次项系数,
εn为导航坐标系下陀螺测得的角速度误差,
εb为载体坐标系下陀螺测得的角速度误差,
为从第i-1个位置到第i个位置的旋转过程中,载体坐标系到导航坐标系的方向余弦矩阵,
ωb为载体坐标系下陀螺测得的角速度,
为载体坐标系下陀螺零偏,
Kg包括陀螺标度因数误差和陀螺失准角,
T是实时时间;
然后通过步骤二中的及步骤三中的计算出每个静止位置上的二阶中间参数其中,中i=0,1,2,3, 中i=0,1,2,3,4。
步骤七:将二阶误差参数即陀螺零偏Bgx、Bgy、Bgz记为列向量ω,依据二阶中间参数和二阶误差参数ω之间的关系,利用步骤六中构建方程其中i=0,1,2,3,4,即:
其中,
表示第i个位置的二阶中间参数,
fn为导航坐标系下的比力,
为导航坐标系下第i个位置的姿态误差,包括第i-1个位置上初始对准引入的姿态误差及第i-1个位置到第i个位置旋转过程中引入的姿态误差,
为中与二阶误差参数相关的项,
为地球自转角速度在导航坐标系下的投影,
和分别为导航坐标系下第i-1个和第i个位置的等效陀螺零偏,
导航坐标系下第i-1个位置的等效陀螺零偏在Z轴上的投影,
ωie为地球自转角速率,
是在第i-1个位置上从载体坐标系到导航坐标系的方向余弦矩阵,
为载体坐标系下的陀螺零偏;
将以上方程联立得到如下方程:
步骤八:利用步骤七中的联立方程计算B的最小二乘逆矩阵进而通过计算出二阶误差参数ω。另外,当步骤一中惯性测量单元初始位置的Y轴朝向与东西向夹角为0~15°时,B接近奇异,此时二阶误差参数ω中的Bgy项可由外部给出,然后按照步骤五的方法求取B的最小二乘逆矩阵进而得到ω中的另外两个需标定的误差参数Bgx、Bgz。
步骤九:当一阶误差参数K和二阶误差参数ω的残差大于阈值时,用一阶误差参数K和二阶误差参数ω残差补偿前次标定的误差参数。然后将得到的一阶误差参数K和二阶误差参数ω的以及步骤一中采集的惯性测量单元原始数据代入到导航方程中,再进行一次一阶中间参数Δg、二阶中间参数一阶误差参数K和二阶误差参数ω残差的解算,然后对一阶误差参数K和二阶误差参数ω进行残差补偿,依此类推,经过多次迭代直至某一次迭代计算得到的一阶误差参数K和二阶误差参数ω残差小于阈值。
Claims (8)
1.一种适用于低精度无方位基准单轴转位设备的惯性测量单元标定方法,其特征在于:包含如下步骤:
步骤一:将惯性测量单元安装在单轴转位设备上,所述惯性测量单元初始位置保证X轴朝上或朝下,惯性测量单元通电预热后开始采集输出的原始数据,所述惯性测量单元先在第0个位置上静止3-5分钟后,再转动到第1个位置静止3-5分钟,随后转动到第2个位置,依此类推,直至在第4个位置上静止3-5分钟后停止采集惯性测量单元输出的原始数据;
步骤二:利用步骤一采集的惯性测量单元原始数据,在第0位置上使用双矢量定姿法进行初始对准,进而得到第0位置上导航起始时刻的天向转角然后利用对准结果和第0位置上的采集数据进行导航解算,进而得到第0位置上导航过程中的实时速度以及实时天向转角θn(0),设第0位置上导航起始时刻的速度 均为0,以速度和天向转角为观测结果拟合出第0位置上的和一阶中间参数所述包含和所述和分别为第0位置上的参数在x轴、y轴和z轴上投影的标量,所述包含和所述和分别为第0位置上的一阶中间参数在x轴、y轴和z轴上投影的标量;
步骤三:利用步骤一采集的惯性测量单元原始数据,在第i位置上使用双矢量定姿法进行初始对准,i=0,1,2,3,然后在第i个位置到第i+1个位置的转动过程中以及第i+1个位置上的静止过程中进行连续导航,通过导航获取转动到达第i+1个位置瞬间的速度和和瞬间的天向转角以及转动完成后在第i+1个位置静止过程中的实时速度和和实时的天向转角θn(i+1),
式中:g是重力加速度,T是实时时间,
ωvx、ωvy和ωvz分别为系数ωv在x轴、y轴和z轴上的分量,
以速度和天向转角为观测,拟合出第i+1位置上的和一阶中间参数其中,i=0,1,2,3,所述包含和包含和所述和分别为第i+1位置上的参数在x轴、y轴和z轴上投影的标量,所述和分别为第i+1位置上的一阶中间参数在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,陀螺标度因数Kgxx、Kgyy、Kgzz,陀螺失准角Kgxy、Kgxz、Kgyx、Kgyz、Kgzx、Kgzy共计21个误差参数记为一阶误差参数K,其中,Bax、Bay、Baz分别为加速度计零偏Ba在x轴、y轴和z轴上投影的标量;
在每个位置上,依据一阶中间参数Δg与一阶误差参数K的关系,利用步骤二得到的构建方程即:
其中,
δfn(0)为导航坐标系(n系,navigation)下第0个位置的比力误差,
g是重力加速度,
是在第0个位置上从载体坐标系(b系,body)到导航坐标系的方向余弦矩阵,
是在第0个位置上从导航坐标系到载体坐标系的方向余弦矩阵,
为载体坐标系下的加速度计零偏,
fn为导航坐标系下的比力,
Ka包括加速度计标度因数误差和加速度计失准角,
Ka2为加速度计二次项系数,
[X]V表示垂直分量与X相同,水平分量为0的矢量;
用步骤三得到的构建方程其中,中i=0,1,2,3,中i=1,2,3,4,即:
其中,
δfn(i-1)和δfn(i)分别为导航坐标系下第i-1和第i个位置下的比力误差,
fn为导航坐标系下的比力,
ΔΦn(i-1~i)为在导航坐标系下从第i-1到第i个位置旋转过程中引入的姿态误差,
g是重力加速度,
和分别是在第i-1个和第i个位置上从载体坐标系到导航坐标系的方向余弦矩阵,
和分别是在第i-1个和第i个位置上从导航坐标系到载体坐标系的方向余弦矩阵,
为载体坐标系下的加速度计零偏,
Ka包括加速度计标度因数误差和加速度计失准角,
Ka2为加速度计二次项系数,
[X]H代表水平分量与X相同,垂直分量为0的矢量,
为从第i-1个位置到第i个位置的旋转过程中,载体坐标系到导航坐标系的方向余弦矩阵,
εn为导航坐标系下陀螺测得的角速度误差,
εb为载体坐标系下陀螺测得的角速度误差,
ωb为载体坐标系下陀螺测得的角速度,
为载体坐标系下陀螺零偏,
Kg包括陀螺标度因数误差和陀螺失准角,
T是实时时间;
将以上方程联立得到如下方程:
最终构建如下方程:
Δ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、Kgxx、Kgzz、Kgxy、Kgxz、Kgyx、Kgyz、Kgzx的13个误差参数直接由最近一次的完整标定结果给出,这些由外部给出的误差参数在向量K中的序号为其余参与标定计算的误差参数在向量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,计算方法如下:
当i=0时,的计算方法如下:
其中,
为在第0个位置上的
fn为导航坐标系下的比力,
为导航坐标系下第0个位置的姿态误差,包括第0个位置上初始对准引入的姿态误差,
为中与一阶误差参数相关的项,
为地球自转角速度在导航坐标系下的投影,
g是重力加速度,
[X]H代表水平分量与X相同,垂直分量为0的矢量,
[X]V代表垂直分量与X相同,水平分量为0的矢量,
[X]T为矩阵X或向量X的转置,
和分别为导航坐标系下第0个位置计算的比力误差在X轴和Z轴的分量,
L为纬度;
当i=1,2,3,4时,的计算方法如下:
其中,
为在第i个位置上的
fn为导航坐标系下的比力,
为导航坐标系下第i个位置的姿态误差,包括第i-1个位置上初始对准引入的姿态误差及第i-1个位置到第i个位置旋转过程中引入的姿态误差,
为中与一阶误差参数相关的项,
为地球自转角速度在导航坐标系下的投影,
g是重力加速度,
[X]H代表水平分量与x轴相同,垂直分量为0的矢量,
[X]V代表垂直分量与x轴相同,水平分量为0的矢量,
[X]T为矩阵X或向量X的转置,
和分别为导航坐标系下第i-1个位置计算的比力误差在X轴和Z轴的分量,
L为纬度,
ΔΦn(i-1~i)为在导航坐标系下从第i-1到第i个位置旋转过程中引入的姿态误差,
δfn(i-1)为导航坐标系下第i-1个位置下的比力误差,
是在第i-1个位置上从载体坐标系到导航坐标系的方向余弦矩阵,
是在第i-1个位置上从导航坐标系到载体坐标系的方向余弦矩阵,
为载体坐标系下的加速度计零偏,
Ka包括加速度计标度因数误差和加速度计失准角,
Ka2为加速度计二次项系数,
εn为导航坐标系下陀螺测得的角速度误差,
εb为载体坐标系下陀螺测得的角速度误差,
为从第i-1个位置到第i个位置的旋转过程中,载体坐标系到导航坐标系的方向余弦矩阵,
ωb为载体坐标系下陀螺测得的角速度,
为载体坐标系下陀螺零偏,
Kg包括陀螺标度因数误差和陀螺失准角,
T是实时时间;
然后通过步骤二中的及步骤三中的计算出每个静止位置上的二阶中间参数其中,中i=0,1,2,3,中i=0,1,2,3,4;
步骤七:将二阶误差参数即陀螺零偏Bgx、Bgy、Bgz记为列向量ω,依据二阶中间参数和二阶误差参数ω之间的关系,利用步骤六中构建方程其中i=0,1,2,3,4,即:
其中,
表示第i个位置的二阶中间参数,
fn为导航坐标系下的比力,
为导航坐标系下第i个位置的姿态误差,包括第i-1个位置上初始对准引入的姿态误差及第i-1个位置到第i个位置旋转过程中引入的姿态误差,
为中与二阶误差参数相关的项,
为地球自转角速度在导航坐标系下的投影,
和分别为导航坐标系下第i-1个和第i个位置的等效陀螺零偏,
导航坐标系下第i-1个位置的等效陀螺零偏在Z轴上的投影,
ωie为地球自转角速率,
是在第i-1个位置上从载体坐标系到导航坐标系的方向余弦矩阵,
为载体坐标系下的陀螺零偏;
将以上方程联立得到如下方程:
步骤八:利用步骤七中的联立方程计算B的最小二乘逆矩阵进而通过计算出二阶误差参数ω;
步骤九:当一阶误差参数K和二阶误差参数ω的残差大于阈值时,用一阶误差参数K和二阶误差参数ω残差补偿前次标定的误差参数,然后将得到的一阶误差参数K和二阶误差参数ω以及步骤一中采集的惯性测量单元原始数据代入到导航方程中,再进行一次一阶中间参数Δg、二阶中间参数一阶误差参数K和二阶误差参数ω残差的解算,然后对一阶误差参数K和二阶误差参数ω进行残差补偿,依此类推,经过多次迭代直至某一次迭代计算得到的一阶误差参数K和二阶误差参数ω残差小于阈值。
2.根据权利要求1所述的一种适用于低精度无方位基准单轴转位设备的惯性测量单元标定方法,其特征在于:在步骤一中,所述惯性测量单元初始位置保证Y轴朝向与东西向夹角为15~90°。
3.根据权利要求1所述的一种适用于低精度无方位基准单轴转位设备的惯性测量单元标定方法,其特征在于:当步骤一中惯性测量单元初始位置的Y轴朝向与东西向夹角为0~15°时,步骤八中的B接近奇异,此时二阶误差参数ω中的Bgy项可由外部给出,然后按照步骤五的方法求取B的最小二乘逆矩阵进而得到ω中的另外两个需标定的误差参数Bgx、Bgz。
4.根据权利要求1至3中任一项所述的一种适用于低精度无方位基准单轴转位设备的惯性测量单元标定方法,其特征在于:在步骤一中,导航坐标系选取北天东坐标系。
5.根据权利要求1至3中任一项所述的一种适用于低精度无方位基准单轴转位设备的惯性测量单元标定方法,其特征在于:在步骤一中,标定旋转顺序如下表所示:
标定旋转顺序
6.根据权利要求1至3中任一项所述的一种适用于低精度无方位基准单轴转位设备的惯性测量单元标定方法,其特征在于:惯性测量单元坐标系是:X轴与X加速度计输入轴方向相同,Y轴位于X加速度计和Y加速度计输入轴构成的平面内,接近Y加速度计输入轴方向,Z轴方向由右手定则确定。
7.根据权利要求1至3中任一项所述的一种适用于低精度无方位基准单轴转位设备的惯性测量单元标定方法,其特征在于:在步骤一中,所述的惯性测量单元通电预热时间为30分钟,原始数据的采样周期为0.01s。
8.根据权利要求1至3中任一项所述的一种适用于低精度无方位基准单轴转位设备的惯性测量单元标定方法,其特征在于:在步骤一中,停止采集惯性测量单元后关闭惯性测量单元。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201410232223.0A CN104121927B (zh) | 2014-05-29 | 2014-05-29 | 一种适用于低精度无方位基准单轴转位设备的惯性测量单元标定方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201410232223.0A CN104121927B (zh) | 2014-05-29 | 2014-05-29 | 一种适用于低精度无方位基准单轴转位设备的惯性测量单元标定方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN104121927A CN104121927A (zh) | 2014-10-29 |
CN104121927B true CN104121927B (zh) | 2016-09-28 |
Family
ID=51767438
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201410232223.0A Active CN104121927B (zh) | 2014-05-29 | 2014-05-29 | 一种适用于低精度无方位基准单轴转位设备的惯性测量单元标定方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN104121927B (zh) |
Cited By (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
RU2717566C1 (ru) * | 2019-08-15 | 2020-03-24 | Акционерное общество "Научно-производственное объединение автоматики имени академика Н.А. Семихатова" | Способ определения погрешностей инерциального блока чувствительных элементов на двухосном поворотном столе |
Families Citing this family (7)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN105953820B (zh) * | 2016-06-20 | 2018-10-26 | 浙江大学 | 一种惯性测量组合动态导航性能的光学标定装置 |
CN107421564B (zh) * | 2017-06-23 | 2019-08-02 | 北京机械设备研究所 | 一种四位置寻北仪转位误差补偿方法 |
CN109000644A (zh) * | 2018-06-15 | 2018-12-14 | 北京航天发射技术研究所 | 一种基于VxWorks的惯性测量单元***级标定方法 |
CN109460075B (zh) * | 2018-11-01 | 2021-10-01 | 湖北航天技术研究院总体设计所 | 一种快速方位角对准的方法及*** |
RU2718142C1 (ru) * | 2019-04-17 | 2020-03-30 | Акционерное общество Московский научно-производственный комплекс "Авионика" имени О.В. Успенского (АО МНПК "Авионика") | Способ повышения точности калибровки масштабных коэффициентов и углов неортогональности осей чувствительности блока датчиков ДУС |
FR3097316B1 (fr) * | 2019-06-14 | 2022-01-28 | Safran Electronics & Defense | Procédé de surveillance des performances d’unités de mesure inertielle |
CN113008273B (zh) * | 2021-03-09 | 2023-04-25 | 北京小马智行科技有限公司 | 车辆的惯性测量单元的标定方法、装置与电子设备 |
Citations (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN102052921A (zh) * | 2010-11-19 | 2011-05-11 | 哈尔滨工程大学 | 一种单轴旋转捷联惯导***初始航向的确定方法 |
CN103063205A (zh) * | 2012-12-24 | 2013-04-24 | 陕西宝成航空仪表有限责任公司 | 一种用于寻北***中四位置寻北测量的转位方法及机构 |
CN103148854A (zh) * | 2013-01-28 | 2013-06-12 | 辽宁工程技术大学 | 基于单轴正反转动的mems惯导***姿态测量方法 |
Family Cites Families (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP2007232443A (ja) * | 2006-02-28 | 2007-09-13 | Yokogawa Electric Corp | 慣性航法装置およびその誤差補正方法 |
KR101490332B1 (ko) * | 2012-10-22 | 2015-02-05 | 주식회사 디엠비테크놀로지 | Direct AC LED 구동 장치 및 구동 방법 |
-
2014
- 2014-05-29 CN CN201410232223.0A patent/CN104121927B/zh active Active
Patent Citations (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN102052921A (zh) * | 2010-11-19 | 2011-05-11 | 哈尔滨工程大学 | 一种单轴旋转捷联惯导***初始航向的确定方法 |
CN103063205A (zh) * | 2012-12-24 | 2013-04-24 | 陕西宝成航空仪表有限责任公司 | 一种用于寻北***中四位置寻北测量的转位方法及机构 |
CN103148854A (zh) * | 2013-01-28 | 2013-06-12 | 辽宁工程技术大学 | 基于单轴正反转动的mems惯导***姿态测量方法 |
Cited By (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
RU2717566C1 (ru) * | 2019-08-15 | 2020-03-24 | Акционерное общество "Научно-производственное объединение автоматики имени академика Н.А. Семихатова" | Способ определения погрешностей инерциального блока чувствительных элементов на двухосном поворотном столе |
Also Published As
Publication number | Publication date |
---|---|
CN104121927A (zh) | 2014-10-29 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN104121927B (zh) | 一种适用于低精度无方位基准单轴转位设备的惯性测量单元标定方法 | |
CN104121928B (zh) | 一种适用于低精度有方位基准单轴转位设备的惯性测量单元标定方法 | |
CN110160554B (zh) | 一种基于寻优法的单轴旋转捷联惯导***标定方法 | |
CN103575299B (zh) | 利用外观测信息的双轴旋转惯导***对准及误差修正方法 | |
CN110006450B (zh) | 一种激光捷联惯导***在卧式三轴转台上的标定方法 | |
CN103852085B (zh) | 一种基于最小二乘拟合的光纤捷联惯导***现场标定方法 | |
CN101979277B (zh) | 卫星磁测磁控***的全实物验证平台与工作方法 | |
CN103983274B (zh) | 一种适用于低精度无方位基准双轴转位设备的惯性测量单元标定方法 | |
CN106969783A (zh) | 一种基于光纤陀螺惯性导航的单轴旋转快速标定技术 | |
CN101377422B (zh) | 挠性陀螺仪静态漂移误差模型最优二十四位置标定方法 | |
CN103900565B (zh) | 一种基于差分gps的惯导***姿态获取方法 | |
CN101738203B (zh) | 挠性陀螺仪静态漂移零次和一次加速度相关项误差模型最优位置标定方法 | |
CN102564455B (zh) | 星敏感器安装误差四位置标定与补偿方法 | |
CN108168574A (zh) | 一种基于速度观测的8位置捷联惯导***级标定方法 | |
CN104165638B (zh) | 一种双轴旋转惯导***多位置自主标定方法 | |
CN103076025B (zh) | 一种基于双解算程序的光纤陀螺常值误差标定方法 | |
CN106482746B (zh) | 一种用于混合式惯导***的加速度计内杆臂标定与补偿方法 | |
CN104764463B (zh) | 一种惯性平台调平瞄准误差的自检测方法 | |
CN102519485B (zh) | 一种引入陀螺信息的二位置捷联惯性导航***初始对准方法 | |
CN104697553B (zh) | 光纤陀螺捷联惯导***加速度计内杆臂标定方法 | |
CN101706284A (zh) | 提高船用光纤陀螺捷联惯导***定位精度的方法 | |
CN103994775B (zh) | 一种适用于低精度有方位基准双轴转位设备的惯性测量单元标定方法 | |
CN106017452A (zh) | 双陀螺抗扰动寻北方法 | |
CN105865432B (zh) | 一种针对陀螺仪多源噪声的混合滤波方法与测试平台 | |
CN113203415B (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 |