CN102679978B - 一种旋转式捷联惯性导航***静基座初始对准方法 - Google Patents
一种旋转式捷联惯性导航***静基座初始对准方法 Download PDFInfo
- Publication number
- CN102679978B CN102679978B CN201210148310.9A CN201210148310A CN102679978B CN 102679978 B CN102679978 B CN 102679978B CN 201210148310 A CN201210148310 A CN 201210148310A CN 102679978 B CN102679978 B CN 102679978B
- Authority
- CN
- China
- Prior art keywords
- mtd
- msub
- mtr
- mrow
- mover
- 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 48
- 230000003068 static effect Effects 0.000 title claims abstract description 30
- 238000001914 filtration Methods 0.000 claims abstract description 44
- 238000005259 measurement Methods 0.000 claims abstract description 14
- 239000011159 matrix material Substances 0.000 claims description 56
- 230000001133 acceleration Effects 0.000 claims description 24
- 230000005484 gravity Effects 0.000 claims description 19
- 238000013178 mathematical model Methods 0.000 claims description 10
- 238000004422 calculation algorithm Methods 0.000 claims description 8
- 230000008878 coupling Effects 0.000 claims description 6
- 238000010168 coupling process Methods 0.000 claims description 6
- 238000005859 coupling reaction Methods 0.000 claims description 6
- 230000008859 change Effects 0.000 claims description 2
- 238000004364 calculation method Methods 0.000 abstract description 9
- 230000008569 process Effects 0.000 abstract description 8
- 238000004088 simulation Methods 0.000 description 9
- 230000014509 gene expression Effects 0.000 description 8
- 230000000694 effects Effects 0.000 description 4
- 238000012546 transfer Methods 0.000 description 3
- 238000005516 engineering process Methods 0.000 description 2
- 230000007246 mechanism Effects 0.000 description 2
- 125000004432 carbon atom Chemical group C* 0.000 description 1
- 238000007796 conventional method Methods 0.000 description 1
- 230000006872 improvement Effects 0.000 description 1
- 238000005070 sampling Methods 0.000 description 1
- HOWHQWFXSLOJEF-MGZLOUMQSA-N systemin Chemical compound NCCCC[C@H](N)C(=O)N[C@@H](CCSC)C(=O)N[C@@H](CCC(N)=O)C(=O)N[C@@H]([C@@H](C)O)C(=O)N[C@@H](CC(O)=O)C(=O)OC(=O)[C@@H]1CCCN1C(=O)[C@H]1N(C(=O)[C@H](CC(O)=O)NC(=O)[C@H](CCCN=C(N)N)NC(=O)[C@H](CCCCN)NC(=O)[C@H](CO)NC(=O)[C@H]2N(CCC2)C(=O)[C@H]2N(CCC2)C(=O)[C@H](CCCCN)NC(=O)[C@H](CO)NC(=O)[C@H](CCC(N)=O)NC(=O)[C@@H](NC(=O)[C@H](C)N)C(C)C)CCC1 HOWHQWFXSLOJEF-MGZLOUMQSA-N 0.000 description 1
- 108010050014 systemin Proteins 0.000 description 1
Landscapes
- Navigation (AREA)
Abstract
本发明属于惯性导航技术领域,为了克服现有的初始对准方法中存在的计算量大、收敛速度和精度不理想的问题,本发明提出了一种旋转式捷联惯性导航***静基座初始对准方法,该方法采用低阶的卡尔曼滤波状态方程模型和相应的自对准外观测量获取方法有效的降低了对准计算过程中的计算量,此外通过旋转IMU(惯性测量单元)优化了卡尔曼滤波性能,从而改善了惯导***静基座初始对准性能。
Description
技术领域
本发明涉及一种旋转式捷联惯导***在静基座条件下的初始对准方法,属于惯性导航技术领域。
背景技术
捷联惯导***的初始对准是在较短的时间内,以一定的精度确定载体的初始位置、初始速度以及载体的初始姿态角。捷联惯性导航***的初始对准通常分为两个阶段:粗对准阶段和精对准阶段。在粗对准阶段,根据重力加速度矢量和地球自转角速率矢量的测量值,直接估算出载体坐标系到导航坐标系的方向余弦矩阵,估算值与真实值存在偏差,但应为小量;精对准可在粗对准基础上采用最小二乘法或卡尔曼滤波完成。
按惯导***基座的运动状态,惯性导航初始对准可分为动基座对准和静基座对准。动基座对准是在载体运动状态下进行的,而静基座对准是载体未进行线运动情况下的对准,此时载体经纬度位置不变,地速为零。
按对准过程中信息的获取途径,惯性导航初始对准又可分为自对准和传递对准。传递对准就是利用高精度的主惯导***输出的导航参数或其他设备(如GPS、里程计等)提供的载体运动参数信息,作为外观测量,通过状态滤波技术估计出子惯导***状态量的值;而自对准是从惯导***自身的惯性器件输出值中提取载体运动参数信息作为外观测量,通过状态滤波技术估计出状态量的值。其中,传递对准主要应用于动基座对准,而自对准主要应用于静基座对准。
在精对准阶段,惯导***静基座对准通常采用的方法是基于卡尔曼滤波的状态量估计法,所采用的***方程为:
其中,A为***状态矩阵,W为***噪声向量,X为***的状态向量,G为噪声系数矩阵,将这些参数写成矩阵形式分别为:
X=[δVeδVnφeφnφuΔxΔyΔzεxεyεz]T
W=[waxwaywazwgxwgywgz]T
上式中,L为载体纬度位置,R为地球半径,ωie为地球自转角速率,c11,c12,…,c33为载体姿态矩阵的各元素,下标e、n、u分别表示地理坐标系的东、北、天方向,下标x、y、z分别表示捷联惯导坐标系的坐标轴方向,δVi表示载体速度误差,φi表示载体姿态失准角,Δj、εj分别表示加速度计和陀螺的零偏,waj、wgj分别表示加速度计和陀螺的噪声;其中i的取值为e、n、u;j的取值为x、y、z。
在精对准过程中,***根据粗对准确定的姿态阵和陀螺的实时更新姿态矩阵,在此基础上解算出实时速度,由于载体无移动,所以此速度实际上是速度误差,可将其视为外观测量,从而得到***的观测方程:
上式中,Z为***的观测向量,H为***的观测矩阵,WV为***的观测噪声向量,wve,wvn分别为东、北向速度的观测噪声。
将所求得的状态方程和观测方程进行卡尔曼滤波,估计出姿态角的误差和惯性器件的零偏,即可完成初始对准。
上述方案存在的局限性如下:速度外观测量初始对准方法根据粗对准确定的姿态阵和陀螺的实时更新姿态矩阵,在此基础上需要解算出实时速度作为速度误差,因此导航计算机必须执行复杂的导航解算算法,其中需进行划船效应与涡卷效应等误差的补偿,否则将降低速度解算精度进而降低对准精度;在静基座下方位失准角与各惯性器件零偏的可观测度都很低,导致收敛速度和精度很不理想,而通过载体运动提高可观测度的方法对于一些特殊应用背景(如武器***平台)无法满足。
发明内容
为了克服现有的速度外观测量初始对准方法中存在的计算量大、收敛速度和精度不理想的问题,本发明提出了一种旋转式捷联惯性导航***静基座初始对准方法,该方法采用低阶的卡尔曼滤波状态方程模型和相应的自对准外观测量获取方法有效的降低了对准计算过程中的计算量,此外通过旋转IMU(惯性测量单元)优化了卡尔曼滤波性能,从而完成了惯性导航***静基座初始对准。
一种旋转式捷联惯性导航***静基座初始对准方法,该方法实现的具体步骤如下:
步骤一、获得旋转式捷联惯性导航***的载体所在位置的经度λ、纬度L;
步骤二、根据所确定的经度、纬度信息以及惯导***惯性器件的输出进行粗对准,得到惯性测量单元姿态矩阵的近似估计值;
步骤三、使旋转式捷联惯性导航***的转轴按一定旋转方案旋转;其中,将内环轴、外环轴旋转的角速率分别记为ω1、ω2;
步骤四、按照步骤三所确定的旋转方案旋转的同时,利用粗对准得到的姿态矩阵和惯性测量单元的陀螺实时输出的角速度信息,以更新惯性测量单元的姿态矩阵;
步骤五、通过卡尔曼滤波完成静基座对准,具体步骤如下:
①在载体无移动的静基座条件下,加速度计输出为:
其中,为载体的姿态矩阵,gN=[00-g]T,为导航坐标系下的重力加速度向量,wa=[waz,way,waz]T为加速度计噪声向量,Δ=[Δx,Δy,Δz]T为加速度计零偏向量,为惯性导航***按照步骤三所确定的旋转方案旋转时的旋转方向余弦矩阵;
②根据不同的旋转***结构建立加速度计输出的数学模型,在加速度计输出的数学模型中,简化粗对准后失准角所对应的三角函数以及忽略失准角在东、北方向上的分量φe,φn的二阶小量,从而得到加速度计输出的线性化近似数学模型 其中g为当地重力加速度,m11,m12,…m33为旋转方案所对应的观测方程中粗对准得到的惯性测量单元坐标系下重力加速度分量系数,以及重力加速度与姿态失准角耦合量的系数;
③从加速度计的输出中减去重力加速度的估计值,得到失准角与重力加速度的耦合量、加速度计零偏以及加速度计噪声之和,作为卡尔曼滤波的外观测量,观测方程如下:
其中,X为***的状态向量,Z为***观测向量;
④根据所求得的观测方程以及卡尔曼滤波状态方程进行卡尔曼滤波,通过卡尔曼滤波估计载体姿态失准角误差、加速度计和陀螺零偏,用姿态失准角误差的估计值对载体姿态矩阵进行修正,待卡尔曼滤波达到稳态后,以此时的载体姿态矩阵作为导航解算的初始载体姿态矩阵,从而完成静基座精对准;
所述的卡尔曼滤波的状态方程为:
上式中,L为载体纬度位置,R为地球半径,ωie为地球自转角速率,c11,c12,…,c33为载体姿态矩阵的各元素,下标e、n、u分别表示地理坐标系的东、北、天方向,下标x、y、z分别表示捷联惯导坐标系的坐标轴方向,δVi表示载体速度误差,φi表示载体姿态失准角,Δj、εj分别表示加速度计和陀螺的零偏,waj、wgj分别表示加速度计和陀螺的噪声;其中i的取值为e、n、u;j的取值为x、y、z。
有益效果
(1)卡尔曼滤波器的运算量与其阶数的三次方成正比。若***状态方程阶数为n,观测方程阶数为m,则完成一次递推计算需要完成4n3+(1+4m)n2+(2m2+2m)n+m3次乘除运算和4n3+(4m-2)n2-(2m+1)n+m3次加法运算。本发明的卡尔曼滤波状态方程为9阶,观测方程为3阶,而背景技术中所述的传统方法所用状态方程为11阶,观测方程为2阶。由此可以计算出本发明的卡尔曼滤波乘除法、加法运算量分别下降至速度外观测量初始对准方法(传统方法)的64.28%和61.19%。
(2)速度观测量初始对准方法(传统方法)根据粗对准确定的姿态阵和陀螺的实时更新姿态矩阵,在此基础上需要解算出实时速度作为速度误差;而按照本发明方法提取的外观测量是姿态角误差与加速度计零偏的线性组合,外观测量是姿态角误差与加速度计零偏,因此无需速度解算,可以进一步节省初始对准运算量。
(3)在捷联式惯导***中引入IMU旋转机构,可以通过旋转使IMU处于角运动之中,角运动可以提高初始对准可观测性,从而改善卡尔曼滤波的收敛速度与精度,旋转IMU可以进行在捷联式惯导***中无法实现的角运动机动方式,因此在改善卡尔曼滤波性能方面的效果尤为显著。
附图说明
图1(a)~(e)分别为仿真实验①中,捷联式惯导***与应用本发明的静基座初始对准方法的旋转式惯导***进行初始对准卡尔曼滤波过程中各状态量的估计误差;
图2(a)~(e)分别为仿真实验②中,捷联式惯导***与应用本发明的静基座初始对准方法的旋转式惯导***进行初始对准卡尔曼滤波过程中各状态量的估计误差;
图3(a)~(e)分别为仿真实验③中,捷联式惯导***与应用本发明的静基座初始对准方法的旋转式惯导***进行初始对准卡尔曼滤波过程中各状态量的估计误差。
具体实施方式
为了进一步说明本发明的目的和优点,下面结合附图和实施例详细描述本发明的具体实施方式。
步骤一、通过全球导航卫星***或其他途径获得旋转式捷联惯性导航***的载体所在位置的经度λ、纬度L;将载***置信息导入导航计算机,此时静基座条件下载体的地速度应为零。
步骤二、根据所确定的经度、纬度信息以及惯导***惯性器件的输出进行粗对准,得到惯性测量单元姿态矩阵的近似估计值;
在本步骤中,常用的方法为解析式粗对准方法,求解公式如下:
上式中,为IMU姿态矩阵的粗对准计算值,g为当地重力加速度,ωie为地球自转角速率,gN=[00-g]T,为导航坐标系下的重力加速度向量,为导航坐标系下地球自转角速度向量。为IMU坐标系下重力加速度的测量值,即为静基座下加速度计的输出值;为IMU坐标系下地球自转加速度的测量值,即为静基座下陀螺的输出值。
步骤三、使旋转式捷联惯性导航***的转轴按一定旋转方案旋转;其中,将内环轴、外环轴旋转的角速率分别记为ω1、ω2;
其中,单轴旋转式惯导***旋转方案选择下述方案之一:
a.单向连续旋转;(仅限于有导电滑环的旋转式惯导***)
b.连续旋转,每旋转一周改变转向;
双轴旋转式惯导***旋转方案选择下述方案之一:
a.内环轴、外环轴单向连续旋转;(仅限于有导电滑环的旋转式惯导***)
b.内环轴、外环轴连续旋转,每旋转一周改变转向;
c.内环轴、外环轴单向交替旋转,每个轴旋转一周则停止同时开始旋转另一轴,如此循环往复;(仅限于有导电滑环的旋转式惯导***)
d.内环轴、外环轴变向交替旋转,第一轴旋转一周后停止,然后由第二轴旋转一周,然后再由第一轴反向旋转一周,然后再由第二轴反向旋转一周,如此循环往复;
e.内环轴、外环轴变向交替旋转,第一轴旋转一周后再反向旋转一周,然后停止,然后由第二轴旋转一周后再反向旋转一周,如此循环往复;
上述各方案中ω1和ω2的范围为0.6°/s~60°/s。
步骤四、按照步骤三所确定的旋转方案旋转的同时,利用粗对准得到的姿态矩阵和惯性测量单元的陀螺实时输出的角速度信息,求出矩阵微分方程的数值解,以更新惯性测量单元的姿态矩阵;
在本步骤中,卡尔曼滤波精对准时,需要载体姿态的实时输出,实施方式为利用粗对准所得姿态矩阵和陀螺输出的角速度信息,通过求矩阵微分方程的数值解,以更新IMU的姿态矩阵
其中,表示姿态矩阵的变化率,取的初值等于惯性测量单元姿态矩阵的粗对准计算值 为IMU相对于导航坐标系的陀螺输出的角速度的反对称矩阵形式。
其中,ωx、ωy、ωz分别为陀螺输出的角速度沿IMU坐标系x,y,z轴的分量。
矩阵微分方程数值求解用毕卡逼近算法(适合输出为角增量的陀螺)或龙格-库塔算法(适合输出为角速度的陀螺)。姿态更新可以采用四元数算法或等效旋转矢量算法。
在此给出采用二阶龙格-库塔算法求解的实现方法:
式中T为惯性器件采样周期。
步骤五、通过卡尔曼滤波完成静基座对准,具体步骤如下:
①在载体无移动的静基座条件下,加速度计输出为:
其中,为载体的姿态矩阵,gN=[00-g]T,为导航坐标系下的重力加速度向量的,wa=[waz,way,waz]T为加速度计噪声向量,Δ=[Δx,Δy,Δz]T为加速度计零偏向量,为惯性导航***按照步骤三所确定的旋转方案旋转时的旋转方向余弦矩阵;
②根据不同的旋转***结构建立加速度计输出的数学模型,在加速度计输出的数学模型中,简化粗对准后失准角所对应的三角函数以及忽略失准角在东、北方向上的分量φe,φn的二阶小量,从而得到加速度计输出的线性化近似数学模型 其中g为当地重力加速度,m11,m12,…m33为旋转方案所对应的观测方程中粗对准得到的惯性测量单元坐标系下重力加速度分量系数,以及重力加速度与姿态失准角耦合量的系数;
③从加速度计的输出中减去重力加速度的估计值,得到失准角与重力加速度的耦合量、加速度计零偏以及加速度计噪声之和,作为卡尔曼滤波的外观测量,观测方程如下:
其中,X为***的状态向量,Z为***观测向量;
④根据所求得的观测方程以及卡尔曼滤波状态方程进行卡尔曼滤波,通过卡尔曼滤波估计载体姿态失准角误差,用姿态失准角误差的估计值对载体姿态矩阵进行修正,待卡尔曼滤波达到稳态后,以此时的载体姿态矩阵作为导航解算的初始载体姿态矩阵,从而完成静基座精对准;
所述的卡尔曼滤波的状态方程为:
上式中,L为载体纬度位置,R为地球半径,ωie为地球自转角速率,c11,c12,…,c33为载体姿态矩阵的各元素,下标e、n、u分别表示地理坐标系的东、北、天方向,下标x、y、z分别表示捷联惯导坐标系的坐标轴方向,δVi表示载体速度误差,φi表示载体姿态失准角,Δj、εj分别表示加速度计和陀螺的零偏,waj、wgj分别表示加速度计和陀螺的噪声;其中i的取值为e、n、u;j的取值为x、y、z。
本步骤中,首先对于单轴旋转式惯导***,在载体无移动的静基座条件下,加速度计输出为:
其中,为载体的姿态矩阵,设载体的俯仰角、姿态角、方位角分别为θ,γ,ψ,wa=[waz,way,waz]T为加速度计噪声向量,Δ=[Δx,Δy,Δz]T为加速度计零偏向量,则载体的姿态矩阵表达式为:
为旋转矩阵,即载体与IMU之间的方向余弦矩阵,对于单轴旋转的旋转式惯导***,其旋转矩阵的表达式为:
其中,a、b、c式分别对应于绕IMU的x、y、z轴旋转的单轴旋转式惯导***的旋转矩阵表达式,αi(i=x,y,z)为IMU绕转轴i旋转的角位置。
对于双轴旋转的旋转式惯导***,其旋转矩阵的表达式为:
A.
B.
C.
D.
E.
F.
其中,各式所对应的旋转式***的结构分别为:
A对应的旋转式***的结构为:z轴为内环轴,x轴为外环轴;
B对应的旋转式***的结构为:x轴为内环轴,z轴为外环轴;
C对应的旋转式***的结构为:z轴为内环轴,y轴为外环轴;
D对应的旋转式***的结构为:y轴为内环轴,z轴为外环轴;
E对应的旋转式***的结构为:y轴为内环轴,x轴为外环轴;
F对应的旋转式***的结构为:x轴为内环轴,y轴为外环轴。
以A式所对应结构的旋转式惯导***为例,推导加速度计输出的数学模型:
由于粗对准后误差角为小量,所以可以对其中三角函数进行简化:
sin(φe+θ)=sinφecosθ+cosφesinθ≈φecosθ+sinθ
cos(φe+θ)=cosφecosθ-sinφesinθ≈cosθ-φesinθ
sin(φn+γ)=sinφncosγ+cosφnsinγ≈φncosγ+sinγ
cos(φn+γ)=cosφncosγ-sinφnsinγ≈cosγ-φnsinγ
因此,加速度计输出的数学模型可以简化为:
由于φe,φn均为小量,因此忽略二阶小量可得:
其中,g为当地重力加速度,各系数mij的表达式为:
m11=cosθcosγsinαxsinαz-sinθcosαxsinαz-cosθsinγcosαz
m12=sinθsinγcosαz-cosθcosαxsinαz-sinθcosγsinαxsinαz
m13=-cosθcosγcosαz-cosθsinγsinαxsinαz
m14=sinθcosγcosαz+sinθsinγsinαxsinαz
m21=sinθcosαxcosαz-cosθsinγsinαz-cosθcosγsinαxcosαz
m22=cosθcosαxcosαz+sinθsinγsinαz+sinθcosγsinαxcosαz
m23=cosθsinγsinαxcosαz-cosθcosγsinαz
m24=sinθcosγsinαz-sinθsinγsinαxcosαz
m31=sinθsinαx+cosθcosγcosαx
m32=cosθsinαx-sinθcosγcosαx
m33=cosθsinγcosαx
m34=sinθsinγcosαx
由此,观测方程可以写成:
同理可推导出其他结构的旋转式惯导***观测方程中系数mij的表达式,如表1所示。
表1各种旋转式惯导***结构所对应观测方程的m系数表达式
其中,θ、γ分别为载体的俯仰角、横滚角,αi为***旋转机构中与IMU的敏感轴i重合的转轴(其中i可以为x,y,z)。旋转式惯导***结构a~c分别为代表IMU绕其x,y,z轴旋转的结构;旋转式惯导***结构A~F的所代表结构分别为:A.z轴为内环轴,x轴为外环轴;B.x轴为内环轴,z轴为外环轴;C.z轴为内环轴,y轴为外环轴;D.y轴为内环轴,z轴为外环轴;E.y轴为内环轴,x轴为外环轴;F.x轴为内环轴,y轴为外环轴。
此外,在本步骤的精对准状态滤波过程中,本发明所用卡尔曼滤波的状态方程为:
上式中,L为载体纬度位置,R为地球半径,ωie为地球自转角速率,c11,c12,…,c33为载体姿态矩阵的各元素,下标e、n、u分别表示地理坐标系的东、北、天方向,下标x、y、z分别表示捷联惯导坐标系的坐标轴方向,δVi表示载体速度误差,φi表示载体姿态失准角,Δj、εj分别表示加速度计和陀螺的零偏,waj、wgj分别表示加速度计和陀螺的噪声;其中i的取值为e、n、u;j的取值为x、y、z。
对式(1)和(2)组成的***通过卡尔曼滤波进行精对准。在滤波过程中利用IMU旋转可以提高初始对准可观测性,优化初始对准性能。
下面通过matlab软件仿真实验说明IMU旋转对本发明对静基座初始对准卡尔曼滤波性能的改善。
设载***于北纬30度,初始航向为北偏东30度,陀螺、加速度计零偏分别为0.01°/h和g×10-4,惯性器件白噪声标准差分别为0.005°/h和0.5g×10-4。以三种旋转方案为例,进行卡尔曼滤波初始对准仿真,与IMU无旋转的情况(相当于采用本发明的状态方程和观测方程进行初始对准的捷联式惯导***)进行比较:(这里只给出了旋转式***相对于捷联式***的初始对准卡尔曼滤波性能改善的状态量的滤波估计误差仿真曲线。)
①旋转方案为z轴连续旋转,角速率ω=6°/s,每旋转一周改变转向。卡尔曼滤波初始对准仿真结果与捷联式***情况对比如图1所示。
②旋转式惯导***结构如表1中A式所示,角速率ω=6°/s,旋转方案为双轴连续旋转,每旋转一周改变转向。卡尔曼滤波初始对准仿真结果与捷联式***情况对比如图2所示。
③旋转式惯导***结构如表1中A式所示,角速率ω=6°/s,旋转方案为双轴交替单周旋转,每旋转一周改变转向。卡尔曼滤波初始对准仿真结果与捷联式***情况对比如图3所示。
仿真实验表明:本发明的方法可以提高多数状态量(φe,φn,φu,Δx,Δy)初始对准卡尔曼滤波的收敛速度与精度。
Claims (5)
1.一种旋转式捷联惯性导航***静基座初始对准方法,其特征在于:该方法实现的具体步骤如下:
步骤一、获得旋转式捷联惯性导航***的载体所在位置的经度λ、纬度L;
步骤二、根据所确定的经度、纬度信息以及惯导***惯性器件的输出进行粗对准,得到惯性测量单元姿态矩阵的近似估计值;
步骤三、使旋转式捷联惯性导航***的转轴按一定旋转方案旋转;其中,将内环轴、外环轴旋转的角速率分别记为ω1、ω2;
步骤四、按照步骤三所确定的旋转方案旋转的同时,利用粗对准得到的姿态矩阵和惯性测量单元的陀螺实时输出的角速度信息,以更新惯性测量单元的姿态矩阵;
步骤五、通过卡尔曼滤波完成静基座对准,具体步骤如下:
①在载体无移动的静基座条件下,加速度计输出为:
其中,为载体的姿态矩阵,gN=[0 0 -g]T,为导航坐标系下的重力加速度向量,wa=[waz,way,waz]T为加速度计噪声向量,Δ=[Δx,Δy,Δz]T为加速度计零偏向量,为惯性导航***按照步骤三所确定的旋转方案旋转时的旋转方向余弦矩阵;
②根据不同的旋转***结构建立加速度计输出的数学模型,在加速度计输出的数学模型中,简化粗对准后失准角所对应的三角函数以及忽略失准角在东、北方向上的分量φe,φn的二阶小量,从而得到加速度计输出的线性化近似数学模型 其中g为当地重力加速度,m11,m12,...m33为旋转方案所对应的观测方程中粗对准得到的惯性测量单元坐标系下重力加速度分量系数,以及重力加速度与姿态失准角耦合量的系数;
③从加速度计的输出中减去重力加速度的估计值,得到失准角与重力加速度的耦合量、加速度计零偏以及加速度计噪声之和,作为卡尔曼滤波的外观测量,观测方程如下:
其中,X为***的状态向量,Z为***观测向量;
④根据所求得的观测方程以及卡尔曼滤波状态方程进行卡尔曼滤波,通过卡尔曼滤波估计载体姿态失准角误差、加速度计和陀螺零偏,用姿态失准角误差的估计值对载体姿态矩阵进行修正,待卡尔曼滤波达到稳态后,以此时的载体姿态矩阵作为导航解算的初始载体姿态矩阵,从而完成静基座精对准;
所述的卡尔曼滤波的状态方程为:
上式中,L为载体纬度位置,ωie为地球自转角速率,c11,c12,...,c33为载体姿态矩阵的各元素,下标e、n、u分别表示地理坐标系的东、北、天方向,下标x、y、z分别表示捷联惯导坐标系的坐标轴方向,φi表示载体姿态失准角,Δj、εj分别表示加速度计和陀螺的零偏,waj、wgj分别表示加速度计和陀螺的噪声;其中i的取值为e、n、u;j的取值为x、y、z。
2.如权利要求1所述的一种旋转式捷联惯性导航***静基座初始对准方法,其特征在于:步骤二中,粗对准的方法采用解析式粗对准方法。
3.如权利要求1所述的一种旋转式捷联惯性导航***静基座初始对准方法,其特征在于:步骤三中,旋转方案的选择如下:
单轴旋转式惯导***旋转方案选择下述方案之一:
a.单向连续旋转,该旋转方案仅限于有导电滑环的旋转式惯导***;
b.连续旋转,每旋转一周改变转向;
双轴旋转式惯导***旋转方案选择下述方案之一:
a.内环轴、外环轴单向连续旋转,该旋转方案仅限于有导电滑环的旋转式惯导***;
b.内环轴、外环轴连续旋转,每旋转一周改变转向;
c.内环轴、外环轴单向交替旋转,每个轴旋转一周则停止同时开始旋转另一轴,如此循环往复,该旋转方案仅限于有导电滑环的旋转式惯导***;
d.内环轴、外环轴变向交替旋转,第一轴旋转一周后停止,然后由第二轴旋转一周,然后再由第一轴反向旋转一周,然后再由第二轴反向旋转一周,如此循环往复;
e.内环轴、外环轴变向交替旋转,第一轴旋转一周后再反向旋转一周,然后停止,然后由第二轴旋转一周后再反向旋转一周,如此循环往复。
4.如权利要求1所述的一种旋转式捷联惯性导航***静基座初始对准方法,其特征在于:步骤三中,ω1和ω2的范围为0.6°/s~60°/s。
5.如权利要求1所述的一种旋转式捷联惯性导航***静基座初始对准方法,其特征在于:步骤四中,姿态矩阵的更新采用四元数算法或等效旋转矢量算法。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201210148310.9A CN102679978B (zh) | 2012-05-14 | 2012-05-14 | 一种旋转式捷联惯性导航***静基座初始对准方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201210148310.9A CN102679978B (zh) | 2012-05-14 | 2012-05-14 | 一种旋转式捷联惯性导航***静基座初始对准方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN102679978A CN102679978A (zh) | 2012-09-19 |
CN102679978B true CN102679978B (zh) | 2014-10-29 |
Family
ID=46812264
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201210148310.9A Active CN102679978B (zh) | 2012-05-14 | 2012-05-14 | 一种旋转式捷联惯性导航***静基座初始对准方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN102679978B (zh) |
Families Citing this family (10)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN103575300B (zh) * | 2013-11-13 | 2017-02-08 | 北京理工大学 | 一种基于旋转调制的摇摆基座惯导***粗对准方法 |
CN103575276A (zh) * | 2013-11-13 | 2014-02-12 | 北京理工大学 | 一种双轴旋转惯性导航***初始对准模型降阶方法 |
CN103591960B (zh) * | 2013-11-13 | 2016-04-20 | 北京理工大学 | 一种基于旋转调制的静基座惯性导航***粗对准方法 |
CN104075716B (zh) * | 2014-06-30 | 2017-02-08 | 南京理工大学 | 基于高精度imu的捷联惯导初始对准方法 |
CN105865488B (zh) * | 2016-05-19 | 2018-05-08 | 北京航空航天大学 | 一种基于自主量测信息的静基座动态快速精确对准方法 |
CN107492717B (zh) * | 2017-06-22 | 2020-03-17 | 山东航天电子技术研究所 | 一种动中通天线余弦扫描的惯导航向修正方法 |
CN108592943B (zh) * | 2018-03-16 | 2020-06-02 | 东南大学 | 一种基于opreq方法的惯性系粗对准计算方法 |
CN109782023B (zh) * | 2019-01-25 | 2020-05-19 | 华中科技大学 | 一种通过旋转调制法测量加速度计高阶项数系数的方法 |
CN110388941B (zh) * | 2019-08-28 | 2021-09-10 | 北京机械设备研究所 | 一种基于自适应滤波的车辆姿态对准方法 |
CN110388942B (zh) * | 2019-08-28 | 2021-09-10 | 北京机械设备研究所 | 一种基于角度和速度增量的车载姿态精对准*** |
Citations (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN101216321A (zh) * | 2008-01-04 | 2008-07-09 | 南京航空航天大学 | 捷联惯性导航***的快速精对准方法 |
CN101514900A (zh) * | 2009-04-08 | 2009-08-26 | 哈尔滨工程大学 | 一种单轴旋转的捷联惯导***初始对准方法 |
CN101576385A (zh) * | 2009-06-22 | 2009-11-11 | 哈尔滨工程大学 | 光纤陀螺捷联惯导***消除不确定性干扰的精对准方法 |
CN102221364A (zh) * | 2011-03-10 | 2011-10-19 | 北京理工大学 | 一种单轴旋转式捷联惯导***转位方法 |
-
2012
- 2012-05-14 CN CN201210148310.9A patent/CN102679978B/zh active Active
Patent Citations (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN101216321A (zh) * | 2008-01-04 | 2008-07-09 | 南京航空航天大学 | 捷联惯性导航***的快速精对准方法 |
CN101514900A (zh) * | 2009-04-08 | 2009-08-26 | 哈尔滨工程大学 | 一种单轴旋转的捷联惯导***初始对准方法 |
CN101576385A (zh) * | 2009-06-22 | 2009-11-11 | 哈尔滨工程大学 | 光纤陀螺捷联惯导***消除不确定性干扰的精对准方法 |
CN102221364A (zh) * | 2011-03-10 | 2011-10-19 | 北京理工大学 | 一种单轴旋转式捷联惯导***转位方法 |
Non-Patent Citations (2)
Title |
---|
盛景泉等.采用小波神经网络的捷联惯导***静基座快速初始对准.《内蒙古大学学报(自然科学版)》.2003,第34卷(第4期), |
采用小波神经网络的捷联惯导***静基座快速初始对准;盛景泉等;《内蒙古大学学报(自然科学版)》;20030731;第34卷(第4期);468-471 * |
Also Published As
Publication number | Publication date |
---|---|
CN102679978A (zh) | 2012-09-19 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN102679978B (zh) | 一种旋转式捷联惯性导航***静基座初始对准方法 | |
CN103575299B (zh) | 利用外观测信息的双轴旋转惯导***对准及误差修正方法 | |
CN108318052B (zh) | 一种基于双轴连续旋转的混合式平台惯导***标定方法 | |
CN103090867B (zh) | 相对地心惯性系旋转的光纤陀螺捷联惯性导航***误差抑制方法 | |
CN100516775C (zh) | 一种捷联惯性导航***初始姿态确定方法 | |
CN101514900B (zh) | 一种单轴旋转的捷联惯导***初始对准方法 | |
CN104165638B (zh) | 一种双轴旋转惯导***多位置自主标定方法 | |
CN101514899B (zh) | 基于单轴旋转的光纤陀螺捷联惯性导航***误差抑制方法 | |
CN103900565B (zh) | 一种基于差分gps的惯导***姿态获取方法 | |
CN105371844B (zh) | 一种基于惯性/天文互助的惯性导航***初始化方法 | |
CN108680186B (zh) | 基于重力仪平台的捷联式惯导***非线性初始对准方法 | |
CN108051866A (zh) | 基于捷联惯性/gps组合辅助水平角运动隔离的重力测量方法 | |
CN108871326B (zh) | 一种单轴旋转调制惯性-天文深组合导航方法 | |
CN102052921B (zh) | 一种单轴旋转捷联惯导***初始航向的确定方法 | |
CN111102993A (zh) | 一种旋转调制型捷联惯导***晃动基座初始对准方法 | |
CN105628025B (zh) | 一种恒速偏频/机抖激光陀螺惯导***导航方法 | |
CN104697526A (zh) | 用于农业机械的捷联惯导***以及控制方法 | |
CN106052682A (zh) | 一种混合式惯性导航***及导航方法 | |
CN103148868B (zh) | 匀速直航下基于多普勒计程仪地理系测速误差估计的组合对准方法 | |
CN103090865B (zh) | 一种调制型捷联惯性导航***姿态误差抑制方法 | |
CN107677292B (zh) | 基于重力场模型的垂线偏差补偿方法 | |
CN105865490B (zh) | 一种惯性稳定平台固定基座多位置自瞄准方法 | |
CN103256943A (zh) | 一种在单轴旋转捷联惯导***中刻度因数误差的补偿方法 | |
CN106767806A (zh) | 一种用于混合式惯性导航***的物理平台 | |
CN108132060A (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 |