文档下载 文档下载导航
设为首页 | 加入收藏
搜索 请输入内容:  
 导航当前位置: 文档下载 > 所有分类 > 工程科技 > 交通运输 > 捷联惯导一种优化的惯性系粗对准方法
侵权投诉

捷联惯导一种优化的惯性系粗对准方法

4期

王跃钢,等:捷联惯导一种优化的惯性系粗对准方法

对式( 4)网端在 t o到 t k时 f司段肉进行积分

可得:

[。 ( t . )]

=一 c l 。 f t ̄ g i d + + 6。 t o t O

( 5 )

[ o ( t“ )] L[岫 ( t )× 。 ( t“)] J

( 8 )

式( 5 )中: =一 c 。 ( × r ) 。=f t k 。 。 d 。 令岫:一 c f t k g :c l岫 ( t k ), t 0 : 一

就这样将求得的

姿态信息阵 c l代入式( 1 )中 即可计算出粗对准确定的姿态阵。

眩, ( ):f“一 g d t。则有: t o ,

2姿态信息阵的优化 为提高姿态信息阵 c l的求取精度,优化对准

。

一

即

。 C i b o

( 6 )

由于 g=C i 乙 e g 是可求得,因此 V( t )也是可

结果,可以对 ( 8 )获得的多组数据进行分段处理。 这就是所谓的 Wa h b a问题。对于这个问题,达

求的。按照前面的推导可知在不同时刻 t, t ( t o < t .

< t k 2

),重力加速度在惯性坐标系下是旋转变

文波特以旋转四元数的形式提出了一种解决办法 称之为 q - me t h o d方法,它是基于以下方程:

化的,如图 1所示: 地球自转 、 |,

÷∑ l I b 一 A r l= I 1一 q T 式( 9 )中, 对应于同一向量。 K为量测向量相关函数。

( 9 )

2, r, b为两组给定的向量,每对 r。, b

、

、

\_ l 、 ~、

,,

问题就转化为需要求合适的正交姿态矩阵A使

¨{; ( t 2] ' 、:

。

.一 -

,

。/

得∑ I】 b — A I最小。】具体算法如下: 、

'^

( 1 )获得一组观测量 r , b , i= 1, 2… ., n,在

式( 9 )中对应权重取为,且∑ =1。 ( 2 )构造矩阵日, S和向量以及常数,使得

K: f s一厶 1。 图1 重力加速度相对惯性坐标系旋转运动

进而有:

式中, B=∑ b, S= B+ B ,。= i=1 n ~

∑O t i b ×,=打 ( )。 t r ( )表示对矩阵求迹。 K最大特征值对应的特征向量即为对应四元数的最优估计值。这种方法的最大好处在于对量[ ( t )] ^

测噪声进行了滤波,不需要任何初值。

优化后的惯性系粗对准方法并不一定要求连 ×

c 。

=

[ ( “ )] [ V( t . )×V( t )]

续利用加速度计信息,并且能够有效抑制加速度计的测量噪声,使重力加速度在两个坐标系上的投影

更准确,从理论上将能够在一定程度上提高对准 精度。

捷联惯导一种优化的惯性系粗对准方法

上一页第2页

你可能喜欢

热门文档

相关文档

站点地图 | 文档上传 | 侵权投诉 | 手机版
本站所有资源均来自互联网,本站只负责收集和整理,均不承担任何法律责任,如有侵权等其它行为请联系我们.
文档下载 Copyright 2013 doc.guandang.net All Rights Reserved.  -  email