CN115683155A - 一种旋转捷联惯导***误差***级标定方法 - Google Patents
一种旋转捷联惯导***误差***级标定方法 Download PDFInfo
- Publication number
- CN115683155A CN115683155A CN202211165555.2A CN202211165555A CN115683155A CN 115683155 A CN115683155 A CN 115683155A CN 202211165555 A CN202211165555 A CN 202211165555A CN 115683155 A CN115683155 A CN 115683155A
- Authority
- CN
- China
- Prior art keywords
- error
- accelerometer
- gyroscope
- rotating
- degrees
- 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.)
- Pending
Links
- 238000000034 method Methods 0.000 title claims abstract description 28
- 238000009434 installation Methods 0.000 claims abstract description 51
- 230000007246 mechanism Effects 0.000 claims abstract description 42
- 238000005259 measurement Methods 0.000 claims abstract description 36
- 238000001914 filtration Methods 0.000 claims abstract description 14
- 239000011159 matrix material Substances 0.000 claims description 42
- 230000007704 transition Effects 0.000 claims description 7
- 230000008569 process Effects 0.000 claims description 6
- 230000001133 acceleration Effects 0.000 claims description 2
- 238000012937 correction Methods 0.000 claims description 2
- 230000033001 locomotion Effects 0.000 claims description 2
- 230000009466 transformation Effects 0.000 claims description 2
- 238000004088 simulation Methods 0.000 abstract description 8
- 238000005516 engineering process Methods 0.000 description 5
- 238000004519 manufacturing process Methods 0.000 description 3
- 230000003068 static effect Effects 0.000 description 3
- 230000009471 action Effects 0.000 description 1
- 230000009286 beneficial effect Effects 0.000 description 1
- 230000000694 effects Effects 0.000 description 1
- 230000005284 excitation Effects 0.000 description 1
- 238000002474 experimental method Methods 0.000 description 1
- 238000013178 mathematical model Methods 0.000 description 1
Images
Landscapes
- Navigation (AREA)
Abstract
本发明公开了一种旋转捷联惯导***误差***级标定方法。在旋转惯导具有旋转机构的基础上,设定了30位置旋转标定策略,惯导***在旋转策略的位置翻转可以充分激励出惯性测量单元的各项误差;其次建立Kalman滤波模型,以速度误差和位置误差为量测量去估计惯导误差;最终通过仿真实验验证了本发明所设计的30位置旋转捷联惯导***误差***级标定方法可以一次性高精度标定出陀螺仪和加速度计的常值误差、刻度系数误差以及安装误差。
Description
技术领域
本发明涉及捷联惯性导航技术领域,具体涉及一种旋转捷联惯导***误差***级标定方法。
背景技术
惯性导航***的主要组成部分为惯性测量单元,在生产制造时不可避免的存在相关器件误差,如常值误差、刻度系数误差、安装误差等。为了抑制这些误差对惯导***的影响,除了旋转调制技术外,常常通过误差标定技术对误差进行估计补偿,来达到高精度导航的目的。标定主要分为分立式标定和***级标定。分立式标定技术将惯导***安装在转动机构上,通过不同位置编排对陀螺仪和加速度计进行标定,将标定出的误差对惯导***进行补偿,但分立式标定具有拆装繁琐,并且对转动机构要求精度高,无法外场标定的缺点。旋转捷联惯性导航***可以利用自身的转动机构进行***级标定,可以避免从载体上拆装的复杂性并且可以为长航时精确导航提供了现实基础。
***级标定通过设计合理的位置编排来激励惯性测量单元的误差,建立惯性测量单元输入输出数学模型,以导航误差(速度误差、位置误差)作为观测量,通过最小二乘法或卡尔曼滤波将误差参数估计出来。SAGEM公司设计了一种18位置标定方案(Camberlein L,Mazzanti F.Calibration technique for laser gyro strapdown inertial navigationsystems[J].Ortung Und Navigation,1985:5.0-5.13.)用来标定激光陀螺惯导***,经过标定可以达到***级精度要求,并且该方案有着丰富的工程实践经验,是一种传统的误差标定方法。文献(谢波,秦永元,万彦辉.激光陀螺捷联惯导***多位置标定方法[J].中国惯性技术学报,2011,19(02):157-162+169.)提出了一种19位置标定方法,通过多次初始对准、位置翻转和静态导航过程激励惯性测量单元误差参数,采用最小二乘方法可以在较短时间内可以标定出21个误差参数。***级标定技术中旋转标定方案是关键因素。
发明内容
本发明的目的是解决惯导***误差标定问题,提供了一种新的旋转捷联惯导***误差标定方法,能够同时标定出陀螺仪和加速度计的常值误差、刻度系数误差和安装误差,并对惯导***进行补偿,进而达到提高***精度的目的。
为实现上述目的,本发明所设计的旋转捷联惯导***误差标定方法,包括如下步骤:
步骤S11:定义坐标系和定义惯性测量单元中陀螺仪和加速度计的常值误差参数、刻度系数误差参数和安装误差参数
确定旋转惯导***惯性测量单元所处的惯性坐标系(设为i系),惯性坐标系的原点oi位于地球的中心,由原点出发指向北极为oi-zi轴,由原点出发指向平均春分点为oi-xi轴,oi-yi轴与oi-zi轴构成右手直角坐标系;
确定旋转惯导***惯性测量单元所处的导航坐标系(设为n系),该坐标系为当地地理坐标系,其原点on位于载体质心,其on-xn、on-yn、on-zn轴由原点分别指向东、北、天方向;
确定旋转惯导***惯性测量单元所处的载体坐标系(设为b系),载体的质心为载体坐标系的原点ob,载体系坐标系的ob-xb、ob-yb和ob-zb轴分别从载体的质心指向载体的右侧、前侧和上侧;
确定惯性测量单元坐标系(设为p系),惯性测量单元由三组正交安装的陀螺仪和加速度计组成,惯性测量单元坐标系的原点op位于惯性测量单元质心,其op-xp、op-yp、op-zp轴指向由原点出发分别与三组正交安装的陀螺仪和加速度计指向平行;
确定安装坐标系坐标系(设为m系),在制作惯性测量单元时,无法保证三组陀螺仪和加速度计是理想正交安装的,设实际安装时惯性测量单元坐标系为安装坐标系,安装坐标系的原点om与p系相同;
陀螺仪和加速度计刻度系数误差分别表示为δKg和δKa,具体表示如下:
其中,δKgx、δKgy、δKgz分别为陀螺仪刻度系数误差在op-xp、op-yp、op-zp轴的分量,δKax、δKay、δKaz分别为加速度计刻度系数误差在op-xp、op-yp、op-zp轴的分量。
陀螺仪和加速度计安装误差分别表示为δAg和δAa,具体表示如下:
其中,δAgyx为om-ym轴陀螺仪与op-xp-yp平面的安装误差角,δAgzx为om-zm轴陀螺仪与op-xp-zp平面的安装误差角,δAgzy为om-zm轴陀螺仪与op-yp-zp平面的安装误差角,δAgxy为om-xm轴陀螺仪与op-xp-yp平面的安装误差角,δAgxz为om-xm轴陀螺仪与op-xp-zp平面的安装误差角,δAgyz为om-ym轴陀螺仪与op-yp-zp平面的安装误差角,δAayx为om-ym轴加速度计与op-xp-yp平面的安装误差角,δAazx为om-zm轴加速度计与op-xp-zp平面的安装误差角,δAazy为om-zm轴加速度计与op-yp-zp平面的安装误差角,δAaxy为om-xm轴加速度计与op-xp-yp平面的安装误差角,δAaxz为om-xm轴加速度计与op-xp-zp平面的安装误差角,δAayz为om-ym轴加速度计与op-yp-zp平面的安装误差角。
步骤S21:构建陀螺仪和加速度计误差模型
为了减少标定参数的数量,以便于提高运算速率,缩短标定时间,现假定陀螺仪正交系的op-xp轴与安装坐标系下的om-xm轴重合,并且op-yp轴在om-xm-ym平面内。则陀螺仪误差模型如下:
加速度计误差模型:
步骤S31:通过步骤21陀螺仪和加速度计误差模型经过翻转激励出步骤11定义的误差参数。
初始时惯性测量单元的三个轴向op-xp、op-yp、op-zp分别指向天-东-北,转动机构的中轴与惯性测量单元的op-yp轴重合,转动机构的内轴与惯性测量单元的op-zp轴重合,转动机构的外轴与惯性测量单元的op-xp轴重合。设计30位置标定路径如下:1.绕转动机构中框轴正向旋转90度,旋转角速度为ω度/秒,转动完成后停止t秒;2.绕转动机构中框轴正向旋转90度,旋转角速度为ω度/秒,转动完成后停止t秒;3.绕转动机构中框轴正向旋转90度,旋转角速度为ω度/秒,转动完成后停止t秒;4.绕转动机构中框轴反向旋转180度,旋转角速度为ω度/秒,转动完成后停止t秒;5.绕转动机构中框轴反向旋转90度,旋转角速度为ω度/秒,转动完成后停止t秒;6.绕转动机构内框轴正向旋转90度,旋转角速度为ω度/秒,转动完成后停止t秒;7.绕转动机构中框轴正向旋转90度,旋转角速度为ω度/秒,转动完成后停止t秒;8.绕转动机构中框轴正向旋转90度,旋转角速度为ω度/秒,转动完成后停止t秒;9.绕转动机构中框轴正向旋转90度,旋转角速度为ω度/秒,转动完成后停止t秒;10.绕转动机构中框轴反向旋转180度,旋转角速度为ω度/秒,转动完成后停止t秒;11.绕转动机构中框轴反向旋转90度,旋转角速度为ω度/秒,转动完成后停止t秒;12.绕转动机构内框轴正向旋转90度,旋转角速度为ω度/秒,转动完成后停止t秒;13.绕转动机构内框轴正向旋转90度,旋转角速度为ω度/秒,转动完成后停止t秒;14.绕转动机构内框轴反向旋转180度,旋转角速度为ω度/秒,转动完成后停止t秒;15.绕转动机构内框轴反向旋转90度,旋转角速度为ω度/秒,转动完成后停止t秒;16-30位置与1-15位置转轴次序相同,转动方向相反。
步骤S41:根据步骤31中的误差参数建立Kalman滤波模型
经过步骤31的一系列翻转,可以激励陀螺仪和加速度计产生误差。然后将其带入惯导姿态误差、速度误差和位置误差方程即可得到***状态误差模型。
建立状态向量包含姿态误差、速度误差、位置误差、陀螺仪和加速度计常值误差、刻度系数误差和安装误差的30维Kalman状态方程:
其中,30维状态向量X(t)为
其中各分块矩阵具体表达式如下:
其中,ωie为地球自转角速率,RM、RN分别为地球子午圈、卯酉圈曲率半径,L为载体所在纬度,h为载体所在高度。
其中,vE、vN分别为北向、北向速度。
其中,vU为天向速度。
式(3)中G为***噪声驱动矩阵,表达式如下:
W(t)为***噪声矩阵,由陀螺仪噪声Wg(t)和加速度计噪声Wa(t)组成,均为零均值高斯白噪声向量序列,其表达式如下:
建立如下以速度误差和位置误差为观测量的Kalman滤波器观测方程:
Z(t)=H(t)X(t)+V(t) (19)
其中,Z(t)为观测量,由速度误差和位置误差组成,表达式如下:
Z(t)=[δvE δvN δvU δL δλ δh]T (20)
H为观测矩阵,表达式如下:
V(t)为观测噪声矩阵,代表能够获取观测量的***噪声,包括速度观测噪声和位置观测噪声,均为零均值高斯白噪声向量序列,且上述W(t)和V(t)互不相关,表达式如下:
步骤S51:Kalman滤波模型离散化获得陀螺仪和加速度计的常值误差、刻度系数误差和安装误差估计值
给定***状态空间模型:
式中,Xk为离散后的状态向量,Zk为离散后的量测向量,Fk/k-1、Hk和Γk/k-1分别为状态转移矩阵、量测矩阵和***噪声驱动矩阵,Wk-1和Vk分别为***噪声向量和量测噪声向量。
从k-1时刻到k时刻的离散状态转移矩阵Fk/k-1具体表达式如下:
其中,I为单位矩阵,Ts为滤波周期。
Kalman滤波全套算法如下:
状态一步预测
状态一步预测均方误差阵
滤波增益
状态估计
状态估计均方误差
Pk=(I-KkHk)Pk/k-1 (28)
式(25)中Q为陀螺仪和加速度计输出白噪声的均方误差矩阵,R为观测噪声方差矩阵。
综上所述,结合步骤31一系列翻转运动,将惯性测量单元输出数据进行惯导解算,与此同时进行Kalman滤波,在给定***状态向量初始值X0、状态估计均方差初始值P0,陀螺仪和加速度计输出白噪声的均方误差矩阵Q0和观测噪声方差矩阵初始值R0的条件下,以及确定观测量Z、状态转移矩阵F和观测矩阵H的选取,由式(24)至式(28)可以递推估计出任意时刻的状态量X,从而可以得到陀螺仪和加速度计的常值误差、刻度系数误差和安装误差估计值。
步骤S61:将步骤51中得到的陀螺仪和加速度计的常值误差、刻度系数误差和安装误差估计值对***进行校正。误差修正模型如下所示:
陀螺仪和加速度计常值误差反馈:
陀螺仪刻度系数误差和安装误差反馈:
陀螺仪和加速度安装误差反馈:
与现有技术相比,本发明的有益效果为:本发明利用旋转惯导***自身转动机构优势以及设计的30位置旋转标定方案,可以在外场环境下充分激励出惯导相关器件误差,然后通过建立30维Kalman滤波模型,以速度误差和位置误差作为观测量可以较高精度的估计出陀螺仪和加速度计的常值误差、刻度系数误差和安装误差。
附图说明
图1为转动机构示意图;
图2为旋转标定策略图;
图3为仿真实验误差参数估计曲线对比
图4为估计的惯性器件误差补偿后导航定位误差对比
具体实施方式
下面结合附图和具体实施例对本发明作进一步的详细说明。
本发明可行性可通过仿真实验验证,如图1惯性测量单元安装在旋转机构上,b系下标定旋转方案如图2所示,仿真实验采取对比实验,以SAGEM公司设计的传统18位置方案为参照,比对本发明方案的标定效果:
实验条件:初始纬度30.6度,初始经度114.2度,初始高度25米;初始姿态为(0°,-90°,-90°);仿真采取静态仿真,所以初始速度为0;初始姿态误差(0.5′,-0.5′,0.5′);初始速度误差(0.1m/s,0.1m/s,0.1m/s,);初始位置误差(1m,1m,3m);仿真时长4小时。
Kalman滤波模型初始参数设置:
***状态向量初始值X0=[030×1];
状态估计均方差初始值P0:
P0=diag{(0.5′)2,(-0.5′)2,(0.5′)2,(0.1m/s)2,(0.1m/s)2,(0.1m/s)2,(1m)2,(1m)2,(3m)2,(0.05°/h)2,(0.05°/h)2,(0.05°/h)2,(80ug)2,(90ug)2,(100ug)2,(40ppm)2,(10″)2,(10″)2,(40ppm)2,(10″)2,(40ppm)2,(20ppm)2,(10″)2,(10″)2,(10″)2,(20ppm)2,(10″)2,(10″)2,(10″)2,(20ppm)2}
白噪声的均方误差矩阵Q0:
Q0=diag{(0.001°/h)2,(0.001°/h)2,(0.001°/h)2,(1ug)2,(1ug)2,(1ug)2}
观测噪声方差矩阵初始值R0:
R0=diag{(0.1m/s)2,(0.1m/s)2,(0.1m/s)2,(1m)2,(1m)2,(1m)2}
仿真实验中陀螺仪和加速度计常值误差、安装误差、刻度系数误差参数设定值与估计值如下表1所示。
表1标定误差参数设定值与估计值结果
如附图3中3a陀螺仪x轴常值误差、3b陀螺仪y轴常值误差、3c陀螺仪z轴常值误差、3d加速度计x轴常值误差、3e加速度计y轴常值误差、3f加速度计z轴常值误差、3g陀螺仪x轴刻度系数误差、3h陀螺仪y轴刻度系数误差、3i陀螺仪z轴刻度系数误差、3j加速度计x轴刻度系数误差、3k加速度计y轴刻度系数误差、3l加速度计z轴刻度系数误差、3m陀螺仪安装误差yx、3n陀螺仪安装误差zx、3o陀螺仪安装误差zy、3p加速度计安装误差yx、3q加速度计安装误差zx、3r加速度计安装误差xy、3s加速度计安装误差zy、3t加速度计安装误差xz、3u加速度计安装误差yz所示为陀螺仪和加速度计21个相关误差参数估计曲线。从图中可以看出,设计的30位置方案各项误差参数在标定旋转策略以及Kalman滤波的作用下和传统18位置方案一样得到了收敛,且大部分误差参数收敛效果更好。
结合表1结果,设计的30位置标定方案所估计出的21项误差参数中16项残余误差比18位置方案小。将两种标定方案估计的惯性器件误差对IMU补偿后进行48小时的静基座导航,两种方案的导航定位误差曲线如附图4,从图中可以看出,设计的30位置标定方案的最大定位误差比传统18位置方案小3639米,可以验证本发明所提出的标定方案具有更高的标定精度。
Claims (8)
1.一种旋转捷联惯导***误差***级标定方法,其特征在于:所述标定方法如下:
步骤S11:定义坐标系和定义惯性测量单元中陀螺仪和加速度计的常值误差参数、刻度系数误差参数和安装误差参数
步骤S21:构建陀螺仪和加速度计误差模型
步骤S31:通过步骤21陀螺仪和加速度计误差模型经过翻转激励出步骤11定义的误差参数
步骤S41:根据步骤31中的误差参数建立Kalman滤波模型
步骤S51:Kalman滤波模型离散化获得陀螺仪和加速度计的常值误差、刻度系数误差和安装误差估计值
步骤S61:将步骤51中得到的陀螺仪和加速度计的常值误差、刻度系数误差和安装误差估计值对***进行校正。
2.根据权利要求1所述旋转捷联惯导***误差***级标定方法,其特征在于:所述步骤S11中,
确定旋转惯导***惯性测量单元所处的惯性坐标系i系,惯性坐标系的原点oi位于地球的中心,由原点出发指向北极为oi-zi轴,由原点出发指向平均春分点为oi-xi轴,oi-yi轴与oi-zi轴构成右手直角坐标系;
确定旋转惯导***惯性测量单元所处的导航坐标系n系,该坐标系为当地地理坐标系,其原点on位于载体质心,其on-xn、on-yn、on-zn轴由原点分别指向东、北、天方向;
确定旋转惯导***惯性测量单元所处的载体坐标系b系,载体的质心为载体坐标系的原点ob,载体系坐标系的ob-xb、ob-yb和ob-zb轴分别从载体的质心指向载体的右侧、前侧和上侧;
确定惯性测量单元坐标系p系,惯性测量单元由三组正交安装的陀螺仪和加速度计组成,惯性测量单元坐标系的原点op位于惯性测量单元质心,其op-xp、op-yp、op-zp轴指向由原点出发分别与三组正交安装的陀螺仪和加速度计指向平行;
确定安装坐标系坐标系m系,设实际安装时惯性测量单元坐标系为安装坐标系,安装坐标系的原点om与p系的原点op相同。
3.根据权利要求2所述旋转捷联惯导***误差***级标定方法,其特征在于:所述步骤S11中,
陀螺仪和加速度计刻度系数误差分别表示为δKg和δKa,具体表示如下:
其中,δKgx、δKgy、δKgz分别为陀螺仪刻度系数误差在op-xp、op-yp、op-zp轴的分量,δKax、δKay、δKaz分别为加速度计刻度系数误差在op-xp、op-yp、op-zp轴的分量;
陀螺仪和加速度计安装误差分别表示为δAg和δAa,具体表示如下:
其中,δAgyx为om-ym轴陀螺仪与op-xp-yp平面的安装误差角,δAgzx为om-zm轴陀螺仪与op-xp-zp平面的安装误差角,δAgzy为om-zm轴陀螺仪与op-yp-zp平面的安装误差角,δAgxy为om-xm轴陀螺仪与op-xp-yp平面的安装误差角,δAgxz为om-xm轴陀螺仪与op-xp-zp平面的安装误差角,δAgyz为om-ym轴陀螺仪与op-yp-zp平面的安装误差角,δAayx为om-ym轴加速度计与op-xp-yp平面的安装误差角,δAazx为om-zm轴加速度计与op-xp-zp平面的安装误差角,δAazy为om-zm轴加速度计与op-yp-zp平面的安装误差角,δAaxy为om-xm轴加速度计与op-xp-yp平面的安装误差角,δAaxz为om-xm轴加速度计与op-xp-zp平面的安装误差角,δAayz为om-ym轴加速度计与op-yp-zp平面的安装误差角。
5.根据权利要求4所述旋转捷联惯导***误差***级标定方法,其特征在于:所述步骤S31中通过步骤21陀螺仪和加速度计误差模型经过翻转激励出步骤12定义的误差参数具体过程为:
初始时惯性测量单元的三个轴向op-xp、op-yp、op-zp分别指向天-东-北,转动机构的中轴与惯性测量单元的op-yp轴重合,转动机构的内轴与惯性测量单元的op-zp轴重合,转动机构的外轴与惯性测量单元的op-xp轴重合;设定30位置标定路径如下:1.绕转动机构中框轴正向旋转90度,旋转角速度为ω度/秒,转动完成后停止t秒;2.绕转动机构中框轴正向旋转90度,旋转角速度为ω度/秒,转动完成后停止t秒;3.绕转动机构中框轴正向旋转90度,旋转角速度为ω度/秒,转动完成后停止t秒;4.绕转动机构中框轴反向旋转180度,旋转角速度为ω度/秒,转动完成后停止t秒;5.绕转动机构中框轴反向旋转90度,旋转角速度为ω度/秒,转动完成后停止t秒;6.绕转动机构内框轴正向旋转90度,旋转角速度为ω度/秒,转动完成后停止t秒;7.绕转动机构中框轴正向旋转90度,旋转角速度为ω度/秒,转动完成后停止t秒;8.绕转动机构中框轴正向旋转90度,旋转角速度为ω度/秒,转动完成后停止t秒;9.绕转动机构中框轴正向旋转90度,旋转角速度为ω度/秒,转动完成后停止t秒;10.绕转动机构中框轴反向旋转180度,旋转角速度为ω度/秒,转动完成后停止t秒;11.绕转动机构中框轴反向旋转90度,旋转角速度为ω度/秒,转动完成后停止t秒;12.绕转动机构内框轴正向旋转90度,旋转角速度为ω度/秒,转动完成后停止t秒;13.绕转动机构内框轴正向旋转90度,旋转角速度为ω度/秒,转动完成后停止t秒;14.绕转动机构内框轴反向旋转180度,旋转角速度为ω度/秒,转动完成后停止t秒;15.绕转动机构内框轴反向旋转90度,旋转角速度为ω度/秒,转动完成后停止t秒;16-30位置与1-15位置转轴次序相同,转动方向相反。
6.根据权利要求5所述旋转捷联惯导***误差***级标定方法,其特征在于:所述步骤S41中根据步骤31中的误差参数建立Kalman滤波模型的具体过程为:
经过步骤31的翻转,激励陀螺仪和加速度计产生的误差;然后将其带入惯导姿态误差、速度误差和位置误差方程即可得到***状态误差模型;
建立状态向量包含姿态误差、速度误差、位置误差、陀螺仪和加速度计常值误差、刻度系数误差和安装误差的30维Kalman状态方程:
其中,30维状态向量X(t)为
其中各分块矩阵具体表达式如下:
其中,ωie为地球自转角速率,RM、RN分别为地球子午圈、卯酉圈曲率半径,L为载体所在纬度,h为载体所在高度;
其中,vE、vN分别为北向、北向速度;
其中,vU为天向速度;
式(3)中G为***噪声驱动矩阵,表达式如下:
W(t)为***噪声矩阵,由陀螺仪噪声Wg(t)和加速度计噪声Wa(t)组成,均为零均值高斯白噪声向量序列,其表达式如下:
建立如下以速度误差和位置误差为观测量的Kalman滤波器观测方程:
Z(t)=H(t)X(t)+V(t) (19)
其中,Z(t)为观测量,由速度误差和位置误差组成,表达式如下:
Z(t)=[δvE δvN δvU δL δλ δh]T (20)
H为观测矩阵,表达式如下:
V(t)为观测噪声矩阵,代表能够获取观测量的***噪声,包括速度观测噪声和位置观测噪声,均为零均值高斯白噪声向量序列,且上述W(t)和V(t)互不相关,表达式如下:
7.根据权利要求6所述旋转捷联惯导***误差***级标定方法,其特征在于:所述步骤S51中Kalman滤波模型离散化陀螺仪和加速度计的常值误差、刻度系数误差和安装误差估计值具体过程为:
给定***状态空间模型:
式中,Xk为离散后的状态向量,Zk为离散后的量测向量,Fk/k-1、Hk和Γk/k-1分别为状态转移矩阵、量测矩阵和***噪声驱动矩阵,Wk-1和Vk分别为***噪声向量和量测噪声向量;
从k-1时刻到k时刻的离散状态转移矩阵Fk/k-1具体表达式如下:
其中,I为单位矩阵,Ts为滤波周期;
Kalman滤波全套算法如下:
状态一步预测
状态一步预测均方误差阵
滤波增益
状态估计
状态估计均方误差
Pk=(I-KkHk)Pk/k-1 (28)
式(25)中Q为陀螺仪和加速度计输出白噪声的均方误差矩阵,R为观测噪声方差矩阵。
8.根据权利要求7所述旋转捷联惯导***误差***级标定方法,其特征在于:所述步骤S61中将步骤51中得到的陀螺仪和加速度计的常值误差、刻度系数误差和安装误差估计值对***进行校正的具体过程为:
误差修正模型如下所示:
陀螺仪和加速度计常值误差反馈:
陀螺仪刻度系数误差和安装误差反馈:
陀螺仪和加速度安装误差反馈:
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202211165555.2A CN115683155A (zh) | 2022-09-23 | 2022-09-23 | 一种旋转捷联惯导***误差***级标定方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202211165555.2A CN115683155A (zh) | 2022-09-23 | 2022-09-23 | 一种旋转捷联惯导***误差***级标定方法 |
Publications (1)
Publication Number | Publication Date |
---|---|
CN115683155A true CN115683155A (zh) | 2023-02-03 |
Family
ID=85062735
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN202211165555.2A Pending CN115683155A (zh) | 2022-09-23 | 2022-09-23 | 一种旋转捷联惯导***误差***级标定方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN115683155A (zh) |
Cited By (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN117346823A (zh) * | 2023-11-03 | 2024-01-05 | 中国人民解放军国防科技大学 | 一种考虑磁场影响的捷联惯导******级误差标定方法 |
-
2022
- 2022-09-23 CN CN202211165555.2A patent/CN115683155A/zh active Pending
Cited By (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN117346823A (zh) * | 2023-11-03 | 2024-01-05 | 中国人民解放军国防科技大学 | 一种考虑磁场影响的捷联惯导******级误差标定方法 |
CN117346823B (zh) * | 2023-11-03 | 2024-04-19 | 中国人民解放军国防科技大学 | 一种考虑磁场影响的捷联惯导******级误差标定方法 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN113029199B (zh) | 一种激光陀螺惯导***的***级温度误差补偿方法 | |
CN108168574B (zh) | 一种基于速度观测的8位置捷联惯导***级标定方法 | |
CN108318052B (zh) | 一种基于双轴连续旋转的混合式平台惯导***标定方法 | |
CN106969783B (zh) | 一种基于光纤陀螺惯性导航的单轴旋转快速标定技术 | |
CN110108300B (zh) | 一种基于卧式三轴转台的imu正六面体标定方法 | |
CN103630146B (zh) | 一种离散解析与Kalman滤波结合的激光陀螺IMU标定方法 | |
CN104764467B (zh) | 空天飞行器惯性传感器误差在线自适应标定方法 | |
CN106482746B (zh) | 一种用于混合式惯导***的加速度计内杆臂标定与补偿方法 | |
CN111006675B (zh) | 基于高精度重力模型的车载激光惯导***自标定方法 | |
CN115143993B (zh) | 基于三轴转台的激光陀螺惯导***g敏感性误差标定方法 | |
CN101246023A (zh) | 微机械陀螺惯性测量组件的闭环标定方法 | |
CN110361031B (zh) | 一种基于回溯理论的imu全参数误差快速标定方法 | |
CN105352527B (zh) | 一种基于双轴转位机构光纤陀螺标定方法 | |
CN112710328B (zh) | 一种四轴冗余惯导***的误差标定方法 | |
CN115265590B (zh) | 一种双轴旋转惯导动态误差抑制方法 | |
CN111780752B (zh) | 一种姿态误差可观测的提高惯性制导精度方法 | |
CN113503894A (zh) | 基于陀螺基准坐标系的惯导***误差标定方法 | |
CN115683155A (zh) | 一种旋转捷联惯导***误差***级标定方法 | |
CN114877915A (zh) | 一种激光陀螺惯性测量组件g敏感性误差标定装置及方法 | |
CN109631952B (zh) | 航天器用光学陀螺组件姿态基准镜安装误差标定方法 | |
CN114608573A (zh) | 一种基于双轴旋转惯导***的温度误差模型系数快速辨识方法 | |
CN110940357B (zh) | 一种用于旋转惯导单轴自对准的内杆臂标定方法 | |
CN108593966B (zh) | 一种两轴框架摆式加速度计自标定方法和*** | |
CN114858187A (zh) | 一种mems惯导***标定方法 | |
CN112197767B (zh) | 一种在线改进滤波误差的滤波器设计方法 |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
PB01 | Publication | ||
PB01 | Publication | ||
SE01 | Entry into force of request for substantive examination | ||
SE01 | Entry into force of request for substantive examination |