CN108132060A - 一种捷联惯导系统无基准的系统级标定方法 - Google Patents
一种捷联惯导系统无基准的系统级标定方法 Download PDFInfo
- Publication number
- CN108132060A CN108132060A CN201711143868.7A CN201711143868A CN108132060A CN 108132060 A CN108132060 A CN 108132060A CN 201711143868 A CN201711143868 A CN 201711143868A CN 108132060 A CN108132060 A CN 108132060A
- Authority
- CN
- China
- Prior art keywords
- inertial navigation
- axis
- gyroscope
- calibration
- error
- 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 76
- 230000009897 systematic effect Effects 0.000 title abstract 3
- 239000011159 matrix material Substances 0.000 claims description 63
- 238000004364 calculation method Methods 0.000 claims description 15
- 230000008569 process Effects 0.000 claims description 15
- 239000004579 marble Substances 0.000 claims description 11
- 230000001133 acceleration Effects 0.000 claims description 10
- 238000006243 chemical reaction Methods 0.000 claims description 9
- 238000009434 installation Methods 0.000 claims description 8
- 230000007306 turnover Effects 0.000 claims description 8
- 238000002955 isolation Methods 0.000 claims description 6
- 238000012937 correction Methods 0.000 claims description 5
- 238000012163 sequencing technique Methods 0.000 claims description 4
- 230000003068 static effect Effects 0.000 claims description 4
- 230000005484 gravity Effects 0.000 claims description 3
- 239000011435 rock Substances 0.000 claims description 3
- 230000017105 transposition Effects 0.000 claims description 3
- 230000000694 effects Effects 0.000 description 5
- 238000001914 filtration Methods 0.000 description 4
- 230000036544 posture Effects 0.000 description 4
- 230000007547 defect Effects 0.000 description 3
- 238000012935 Averaging Methods 0.000 description 2
- 238000012986 modification Methods 0.000 description 2
- 230000004048 modification Effects 0.000 description 2
- 241000287196 Asthenes Species 0.000 description 1
- 238000004458 analytical method Methods 0.000 description 1
- 230000008859 change Effects 0.000 description 1
- 238000005516 engineering process Methods 0.000 description 1
- 230000007613 environmental effect Effects 0.000 description 1
- 230000000007 visual effect 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
技术领域
本发明涉及一种导航技术,特别涉及一种捷联惯导系统无基准的 系统级标定方法。
背景技术
捷联惯导系统(以下简称惯导)的标定方法有分立式和系统级标 定方法两大方向,分立式标定一般需在实验室条件下完成,需要高精 度的且有基准三轴的转台,对标定设备的精度要求高,标定成本高, 且标定精度较系统级标定低。
系统级标定精度高,对转台精度要求低,有的系统级标定方法甚 至不需要转台,只需人工手动翻转惯导即可实现高精度标定。目前, 系统级标定方法已经逐渐应用到惯导系统的标定上。
系统级标定大体上有两种技术方案:(1)基于kalman滤波的系统 级标定方案;(2)基于最小二乘辨识的系统级标定方案。
基于kalman滤波的系统级标定方法建立惯导系统的误差方程,将 惯导的误差补偿参数列为被估计状态,通过建立30维(或33维)的状 态方程,和6维的观测方程,并辅以适当的转台操作,利用kalman滤 波器对惯导误差补偿参数进行估计和修正,进而实现惯导的系统级标 定。
基于kalman滤波的系统级标定方法适用于高精度惯导(陀螺零偏 稳定性优于0.1°/h),且适用于有轻微角晃动的环境,但是该方法对 中等精度惯导效果不好;只能在转台上实现,不能采用手工翻动实现; 该方法可观测性分析较为复杂,因此对标定过程中的转序编排有难 度;标定过程的转动中的内杆臂效应、外杆臂效应、陀螺及加速度计 数据的不同步性造成的误差会严重影响标定精度。
基于最小二乘辨识系统级标定方法需要建立惯导标定补偿模型 和惯导误差方程,通过观测加速度计输出的比力、导航速度或位置误 差等与待标定参数的关系,来建立辨识方程组,再利用最小二乘法完 成误差参数的辨识。
基于最小二乘辨识系统级标定方法需在静止条件下进行,但是可 克服kalman滤波标定方法的其它缺点:(1)适用于中等精度惯导的标 定(陀螺零偏稳定性优于0.5°/h);(2)可用双轴低精度转台,也可 将惯导安装在低精度工装上,采用手工翻转方式实现标定;(3)转序 编排相对简单直观;(4)标定过程中的转动内外杆臂效应、陀螺及加 速度计数据不同步性不影响标定精度。
基于以上原因,基于最小二乘辨识的系统级标定方法也在广泛使 用。
但是目前的基于最小二乘辨识的系统级标定在应用中需满足两 个要求:(1)需要水平和北向方位基准误差在3°以内;(2)惯导初 始姿态以及转动顺序固化,不能更改,否则无法实现标定。
对于这两个要求,除非是试验室环境条件下,否则在实际应用中 多数条件下较难满足这两个要求,这样便限制了该标定方法的应用范 围。
发明内容
本发明的目的在于提供一种捷联惯导系统无基准的系统级标定 方法,用于解决上述现有技术的问题。
本发明一种捷联惯导系统无基准的系统级标定方法,其中,包括:
第一步,建立惯导标定补偿模型;
惯导的标定补偿模型包括:
角速度通道:
加速度通道:
其中,上标b表示相关参数在b系上的投影,为陀螺仪输出的 b系相对i系的转动角速度,fb为加速度计输出的比力, Ng=[Ngx Ngy Ngz]T,Ngx为X陀螺仪单位时间内输出的原始脉冲量, Ngy为Y陀螺仪单位时间内输出的原始脉冲量,Ngz为Z陀螺仪单位 时间内输出的原始脉冲量,Na=[Nax Nay Naz]T,Nax为X加速度计 输出的原始脉冲量,Nay为Y加速度计输出的原始脉冲量,Naz为Z 加速度计输出的原始脉冲量,Kg为角速度通道补偿矩阵, ε=[εx εyεz]T,εx为X陀螺仪常值漂移,εy为Y陀螺仪常值漂移, εz为Z陀螺仪常值漂移,Ka为加速度通道补偿矩阵, 为X加速度计常值偏置,为Y加速度计常 值偏置,为Z加速度计常值偏置;
第二步,建立惯导标定补偿误差模型,包括:
角速度和比力fb的误差模型为:
角速度误差:
比力误差:
其中,δKgx为X陀螺的标度因数误差,δKgy为Y陀螺的标度因 数误差,δKgz为Z陀螺的标度因数误差,Egxy为X陀螺仪与惯导Y轴 的安装误差,Egxz为X陀螺仪与惯导Z轴的安装误差,Egyx为Y陀螺 仪与惯导X轴的安装误差、Egyz为Y陀螺仪与惯导Z轴的安装误差, Egzx为Z陀螺仪与惯导X轴的安装误差,Egzy为Z陀螺仪与惯导Y轴 的安装误差,为陀螺仪输出角速度误差,为惯导X轴向输入 的真实角速度,为惯导Y轴向输入的真实角速度,为惯导Z 轴向输入的真实角速度,δεx为X陀螺仪的残余常值零偏,δεy为Y陀 螺仪的残余常值零偏,δεz为Z陀螺仪的残余常值零偏,δfb为加速度 计输出比力误差,为惯导X轴向输入的真实比力,为惯导Y轴 向输入的真实比力,为惯导Z轴向输入的真实比力,δKax为X陀螺的标度因数误差,δKay为Y陀螺的标度因数误差,δKaz为Z陀螺 的标度因数误差,Eayx为Y轴加速度计与惯导X轴的安装误差,Eazx为 Z轴加速度计与惯导X轴的安装误差,Eazy为Z轴加速度计与惯导Y 轴的安装误差,为X、Y、Z轴加速度计的残余常值偏置、为 X、Y、Z轴加速度计的残余常值偏置、分别为X、Y、Z轴加速 度计的残余常值偏置;
第三步,进行标定转序编排与数据采集,包括:
惯导的系统级标定方法采用静止-翻转-静止的转序编排策略,在 第一个位置静止T1时间,然后在T2时间内完成第一次翻转,然后在第 二个位置再静止T1时间,然后再在T2时间内完成第二次翻转,共翻转 18次,在19个位置保持静止;
然后将整个标定过程的惯导输出的原始数据进行采集,以便于离 线解算;
第四步,标定误差解算及修正,包括:
a)获取采集的Ng和Na,假设惯导系统经过粗略标定,标定参数 分别为Kg0,ε0,Ka0和输出的带有误差的角速度和比力分别为和则:
标定解算过程如下:
定义标定地点的东北天坐标系为导航坐标系,用n表示,在第一 个位置,利用输出和进行初始对准,采用解析粗对准方法进 行初始对准,包括:
对第一个位置T1时间内输出的和进行平均,记其平均值分别 为和则可求得惯导的姿态矩阵:
其中,gn=[0 0 g0 T],g0为标定地点的重力加速度, ωie为地球自转角速度,L为标定地点纬度;
记初始对准得到的姿态矩阵为
b)在翻转过程T2时间内,进行姿态更新,包括:
其中,惯导相对导航坐标系的转动角速度在b系上的投影,
记姿态更新后的姿态矩阵为
c)计算相关矩阵和误差参数,包括:
首先定义有关矩阵相关元素的表示方法:假设A为一n行m列 的矩阵,则A(i,:)表示矩阵A的第i行元素,A(:,j)表示矩阵A的第j列 元素,A(i1:i2,:)表示矩阵A的第i1行到第i2行元素,A(:,j1:j2)矩阵A的 第j1列到第j2列元素,A=[0]i×j表示A为一i行j列的全零矩阵;
定义一个3行12列矩阵HI1,且令:
定义一个3行9列的矩阵Hg,且令:
定义一个3行12列矩阵HI2,
定义一个3行12列矩阵HI3,且令:
HI3(1:2,:)=-HI1(1:2,:)+HI2(1:2,:);
HI3(3,:)=HI2(3,:);
定义一个3行18列矩阵H1,且令:
H1(:,1:9)=[HI3(:,1:4)HI3(:,7:8)HI3(:,10:12)];
H1(1,10:18)=-g0Hg(2,:);
H1(2,10:18)=g0Hg(1,:);
H1(3,10:18)=[0]1×9;
再对第二个静止位置的陀螺仪和加速度计输出值进行平均记为 和求得下式:
计算得到第一次惯导翻转的中间计算数据H1、Z1、C1以及Y1;
d)根据第2次至第18次的翻转数据,采用a)~c)的计算方法, 依次求取第二次惯导翻转到第十八次惯导翻转的中间计算数据,记 为:Hn、Zn、Cn以及Yn,其中n为2到18的整数;
得矩阵:
e)计算标定补偿误差参数,包括:
求得陀螺残余常值漂移:
δε=(CTC)-1CTY;
求其它误差参数:
X=(HTH)-1HTZ;
其中,
f)修正标定补偿参数,包括:
利用得到的参数对陀螺和加速度计标定补偿参数进行修正,包 括:
Kg1=(I3×3-DKg)Kg0;
ε1=ε0+δε;
Ka1=(I3×3-DKa)Ka0;
其中,I3x3为三维单位矩阵;
g)进行迭代计算,包括:
利用Kg1、ε1、Ka1和对Ng和Na进行补偿,再对采得的原始数 据按照a)~f)计算方法,求得Kg2、ε2、Ka2和依次循环计算, 直到δε<0.0001°/h时,判定标定已经收敛,得到标定解算结果。
根据本发明的捷联惯导系统无基准的系统级标定方法一实施例, 其中,设置标定环境,包括:(1)双轴隔振转台;(2)隔振大理石平 台,采用手工翻转(3)如果是双轴转位系统惯导在载车上标定,则 需载车发动机关机,停在厂房中避免阵风影响,避免有人员上下车对 载车角晃动影响。
根据本发明的捷联惯导系统无基准的系统级标定方法一实施例, 其中,定义惯性坐标系为i系,定义惯导坐标系为b系,惯导的三个 敏感轴分别为X轴、Y轴以及Z轴,且X、Y以及Z轴相互垂直正 交,惯导有三个陀螺仪和三个加速度计,分别为X陀螺仪、Y陀螺 仪、Z陀螺仪和X加速度计、Y加速度计、Z加速度计,且X陀螺仪 和X加速度计与b系的X轴重合,Y陀螺仪和Y加速度计与b系的Y 轴重合,Z陀螺仪和Z加速度计与b系的Z轴重合。
根据本发明的捷联惯导系统无基准的系统级标定方法一实施例, 其中,第三步中进行标定转序编排与数据采集的条件包括:惯导初始 姿态:无要求,如惯导安装在转台上,则需要转台平面与水平面夹角 小于10°,如惯导在大理石平台上或地面手动翻转,则需要大理石 平台与水平面夹角小于10°。
根据本发明的捷联惯导系统无基准的系统级标定方法一实施例, 其中,T1大于100s,T2大于10s,小于20s。
根据本发明的捷联惯导系统无基准的系统级标定方法一实施例, 其中,具体的翻转顺序包括:将惯导的3个敏感轴分别沿水平方向正 向翻转三次,每次翻转90°,再分别反向翻转三次每次90°。
本发明针对目前基于最小二乘辨识方法的这两个缺点,设计了一 种无基准要求,且对惯导初始姿态无要求、对标定过程中转序要求较 低的系统级标定方法。该方法可在无基准条件下,实现惯导在不同初 始姿态、不同转序下的高精度标定。
附图说明
无
具体实施方式
为使本发明的目的、内容、和优点更加清楚,下面结合实施例, 对本发明的具体实施方式作进一步详细描述。
本发明捷联惯导系统无基准的系统级标定方法包括:
设置标定环境,包括:(1)双轴隔振转台;(2)隔振大理石平台, 采用手工翻转(3)如果是双轴转位系统惯导在载车上标定,则需载 车发动机关机,停在厂房中避免阵风影响,避免有人员上下车对载车 角晃动影响。
第一步,建立惯导标定补偿模型
首先定义惯性坐标系为i系,定义惯导坐标系为b系,惯导的三 个敏感轴分别为X轴、Y轴、Z轴,且X、Y、Z轴相互垂直正交。 惯导有三个陀螺仪和三个加速度计,分别为X陀螺仪、Y陀螺仪、Z 陀螺仪和X加速度计、Y加速度计、Z加速度计,且X陀螺仪和X 加速度计与b系的X轴重合,Y陀螺仪和Y加速度计与b系的Y轴重 合,Z陀螺仪和Z加速度计与b系的Z轴重合。
惯导的标定补偿模型为
角速度通道:
加速度通道:
其中,上标b表示相关参数在b系上的投影,为陀螺仪输出的 b系相对i系的转动角速度,fb为加速度计输出的比力, Ng=[Ngx Ngy Ngz]T,Ngx、Ngy、Ngz分别为X、Y、Z陀螺仪单位时 间内输出的原始脉冲量,Na=[Nax Nay Naz]T,Nax、Nay、Naz分别为 X、Y、Z加速度计输出的原始脉冲量,Kg为角速度通道补偿矩阵, ε=[εx εy εz]T,εx、εy、εz分别为X、Y、Z陀螺仪常值漂移,Ka为 加速度通道补偿矩阵, 分别为X、Y、 Z加速度计常值偏置。
惯导标定的目的就是求得精确的Kg,ε,Ka,从而利用上式 实现对陀螺仪和加速度计输出的原始脉冲数进行补偿,得到真实的角 速度和比力fb。
第二步,建立惯导标定补偿误差模型
当惯导标定参数不够准确时,解算的角速度和比力fb也会有 误差,其误差模型为:
角速度误差:
比力误差:
其中,δKgx,δKgy,δKgz为分别为X陀螺、Y陀螺、Z陀螺的标 度因数误差,Egxy,Egxz为X陀螺仪与惯导Y轴、Z轴的安装误差,Egyx、 Egyz为Y陀螺仪与惯导X、Z轴的安装误差,Egzx、Egzy为Z陀螺仪与 惯导X、Y轴的安装误差,为陀螺仪输出角速度误差,为惯导 X轴向输入的真实角速度,为惯导Y轴向输入的真实角速度,为惯导Z轴向输入的真实角速度,δεx、δεy、δεz为X、Y、Z陀螺仪 的残余常值零偏,δfb为加速度计输出比力误差,为惯导X轴向输 入的真实比力,为惯导Y轴向输入的真实比力,为惯导Z轴向 输入的真实比力,δKax,δKay,δKaz为分别为X陀螺、Y陀螺、Z陀 螺的标度因数误差,Eayx为Y轴加速度计与惯导X轴的安装误差,Eazx、 Eazy为Z轴加速度计与惯导X、Y轴的安装误差,分 别为X、Y、Z轴加速度计的残余常值偏置。
第三步,进行标定转序编排与数据采集
惯导初始姿态:无要求,但是如惯导安装在转台上,则需要转台 平面与水平面夹角小于10°,如惯导在大理石平台上或地面手动翻 转,则需要大理石平台与水平面夹角小于10°。
惯导的系统级标定方法采用静止-翻转-静止的转序编排策略,在 第一个位置静止T1时间,然后在T2时间内完成第一次翻转,然后在第 二个位置再静止T1时间,然后再在T2时间内完成第二次翻转,共翻转 18次,在19个位置保持静止。一般T1要在100s以上,T2在10s以上, 20s以内。
翻转顺序:只需将惯导的3个敏感轴分别沿水平方向正向翻转三 次,每次翻转90°,再分别反向翻转三次每次90°(不必是严格的 90°,误差在3°以内即可),即每个敏感轴共翻转6次,惯导共进 行18次翻转即可,具体翻转顺序可根据实际情况进行编排,大大提升了系统级标定转序编排的灵活性。示例:假设惯导水平放置在转台 上,X、Y轴在水平面上(当然不是严格在水平面上,与水平面误差 在10°以内即可),其中一种18次翻转顺序编排如下:1)绕X轴旋 转90°;2)绕X轴旋转90°;3)绕X轴旋转90°;4)绕X轴旋 转-90°;5)绕X轴旋转-90°;6)绕X轴旋转-90°;7)绕Y轴 旋转90°;8)绕Z轴旋转90°;9)绕Z轴旋转90°;10)绕Z轴旋转90°;11)绕Z轴旋转-90°;12)绕Z轴旋转-90°;13)绕Z 轴旋转-90°;14)绕Y轴旋转90°;15)绕Y轴旋转90°;16) 绕Y轴旋转-90°;17)绕Y轴旋转-90°;18)绕Y轴旋转-90°。
然后将整个标定过程的惯导输出的原始数据采集到计算机上,以 便于离线解算。
第四步,标定误差解算及修正
a)获取采集的Ng,Na,假设惯导系统经过粗略标定,标定参数 分别为Kg0,ε0,Ka0,输出的带有误差的角速度和比力分别为 即
标定解算过程如下:
定义标定地点的东北天坐标系为导航坐标系,用n表示。在第一 个位置,利用输出进行初始对准,采用解析粗对准方法进 行初始对准,具体方法如下:
对第一个位置T1时间内输出的进行平均,记其平均值分别 为则可求得惯导的姿态矩阵
其中,gn=[0 0 g0]T,g0为标定地点的重力加速度,为已知量,ωie为地球自转角速度,L为标定地点纬度, 皆为已知量。
记初始对准得到的姿态矩阵为
b)在翻转过程T2时间内,进行姿态更新,具体公式如下:
其中,惯导相对导航坐标系的转动角速度在b系上的投影(x,y, z轴的分量),
记姿态更新后的姿态矩阵为
c)计算相关矩阵和误差参数
首先定义有关矩阵相关元素的表示方法:假设A为一n行m列 的矩阵,则A(i,:)表示矩阵A的第i行元素,A(:,j)表示矩阵A的第j列 元素,A(i1:i2,:)表示矩阵A的第i1行到第i2行元素,A(:,j1:j2)矩阵A的 第j1列到第j2列元素,A=[0]i×j表示A为一i行j列的全零矩阵。
定义一个3行12列矩阵HI1,且令
定义一个3行9列的矩阵Hg,且令
定义一个3行12列矩阵HI2
定义一个3行12列矩阵HI3,且令
HI3(1:2,:)=-HI1(1:2,:)+HI2(1:2,:)
HI3(3,:)=HI2(3,:)
定义一个3行18列矩阵H1,且令
H1(:,1:9)=[HI3(:,1:4)HI3(:,7:8)HI3(:,10:12)]
H1(1,10:18)=-g0Hg(2,:)
H1(2,10:18)=g0Hg(1,:)
H1(3,10:18)=[0]1×9
再对第二个静止位置的陀螺仪和加速度计输出值进行平均记为 求得下式:
计算得到H1、Z1、C1以及Y1,即第一次惯导翻转的中间计算数 据;
d)根据第2次至第18次的翻转数据,采用a)~c)的计算方法, 依次求取H2、Z2、C2、Y2····H18、Z18;
则可得以下矩阵
e)计算标定补偿误差参数
则利用下式求得陀螺残余常值漂移
δε=(CTC)-1CTY
利用下式求得其它误差参数
X=(HTH)-1HTZ
其中,
f)标定补偿参数的修正
再利用得到的参数对陀螺和加速度计标定补偿参数进行修正,如 下式所示
Kg1=(I3×3-DKg)Kg0
ε1=ε0+δε
Ka1=(I3×3-DKa)Ka0
其中,I3x3为三维单位矩阵;
g)迭代计算
一般来说,经过一次的计算和修正,对惯导标定补偿参数的修正 效果不会很好,因此可采用迭代的方法,即利用Kg1、ε1、Ka1、对 Ng、Na进行补偿,再对采得的原始数据按照a)~f)计算方法,求得 Kg2、ε2、Ka2、依次循环计算,直到δε<0.0001°/h时,判定标定 已经收敛,标定解算过程结束。
本发明的关键点,巧妙的利用惯导输出的数据计算出姿态矩阵来 近似惯导的真实姿态矩阵,利用惯导翻转时陀螺输出的角速度积分来 近似惯导的转动角度,使标定方法具有一定的智能性,能自动近似计 算出惯导的姿态矩阵和转动角度,摆脱了现有系统级标定方法靠人工 辨别近似的缺陷,从而使本发明对初始姿态、水平和北向方位基准不 再有要求,对转序要求也大大降低。
本发明设计了一种无基准的系统级标定方法,该方法具有以下优 点:
(1)对惯导的初始姿态无要求。摆脱了现有标定方法对初始姿 态的严格要求。
(2)标定过程中无水平和北向方位基准要求,仅对惯导的安装 面与水平面夹角有要求。如惯导安装在转台上,则需要转台平面与水 平面夹角小于10°,如惯导在大理石平台上或地面上手动翻转,则 需要大理石平台或地面与水平面夹角小于10°。摆脱了现有标定方 法对水平和北向方位基准3°以内的要求。
(3)对转序要求不严格,只需将惯导的3个敏感轴沿水平方向 正向翻转90°,再反向翻转90°,共进行18次翻转即可。因此翻转 顺序可根据实际情况进行编排,大大提升了系统级标定转序编排的灵 活性,摆脱了现有系统级标定方法对转序的严格要求。
以上所述仅是本发明的优选实施方式,应当指出,对于本技术领 域的普通技术人员来说,在不脱离本发明技术原理的前提下,还可以 做出若干改进和变形,这些改进和变形也应视为本发明的保护范围。
Claims (6)
1.一种捷联惯导系统无基准的系统级标定方法,其特征在于,包括:
第一步,建立惯导标定补偿模型;
惯导的标定补偿模型包括:
角速度通道:
加速度通道:
其中,上标b表示相关参数在b系上的投影,为陀螺仪输出的b系相对i系的转动角速度,fb为加速度计输出的比力,Ng=[Ngx Ngy Ngz]T,Ngx为X陀螺仪单位时间内输出的原始脉冲量,Ngy为Y陀螺仪单位时间内输出的原始脉冲量,Ngz为Z陀螺仪单位时间内输出的原始脉冲量,Na=[Nax Nay Naz]T,Nax为X加速度计输出的原始脉冲量,Nay为Y加速度计输出的原始脉冲量,Naz为Z加速度计输出的原始脉冲量,Kg为角速度通道补偿矩阵,ε=[εx εy εz]T,εx为X陀螺仪常值漂移,εy为Y陀螺仪常值漂移,εz为Z陀螺仪常值漂移,Ka为加速度通道补偿矩阵, 为X加速度计常值偏置,为Y加速度计常值偏置,为Z加速度计常值偏置;
第二步,建立惯导标定补偿误差模型,包括:
角速度和比力fb的误差模型为:
角速度误差:
比力误差:
其中,δKgx为X陀螺的标度因数误差,δKgy为Y陀螺的标度因数误差,δKgz为Z陀螺的标度因数误差,Egxy为X陀螺仪与惯导Y轴的安装误差,Egxz为X陀螺仪与惯导Z轴的安装误差,Egyx为Y陀螺仪与惯导X轴的安装误差、Egyz为Y陀螺仪与惯导Z轴的安装误差,Egzx为Z陀螺仪与惯导X轴的安装误差,Egzy为Z陀螺仪与惯导Y轴的安装误差,为陀螺仪输出角速度误差,为惯导X轴向输入的真实角速度,为惯导Y轴向输入的真实角速度,为惯导Z轴向输入的真实角速度,δεx为X陀螺仪的残余常值零偏,δεy为Y陀螺仪的残余常值零偏,δεz为Z陀螺仪的残余常值零偏,δfb为加速度计输出比力误差,为惯导X轴向输入的真实比力,为惯导Y轴向输入的真实比力,为惯导Z轴向输入的真实比力,δKax为X陀螺的标度因数误差,δKay为Y陀螺的标度因数误差,δKaz为Z陀螺的标度因数误差,Eayx为Y轴加速度计与惯导X轴的安装误差,Eazx为Z轴加速度计与惯导X轴的安装误差,Eazy为Z轴加速度计与惯导Y轴的安装误差,为X、Y、Z轴加速度计的残余常值偏置、为X、Y、Z轴加速度计的残余常值偏置、分别为X、Y、Z轴加速度计的残余常值偏置;
第三步,进行标定转序编排与数据采集,包括:
惯导的系统级标定方法采用静止-翻转-静止的转序编排策略,在第一个位置静止T1时间,然后在T2时间内完成第一次翻转,然后在第二个位置再静止T1时间,然后再在T2时间内完成第二次翻转,共翻转18次,在19个位置保持静止;
然后将整个标定过程的惯导输出的原始数据进行采集,以便于离线解算;
第四步,标定误差解算及修正,包括:
a)获取采集的Ng和Na,假设惯导系统经过粗略标定,标定参数分别为Kg0,ε0,Ka0和输出的带有误差的角速度和比力分别为和则:
标定解算过程如下:
定义标定地点的东北天坐标系为导航坐标系,用n表示,在第一个位置,利用输出和进行初始对准,采用解析粗对准方法进行初始对准,包括:
对第一个位置T1时间内输出的和进行平均,记其平均值分别为和则可求得惯导的姿态矩阵:
其中,gn=[0 0 g0 T],g0为标定地点的重力加速度,ωie为地球自转角速度,L为标定地点纬度;
记初始对准得到的姿态矩阵为
b)在翻转过程T2时间内,进行姿态更新,包括:
其中,惯导相对导航坐标系的转动角速度在b系上的投影,
记姿态更新后的姿态矩阵为
c)计算相关矩阵和误差参数,包括:
首先定义有关矩阵相关元素的表示方法:假设A为一n行m列的矩阵,则A(i,:)表示矩阵A的第i行元素,A(:,j)表示矩阵A的第j列元素,A(i1:i2,:)表示矩阵A的第i1行到第i2行元素,A(:,j1:j2)矩阵A的第j1列到第j2列元素,A=[0]i×j表示A为一i行j列的全零矩阵;
定义一个3行12列矩阵HI1,且令:
定义一个3行9列的矩阵Hg,且令:
定义一个3行12列矩阵HI2,
定义一个3行12列矩阵HI3,且令:
HI3(1:2,:)=-HI1(1:2,:)+HI2(1:2,:);
HI3(3,:)=HI2(3,:);
定义一个3行18列矩阵H1,且令:
H1(:,1:9)=[HI3(:,1:4)HI3(:,7:8)HI3(:,10:12)];
H1(1,10:18)=-g0Hg(2,:);
H1(2,10:18)=g0Hg(1,:);
H1(3,10:18)=[0]1×9;
再对第二个静止位置的陀螺仪和加速度计输出值进行平均记为和求得下式:
计算得到第一次惯导翻转的中间计算数据H1、Z1、C1以及Y1;
d)根据第2次至第18次的翻转数据,采用a)~c)的计算方法,依次求取第二次惯导翻转到第十八次惯导翻转的中间计算数据,记为:Hn、Zn、Cn以及Yn,其中n为2到18的整数;
得矩阵:
e)计算标定补偿误差参数,包括:
求得陀螺残余常值漂移:
δε=(CTC)-1CTY;
求其它误差参数:
X=(HTH)-1HTZ;
其中,
f)修正标定补偿参数,包括:
利用得到的参数对陀螺和加速度计标定补偿参数进行修正,包括:
Kg1=(I3×3-DKg)Kg0;
ε1=ε0+δε;
Ka1=(I3×3-DKa)Ka0;
其中,I3x3为三维单位矩阵;
g)进行迭代计算,包括:
利用Kg1、ε1、Ka1和对Ng和Na进行补偿,再对采得的原始数据按照a)~f)计算方法,求得Kg2、ε2、Ka2和依次循环计算,直到δε<0.0001°/h时,判定标定已经收敛,得到标定解算结果。
2.如权利要求1所述的捷联惯导系统无基准的系统级标定方法,其特征在于,设置标定环境,包括:(1)双轴隔振转台;(2)隔振大理石平台,采用手工翻转(3)如果是双轴转位系统惯导在载车上标定,则需载车发动机关机,停在厂房中避免阵风影响,避免有人员上下车对载车角晃动影响。
3.如权利要求1所述的捷联惯导系统无基准的系统级标定方法,其特征在于,定义惯性坐标系为i系,定义惯导坐标系为b系,惯导的三个敏感轴分别为X轴、Y轴以及Z轴,且X、Y以及Z轴相互垂直正交,惯导有三个陀螺仪和三个加速度计,分别为X陀螺仪、Y陀螺仪、Z陀螺仪和X加速度计、Y加速度计、Z加速度计,且X陀螺仪和X加速度计与b系的X轴重合,Y陀螺仪和Y加速度计与b系的Y轴重合,Z陀螺仪和Z加速度计与b系的Z轴重合。
4.如权利要求1所述的捷联惯导系统无基准的系统级标定方法,其特征在于,第三步中进行标定转序编排与数据采集的条件包括:
惯导初始姿态:无要求,如惯导安装在转台上,则需要转台平面与水平面夹角小于10°,如惯导在大理石平台上或地面手动翻转,则需要大理石平台与水平面夹角小于10°。
5.如权利要求1所述的捷联惯导系统无基准的系统级标定方法,其特征在于,T1大于100s,T2大于10s,小于20s。
6.如权利要求1所述的捷联惯导系统无基准的系统级标定方法,其特征在于,具体的翻转顺序包括:将惯导的3个敏感轴分别沿水平方向正向翻转三次,每次翻转90°,再分别反向翻转三次每次90°。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201711143868.7A CN108132060B (zh) | 2017-11-17 | 2017-11-17 | 一种捷联惯导系统无基准的系统级标定方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201711143868.7A CN108132060B (zh) | 2017-11-17 | 2017-11-17 | 一种捷联惯导系统无基准的系统级标定方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN108132060A true CN108132060A (zh) | 2018-06-08 |
CN108132060B CN108132060B (zh) | 2021-06-01 |
Family
ID=62388627
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201711143868.7A Active CN108132060B (zh) | 2017-11-17 | 2017-11-17 | 一种捷联惯导系统无基准的系统级标定方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN108132060B (zh) |
Cited By (7)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN109000644A (zh) * | 2018-06-15 | 2018-12-14 | 北京航天发射技术研究所 | 一种基于VxWorks的惯性测量单元系统级标定方法 |
CN109186635A (zh) * | 2018-08-30 | 2019-01-11 | 上海仙知机器人科技有限公司 | 三轴陀螺仪的零点校准方法及系统 |
CN111006675A (zh) * | 2019-12-27 | 2020-04-14 | 西安理工大学 | 基于高精度重力模型的车载激光惯导系统自标定方法 |
CN111486870A (zh) * | 2020-04-23 | 2020-08-04 | 中南大学 | 一种斜置捷联惯组系统级标定方法 |
CN111561948A (zh) * | 2019-12-05 | 2020-08-21 | 北京计算机技术及应用研究所 | 四轴冗余捷联惯导的系统级标定方法 |
CN112595350A (zh) * | 2020-12-31 | 2021-04-02 | 福建星海通信科技有限公司 | 一种惯导系统自动标定方法及终端 |
CN114088118A (zh) * | 2021-12-08 | 2022-02-25 | 北京理工大学 | 一种正反转法mems陀螺仪标定补偿方法 |
Citations (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US20050114112A1 (en) * | 2003-11-03 | 2005-05-26 | Jochen Rivoir | Using component-level calibration data to reduce system-level test |
CN101788296A (zh) * | 2010-01-26 | 2010-07-28 | 北京航空航天大学 | 一种sins/cns深组合导航系统及其实现方法 |
CN101975872A (zh) * | 2010-10-28 | 2011-02-16 | 哈尔滨工程大学 | 石英挠性加速度计组件零位偏置的标定方法 |
CN103852085A (zh) * | 2014-03-26 | 2014-06-11 | 北京航空航天大学 | 一种基于最小二乘拟合的光纤捷联惯导系统现场标定方法 |
CN104344837A (zh) * | 2014-10-30 | 2015-02-11 | 北京航空航天大学 | 一种基于速度观测的冗余惯导系统加速度计系统级标定方法 |
-
2017
- 2017-11-17 CN CN201711143868.7A patent/CN108132060B/zh active Active
Patent Citations (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US20050114112A1 (en) * | 2003-11-03 | 2005-05-26 | Jochen Rivoir | Using component-level calibration data to reduce system-level test |
CN101788296A (zh) * | 2010-01-26 | 2010-07-28 | 北京航空航天大学 | 一种sins/cns深组合导航系统及其实现方法 |
CN101975872A (zh) * | 2010-10-28 | 2011-02-16 | 哈尔滨工程大学 | 石英挠性加速度计组件零位偏置的标定方法 |
CN103852085A (zh) * | 2014-03-26 | 2014-06-11 | 北京航空航天大学 | 一种基于最小二乘拟合的光纤捷联惯导系统现场标定方法 |
CN104344837A (zh) * | 2014-10-30 | 2015-02-11 | 北京航空航天大学 | 一种基于速度观测的冗余惯导系统加速度计系统级标定方法 |
Non-Patent Citations (2)
Title |
---|
张秀娟等: "随机游走对罗经方位对准的精度影响分析", 《中国惯性技术学报》 * |
葛磊等: "一种改进的晃动基座上纬度自估计方法", 《导航与控制》 * |
Cited By (10)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN109000644A (zh) * | 2018-06-15 | 2018-12-14 | 北京航天发射技术研究所 | 一种基于VxWorks的惯性测量单元系统级标定方法 |
CN109186635A (zh) * | 2018-08-30 | 2019-01-11 | 上海仙知机器人科技有限公司 | 三轴陀螺仪的零点校准方法及系统 |
CN111561948A (zh) * | 2019-12-05 | 2020-08-21 | 北京计算机技术及应用研究所 | 四轴冗余捷联惯导的系统级标定方法 |
CN111561948B (zh) * | 2019-12-05 | 2023-07-28 | 北京计算机技术及应用研究所 | 四轴冗余捷联惯导的系统级标定方法 |
CN111006675A (zh) * | 2019-12-27 | 2020-04-14 | 西安理工大学 | 基于高精度重力模型的车载激光惯导系统自标定方法 |
CN111006675B (zh) * | 2019-12-27 | 2022-10-18 | 西安理工大学 | 基于高精度重力模型的车载激光惯导系统自标定方法 |
CN111486870A (zh) * | 2020-04-23 | 2020-08-04 | 中南大学 | 一种斜置捷联惯组系统级标定方法 |
CN112595350A (zh) * | 2020-12-31 | 2021-04-02 | 福建星海通信科技有限公司 | 一种惯导系统自动标定方法及终端 |
CN114088118A (zh) * | 2021-12-08 | 2022-02-25 | 北京理工大学 | 一种正反转法mems陀螺仪标定补偿方法 |
CN114088118B (zh) * | 2021-12-08 | 2024-04-05 | 北京理工大学 | 一种正反转法mems陀螺仪标定补偿方法 |
Also Published As
Publication number | Publication date |
---|---|
CN108132060B (zh) | 2021-06-01 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN108458725B (zh) | 捷联惯导系统晃动基座上的系统级标定方法 | |
CN108132060B (zh) | 一种捷联惯导系统无基准的系统级标定方法 | |
CN108168574B (zh) | 一种基于速度观测的8位置捷联惯导系统级标定方法 | |
CN108318052B (zh) | 一种基于双轴连续旋转的混合式平台惯导系统标定方法 | |
CN110006450B (zh) | 一种激光捷联惯导系统在卧式三轴转台上的标定方法 | |
CN105203129B (zh) | 一种惯导装置初始对准方法 | |
CN111561948B (zh) | 四轴冗余捷联惯导的系统级标定方法 | |
CN107655493B (zh) | 一种光纤陀螺sins六位置系统级标定方法 | |
CN106969783B (zh) | 一种基于光纤陀螺惯性导航的单轴旋转快速标定技术 | |
CN106017507B (zh) | 一种用于中低精度的光纤惯组快速标定方法 | |
CN109211269B (zh) | 一种双轴旋转惯导系统姿态角误差标定方法 | |
CN104316055B (zh) | 一种基于改进的扩展卡尔曼滤波算法的两轮自平衡机器人姿态解算方法 | |
CN112595350B (zh) | 一种惯导系统自动标定方法及终端 | |
CN102564455B (zh) | 星敏感器安装误差四位置标定与补偿方法 | |
CN108088443B (zh) | 一种定位定向设备速度补偿方法 | |
CN109708663B (zh) | 基于空天飞机sins辅助的星敏感器在线标定方法 | |
CN106482746B (zh) | 一种用于混合式惯导系统的加速度计内杆臂标定与补偿方法 | |
CN108507592A (zh) | 一种双轴旋转惯性导航系统转轴非正交角标定方法 | |
CN110006454B (zh) | 一种imu标定三轴转台垂直度和初始姿态的方法 | |
CN102679999A (zh) | 星敏感器安装误差四位置标定与补偿方法 | |
CN115265590A (zh) | 一种双轴旋转惯导动态误差抑制方法 | |
CN113790737A (zh) | 一种阵列式传感器的现场快速标定方法 | |
CN110940357B (zh) | 一种用于旋转惯导单轴自对准的内杆臂标定方法 | |
CN116242397B (zh) | 一种速度误差修正模型下的双惯导协同标定方法 | |
CN113776560B (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 | ||
GR01 | Patent grant | ||
GR01 | Patent grant |