本章的学习目的全日制学位研究生专业必修课《现代导航技术》1、惯性导航系统中常用坐标系第4章平台式惯性导航系统2、惯性导航系统基本方程:3、掌握平台惯性导航系统的工作原理;4、掌握平台惯导系统的力学方程编排。1概述1 概述单轴惯导系统和舒动调实现Jta(ndX =Xo+f'v(0)dt加速度计4+$陀螺仪2惯性导航系统常用坐标系及坐标变换2惯性导航系统常用坐标系及坐标变换日心惯性坐标系(1)惯性坐标系·原点在太阳中心,以指向任意恒的直线为坐标轴,并满足右手定则,构成日日心惯性坐标系心惯性坐标系。地心惯性坐标系太阳距银河系中心的距高:2.2×1017km·太阳绕银河系转周期:1.90×10°年>地球卫星轨道惯性坐标系●太阳相对银河中心的旋转角速度:0.001角秒/年起飞点(发射点)惯性坐标系·太阳相对银河中心的向心加速度:2.4×10-11g1
1 第4章 平台式惯性导航系统 全日制学位研究生专业必修课《现代导航技术》 本章的学习目的 1、惯性导航系统中常用坐标系 2、惯性导航系统基本方程; 3、掌握平台惯性导航系统的工作原理; 4、掌握平台惯导系统的力学方程编排。 A B Oe V V N A H p y p z AN H p y p z 单轴惯导系统和舒勒调谐实现 H 信号器 力矩器 减速器 稳定电机 M c M s M d 稳定回路 VN 0 L0 R L 1 修正回路 AN 1 概述 N a u t x a u t x a RH R K K K RH K K K g 1 x y 0 运动 轨迹 x1 y1 t v v a t dt 0 0 ( ) t X X v t dt 0 0 ( ) 1 概述 ∫ a V ∫ X 加速度计 ∫ , , Z X 陀螺仪 Y (1)惯性坐标系 日心惯性坐标系 地心惯性坐标系 地球卫星轨道惯性坐标系 起飞点(发射点)惯性坐标系 2 惯性导航系统常用坐标系及坐标变换 日心惯性坐标系 原点在太阳中心,以指向任意恒星的直 线为坐标轴,并满足右手定则,构成日 心惯性坐标系。 太阳距银河系中心的距离:2.2×1017km 太阳绕银河系旋转周期:1.90×108 年 太阳相对银河中心的旋转角速度:0.001 角秒/年 太阳相对银河中心的向心加速度:2.4×10-11g 2 惯性导航系统常用坐标系及坐标变换
2惯性导航系统常用坐标系及坐标变换2惯性导航系统常用坐标系及坐标变换>地心惯性坐标系 0,-X,YZ,》地心惯性坐标系原点在地球中心,Z,·地球缆太阳公转2公转速度为29.79km/指向极轴,X、Y在赤公转周期为365.2422日道平面内,指向空间的●地心和日心距高为1.496×10两恒星,简称1系。?向心加速度为6.05×10公转角速度为0.041:/h2惯性导航系统常用坐标系及坐标变换2惯性导航系统常用坐标系及坐标变换Z(2)地球坐标系e-XYZ(2)地球坐标系e-XYZ与地球固联,原点在地球12.中心,Z指向极轴,O,Z.与0,Z重合,X,指向格林威治经线,Y。与X和Z,满足右手定则。o1地球坐标系相对惯性坐标系的转动角速度为+o=15.04108°/h=7.292115×10-srad/s2惯性导航系统常用坐标系及坐标变换2惯性导航系统常用坐标系及坐标变换(4)导航坐标系n-O,X,Y,Z(3)地理坐标系t-0,X,Y,Z原点在载体重心,X,指向东,原点在载体重心,当Y,指向北,Z,指向天。与地理坐标系重合时,X地理坐标系的坐标轴指向指向东,Y.指向北,Z.指可根据需要进行选择,不影响向天。导航的计算结果。地理坐标系相对于惯性称此种导航系统参考坐标系的转动角速度包为指北方位系统。括两部分:0,=0+02
2 地球绕太阳公转 公转速度为29.79km/s 公转周期为365.2422 日 地心和日心距离为1.496×108km 向心加速度为6.05×10-4g 公转角速度为0.041°/h 地心惯性坐标系 2 惯性导航系统常用坐标系及坐标变换 地心惯性坐标系 Oi XiYiZi 原点在地球中心, 指向极轴, 、 在赤 道平面内,指向空间的 两颗恒星,简称 i 系。 Zi Yi Xi Oi Zi Xi Yi 2 惯性导航系统常用坐标系及坐标变换 (2)地球坐标系 XeYeZe e h rad s ie . / . / 5 15 04108 7 292115 10 与地球固联,原点在地球 中心, 指向极轴, 与 重合, 指向格林威治经线, 与 和 满足右手定则。 Ze Xe OeZe OiZi Xe Ze Ye Oe Ze Xe 地球坐标系相对惯性 Ye 坐标系的转动角速度为 2 惯性导航系统常用坐标系及坐标变换 Oe Ze Xe Ye (2)地球坐标系 XeYeZe e L P0 o A B Lc Lt Lg 2 惯性导航系统常用坐标系及坐标变换 地理坐标系相对于惯性 参考坐标系的转动角速度包 括两部分: (3)地理坐标系 原点在载体重心, 指向东, 指向北, 指向天。 Xt Yt Zt t et t ie t it Ot XtYtZt t 地理坐标系的坐标轴指向 可根据需要进行选择,不影响 导航的计算结果。 Oe Ze Ye L Xe Xt Ot Yt Zt 2 惯性导航系统常用坐标系及坐标变换 (4)导航坐标系 n OnXnYnZn 原点在载体重心,当 与地理坐标系重合时, 指向东, 指向北, 指 向天。 X n Yn Zn 称此种导航系统 为指北方位系统。 Oe Ze Ye L Xe Xt(n) Ot Yt(n) Zt(n) 2 惯性导航系统常用坐标系及坐标变换
2惯性导航系统常用坐标系及坐标变换2惯性导航系统常用坐标系及坐标变换(4)导航坐标系n-0,X.Y.Z.>载体坐标系b-X.Y,zZ.自由方位系统和游动自由方位系续。w-O,X,Y,Z.右前上前左上前上右2惯性导航系统常用坐标系及坐标变换2惯性导航系统常用坐标系及坐标变换>地球坐标系到导航坐标系的转换关系>地球坐标系到导航坐标系的转换关系,Z,Zg-Z2=Cr绕OZ,轴aornoxxz, toz.tox.z.ox,r,z,ox'y'z90°L90ar=CirI, =Cr-Iri-Xr,=C-..C,Cr两坐标系间的任何复杂的角位量关系都可看成有限次基本选转的复合,两坐标系间的变换矩阵等于每一一次旋转确定的矩阵的连乘,连乘顾序操据每一次旋转的先后次序从右向左排列2惯性导航系统常用坐标系及坐标变换2惯性导航系统常用坐标系及坐标变换晓oZ,轴orrzmormoxxzMozm机体系到导航系的变换关系ox,y,zox,y,z,g090°L12.Z00sinacOA0sinicos元00020sin0Pst.-sin,cOs ^Usin Loossin LsincosLC"=C'Ccos Lcos )cos Lsin sinL(C)-"-(C)=C.3
3 (4)导航坐标系 n OnXnYnZn 自由方位系统和 游动自由方位系统。 Oe Ze Ye L Xe Xt(n) Ot Yt(n) Zt(n) 2 惯性导航系统常用坐标系及坐标变换 wOw X wYwZw Xb Yb Zb Xb Yb Zb Xb Xb Zb Yb 右前上 前左上 前上右 前右下 2 惯性导航系统常用坐标系及坐标变换 载体坐标系 b XbYbZb 地球坐标系到导航坐标系的转换关系 2 惯性导航系统常用坐标系及坐标变换 1 2 2 1 r C r 2 3 3 2 r C r 1 n1 n n n r C r 1 2 1 3 1 2 r C C C r n n n 两坐标系间的任何复杂的角位置关系都可看成有限次基本选 转的复合,两坐标系间的变换矩阵等于每一次旋转确定的矩阵的 连乘,连乘顺序根据每一次旋转的先后次序从右向左排列。 O X1 X2 Y1 Y2 Z1 r 1 1 2 X3 2 Xn Y3 Yn Z2 Z3 Zn 地球坐标系到导航坐标系的转换关系 绕OZe 轴 ' ' ' e e e OX eYeZe OX Y Z 绕 ' OYe 轴 90 L '' '' '' OX eYe Ze 绕 '' OZe 轴 90 OX nYnZn Y e Z e X e L R Oe ' Xe ' Ye '' Ye ' Ze '' Xe '' Ze Xn Yn Zn Y e Z e X e L R Xn n Zn Y On 2 惯性导航系统常用坐标系及坐标变换 0 0 1 sin cos 0 cos sin 0 1 Ce L L L L C cos 0 sin 0 1 0 sin 0 cos 2 1 0 0 1 1 0 0 0 1 0 2 n C 2 1 2 1 e n n Ce C C C L L L L L L cos cos cos sin sin sin cos sin sin cos sin cos 0 e n n T e n Ce C C ( ) ( ) 1 2 惯性导航系统常用坐标系及坐标变换 绕OZe 轴 ' ' ' e e e OX eYeZe OX Y Z 绕 ' OYe 轴 90 L '' '' '' OX eYe Ze 绕 '' OZe 轴 90 OX nYnZn Yi Zi Xi Y e Z e X e L R Ot X n Y n Z n Ob Xb Yb Zb 机体系到导航系的变换关系 2 惯性导航系统常用坐标系及坐标变换 n x b x b y On (a) 载体的航向角 n y On b y n z b z (b) 载体的航向角 (c) 载体的滚动角
2惯性导航系统常用坐标系及坐标变换2惯性导航系统常用坐标系及坐标变换纯Z.m.0x.Xxz2OY.热.OXJZ机体系到导航系的变换关系ox,r,zox,r,zwW792ZZ.(2)ssin0cosy0-sinyT,=-cos.9sinycosy0S010yZ.00110-sm9cos9Y, (Y,)siny0cosy9T=T'TTJYLcosycosw-sinysin9siny cosysiny+sinysin.9cosy-sinycos.9sin9cos.9sinycos.9cosy(X)[sinycosy+cosysingsiny sinysiny-cosysingcoswcosycos9x)(T)"=(T)=T"LX2惯性导航系统常用坐标系及坐标变换3惯性导航基本方程绝对变率向量相对定坐标系对时间求取变化率Cu地球坐标系导航坐标系地心惯性坐标系(e系)(n系)相对变率(系)向量在动坐标系上的投影对时间的变化率X.,Y.,Z,X,Y,z.X,,z.在绝对变率与相对变率之间存在某中确定的关系:Is:机体坐标系(b系)dRdR.JdR+oxRX.,z,dtldt dt LC'=C,CrcCC,-CCC,C!d'Rd'R.d'R.dR,+oxR,+ox(oxR)+20xdrdrdrdtl,3惯性导航基本方程3惯性导航基本方程dR] _ dR]当研究飞行器的运动时,为了导航的需要,我们选+0RdtldtdR取一个平台系(p系),其原点取在飞行器重心上。设+0xREVdRldtR为平台系的原点在惯性坐标系内的向径。Vedil研究飞行器的运动通带d'RldVedVedR(O.xR0dddtdtdt要相对地球确定飞行器的位置和速度,可以取地球系为dv.dy.+0gxV0.=0.+0didr动系。而地球坐标系相对惯'Rdr.性坐标系的角速度为0。+(20+0xV+0x(OxR)dr2e4
4 绕OZn 轴 OX nYnZn OX1Y1Z1 Xn 1 X Yn 1 Y Zn ( ) Z1 ( ) X2 Y2 Z2 ( ) Yb Zb Xb ( ) On Ob ( ) Zb ( ) Xb ( ) Yb 绕OY2 轴 OX bYbZb 绕OX1轴 机 OX 2Y2Z2 体 系 到 导 航 系 的 变 换 关 系 2 惯性导航系统常用坐标系及坐标变换 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 惯性导航系统常用坐标系及坐标变换 绕OZn 轴 OX nYnZn OX1Y1Z1 绕OY2 轴 OX bYbZb 绕OX1轴 OX 2Y2Z2 地心惯性坐标系 (i 系) Xi Yi Zi , , i Ce e Ci 地球坐标系 (e 系) Xe Ye Ze , , e Cn(t) n Cb 机体坐标系 (b 系) Xb Yb Zb , , b Cn n(t) Ce 导航坐标系 (n 系) X n Yn Zn n(t) , , Ce e i n e p n b p b Ci C C C C p b n p e n i e i Cb C C C C 2 惯性导航系统常用坐标系及坐标变换 3 惯性导航基本方程 绝对变率——向量相对定坐标系对时间求取变化率 相对变率——向量在动坐标系上的投影对时间的变化率 在绝对变率与相对变率之间存在着某中确定的关系 r r r i ir i i t t t ω R R R R d d d d d d ( ) d d 2 d d d d d d 2 2 2 2 2 2 r r r r r r i ir i i t t t t ω R ω ω R R ω R R R O 1 e 2 e 3 e i x i y i z x y z ω O i j k p Ri Rr Rir 当研究飞行器的运动时,为了导航的需要,我们选 取一个平台系(p 系),其原点取在飞行器重心上。设 R 为平台系的原点在惯性坐标系内的向径。 3 惯性导航基本方程 研究飞行器的运动通常 要相对地球确定飞行器的位 置和速度,可以取地球系为 动系。而地球坐标系相对惯 性坐标系的角速度为 ie e。 e z xi yi i z g x g y L D p x p y p z Op Oe R xe ye (2 ) ( ) 2 2 V R dt dV dt d R ie ep ep ie ie p ep i R dt dR dt dR ie i e e ep dt dR V V R dt dR ep ie i ip ep p ep i ep V dt dV dt dV ip ie epi ie i ep i ie i ep i dt dR dt dV R dt d dt dV dt d R ( ) 2 2 3 惯性导航基本方程
3惯性导航基本方程3惯性导航基本方程axnxR营号编出0d'RlV=f-(20,+0)xVg+gF,+mg.=dt2g=gm-0×(0×R)www微5d'RF+g蒙体相对地球的加速度V.微性质单dt?7哥式加速度20,x0gd-R设厂F:表示单位质量块质量所载体固纯地球转动运动所产生的向心加速0pxVpdt承受的弹簧拉力,定义为比力。度(或称为率连加速度)F=F+mgm由地球运动而产生的法向加速度(或0,X(0XR)f+gm=1g+(20.+0g)xV+0.x(0xR)称率连加速度)4平台惯性导航系统4平台惯性导航系统三轴平台是单轴平台的复合,各通道间耦合是很弱的,俯仰环和横滚环的舒勘调谐都可按单轴平台分析和设计。导航计算机控制显示KA4净义信息速度PI计稳定回路平台控制信号导航平台从平台概想政的资态和航自信息7平台债性导航系统4平台惯性导航系统5惯导系统的高度通道HHVec=f-(20+0XV9台-aR(tNELhed-l--(20+0)LI20"+0"0A国国7A-A:0-(20+0)+20.+00Vno20°+0"0W1-8A-(20+0Ve=Veo +fagdta(t)=+"v,secLdtV"= f" +(20g, +0)V"-(20 +om)V"-g'vadtVN=VNoaydtL(t)= L, +-5
5 m s i g m F dt d R 2 2 设 表示单位质量块质量所 承受的弹簧拉力,定义为比力。 m F f s i dt d R F m 2 2 f g V (2 ) V ( R) m ep ie ep ep ie ie i s m dt d R F mg m 2 2 F Fs mgm 3 惯性导航基本方程 敏感轴 弹簧 惯性质量 信号输出 电源 ——载体相对地球的加速度 ——哥式加速度 ——载体围绕地球转动运动所产生的向心加速 度(或称为牵连加速度) ——由地球运动而产生的法向加速度(或 称牵连加速度) Vep 2ie ep ep Vep ( R) ie ie Vep f (2ie ep )Vep g g g ( R) m ie ie M ( R) ie (ie R) ie ie m T g m g 3 惯性导航基本方程 4 平台惯性导航系统 4 平台惯性导航系统 三轴平台是单轴平台的复合,各通道间耦合是很弱的, 俯仰环和横滚环的舒勒调谐都可按单轴平台分析和设计。 平台惯性导航系统 导航平台 陀 螺 加 速 度 计 导航计算机 平台控制信号 稳定回路 陀螺施矩信息 位置信息 速度信息 控制显示 从平台框架提取的姿态和航向信息 陀螺输出信息 t VE VE aE dt 0 0 t VE Ldt R t 0 0 sec 1 ( ) t VN VN aN dt 0 0 V dt R L t L t N 0 0 1 ( ) 4 平台惯性导航系统 L0 L(t) 5 惯导系统的高度通道 Ven f (2ie en )Ven g V g V V f f f V V V n z n y n x n enx n iex n eny n iey n enx n iex n enz n iez n eny n iey n enz n iez n z n y n x n z n y n x 0 0 (2 ) 2 0 2 0 (2 ) 0 (2 ) 2 V f V V g n y n enx n iex n x n eny n iey n z n z (2 ) (2 )