2捷联惯导基本原理2捷联惯导基本顾理2.1捷联姿态矩阵2.2携联寻航系统的姿态算法[1001[coswsiny0][cos0-sinyT,=siny cosw 0T2=0》吹拉角法(三参数法)cos.9sin9Tp=0101Lo-sin9cos9siny0cosy直按获取三个姿态角V、9和T'=TTT方向余弦法(九参数法)coscosy-sinysingsincosysiny+sinysingcosy-sinycos9T'--cos.9sinycos.9cosysin.9直接获得姿态转换矩阵T”[sinycosw+cosysingsinsinysiny-cosysingcosycoscos9>四元数法(四参数法)(T)=(T)=T先获得四元数,然后获得姿态转换矩阵-T2捷联情导基本原理2捷联惯导基本原理2.2.1捷联导航系统的姿态算法感拉角法2.2.1捷联导航系统的姿态算法欧拉角法2Z.(Z.)机体坐标系相对导航坐标系的角速度向量可以表示为o=+9+yy欧拉角组的定义Z.Y, (Y.)9000 cos9 sing0。-。n4014sinxindSin-Y,(Y,)sincos9eXsiny(X.)olycosy cos .9sinyX.2捷联惯导基本原理2捷联惯导基本原理2.2.1捷联导航系统的姿态算法欧拉角法2.2.2捷联导航系统的姿态算法方向余弦法xxxW90TosinyCOS[cosy0[100sinycosy0-siny0Onbycosycos.9sinycos.9T,=siny cosy07=0cos.9A010cos9singsinycOs9-sin.9cos6.0n0mocos9siny0cosT'=T'T'Tcosycosy-sinysin.9sinycosysiny+sinysingcosysinycos9问题:不能全姿态工作,微分方程计算复杂sin.9T:-cos.9sinycos.9cosycosycos.9sinycosy+cosysin.9sinysinysinycosysin.9cosy6
6 0 0 1 sin cos 0 cos sin 0 1 Tn 0 sin cos 0 cos sin 1 0 0 2 T1 sin 0 cos 0 1 0 cos 0 sin 2 b T 2 1 2 1 n b b T n T T T n b b T n b Tn T T ( ) ( ) 1 sin cos cos sin sin sin sin cos sin cos cos cos cos sin cos cos sin cos cos sin sin sin cos sin sin sin cos sin cos b Tn 2 捷联惯导基本原理 2.1 捷联姿态矩阵 2.2 捷联导航系统的姿态算法 欧拉角法(三参数法) 直接获取三个姿态角—— 、 和 方向余弦法(九参数法) 直接获得姿态转换矩阵—— n Tb 先获得四元数,然后获得姿态转换矩阵—— n Tb 四元数法(四参数法) 2 捷联惯导基本原理 欧 拉 角 组 的 定 义 2.2.1 捷联导航系统的姿态算法——欧拉角法 2 捷联惯导基本原理 Yn 1 Y Zn Y2 Z2 ( ) Yb Xb ( ) Zb ( ) Xb ( ) Yb Zb 1 X Xn ( ) X2 机体坐标系相对导航坐标系的角速度向量 可以表示为 b nb 0 0 0 0 sin 0 cos 0 1 0 cos 0 sin 0 0 0 sin cos 0 cos sin 1 0 0 sin 0 cos 0 1 0 cos 0 sin b nbz b nby b nbx cos cos sin 0 sin 0 1 sin cos cos 0 2 捷联惯导基本原理 2.2.1 捷联导航系统的姿态算法——欧拉角法 b nbz b nby b nbx sin sin cos sin cos cos cos 0 sin cos sin 0 cos cos 1 问题:不能全姿态工作,微分方程计算复杂 2 捷联惯导基本原理 2.2.1 捷联导航系统的姿态算法——欧拉角法 0 0 1 sin cos 0 cos sin 0 1 Tn 0 sin cos 0 cos sin 1 0 0 2 T1 sin 0 cos 0 1 0 cos 0 sin 2 b T 2 1 2 1 n b b T n T T T sin cos cos sin sin sin sin cos sin cos cos cos cos sin cos cos sin cos cos sin sin sin cos sin sin sin cos sin cos b Tn 绕OZn 轴 OX nYnZn OX1Y1Z1 绕OY2 轴 OX bYbZb 绕OX1轴 OX 2Y2Z2 2 捷联惯导基本原理 2.2.2 捷联导航系统的姿态算法——方向余弦法
2捷联债导基本原理2捷联惯导基本原理方向余弦法2.2.2捷联导航系统的姿态算法2.2.2捷联寻款系续的姿态算法方向余弦法coscos+sinysingsincossinysincosy-cosysingsinyFcos9sinycoscosysinysin9sinysinycosw+cosysin.9sinyT,=cossin+sinsin9coswcos9cosinsincosincoscos.9cosyT,-cosysingsinysingcosysinsinycossingcossinycos.9sin.9cosycs.9sinycos.91cosycos.9L_singW± =1g(-T12/T2)± = Ig-(-T31/ 3)[0° 3600][0° 360]V = tan-'(-Tiz/T22)[-180°180]表1航向角的真值判别表2横液角的真值判别[-90° 90]9量=tan(T3z2/ J+7)业,的符号五的特号w联值的符号,的符号取值伊主7±180°[-180°180]Y± =tan-(-T3,/T3)?-++360PY±+180++.W++180°+、Y2捷联情导基本原理2捷联惯导基本原理2.2.2捷联导航系统的姿态算法方向余弦法2.2.2捷联寻航系统的姿态算法方向余弦法主值主值域定义城主值主值城定义城(-)[o,360][-90°,90′]W±=tar[-90′,90][180°,180]Y±=tanT33V±<0560>0±>0180i807±<0T2>0Tn<0T2>090°T33<0222-1809W=VW++3600tanyiY3P/与T同号T,<0OEA2-7141809T>0tmp间号WW-180972捷联惯导基本原理2捷联惯导基本原理D2.2.2捷联导航系统的姿态算法2.2.2捷联导航系统的姿态算法方向象弦法方向余弦法·由于陀螺的漫整和计算漫整,态矩陈趣失去正交性TuTaT3[]1-O·对计算的姿态矩降周期性地进行正交化!0-0TTul-o.o·找个最接近计算姿态矩阵的正交阵;·正交阵和计算爽态矩阵的整值范嫩景小!特点:·可以全姿态工作,不受限前,J-- 或 m-·微分方程维数高,达到了9维!计算的矩阵正交化后的矩阵·运算过程中有非正交诞整产生,每次需正交化。7
7 tan ( ) 12 22 1 T T 主 tan ( ) 2 22 2 32 12 1 T T T 主 tan ( ) 31 33 1 T T 主 90 90 180 180 0 360 sin cos sin cos cos cos sin sin sin cos cos cos sin sin cos sin cos cos cos sin sin sin cos sin sin cos cos sin sin n Tb 2 捷联惯导基本原理 2.2.2 捷联导航系统的姿态算法——方向余弦法 ( ) 12 22 1 tg T T 主 ( ) 31 33 1 tg T T 主 0 360 180 180 表 1 航向角的真值判别 主 的符号 T22 的符号 取值 + + 主 - + 主 360 +、- - 主 180 表 2 横滚角的真值判别 主 的符号 T33 的符号 取值 + - 主 180 - - 主 180 +、- + 主 sin cos sin cos cos cos sin sin sin cos cos cos sin sin cos sin cos cos cos sin sin sin cos sin sin cos cos sin sin n Tb 2 捷联惯导基本原理 2.2.2 捷联导航系统的姿态算法——方向余弦法 90 90 0 0 90 90 180 180 270 270 360 360 cos tan 与T22同号 主值 主值域 定义域 22 1 12 tan T T 主 90 ,90 0 ,360 主 0 T22 0 主 主 0 T22 0 主 360 T22 0 主 180 2 捷联惯导基本原理 2.2.2 捷联导航系统的姿态算法——方向余弦法 180 90 90 0 0 90 90 180 180 cos tan 与 T33同号 180 主值 主值域 定义域 33 1 31 tan T T 主 90 ,90 180 ,180 主 0 T33 0 主 180 主 0 T33 0 主 180 T33 0 主 2.2.2 捷联导航系统的姿态算法——方向余弦法 2 捷联惯导基本原理 0 0 0 1 3 2 3 3 3 1 2 2 2 3 2 1 1 2 1 3 1 1 3 2 3 3 3 1 2 2 2 3 2 1 1 2 1 3 1 b nbx b nby b nbx b nbz b nby b nbz T T T T T T T T T T T T T T T T T T 特点: •可以全姿态工作,不受限制; •微分方程维数高,达到了9维; •运算过程中有非正交误差产生,每次需正交化。 2 捷联惯导基本原理 2.2.2 捷联导航系统的姿态算法——方向余弦法 • 由于陀螺的误差和计算误差,姿态矩阵逐渐失去正交性; • 对计算的姿态矩阵周期性地进行正交化; • 找个最接近计算姿态矩阵的正交阵; • 正交阵和计算姿态矩阵的差值范数最小; J T T ˆ min 0 2 min 0 T T ˆ 或 J 正交化后的矩阵 计算的矩阵 2 捷联惯导基本原理 2.2.2 捷联导航系统的姿态算法——方向余弦法
2捷联债导基本原理2捷联惯导基本原理2.2.3捷联导航系统的姿态算法一四元数法2.2.2捷联寻款系续的姿态算法方向余弦法四元数法是一种数学间接的方法X +(x)X.I=计算量大具体机上执行耐用四元数微分方程计算代誉方向余弦微分i=0X,=Tr方程的计算,减小计算量[x+(xi)i=i+1X.u=》易于正交化计算T;=XNN代表送代的次收,的2~3次2捷联惯导基本原理2捷联惯导基本原理2.2.3捷联导航系统的姿态算法四元数法1826年数学家罗巴切夫斯基的论文《几何原理概述及平等线定理的严格证明》宣告了非欧几何的诞生,四元数代理论著作数是由非欧几何引发出来的分支之一,它同非欧几何一样,用了一些与传统理论相矛盾的假说,1843年,哈密顿首先在数学中引入四元数,作为19世纪早期,人们认为在数学领城里不存在与一般算术代数不同的代数,但是年轻的数学家哈密顿却独树一帜四维线性代数形式的数学模式范例,著作:《四元的设想建立超复数系,定义这样两个有序实数四元数组(abe,d),(efe.h)为相等的,当且仅当a-e.b-fc-g.d-h数讲义》,《四元数基础》。又用记号1,)分别表示(1,0,0,0),(0,1,0,0)(0,0,1,0)(0,0,0,1)成康·卢云-哈密锁但是如何规定其运算法则呢?如果按照普通代数的四则运(1805-1865)最近的理论著作1977年国防工业出版社翻译算法则进行,不可能,如果独辞躁径,又该从何下手呢?1843年10月6日晚饭居,哈密领像往常一样和夫人到外边散步,当经过柏林的由(苏)勃拉涅茨和梅格列夫斯基所蓄的:《四元城外皇家运河布落翰桥进城时,突然四元数的概念映入了他的脑海,四元数(a,b,c,d)四写成a+bitcj+dk这样的形式,哈密顿通过认真思考,直觉地感到,这样要求的太多,数在刚体定位问题中的应用》。元数法就必须性交换律,于是第一个非交换的代数一一四元数代数诞生了,1843年11月,哈密顿在爱尔兰科学院正式宣布他发明了四元数。2捷联惯导基本原理2捷联惯导基本原理2.2.3捷联导航系统的姿态算法一四元数法2.2.3捷联导航系统的姿态算法四元数法》四元数的表示方法四元数的性质设Q=q1+qi+qi+qi复数式Q=+q+qi+q=+q矢量式Q=+qQ=cos0+isino三角式P=po+pi+pi +pi=po+pQ=e'?指数式矩阵式Q=[2]8
8 1 1 2 1 T Xi Xi Xi 具体机上执行时 i 0 n X0 Tb i i 1 1 1 2 1 T Xi Xi Xi N n T ˆ b X N代表迭代的次数,约2~3次 2 捷联惯导基本原理 2.2.2 捷联导航系统的姿态算法——方向余弦法 计算量大 四元数法是一种数学间接的方法 用四元数微分方程计算代替方向余弦微分 方程的计算,减小计算量 易于正交化计算 2.2.3 捷联导航系统的姿态算法——四元数法 2 捷联惯导基本原理 1826 年数学家罗巴切夫斯基的论文《几何原理概述及 平等线定理的严格证明》宣告了非欧几何的诞生。四元数代 数是由非欧几何引发出来的分支之一。它同非欧几何一样, 用了一些与传统理论相矛盾的假说。 19 世纪早期,人们认为在数学领域里不存在与一般算 术代数不同的代数。但是年轻的数学家哈密顿却独树一帜, 设想建立超复数系,定义这样两个有序实数四元数组 (a,b,c,d),(e,f,g,h)为相等的,当且仅当 a=e,b=f,c=g,d=h. 又用记号 l,i,j,k 分别表示(1,0,0,0),(0,1,0,0),(0,0,1,0),(0,0,0,1)。 但是如何规定其运算法则呢?如果按照普通代数的四则运 算法则进行,不可能。如果独辟蹊径,又该从何下手呢? 1843 年 10 月 6 日晚饭后,哈密顿像往常一样和夫人到外边散步,当经过柏林 城外皇家运河布洛翰桥进城时,突然四元数的概念映入了他的脑海。四元数(a,b,c,d) 写成 a+bi+cj+dk 这样的形式,哈密顿通过认真思考,直觉地感到,这样要求的太多, 就必须牺牲交换律,于是第一个非交换的代数——四元数代数诞生了。 1843 年 11 月,哈密顿在爱尔兰科学院正式宣布他发明了四元数。 威廉·卢云·哈密顿 (1805-1865) 捷 联 导 航 系 统 的 姿 态 算 法 四 元 数 法 2 捷联惯导基本原理 1843年,哈密顿首先在数学中引入四元数,作为 四维线性代数形式的数学模式范例,著作:《四元 数讲义》,《四元数基础》。 最近的理论著作——1977年国防工业出版社翻译 的由(苏)勃拉涅茨和梅格列夫斯基所著的:《四元 数在刚体定位问题中的应用》。 理论著作 2 捷联惯导基本原理 2.2.3 捷联导航系统的姿态算法——四元数法 四元数的表示方法 01 1 1 2 2 3 3 Q q q i q i q i 复数式 Q q q 0 矢量式 Q cos isin 三角式 T Q q0 q1 q2 q3 矩阵式 2 i Q e 指数式 2 捷联惯导基本原理 2.2.3 捷联导航系统的姿态算法——四元数法 设 四元数的性质 2 捷联惯导基本原理 2.2.3 捷联导航系统的姿态算法——四元数法 Q q0 q1 i1 q2 i2 q3 i3 q0 q P p0 p1 i1 p2 i2 p3 i3 p0 p