高精度捷联式惯性导航系统算法研究.docx
高精度捷联式惯性导航系统算法研究
引言
随着计算机技术的发展,捷联式惯性导航系统(strapdownInertialNavigationSystem,SINS)的概念被提出,它取消了平台式惯性导航系统中复杂的机械平台装置,而将惯性传感器直接固联在载体上。SINS具有制造和维护成本低、体积小、重量轻以及可靠性高等优点,目前在高、中、低精度领域都得到了广泛使用。
捷联算法的基本框图如图1所示。
加速度计
加速度计
惯性传感器误差补偿
投影在平台坐标
系的比力矢量
地速与位置的
计算
位置角速度的
计算
显示器
陀螺仪
方向余弦矩阵
(数学平台)
姿态角计算
导航计算机
图1捷联算法的基本框图
在捷联惯性导航系统中,惯性传感器直接固联在载体上,因此对惯性传感器的性能提出了更高的要求。SINS中使用的陀螺所承受的动态范围较大,一般能够达到100/s,与此同时,SINS中的陀螺和加速度计与载体一起进行角运动和线运动,这增加了导航计算机输出数据的难度和复杂性。姿态实时计算是捷联惯导的关键技术,也是影响捷联惯导系统导航精度的重要因素。
载体的姿态和航向是载体坐标系和地理坐标系之间的方位关系,两坐标系之间的方位关系等效于力学中的刚体定点转动问题。在刚体定点转动理论中,描述动坐标系相对参考坐标系方位关系的方法有欧拉角法、四元数法、方向余弦法以及等效旋转矢量法。本报告对这四种姿态算法进行简单介绍,并结合研究对象对等效旋转矢量算法进行重点研究。针对角速率输入陀螺构成的捷联式惯性导航系统,本报告给出了一种改进的姿态算法,并在圆锥运动环境下对该算法进行数学仿真,验证了该方法的可能性。
姿态算法介绍
欧拉角法
一个动坐标系相对参考坐标系的方位可以完全由动坐标系依次绕三个不同轴转动
三个角度进行确定。把载体坐标系oxbybzb作为动坐标系,导航坐标系oxnyn
(即地理坐
zn
z
标系)作为参考坐标系,导航系依次转过航向角H、俯仰角P、横摇角R可得到载体坐标系,通过求解欧拉角微分方程得到三个欧拉角,从而进一步可以得到捷联姿态矩阵。欧拉角微分方程如下所示:
?P?
?cosPcosP
0 sinRcosP???b ?
? ? 1 ?
?? nbx?
?R??cosP?sinPsinR cosP ?cosPsinP???b ?
(1)
? ? ??nby?
??H?
?
?? ?sinR 0 cosR
???
bnbz
式(1)即为欧拉角微分方程,求解方程可以得到三个欧拉角,也就是航向角、俯仰角
以及横摇角,根据三个姿态角和姿态矩阵元素之间的关系即可以得到姿态矩阵Cn。
b
方向余弦法
常用方向余弦姿态矩阵微分方程的形式为
Cb??bkCb
(1)
n nb n
式中?bk为载体坐标系相对地理坐标系的转动角速度在载体坐标轴向的分量的反对称矩nb
阵形式,具体表达式如式(2)。
??? 0 ??b ?b ?
?
?
?bk
???b
nbz
?0
?
nby
?b
?
? (2)
?nb ?
?
nbz
nbx?
??b
nby
?b 0
nbx
用毕卡逼近法求解矩阵微分方程,其解为
? sin??
1?cos?? ?
Cb(t??t)?C(t)?I? 0??bk?
0(??bk)2? (3)
?n ?? nb
?
0
式中
??2
0
nb ?
???? 0 ???b ??b ?
?
?
?
??bk
??t
n?1?bkdt????b
nbz
0
nby
??? b ?
?
?nb t nb
?
n
? nbz
nbx?
??b2
??b2???b2???b2
nbx nby nbz
0
???b
nby
??b 0
nbx
四元数法
四元数微分方程的形式为
?bnb1Q(t)? Q(
?bnb
1
2
(4)
其中,Q(t)是姿态四元数,?b
nb
??? ?
?x y
?
??T,为b系相对n系的角速度。
?z
?
求解四元数微分方程一般用计算机实现,常用方法有毕卡逼近增量法和数值积分算法,本报告关于四元数求解姿态角算法采用的都是数值积分算法,因此此处仅对四元数四阶-龙格库塔算法进行简单介绍。
对四元数微分方程
1Q? Q??b (5)
1
2 nb
式中:?b
?0??bxi
?byj
?bzk
,为载体坐标系相对于导航坐标系的角速度矢量
nb
的四元数表达形式。
nbb
nbb
nb b
用四阶