2017/4/61惯性导航系统常用坐标系(1)惯性坐标系全用制学位研究生专业心修部《导航采统设计》日心惯性坐标系P第2章基于方向余弦矩阵的姿态解算设计地心惯性坐标系P地球卫星轨道惯性坐标系起飞点(发射点)模性坐标系1惯性导航系统常用坐标系1惯性导航系统常用坐标系日心惯性坐标系》地心惯性坐标系·地球绕太阳公转●原点在太阳中心,以指向任意恒星的直?公转速度为29.79km/s线为坐标轴,并满足右手定则,构成日·公转周期为365.2422日心惯性坐标系。●地心和日心距离为1.496×10%km●太阳距银河系中心的距离:2.2×1017km*向心加速度为6.05×10*g●太阳绕银河系旋转周期:1.90×108年公转角速度为0.041°/h?太阳相对银河中心的旋转角速度:0.001角秒/年●太阳相对银河中心的向心加速度:2.4×10-11g1惯性导航系统常用坐标系1惯性导航系统常用坐标系>地心惯性坐标系 0,-X,YZ,(2)地球坐标系e-XYz原点在地球中心,乙,指向极轴,X,在赤道平面内,指向空间的两颗与地球固联,原点在地球中恒星,简称/系,tZ,心,Z指向极轴,OZ与0z重合,X,指向格林威治经线,Y与X,和Z,满足右手定则。地球坐标系相对惯性X坐标系的转动角速度为XWe=15.04108°/h=7.292115×10-rad/s1
2017/4/6 1 第2章 基于方向余弦矩阵的姿态解算设计 全日制学位研究生专业必修课《导航系统设计》 1 惯性导航系统常用坐标系 (1)惯性坐标系 日心惯性坐标系 地心惯性坐标系 地球卫星轨道惯性坐标系 起飞点(发射点)惯性坐标系 日心惯性坐标系 原点在太阳中心,以指向任意恒星的直 线为坐标轴,并满足右手定则,构成日 心惯性坐标系。 太阳距银河系中心的距离:2.2×1017km 太阳绕银河系旋转周期:1.90×108 年 太阳相对银河中心的旋转角速度:0.001 角秒/年 太阳相对银河中心的向心加速度:2.4×10-11g 1 惯性导航系统常用坐标系 地球绕太阳公转 公转速度为29.79km/s 公转周期为365.2422 日 地心和日心距离为1.496×108km 向心加速度为6.05×10-4g 公转角速度为0.041°/h 地心惯性坐标系 1 惯性导航系统常用坐标系 地心惯性坐标系 Oi XiYiZi 原点在地球中心, 指向极轴, 、 在赤道平面内,指向空间的两颗 恒星,简称i 系。 Zi Xi Yi Oi Zi Xi Yi 1 惯性导航系统常用坐标系 (2)地球坐标系 XeYeZe e rad s w h ie 7.292115 10 / 15.04108 / 5 与地球固联,原点在地球中 心, 指向极轴, 与 重 合, 指向格林威治经线, 与 和 满足右手定则。 Ze Xe OeZe OiZi Xe Ze Ye Oe Ze Xe Ye 地球坐标系相对惯性 坐标系的转动角速度为 1 惯性导航系统常用坐标系
2017/4/61惯性导航系统常用坐标系1惯性导航系统常用坐标系(2)地球坐标系e-XY,Z(3)地理坐标系t-0,X,Y,Z原点在载体重心,X.指向东,1Z.Y,指向北,Z,指向天。地理坐标系的坐标轴指向可根据需要进行选择,不影响o.1..导航的计算结果。地理坐标系相对于惯性参考坐标系的转动角速度包括两部分:0,=0'+01惯性导航系统常用坐标系1惯性导航系统常用坐标系(4)导航坐标系n-0,x.Y.z(4)导航坐标系n-0,x,Yz原点在载体重心,当与地理坐标系自由方位系统和重合时,X指向东,Y.指向北,Z指向游动自由方位系统。天.称此种导航系统为指北方位系统。1惯性导航系统常用坐标系1惯性导航系统常用坐标系>载体坐标系b-X,Y,z自由方位系统o=0》游动方位自由方位系统古前上前左上Om=,sinL前上右2
2017/4/6 2 Oe Ze Xe Ye (2)地球坐标系 XeYeZe e L P0 o A B Lc Lt Lg 1 惯性导航系统常用坐标系 地理坐标系相对于惯性 参考坐标系的转动角速度包 括两部分: (3)地理坐标系 原点在载体重心, 指向东, 指向北, 指向天。 Xt Yt Zt t et t ie t it Ot XtYtZt t 地理坐标系的坐标轴指向 可根据需要进行选择,不影响 导航的计算结果。 Oe Ze Ye L Xe Xt Ot Yt Zt 1 惯性导航系统常用坐标系 (4)导航坐标系 n OnXnYnZn 原点在载体重心,当与地理坐标系 重合时, 指向东, 指向北, 指向 天。 X n Yn Zn 称此种导航系统 为指北方位系统。 Oe Ze Ye L Xe Xt(n) Ot Yt(n) Zt(n) 1 惯性导航系统常用坐标系 (4)导航坐标系 n OnXnYnZn 自由方位系统和 游动自由方位系统。 Oe Ze Ye L Xe Xt(n) Ot Yt(n) Zt(n) 1 惯性导航系统常用坐标系 0 n inz 自由方位系统 游动方位自由方位系统 ie L n inz sin 1 惯性导航系统常用坐标系 载体坐标系 b XbYbZb Xb Yb Zb Xb Yb Zb Xb Xb Zb Yb 右前上 前左上 前上右 前右下 1 惯性导航系统常用坐标系
2017/4/62 裁体姿态的定义2戴体姿态角的定义俏航角锻体自身纵轴在水平面内的投影与地理坐标系Y.轴间的夹角(真北方向)。佛航角的正方向:飞机为北俄东为正,燃航弹为北偏西为正。First-水2裁体姿态角的定义2 载体姿态角的定义俯仰角9:载体纵轴与水平面的夹角。滚动角:绕载体纵轴旋转的角度。俯仰角9正方向:载体纵轴向上。滚动角正方向:载体横轴瞬时针旋转。Secend rotation (pitch)Third rotation (roll )9rollpitch3空间直角坐标系的坐标变换3空间真角坐标系的坐标变换3.1方向余弦法3.1方向余弦法17r=r+ri,+ri =re+re,+re设空间正交坐标系OXYZ的单位失量为;Oxyzr=er=e-irx+eriry+e-iyz坐标系的单位失量,,3向量r在两个坐标系内的投I,=e,-F=e,-irx+eiry+e,-irzY影分量分别为r=[rx,,rz],=éy-r=e-irx+e-in+e,inz和=T=ri+ri+ri=re+re+reee-e-+-e,-2 -e,-14eieieiz1-1, -1-1 --2 =03
2017/4/6 3 Xn Yn Zn Zb Xb Yb 2 载体姿态的定义 偏航角:载体自身纵轴在水平面内的投影与地理 坐标系Y n轴间的夹角(真北方向)。 偏航角 的正方向:飞机为北偏东为正,巡航弹为 北偏西为正。 2 载体姿态角的定义 俯仰角ϑ :载体纵轴与水平面的夹角。 俯仰角ϑ 正方向:载体纵轴向上抬。 2 载体姿态角的定义 滚动角γ :绕载体纵轴旋转的角度。 滚动角γ 正方向:载体横轴瞬时针旋转。 2 载体姿态角的定义 3 空间直角坐标系的坐标变换 3.1方向余弦法 设空间正交坐标系OXYZ 的单位矢量为 ;Oxyz 坐标系的单位矢量 。 向量 在两个坐标系内的投 影分量分别为 和 。 1 2 3 e ,e ,e 1 2 3 i ,i ,i r T X Y Z r [r ,r ,r ] T x y z r [r ,r ,r ] 0 1 1 2 2 3 3 1 1 1 2 2 3 3 1 2 3 1 2 3 e e e e e e e e e e e e r r i r i r i r e r e r e X Y Z x y z X Y Z x y z O 1 i 2 i 3 i 1 e 2 e e3 r 3 空间直角坐标系的坐标变换 3.1方向余弦法 Z Y X z y x z X Y Z y X Y Z x X Y Z X Y Z x y z r r r e i e i e i e i e i e i e i e i e i r r r r e r e i r e i r e i r r e r e i r e i r e i r r e r e i r e i r e i r r r i r i r i r e r e r e 3 1 3 2 3 3 2 1 2 2 2 3 1 1 1 2 1 3 3 3 1 3 2 3 3 2 2 1 2 2 2 3 1 1 1 1 2 1 3 1 2 3 1 2 3 3 空间直角坐标系的坐标变换 3.1方向余弦法
2017/4/63空间直角坐标系的坐标变换3空间直角坐标系的坐标变换-3.1方向余弦法3.2欧拉角法坐标系O-XYZ,绕OZ轴旋转角后得到O-X,yzeieiF空间量在O-XYZ内的投影为eeee,.ir2在0-X,Y,Z的投影为[,]e.ieeirrYV12山C, =eij = cosay, =cosαyo1性质1:空间直角坐标系间的变换矩感正交阵。性质2:正交矩阵的每一个元素等于其代数余子式,P3空间直角坐标系的坐标变换3空间直角坐标系的坐标变换3.2欧拉角法3.2欧拉角法E由于绕OZ,轴进行旋转,有z=r1Z1x,=OA+AB+BCy02=ODcos+BDsin+BFsiny=rcosy+r,siny-sinacosaF.=DE-AD=DFcosw-ODsinyDTr=Crsinurcos2=C5=Cir晓OZ,柏袋OZ柏0-sinyCOSWj=CC, 0-2.O-x.YzO-X,Y,z,K8M0-0-XY3空间直角坐标系的坐标变换3空间直角坐标系的坐标变换3.2欧拉角法3.2欧拉角法2,2,Zg-Z,DX,同理r=Crr=Cirn1O0.r, = Ch-I'n-Ir, =C.-.CCrB [T两坐标系间的任何复杂的角位置关系都可看成有限次基本-0选转的复合,两坐标系间的变换矩阵等于每一次旋转确定的矩oY0-XYZ绿轴a阵的连乘,连乘顺序根据每一次旋转的先后次序从右向左排列。O-XYZO-XY7O-XYZ4
2017/4/6 4 性质1:空间直角坐标系间的变换矩阵是正交矩阵。 性质2:正交矩阵的每一个元素等于其代数余子式。 Z Y X z y x r r r e i e i e i e i e i e i e i e i e i r r r 3 1 3 2 3 3 2 1 2 2 2 3 1 1 1 2 1 3 ij i j i j ij ij C e i e i cos cos X Y Z x y z O 1 i 2 i 3 i 1 e 2 e e3 r 3 空间直角坐标系的坐标变换 3.1方向余弦法 坐标系 绕 轴旋转 角后得到 空间矢量 r在 内的投影为 r 在 的投影为 O X1Y1Z1 OZ1 O X2Y2Z2 O X1Y1Z1 O X2Y2Z2 T X Y Z r r r 1 1 1 , , T X Y Z r r r 2 2 2 , , O X1 Y1 Z1 X2 Y2 r X1 r Y1 r Y2 r X2 r Y2 X1 Y1 X2 r O A B C D E F 3 空间直角坐标系的坐标变换 3.2 欧拉角法 由于绕 OZ1 轴进行旋转,有 Z1 Z2 r r 1 1 1 2 2 2 1 O X Y Z O X Y Z OZ 绕 轴 X1 r Y1 r Y2 r X2 r Y2 X1 Y1 X2 r O A B C D E F OA AB BC rX 2 ODcos BDsin BF sin cos sin X1 Y1 r r rY DE AD 2 DFcos ODsin cos sin Y1 X1 r r 1 1 1 2 2 2 0 0 1 sin cos 0 cos sin 0 Z Y X Z Y X r r r r r r 1 2 2 1 r C r 3 空间直角坐标系的坐标变换 3.2 欧拉角法 1 1 1 2 2 2 1 O X Y Z O X Y Z OZ 绕 轴 1 2 2 1 r C r O X1 Y1 Z1 X2 Y2 r 1 1 1 2 2 2 0 0 1 sin cos 0 cos sin 0 Z Y X Z Y X r r r r r r 1 2 2 1 r C r 绕OZ1 轴 O X2Y2Z2 O X1Y1Z1 绕OZ2 轴 O X3Y3Z3 2 2 2 3 3 0 0 1 sin cos 0 3 cos sin 0 Z Y X Z Y X r r r r r r 2 3 3 2 r C r 1 2 1 3 3 2 r C C r 3 空间直角坐标系的坐标变换 3.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 3 空间直角坐标系的坐标变换 3.2 欧拉角法 同理 1 1 1 2 2 2 0 sin cos 0 cos sin 1 0 0 Z Y X Z Y X r r r r r r 1 1 1 2 2 2 sin 0 cos 0 1 0 cos 0 sin Z Y X Z Y X r r r r r r 1 1 1 2 2 2 1 O X Y Z O X Y Z OX 绕 轴 1 1 1 2 2 2 1 O X Y Z Y O X Y Z O 绕 轴 3.2 欧拉角法 Z2 O Z1 Y1 X1 Y2 r O Z1 X1 Y1 Z2 X2 r 3 空间直角坐标系的坐标变换
2017/4/63空间直角坐标系的坐标变换3空间直角坐标系的坐标变换捷联姿态矩阵捷联姿态矩阵M绕OZ轴绕OX,轴<OY钟OXYZ[cossiny0]007[cosy0-sinoxY,zoxYZOX.Y2T,=siny cosw oT3=0cos9singaT=010y9L1losing cos.9]0sinyocosyZ.(Z,)T -T'TTUZ.,(Y)coscosw-sinysingsinycossin+sinysingcosy-sinycos99T'--cos.9sinycos.9cosysin.9ysinycosy+cosysin9sinysinysiny-cosysin.9cosycosycos.9Y,(,)(T')" =(T) =T"3(X.)X,4基于方向余弦矩阵的姿态解算4基于方向余弦矩阵的姿态解算()-cos9sinysinycosy+cossin9siny(cosycos-sinysingsin[coswsinw0[100cosy0-sinyT-Tacossiny+snsngcosyossysinsing-cosysinosycos9sin.gT,'=sinw cosw 0T=0Th =010-sin700s.9南sing057cos.901[0 - sin9 cos.9]0siny0cosT'=T'T'TW± = tan"二T2[r.360]cosycosy-sinysingsinycosysiny+sinysingcosysinycos9T22Tsin.9-cos.9sinycos.9cosyT32[-90,90]9± =tancosycos.9sinycosy+cosysin9sinysinysiny-cosysin9cosyJT+T(T)- =(T)=T7=tan"[-180”,180]Te3T,=e,=ecosa,=cosag4基于方向余弦矩阵的姿态解算5方向余弦矩阵的微分方程绕OZ.轴.oX,yz.0X.4oX.yz.纯OY轴OX,YZV±=tg-(T2/T22)oxyzf9的符号的取值2的符号4xW[ossnCOSy0-siny±+360grisl-siny cosy 0T2-cos.9sins010¥±+180°+nnnesiny0cosy± =tg-(-Ts/Tgs)cosycosysinysin.9sinycosysiny+sinysin.gcosysinycos.94的符号取值T3的符号sin.gC-cos.9sinycos.9cosy+Y±-180°sinycosy+cosysin.gsiny sinysiny-cosysin.gcosycosycos9.-7±+1800++、Y5
2017/4/6 5 绕OZn 轴 OX nYnZn OX1Y1Z1 绕OX1轴 OX 2Y2Z2 绕OY2 轴 OX bYbZb Yn 1 Y Zn Y2 Z2 ( ) Yb Xb ( ) Zb ( ) Xb ( ) Yb Zb 1 X Xn ( ) X2 捷联姿态矩阵 3 空间直角坐标系的坐标变换 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 捷联姿态矩阵 3 空间直角坐标系的坐标变换 4 基于方向余弦矩阵的姿态解算 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 ij i j i j ij ij T e i e i cos cos tan 90 ,90 2 22 2 12 1 32 T T T 主 tan 0 ,360 22 1 12 T T 主 tan 180 ,180 33 1 31 T T 主 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 3 1 3 2 3 3 2 1 2 2 2 3 1 1 1 2 1 3 T T T T T T T T T T n b 4 基于方向余弦矩阵的姿态解算 ( ) 12 22 1 tg T T 主 ( ) 31 33 1 tg T T 主 主 的符号 T22 的符号 的取值 + + 主 - + 主 360 +、- - 主 180 主 的符号 T33 的符号 取值 + - 主 180 - - 主 180 +、- + 主 4 基于方向余弦矩阵的姿态解算 绕OZn 轴 OX nYnZn OX1Y1Z1 绕OY2 轴 OX bYbZb 绕OX1轴 OX 2Y2Z2 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 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 5 方向余弦矩阵的微分方程