CN108168574B - 一种基于速度观测的8位置捷联惯导系统级标定方法 - Google Patents
一种基于速度观测的8位置捷联惯导系统级标定方法 Download PDFInfo
- Publication number
- CN108168574B CN108168574B CN201711178396.9A CN201711178396A CN108168574B CN 108168574 B CN108168574 B CN 108168574B CN 201711178396 A CN201711178396 A CN 201711178396A CN 108168574 B CN108168574 B CN 108168574B
- Authority
- CN
- China
- Prior art keywords
- error
- temperature
- matrix
- navigation system
- inertial navigation
- 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
Images
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
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01C—MEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
- G01C21/00—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00
- G01C21/10—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 by using measurements of speed or acceleration
- G01C21/12—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 by using measurements of speed or acceleration executed aboard the object being navigated; Dead reckoning
- G01C21/16—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 by using measurements of speed or acceleration executed aboard the object being navigated; Dead reckoning by integrating acceleration or speed, i.e. inertial navigation
Landscapes
- Engineering & Computer Science (AREA)
- Radar, Positioning & Navigation (AREA)
- Remote Sensing (AREA)
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Manufacturing & Machinery (AREA)
- Automation & Control Theory (AREA)
- Gyroscopes (AREA)
- Navigation (AREA)
Abstract
本发明公开了一种基于速度观测的8位置捷联惯导系统级标定方法,所述的方法主要包括以下步骤:首先将惯组安装在带温箱双轴转台上,设定转台温箱温度,并为捷联惯导系统上电,待温度稳定后初始化导航系统和卡尔曼滤波器,利用转台使惯组依次转动8个位置,充分激励惯组误差,将导航解算的速度误差作为观测量输入卡尔曼滤波器,估计惯组24个误差参数,分别设定温箱温度为N个不同温度点,重复8位置标定步骤,拟合若干个温度点的误差参数。本发明具有标定快速、不依赖转台精度的优点,同时能够对惯组进行温度补偿,节省繁琐的温度补偿试验。
Description
技术领域
本发明属于惯性导航技术,具体涉及一种基于速度观测的8位置捷联惯导系统级标定方法。
背景技术
惯性导航技术是基于自身惯组输出,通过导航解算,为载体提供导航信息的技术,由于其隐蔽性强、可靠性高等特有优势广泛应用于军事、勘测等领域。惯组是构成惯性导航系统的核心单元,其精度直接影响惯性导航系统精度,故惯组的标定是惯性导航系统使用前的必要过程,其目的是建立惯组输入输出关系的精确数学模型,其理论基础是系统辨识和参数估计。
目前惯组的标定方法根据观测量的不同,分为分立式标定法和系统级标定法。分立式标定法通过精密转台给惯组精确已知的输入量,记录陀螺和加速度计的输入、输出关系,一般采用最小二乘法作为标定参数的估计方法,标定流程繁琐,标定精度依赖于转台精度。
系统级标定则利用陀螺和加速度计的输出进行导航解算,以导航误差(位置误差、速度误差或姿态误差)作为观测量来估计惯组的误差参数,标定过程相对简单,标定精度不依赖于转台精度。
近年来,系统级标定以其优势广泛应用于各类惯性导航系统产品中,但一方面,惯组翻转位置较多,标定时间长,导致惯组在标定过程中随时间漂移较大,标定精度降低;另一方面,温度补偿需要通过大量试验分别补偿惯组零偏和标度因数随温度的变化,标定过程繁琐,耗时长。基于此,研究一种更高精度、更快速且带有温度补偿的系统级标定方法,成为了行业发展的方向。
发明内容
发明目的:针对上述现有技术中惯组在系统级标定过程中随时间漂移导致标定精度降低和温度补偿过程繁琐的问题,本发明一种基于速度观测的8位置捷联惯导系统级标定方法,能减少标定位置编排,缩短标定时间,并同时对惯组进行温度补偿。
技术方案:一种基于速度观测的8位置捷联惯导系统级标定方法,该方法的具体步骤如下:
(1)将捷联惯导系统安装在带温箱双轴转台上,确定试验场地的经度、纬度和高度;
(2)设定转台温箱温度,并将捷联惯导系统上电;
(3)待系统温度恒定后,初始化捷联惯性导航系统和卡尔曼滤波器;
(4)控制转台,使捷联惯导系统依次旋转至南东天、南地东、地北东、西北地、天北西、北地西、北东地、北天东8个位置,并在每个位置保持静止5分钟,在此过程中,捷联惯性导航系统进行导航解算,并将导航解算的速度误差作为观测量输入卡尔曼滤波器;
(5)分别设定温箱温度为N个不同温度点,然后将捷联惯导系统重新上电,重复步骤(3)和步骤(4);
(6)将N个温度点下卡尔曼滤波器所估计出的惯组误差参数对温度进行拟合,以实现温度补偿。
进一步的,所述步骤(4)中,采用基于卡尔曼滤波技术的误差标定方法,利用捷联惯导系统在转台上的8位置旋转充分激励惯组误差,以此估计三轴加速度计零偏▽x、▽y、▽z、三轴加速度计标度因数误差δKax、δKay、δKaz、加速度计安装误差Eaxy、Eaxz、Eayx、Eayz、Eazx、Eazy、三轴光纤陀螺零偏εx、εy、εz、三轴光纤陀螺标度因数误差δKgx、δKgy、δKgz和光纤陀螺安装误差Egxy、Egxz、Egyx、Egyz、Egzx、Egzy共24个误差参数。
步骤(5)中并采用最小二乘法以温度为自变量,拟合N个温度点下卡尔曼滤波标定出的误差参数,所述的温度点个数大于等于2。其中卡尔曼滤波技术标定方法将导航解算的速度误差作为观测量,估计出光纤陀螺和加速度计的零偏、标度因数误差和安装误差共24个误差参数,步骤(4)的具体步骤为:
4.1)建立惯组标定的系统状态方程和量测方程:
含有24个光纤陀螺和加速度计误差参数的卡尔曼滤波器状态方程为:
其中,30维状态向量为
X=[δVE δVN δVU φE φN φU ▽x ▽y ▽z δKax δKay δKaz Eaxy Eaxz Eayx Eayz EazxEazy εx εy εz δKgx δKgy δKgz Egxy Egxz Egyx Egyz Egzx Egzy]T
包括东向速度误差δVE、北向速度误差δVN、天向速度误差δVU、东向失准角φE、北向失准角φN、天向失准角φU、三轴加速度计零偏▽x、▽y、▽z、三轴加速度计标度因数误差δKax、δKay、δKaz、加速度计安装误差Eaxy、Eaxz、Eayx、Eayz、Eazx、Eazy、三轴光纤陀螺零偏εx、εy、εz、三轴光纤陀螺标度因数误差δKgx、δKgy、δKgz和光纤陀螺安装误差Egxy、Egxz、Egyx、Egyz、Egzx、Egzy。
其中,F11、F12、F13、F14、F21、F22、F23、F24分别表示为如下形式:
式(3)至(10)中,ωie为地球自转角速率,VE、VN、VU分别为东向、北向、天向速度,L为纬度,h为高度,RM、RN分别为地球子午圈、卯酉圈曲率半径,fE、fN、fU分别为加速度计输出的比力在导航系东向、北向、天向的投影,为三轴加速度计输出的比力,Cij为载体系b系至导航系n系姿态转换矩阵的第i行第j列元素。为三轴光纤陀螺输出的角速度。
G为系统噪声驱动矩阵,形式如下:
W(t)为系统噪声矩阵,形式如下:
W(t)=[WAx(t) WAy(t) WAz(t) WGx(t) WGy(t) WGz(t) 01×24]T (12)
式中WAx(t)、WAy(t)、WAz(t)为三轴加速度计输出白噪声,WGx(t)、WGy(t)、WGz(t)为三轴光纤陀螺输出白噪声,假设QAm(m=x,y,z)为m轴加速度计输出白噪声方差,QAn(n=x,y,z)为n轴光纤陀螺输出白噪声方差,满足如下条件:
以速度误差为观测量构建卡尔曼滤波器的量测方程,形式如下:
Z=HX+V(t) (15)
式中状态向量X定义与式(1)相同,观测量Z=[δVE δVN δVU]T,H为系统观测矩阵,形式如下:
H=[I3×3 03×27] (16)
V(t)为观测噪声向量,假设R为观测噪声方差阵,满足如下条件:
4.2)离散化系统状态方程:
将连续系统进行离散化,该过程采用泰勒级数展开并取前两阶,忽略高阶小量,形式如下:
式中,I为单位矩阵,Tf为滤波周期,F为状态转移矩阵。
4.3)利用卡尔曼滤波估计状态量:
利用卡尔曼滤波对状态量进行估计,其中状态一步预测公式、状态估计公式、滤波增益矩阵计算公式、一步预测误差方差矩阵计算公式、估计误差方差矩阵公式形式如下:
Pk=[I-KkHk]Pk,k-1 (22)
最终估计出相应温度点下的加速度计和光纤陀螺的零偏、标度因数误差和安装误差共24个惯组误差参数。
步骤(5)的利用最小二乘法拟合N个温度点的标定参数具体步骤如下:
光纤陀螺和加速度计的零偏和标度因数随温度有较大变化,且变化近似为线性,为解决惯组温度补偿问题,将N个温度点下标定的参数进行一阶拟合,此过程采用最小二乘法,具体步骤为:
令N个温度点分别为T1,T2,…,TN,对应温度点下标定的误差参数分别为Y1,Y2,…,YN,待拟合温度系数为c0、c1,满足条件如下:
则误差参数的温度拟合公式形式如下:
C=(ATA)-1ATB(10)
式中,温度系数矩阵为C=[c0 c1]T,矩阵A、B形式为
B=[Y1 Y2 … YN]T (12)
利用最小二乘法对标定的误差参数进行一阶拟合,实现对惯组的温度补偿。
有益效果:本发明相比现有技术其显著的在于,本发明提供的方法一方面仅需将惯组安装于带温箱双轴转台上,进行8位置转停试验,转动位置少,标定时间短,流程简单,避免长时间标定过程中惯组随时间漂移导致标定精度降低的问题,能够提高标定精度;另一方面本发明能够避免繁琐的温度补偿试验,利用温箱控制系统温度,将4个温度点下误差参数拟合即可直接对惯组进行温度补偿。
附图说明
图1为基于速度误差观测的捷联惯导系统级标定流程框图;
图2为惯性导航系统8位置旋转方案示意图;
图3(a)光纤陀螺安装误差示意图;
图3(b)加速度计安装误差示意图;
图4为仿真中加速度计零偏标定结果图;
图5为仿真中加速度计标度因数误差标定结果图;
图6为仿真中加速度计安装误差(Eaxy、Eaxz、Eayx)标定结果图;
图7为仿真中加速度计安装误差(Eayz、Eazx、Eazy)标定结果图;
图8为仿真中光纤陀螺零偏标定结果图;
图9为仿真中光纤陀螺标度因数误差标定结果图;
图10为仿真中光纤陀螺安装误差(Egxy、Egxz、Egyx)标定结果图;
图11为仿真中光纤陀螺安装误差(Egyz、Egzx、Egzy)标定结果图。
具体实施方式
为了详细的说明本发明公开的技术方案,下面结合说明书附图和具体实施例做进一步的阐述。
如图1所示,本发明的一种速度观测的8位置捷联惯导系统级标定方法,具体步骤如下:
(1)将捷联惯导系统安装在带温箱双轴转台上,确定试验场地的经度、纬度和高度;
(2)设定转台温箱温度为1℃,并将捷联惯导系统上电;
(3)待系统温度恒定后,初始化捷联惯性导航系统和卡尔曼滤波器;
(4)控制转台,使捷联惯导系统依次旋转至南东天、南地东、地北东、西北地、天北西、北地西、北东地、北天东8个位置,并在每个位置保持静止5分钟,在此过程中,捷联惯性导航系统进行导航解算,并将导航解算的速度误差作为观测量输入卡尔曼滤波器;
(5)分别设定温箱温度为N个不同温度点,将捷联惯导系统重新上电,重复步骤(3)和步骤(4);
(6)将N个温度点下卡尔曼滤波器所估计出的惯组误差参数对温度进行拟合,以实现温度补偿。
其中步骤(4)所述惯导系统转动方式如附图2所示,将惯组x、y、z轴按照位置0所示分别指向东、北、天安装在双轴转台上,其中转台内框外框转轴如图中所示,转台寻零后,待系统温度恒定,使惯导系统转至南东天位置1,保持静止5分钟;使惯导系统绕X轴以角速率25°/s旋转-90°至南地东位置2,保持静止5分钟;使惯导系统绕Z轴以角速率25°/s旋转+90°至地北东位置3,保持静止5分钟;使惯导系统绕Y轴以角速率25°/s旋转+90°至西北地位置4,保持静止5分钟;使惯导系统绕Y轴以角速率25°/s旋转+90°至天北西位置5,保持静止5分钟;使惯导系统绕Z轴以角速率25°/s旋转+90°至北地西位置6,保持静止5分钟;使惯导系统绕X轴以角速率25°/s旋转-90°至北东地位置7,保持静止5分钟;使惯导系统绕X轴以角速率25°/s旋转-90°至北天东位置8,保持静止5分钟;
具体的,所述步骤(4)中,采用基于卡尔曼滤波技术的误差标定方法,利用捷联惯导系统在转台上的8位置旋转充分激励惯组误差,以此估计三轴加速度计零偏▽x、▽y、▽z、三轴加速度计标度因数误差δKax、δKay、δKaz、加速度计安装误差Eaxy、Eaxz、Eayx、Eayz、Eazx、Eazy、三轴光纤陀螺零偏εx、εy、εz、三轴光纤陀螺标度因数误差δKgx、δKgy、δKgz和光纤陀螺安装误差Egxy、Egxz、Egyx、Egyz、Egzx、Egzy共24个误差参数。其中,光纤陀螺和加速度计的安装误差示意图如附图3(a)和附图3(b)所示,载体系O-xbybzb为正交系,光纤陀螺安装坐标系O-xgiygizgi和加速度计安装坐标系O-xaiyaizai为非正交系,光纤陀螺和加速度计的误差数学模型如下:
所述步骤(5)中将转台温箱温度分别设定为10℃、20℃、30℃,重复步骤(3)和步骤(4),采用最小二乘法以温度为自变量,拟合N(N=4)个温度点下卡尔曼滤波标定出的误差参数。
步骤(4)和步骤(5)的具体步骤为:
4.1)建立惯组标定的系统状态方程和量测方程:
含有24个光纤陀螺和加速度计误差参数的卡尔曼滤波器状态方程为:
其中,30维状态向量为
X=[δVE δVN δVU φE φN φU ▽x ▽y ▽z δKax δKay δKaz Eaxy Eaxz Eayx Eayz EazxEazy εx εy εz δKgx δKgy δKgz Egxy Egxz Egyx Egyz Egzx Egzy]T
包括东向速度误差δVE、北向速度误差δVN、天向速度误差δVU、东向失准角φE、北向失准角φN、天向失准角φU、三轴加速度计零偏▽x、▽y、▽z、三轴加速度计标度因数误差δKax、δKay、δKaz、加速度计安装误差Eaxy、Eaxz、Eayx、Eayz、Eazx、Eazy、三轴光纤陀螺零偏εx、εy、εz、三轴光纤陀螺标度因数误差δKgx、δKgy、δKgz和光纤陀螺安装误差Egxy、Egxz、Egyx、Egyz、Egzx、Egzy。
其中,F11、F12、F13、F14、F21、F22、F23、F24分别表示为如下形式:
式(3)至(10)中,ωie为地球自转角速率,VE、VN、VU分别为东向、北向、天向速度,L为纬度,h为高度,RM、RN分别为地球子午圈、卯酉圈曲率半径,fE、fN、fU分别为加速度计输出的比力在导航系东向、北向、天向的投影,为三轴加速度计输出的比力,Cij为载体系b系至导航系n系姿态转换矩阵的第i行第j列元素。为三轴光纤陀螺输出的角速度。
G为系统噪声驱动矩阵,形式如下:
W(t)为系统噪声矩阵,形式如下:
W(t)=[WAx(t) WAy(t) WAz(t) WGx(t) WGy(t) WGz(t) 01×24]T (12)
式中WAx(t)、WAy(t)、WAz(t)为三轴加速度计输出白噪声,WGx(t)、WGy(t)、WGz(t)为三轴光纤陀螺输出白噪声,假设QAm(m=x,y,z)为m轴加速度计输出白噪声方差,QAn(n=x,y,z)为n轴光纤陀螺输出白噪声方差,满足如下条件:
以速度误差为观测量构建卡尔曼滤波器的量测方程,形式如下:
Z=HX+V(t) (15)
式中状态向量X定义与式(1)相同,观测量Z=[δVE δVN δVU]T,H为系统观测矩阵,形式如下:
H=[I3×3 03×27] (16)
V(t)为观测噪声向量,假设R为观测噪声方差阵,满足如下条件:
4.2)离散化系统状态方程:
将连续系统进行离散化,该过程采用泰勒级数展开并取前两阶,忽略高阶小量,形式如下:
式中,I为单位矩阵,Tf为滤波周期,F为状态转移矩阵。
4.3)利用卡尔曼滤波估计状态量:
利用卡尔曼滤波对状态量进行估计,其中状态一步预测公式、状态估计公式、滤波增益矩阵计算公式、一步预测误差方差矩阵计算公式、估计误差方差矩阵公式形式如下:
Pk=[I-KkHk]Pk,k-1 (22)
最终估计出相应温度点下的加速度计和光纤陀螺的零偏、标度因数误差和安装误差共24个惯组误差参数。
利用最小二乘法拟合4个温度点的标定参数:光纤陀螺和加速度计的零偏和标度因数随温度有较大变化,且变化近似为线性,为解决惯组温度补偿问题,将4个温度点下标定的参数进行一阶拟合,此过程采用最小二乘法,具体步骤为:
令4个温度点分别为T1、T2、T3、T4,对应温度点下标定的误差参数分别为Y1,Y2,Y3,Y4,待拟合温度系数为c0、c1,满足条件如下:
则误差参数的温度拟合公式形式如下:
C=(ATA)-1ATB (24)
式中,温度系数矩阵为C=[c0c1]T,矩阵A、B形式为
B=[Y1 Y2 Y3 Y4]T (26)
利用最小二乘法对标定的所有误差参数进行一阶拟合,实现对惯组的温度补偿。
本发明的可行性通过如下仿真加以验证:
(1)系统级标定仿真平台由惯组数据发生器、导航解算模块和以速度误差为观测量的卡尔曼滤波器构成;
(2)设定标定试验地点的经度为106.6906°,纬度为26.5019°,高度为1030.0m。
(3)仿真时间40min,卡尔曼滤波器的滤波周期为50ms。
(4)惯组数据发生器的数据更新周期为5ms,仿真设定的各项误差参数如表1所示,光纤陀螺随机白噪声标准差为0.01°/h,加速度计随机白噪声标准差为0.01mg。
表1惯组误差参数设定值与标定值表
标定结果如附图4至附图11所示,其中虚线表示仿真中惯组误差参数设定值,实线表示所提出方法的惯组误差参数标定值。图4为三轴加速度计零偏标定值,图5为三轴加速度计标度因数误差标定值,图6为加速度计安装误差(Eaxy、Eaxz、Eayx)标定值,图7为加速度计安装误差(Eayz、Eazx、Eazy)标定值,图8为三轴光纤陀螺零偏标定值,图9为三轴光纤陀螺标度因数误差标定值,图10为光纤陀螺安装误差(Egxy、Egxz、Egyx)标定值,图11为光纤陀螺安装误差(Egyz、Egzx、Egzy)标定值,24个误差参数作为卡尔曼滤波器的状态量均收敛。仿真中设定的惯组误差参数值与所标定出的误差参数值对比如表1所示,其中加速度计零偏的设定值与标定值的最大偏差为0.0037mg,标度因数误差最大偏差为3.859ppm,安装误差最大偏差为0.3694′;光纤陀螺零偏最大偏差为0.0021°/h,标度因数误差最大偏差为4.951ppm,安装误差最大偏差为0.3859′。由仿真结果可以看出,本发明所提方法能够较准确标定出惯组的24个误差参数,标定流程简单,标定时间短,精度较高。
Claims (5)
1.一种基于速度观测的8位置捷联惯导系统级标定方法,其特征在于,包括以下步骤:
(1)将捷联惯导系统安装在带温箱双轴转台上,确定试验场地的经度、纬度和高度;
(2)设定转台温箱温度,并将捷联惯导系统上电;
(3)待系统温度恒定后,初始化捷联惯性导航系统和卡尔曼滤波器;
(4)控制转台,使捷联惯导系统依次旋转至南东天、南地东、地北东、西北地、天北西、北地西、北东地、北天东8个位置,并在每个位置保持静止5分钟,在此过程中,捷联惯性导航系统进行导航解算,并将导航解算的速度误差作为观测量输入卡尔曼滤波器,采用基于卡尔曼滤波技术进行捷联惯性导航系统的误差标定,利用捷联惯导系统在转台上的8位置旋转充分激励惯组误差,以此估计三轴加速度计零偏▽x、▽y、▽z、三轴加速度计标度因数误差δKax、δKay、δKaz、加速度计安装误差Eaxy、Eaxz、Eayx、Eayz、Eazx、Eazy、三轴光纤陀螺零偏εx、εy、εz、三轴光纤陀螺标度因数误差δKgx、δKgy、δKgz和光纤陀螺安装误差Egxy、Egxz、Egyx、Egyz、Egzx、Egzy共24个误差参数,其中卡尔曼滤波技术标定方法是将导航解算的速度误差作为观测量;
(5)分别设定温箱温度为N个不同温度点,然后将捷联惯导系统重新上电,重复步骤(3)和步骤(4),采用基于最小二乘法进行误差参数的温度拟合,所述的最小二乘法以温度为自变量,拟合N个温度点下卡尔曼滤波标定的误差参数;
(6)将N个温度点下卡尔曼滤波器所估计出的惯组误差参数对温度进行拟合,利用最小二乘法将惯组的N个温度点下标定的参数进行一阶拟合,进行温度补偿,所述惯组误差参数包括惯组零偏、标度因数和安装误差。
2.根据权利要求1所述的一种基于速度观测的8位置捷联惯导系统级标定方法,其特征在于,所述的温度点个数大于等于2。
3.根据权利要求1所述的一种基于速度观测的8位置捷联惯导系统级标定方法,其特征在于,误差参数计算包括以下计算表达式和条件,具体如下:
3.1)建立惯组标定的系统状态方程和量测方程:
含有24个光纤陀螺和加速度计误差参数的卡尔曼滤波器状态方程为:
以速度误差为观测量构建卡尔曼滤波器的量测方程,计算表达式如下:
Z=HX+V(t) (2)
式中,观测量Z=[δVE δVN δVU]T,H为系统观测矩阵,X为状态向量,V(t)为观测噪声向量;
3.2)离散化系统状态方程:将连续系统进行离散化,该过程采用泰勒级数展开并取前两阶,忽略高阶小量,离散化状态转移矩阵形式如下:
式中,I为单位矩阵,Tf为滤波周期,F为状态转移矩阵;
3.3)利用卡尔曼滤波估计状态量:利用卡尔曼滤波对状态量进行估计,其中状态一步预测公式、状态估计公式、滤波增益矩阵计算公式、一步预测误差方差矩阵计算公式、估计误差方差矩阵公式分别如下所示:
Pk=[I-KkHk]Pk,k-1 (8)
最终估计出相应温度点下的加速度计和光纤陀螺的零偏、标度因数误差和安装误差共24个惯组误差参数。
5.根据权利要求1所述的一种基于速度观测的8位置捷联惯导系统级标定方法,其特征在于,所述的步骤(4.1)包括以下计算表达式和条件,具体如下:
30维状态向量X为:
其中包括:东向速度误差δVE、北向速度误差δVN、天向速度误差δVU、东向失准角φE、北向失准角φN、天向失准角φU、三轴加速度计零偏▽x、▽y、▽z、三轴加速度计标度因数误差δKax、δKay、δKaz、加速度计安装误差Eaxy、Eaxz、Eayx、Eayz、Eazx、Eazy、三轴光纤陀螺零偏εx、εy、εz、三轴光纤陀螺标度因数误差δKgx、δKgy、δKgz和光纤陀螺安装误差Egxy、Egxz、Egyx、Egyz、Egzx、Egzy,表达式为:
状态转移矩阵F:
其中,F11、F12、F13、F14、F21、F22、F23、F24分别表示为如下形式:
式(14)至(21)中,ωie为地球自转角速率,VE、VN、VU分别为东向、北向、天向速度,L为纬度,h为高度,RM、RN分别为地球子午圈、卯酉圈曲率半径,fE、fN、fU分别为加速度计输出的比力在导航系东向、北向、天向的投影,为三轴加速度计输出的比力,Cij为载体系b系至导航系n系姿态转换矩阵的第i行第j列元素;为三轴光纤陀螺输出的角速度;
系统噪声驱动矩阵G,形式如下:
W(t)为系统噪声矩阵,形式如下:
W(t)=[WAx(t) WAy(t) WAz(t) WGx(t) WGy(t) WGz(t) 01×24]T (12)
式中WAx(t)、WAy(t)、WAz(t)为三轴加速度计输出白噪声,WGx(t)、WGy(t)、WGz(t)为三轴光纤陀螺输出白噪声,假设QAm(m=x,y,z)为m轴加速度计输出白噪声方差,QAn(n=x,y,z)为n轴光纤陀螺输出白噪声方差,满足如下条件:
系统观测矩阵H形式如下:
H=[I3×3 03×27] (16)
观测噪声向量V(t)满足如下条件,其中R为观测噪声方差阵:
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201711178396.9A CN108168574B (zh) | 2017-11-23 | 2017-11-23 | 一种基于速度观测的8位置捷联惯导系统级标定方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201711178396.9A CN108168574B (zh) | 2017-11-23 | 2017-11-23 | 一种基于速度观测的8位置捷联惯导系统级标定方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN108168574A CN108168574A (zh) | 2018-06-15 |
CN108168574B true CN108168574B (zh) | 2022-02-11 |
Family
ID=62527522
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201711178396.9A Active CN108168574B (zh) | 2017-11-23 | 2017-11-23 | 一种基于速度观测的8位置捷联惯导系统级标定方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN108168574B (zh) |
Families Citing this family (24)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN108981751A (zh) * | 2018-08-16 | 2018-12-11 | 昆山天地睿航智能科技有限公司 | 一种双轴旋转惯导系统的八位置在线自标定方法 |
CN109186633B (zh) * | 2018-08-30 | 2020-11-03 | 衡阳市衡山科学城科技创新研究院有限公司 | 一种复合测量装置的现场标定方法及系统 |
CN109163734B (zh) * | 2018-09-18 | 2020-10-30 | 北京机械设备研究所 | 一种基于双轴光纤旋转调制组合导航系统的自主标定方法 |
CN109141479B (zh) * | 2018-10-30 | 2022-04-12 | 中国船舶重工集团公司第七0七研究所 | 一种系统级加速度计温度补偿方法 |
CN109163736B (zh) * | 2018-11-12 | 2020-06-30 | 西安微电子技术研究所 | 一种光纤imu全温标定补偿方法 |
CN109596139B (zh) * | 2019-01-22 | 2021-05-04 | 中国电子科技集团公司第十三研究所 | 基于mems的车载导航方法 |
CN110083184A (zh) * | 2019-04-19 | 2019-08-02 | 北京航天发射技术研究所 | 一种双轴带温箱转台控制方法及装置 |
CN110006455A (zh) * | 2019-04-24 | 2019-07-12 | 保定开拓精密仪器制造有限责任公司 | 用于冗余惯导系统中加速度计误差参数的快速标定方法 |
CN110160554B (zh) * | 2019-04-30 | 2022-10-14 | 东南大学 | 一种基于寻优法的单轴旋转捷联惯导系统标定方法 |
CN110375726A (zh) * | 2019-05-15 | 2019-10-25 | 北京航天发射技术研究所 | 一种光纤陀螺系统级温度补偿方法、装置和光纤惯导系统 |
CN112665610B (zh) * | 2019-10-15 | 2023-01-03 | 哈尔滨工程大学 | 一种惯性平台误差参数标定方法 |
CN112733314B (zh) * | 2019-10-28 | 2023-03-21 | 成都安则优科技有限公司 | 一种惯性传感器数据模拟方法 |
CN111351508B (zh) * | 2020-04-22 | 2023-10-03 | 中北大学 | 一种mems惯性测量单元系统级批量标定方法 |
CN111678538B (zh) * | 2020-07-29 | 2023-06-09 | 中国电子科技集团公司第二十六研究所 | 一种基于速度匹配的动态水平仪误差补偿方法 |
CN113252069B (zh) * | 2021-04-02 | 2023-02-03 | 北京航天时代激光导航技术有限责任公司 | 一种基于梯度下降法的惯性仪表多项式温补方法 |
CN113465595A (zh) * | 2021-06-25 | 2021-10-01 | 湖北三江航天万峰科技发展有限公司 | 一种惯性定位定向设备惯组参数温补标定方法 |
CN113639766B (zh) * | 2021-08-20 | 2023-12-01 | 北京理工大学 | 双轴旋转惯性导航系统中包含非正交角的系统级标定方法 |
CN113916257B (zh) * | 2021-09-03 | 2023-09-12 | 北京自动化控制设备研究所 | 三轴mems加计组合惯性测量单元标定方法 |
CN113916256B (zh) * | 2021-09-03 | 2023-09-12 | 北京自动化控制设备研究所 | 三轴mems陀螺组合惯性测量单元标定方法 |
CN114279449A (zh) * | 2022-01-01 | 2022-04-05 | 南昌智能新能源汽车研究院 | 一种考虑加速度计温度漂移误差的姿态估计方法 |
CN115046568B (zh) * | 2022-03-31 | 2024-04-19 | 湖南航天机电设备与特种材料研究所 | 一种捷联惯导系统温度标定方法与系统 |
CN114608573B (zh) * | 2022-04-02 | 2024-04-16 | 北京航空航天大学 | 一种基于双轴旋转惯导系统的温度误差模型系数快速辨识方法 |
CN114964223B (zh) * | 2022-04-19 | 2023-09-12 | 北京自动化控制设备研究所 | 一种微惯导系统测量误差补偿方法 |
CN115597571B (zh) * | 2022-12-15 | 2023-03-28 | 西南应用磁学研究所(中国电子科技集团公司第九研究所) | 电子罗盘传感器误差及安装误差快速标定与补偿方法 |
Citations (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN1818555A (zh) * | 2006-03-29 | 2006-08-16 | 北京航空航天大学 | 安装误差角与标度因数解耦的微惯性测量单元精确标定方法 |
CN1821721A (zh) * | 2006-03-27 | 2006-08-23 | 北京航空航天大学 | 一种陀螺仪标度因数和输入轴失准角的精确解耦测试方法 |
CN201653429U (zh) * | 2010-04-29 | 2010-11-24 | 北京航天控制仪器研究所 | 一种双轴转台的mems陀螺测试系统 |
CN103344257A (zh) * | 2013-06-28 | 2013-10-09 | 武汉大学 | 一种惯性测量单元的快速温度标定方法 |
CN104897171A (zh) * | 2015-06-05 | 2015-09-09 | 立得空间信息技术股份有限公司 | 全温一体化惯性测量单元标定方法 |
Family Cites Families (15)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN101701825A (zh) * | 2009-09-28 | 2010-05-05 | 龙兴武 | 高精度激光陀螺单轴旋转惯性导航系统 |
CN101701824A (zh) * | 2009-11-16 | 2010-05-05 | 龙兴武 | 基于激光陀螺的高精度单轴旋转姿态测量系统 |
CN101713666B (zh) * | 2009-11-20 | 2011-09-14 | 哈尔滨工程大学 | 一种基于单轴转停方案的系泊估漂方法 |
CN101975872B (zh) * | 2010-10-28 | 2011-09-14 | 哈尔滨工程大学 | 石英挠性加速度计组件零位偏置的标定方法 |
CN102679968A (zh) * | 2012-05-17 | 2012-09-19 | 哈尔滨工程大学 | 一种微机械陀螺捷联系统误差参数的辨识方法 |
CN102680005A (zh) * | 2012-06-05 | 2012-09-19 | 北京航空航天大学 | 一种光纤陀螺标度因数非对称性误差的系统级标定方法 |
CN103256943A (zh) * | 2013-04-26 | 2013-08-21 | 哈尔滨工程大学 | 一种在单轴旋转捷联惯导系统中刻度因数误差的补偿方法 |
CN103453917A (zh) * | 2013-09-04 | 2013-12-18 | 哈尔滨工程大学 | 一种双轴旋转式捷联惯导系统初始对准与自标校方法 |
CN104344837B (zh) * | 2014-10-30 | 2017-04-19 | 北京航空航天大学 | 一种基于速度观测的冗余惯导系统加速度计系统级标定方法 |
CN105758393A (zh) * | 2014-12-19 | 2016-07-13 | 西安发威电子科技有限公司 | 一种带温度零漂补偿的陀螺仪装置 |
CN105180968B (zh) * | 2015-09-02 | 2018-06-01 | 北京天航华创科技股份有限公司 | 一种imu/磁强计安装失准角在线滤波标定方法 |
CN106017470B (zh) * | 2016-05-12 | 2019-05-24 | 湖南格纳微信息科技有限公司 | 微惯性测量单元筛选方法及组合式微惯性测量装置 |
CN106199668A (zh) * | 2016-06-24 | 2016-12-07 | 南京理工大学 | 一种级联式gnss/sins深组合导航方法 |
CN106441291B (zh) * | 2016-09-27 | 2019-06-21 | 北京理工大学 | 一种基于强跟踪sdre滤波的组合导航系统及导航方法 |
CN107167134B (zh) * | 2017-06-22 | 2019-06-14 | 中国人民解放军国防科学技术大学 | 冗余配置激光陀螺航海惯导协同定位方法 |
-
2017
- 2017-11-23 CN CN201711178396.9A patent/CN108168574B/zh active Active
Patent Citations (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN1821721A (zh) * | 2006-03-27 | 2006-08-23 | 北京航空航天大学 | 一种陀螺仪标度因数和输入轴失准角的精确解耦测试方法 |
CN1818555A (zh) * | 2006-03-29 | 2006-08-16 | 北京航空航天大学 | 安装误差角与标度因数解耦的微惯性测量单元精确标定方法 |
CN201653429U (zh) * | 2010-04-29 | 2010-11-24 | 北京航天控制仪器研究所 | 一种双轴转台的mems陀螺测试系统 |
CN103344257A (zh) * | 2013-06-28 | 2013-10-09 | 武汉大学 | 一种惯性测量单元的快速温度标定方法 |
CN104897171A (zh) * | 2015-06-05 | 2015-09-09 | 立得空间信息技术股份有限公司 | 全温一体化惯性测量单元标定方法 |
Also Published As
Publication number | Publication date |
---|---|
CN108168574A (zh) | 2018-06-15 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN108168574B (zh) | 一种基于速度观测的8位置捷联惯导系统级标定方法 | |
CN113029199B (zh) | 一种激光陀螺惯导系统的系统级温度误差补偿方法 | |
CN110160554B (zh) | 一种基于寻优法的单轴旋转捷联惯导系统标定方法 | |
CN108318052B (zh) | 一种基于双轴连续旋转的混合式平台惯导系统标定方法 | |
CN106017507B (zh) | 一种用于中低精度的光纤惯组快速标定方法 | |
CN107655493B (zh) | 一种光纤陀螺sins六位置系统级标定方法 | |
CN104764467B (zh) | 空天飞行器惯性传感器误差在线自适应标定方法 | |
CN112595350B (zh) | 一种惯导系统自动标定方法及终端 | |
CN102749079A (zh) | 一种光纤捷联惯导双轴旋转调制方法及双轴旋转机构 | |
CN108132060B (zh) | 一种捷联惯导系统无基准的系统级标定方法 | |
CN106969783A (zh) | 一种基于光纤陀螺惯性导航的单轴旋转快速标定技术 | |
CN109211269A (zh) | 一种双轴旋转惯导系统姿态角误差标定方法 | |
CN112710328B (zh) | 一种四轴冗余惯导系统的误差标定方法 | |
CN106940193A (zh) | 一种基于Kalman滤波的船舶自适应摇摆标定方法 | |
CN113503894B (zh) | 基于陀螺基准坐标系的惯导系统误差标定方法 | |
CN111121766A (zh) | 一种基于星光矢量的天文与惯性组合导航方法 | |
CN104596543A (zh) | 一种基准不确定情况下陀螺仪组合误差系数标定方法 | |
CN113959462A (zh) | 一种基于四元数的惯性导航系统自对准方法 | |
CN113137977B (zh) | 一种sins/偏振光组合导航初始对准滤波方法 | |
CN114858187A (zh) | 一种mems惯导系统标定方法 | |
CN113790737B (zh) | 一种阵列式传感器的现场快速标定方法 | |
CN115683155A (zh) | 一种旋转捷联惯导系统误差系统级标定方法 | |
Li et al. | A fast continuous self-calibration method for FOG rotational inertial navigation system based on invariant extended Kalman filter | |
CN113970344B (zh) | 一种惯导系统的陀螺和加速度计刻度系数非对称性误差标定方法 | |
CN117346823B (zh) | 一种考虑磁场影响的捷联惯导系统系统级误差标定方法 |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
PB01 | Publication | ||
SE01 | Entry into force of request for substantive examination | ||
SE01 | Entry into force of request for substantive examination | ||
GR01 | Patent grant | ||
GR01 | Patent grant |