2016/10/24本章的学习目的全日制学位研究生专业必修课《现代导航技术》1、掌握惯性导航系统误差方程;第6章惯性导航系统误差分析2、掌握惯性导航系统误差分析原理和方法;3、掌握惯性导航系统误差传播特性。6.1概述6.1 概述HhVgo党国a(r)d2学Mec国OHAD轨迹X = Xo+Cr(0)dtLoVno加速度计Ve=Veo+fardt2(t)= +'VsecLdtRJcL()=Lo+'VvdtVN=-Vno +[axdt陀螺仪D6.1概述6.1概述4设聘A飞花资类标票3位置沿飞行器销计等4COS.间方向余弦降加速度分量速度4X北白腔夜兒鑫卤金方配修正地理星标彩T沿飞行器轴奢年奇位8安态航向刹得角速率Ru+hC计算机平台国东向惯性元件计算机1
2016/10/24 1 第6章 惯性导航系统误差分析 全日制学位研究生专业必修课《现代导航技术》 本章的学习目的 1、掌握惯性导航系统误差方程; 2、掌握惯性导航系统误差分析原理和方法; 3、掌握惯性导航系统误差传播特性。 x y 0 运动 轨迹 x1 y1 t v v a t dt 0 0 ( ) t X X v t dt 0 0 ( ) 6.1 概述 ∫ a V ∫ X 加速度计 ∫ ,, Z X 陀螺仪 Y 6.1 概述 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 ( ) L0 L(t) 6.1 概述 t Vx (0) t Vx R h N 1 sec L (0) t y f t ay t Vy t Vy (0) t Vy R h M 1 L L(0) L 1 t itx 至东向陀螺 ie cos L t ity 至北向陀螺 tan L ie sin L t itz 至方位陀螺 t x a t Vx t x f 6.1 概述
2016/10/246.1概述6.1概述(1)地理坐标系t-0,X,Y,zAEEFr(0季积计算原点在载体重心,X,指向东,LS).Y,指向北,Z,指向天。k-日卤r()-地理坐标系的坐标轴指向可损据需要进行选择,不影响寻航的计算结果。v7(0)dedoeneen地理坐标系相对于惯性参考坐标系的种动角惠座包=0+0括两部分,6.1概述6.1 概述(2)游动方位坐标系w-0X,YZ(3)导航坐标系n-0,xYz在导航时根据导航系统工原点在载体重心,与地理坐标Z2作需要而选取的作为导航基准的X,轴和Y轴有一个夹角α的坐标系。导航坐标系是惯导系统在求解导航参数时所采用的坐标系,它与系统所在的位置没有关系。6.1概述6.1 概述(4)平台坐标系p-O,XYz(5)计算坐标系c-0XYz用惯导系统来复现导航坐惯导系统利用本身计算的标系时所获得的坐标系,对于载体的位量来描述导航坐标系平台惯性导航系统就是平台指时,坐标系因惯导系统有位置向坐标系。误差而有误差,这种坐标系称为计算坐标系。2
2016/10/24 2 p x f p x a p Vx p Vx s 1 (0) p Vx 导航计算 p y f p y a p Vy p Vy s 1 (0) p Vy p epx 至东向陀螺 ie 至北向陀螺 ie c13 p ipy xp f f yp R R 1 1 1 1 C (t) C (t) p e p ep p e p epy ie c23 p ipx (0) p Ce s 1 L f 地球速率计 算 ie c13 ie c23 至方位陀螺ie p ipz c33 6.1 概述 地理坐标系相对于惯性 参考坐标系的转动角速度包 括两部分: (1)地理坐标系 原点在载体重心, 指向东, 指向北, 指向天。 Xt Yt Zt t et t ie t it Ot XtYtZt t 地理坐标系的坐标轴指向 可根据需要进行选择,不影响 导航的计算结果。 Oe Ze Ye L Xe Xt Ot Yt Zt 6.1 概述 (2)游动方位坐标系 wOw X wYwZw Oe Ze Ye L Xe Xt Ot Yt 原点在载体重心,与地理坐标 Zt(n) 的 Xt 轴和Yt 轴有一个夹角 6.1 概述 (3)导航坐标系 n OnXnYnZn Oe Ze Ye L Xe Xt(n) Ot Yt(n) 在导航时根据导航系统工 Zt(n) 作需要而选取的作为导航基准 的坐标系。 导航坐标系是惯导系统 在求解导航参数时所采用 的坐标系,它与系统所在的 位置没有关系。 6.1 概述 (4)平台坐标系 p OpX pYpZp Oe Ze Ye L Xe Xt(n) Ot Yt(n) Zt(n) 用惯导系统来复现导航坐 标系时所获得的坐标系,对于 平台惯性导航系统就是平台指 向坐标系。 6.1 概述 (5)计算坐标系 OcXcYcZc c Oe Ze Ye L Xe Xt(n) Ot Yt(n) Zt(n) 惯导系统利用本身计算的 载体的位置来描述导航坐标系 时,坐标系因惯导系统有位置 误差而有误差,这种坐标系称 为计算坐标系。 6.1 概述
2016/10/246.1概述6.1概述惯导系统在结构安装,惯性元件以及系统的工程实现中L各个环节都不可避免地存在误差。这些因素统称为误差源。元件误差=+Y=+安装误差9= 9+89i=L+&初始条件误差=y+oy运动干扰"=V"+"其它误差导航坐标系与平台坐标系间的关系prpy.p6.1概述5.1概述IX.Y.ZXY7绕X8,XYZPy:X.Y.Z.XYZV0cos0-sing.10cos.sing绕x,yz绕xy,20-sing.coso.n1ncososing9i,9y,9.00Ising,ocose,0-sing,coso,绕x,y,=cos,=sing=0、男、单是小角度+ cose,=ksing,=,dr.ecosg,=1.sing,=0.IX,Y,Z.sXYzi绕xyz, =McosL80,=-8L0.=MsinL06.1概述6.2惯性导航系统误差基本方程》平台角误差方程在导航解算过程中,为使平台坐标系复现导航坐标系,需要给平台施nZZ.加角速度指令0,但由于调差的存在,实际上给平台施加的角速度指令为,于是平台在复现导航坐标系时就会存在误差角,于是有=0品=0P-0%Y由于实际的平台指令角速度是通过计算机来实现,于是可将其写成X0.在计算坐标系下的指令角速度o和等效陀帐漂移的形式,即TP01o-9og=of+ePLe-0118=0.-0%+63
2016/10/24 3 导航坐标系与平台坐标系间的关系 L Oe Ze Ye Xe X p Ot Yp Z p Xt Yt Zt X p Yp Z p O ie L 6.1 概述 Zn Xn Yn 惯导系统在结构安装,惯性元件以及系统的工程实现中 各个环节都不可避免地存在误差。这些因素统称为误差源。 元件误差 安装误差 初始条件误差 运动干扰 其它误差 ˆ L ˆ L L n n n V V V ˆ ˆ ˆ ˆ 6.1 概述 XnYnZn XcYcZc X pYpZp x y z x yz , , , , 绕 x,y,z 绕 x,y,z x y z , , 绕x, y,z XnYnZn X pYpZp x yz , , 绕 x,y,z x L y cosL z sinL 6.1 概述 5.1 概述 XnYnZn X pYpZp x yz , , 绕 x,y,z x x x x y y y y z z z z p Tn 0 sin cos 0 cos sin 1 0 0 sin 0 cos 0 1 0 cos 0 sin 0 0 1 sin cos 0 cos sin 0 x、y、z 是小角度 x x x cos 1、sin y y y cos 1、sin z z z cos 1、sin 0 1 0 1 1 0 0 0 1 0 1 0 1 0 0 0 1 1 0 1 0 x x y y z z p Tn 1 1 1 y x z x z y p Tn p b n p n Tb T T ˆ 6.1 概述 T I y x z x z y p n 1 1 1 Xt Yt Zt X p Yp Z p O Zn Xn Yn 6.2 惯性导航系统误差基本方程 平台角误差方程 在导航解算过程中,为使平台坐标系复现导航坐标系,需要给平台施 加角速度指令 p ωin ,但由于误差的存在,实际上给平台施加的角速度指令为 p ωip ,于是平台在复现导航坐标系时就会存在误差角 ,于是有 p in p ip p ωnp ω ω 由于实际的平台指令角速度 p ωip 是通过计算机来实现,于是可将其写成 在计算坐标系下的指令角速度 c ωic 和等效陀螺漂移 p ε 的形式,即 c p ic p ip ω ω ε p p in c ic ω ω ε
2016/10/246.2惯性导航系统误差基本方程6.2惯性导航系统误差基本方程》平台角误差方程平台角误差方程00$=0f-0l+ePdo-OsinL&,coslo=LocosLal=-TP+P=f-(I-x+P[o,sinl]=0f-0"+$x0"+gVV.0fel=&of -of$+zfRu+hR+hRx+h=+0-(o+0)×$+ePaavecL&L"RL+Rur+hRy+hRy+hR+h=&0"+0"(@"+o")x+eP6.2惯性导航系统误差基本方程6.2惯性导航系统误差基本方程》平台角误差方程平台角误差方程o.,sinL+"=&" +&o"-o" +o"xo+gD.cosL-telRsinL+9.sinL&-IgL.o+oVRR.Ry0=o,sinL.0.osL1R.R.Rov.see1tgl.+o.cosL+o,cosL+5STIRR.o.sinlao,sinL+-IgL00.+6.aRyR.。平台漂移项,即陀螺漂移项·平台有误差,误差角引起的交叉耦合项;o1cos+seeLsL-gL+d.9.cosL.●导航参数有误差而产生的误差项;6.2惯性导航系统误差基本方程6.2惯性导航系统误差基本方程速度误差方程速度误差方程00"=f"-(20.+om)xV"+go=0,cosL,osinLLLOcOsLaL[o,sinLdr-(20+)xV-(20+0)xoV+gRu+hR+h"=fp-f"R&g"=0f"xo"+VPior":oVP=T"+P=(I-)"+secL&Lo"tgL-R.+hRu+hRthRy+h"=x*"+-(2+80)xV-(20+)xoV"+gSVEf"×"+VP-(280+0.)xV*-(20,+0)xV*+8g4
2016/10/24 4 6.2 惯性导航系统误差基本方程 平台角误差方程 p p in c ic ω ω ε n p in c ic n p in p n c ic ω T ω ε ω I ω ε n p in n in c ic ω ω ω ε n p in n in ω ω ε n p en n ie n en n ie ω ω ω ω ε 6.2 惯性导航系统误差基本方程 平台角误差方程 L L ie ie n ie sin cos 0 n p en n ie n en n ie n L L L L ie ie n ie cos sin 0 T N x N x M n y en tgL R h V R h V R h V T N x N x N x M n y en L L R h V tgL R h V R h V R h V 2 sec 6.2 惯性导航系统误差基本方程 平台角误差方程 n p en n ie n en n ie n z x N x y ie N x ie M y x R V tgL L R V L R V sin cos z y M y x N x ie ie N x y R V tgL R V L L L R V sin sin y z M y x N x ie N x ie N x z R V R V L L L R V tgL L R V cos sec cos 2 6.2 惯性导航系统误差基本方程 平台角误差方程 z x N x y ie N x ie M y x R V tgL L R V L R V sin cos z y M y x N x ie ie N x y R V tgL R V L L L R V sin sin y z M y x N x ie N x ie N x z R V R V L L L R V tgL L R V cos sec cos 2 平台漂移项,即陀螺漂移项; 平台有误差,误差角引起的交叉耦合项; 导航参数有误差而产生的误差项; 6.2 惯性导航系统误差基本方程 速度误差方程 n n ie en n n V f (2 )V g n n ie en n ie en n n V f (2 )V (2 )V g 0 n g n p n f f f n n ie en n ie en n n n p V f (2 )V (2 )V g p n p n p n p f T f I f n n n p f f 6.2 惯性导航系统误差基本方程 速度误差方程 n n ie en n ie en n n n p V f (2 )V (2 )V g L L ie ie n ie sin cos 0 L L L L ie ie n ie cos sin 0 T N x N x M n y en tgL R h V R h V R h V T N x N x N x M n y en L L R h V tgL R h V R h V R h V 2 sec
2016/10/246.2惯性导航系统误差基本方程6.2惯性导航系统误差基本方程》速度误差方程位置误差方程V"=f"x"+VP-(2&+0m)xV"-(20+0.)×"+g"i(R +h)cosL1-是][20 smn gr)0V,= I0-- J.0, +tanL-W+i-R+hIsee+2a,sinLy.2e,cosLV,2e,cos.V.+Va,=-J2sinL+nayecLtanLdo1R+h20,cosL+s&+VSo&=oVR+h2sin8),= J,,- J,4 +a,cosL+6.3惯导系统误差基本误差特性6.3惯性导航系统误差基本方程&0c0[ sin +gL bo-{.+6惯导系统误差源有两类,一类是确定性的,一类是随机RuR.R的。两类误差源引起的系统误差特性不同。adou sin a-esin +gt )-R典+s,R.为了分析惯导系统误差传播的基本特性,考虑静基座情-+(os++(si+)++况。由于惯导系统的垂直通道不稳定的,而且经度误差在a)--18,+(tanL-+2asimL+系统回路之外,不影响系统的动态特性,因此不考虑垂直tanLja通和经度误差。[2g, cos 1,+se L+28, inr, - 20g s L",-f8-fa-2(asinL+anL ,-a,--82n.cosLeLy&+V6.3惯导系统误差基本误差特性6.3惯导系统误差基本误差特性Ne++o,sinL-o,cosLe,s.0002e, sin L-g0四的风Ru000.0-2e, sin L8&:ovo,sinL&-o,sinLo,+e,0右0000R.0050e,sinLe, cos L9,aoVo.=tgL+o,cosLaL+o,cosLo,+s-ke0-e, sinLe, sin L0eR.00e, cos Le, cosL02o, =-hg,+20, sin LV,+VX(t)= FX(t)+W()y,=f020sinV,+V拉氏-o变换RMsX(s)-X(0)= FX(s)+W(s)X(s)=(s/ -F)X(O)+W(s)5
2016/10/24 5 6.2 惯性导航系统误差基本方程 速度误差方程 z x N x ie z ie N x y ie y y N x x ie N z N y x x z z y V R V L LV L L R V V LV L V R V V L R V L R V V f f 2 cos sec 2 sin 2 cos tan 2 sin tan 2 x y N x ie z M y y M z x N x y z x x z ie L V L R V L V R V V R V L V R V V f f L 2 2 cos sec 2 sin tan y ie x z M y x N x z x y y x ie V LV L R V V R V V f f L 2 sin 2 2 cos n n ie en n ie en n n n p V f (2 )V (2 )V g 6.2 惯性导航系统误差基本方程 位置误差方程 R h V L M t y R h L V N t x ( ) cos Oe L Ze Ye Xe X p Ot Yp Z p ie L R h V L M y L L L R h V L R h V N x N x sec sec tan h Vz 6.3 惯导系统误差基本误差特性 惯导系统误差源有两类,一类是确定性的,一类是随机 的。两类误差源引起的系统误差特性不同。 为了分析惯导系统误差传播的基本特性,考虑静基座情 况。由于惯导系统的垂直通道不稳定的,而且经度误差在 系统回路之外,不影响系统的动态特性,因此不考虑垂直 通道和经度误差。 6.3 惯性导航系统误差基本方程 z x N x y ie N x ie M y x R V tgL L R V L R V sin cos z y M y x N x ie ie N x y R V tgL R V L L L R V sin sin y z M y x N x ie N x ie N x z R V R V L L L R V tgL L R V cos sec cos 2 z x N x ie z ie N x y ie y y N x x ie N z N y x x z z y V R V L LV L L R V V LV L V R V V L R V L R V V f f 2 cos sec 2 sin 2 cos tan 2 sin tan 2 x y N x ie z M y y M z x N x y z x x z ie L V L R V L V R V V R V L V R V V f f L 2 2 cos sec 2 sin tan 6.3 惯导系统误差基本误差特性 ie y ie z x M y x L L R V sin cos ie ie x y N x y L L L R V sin sin ie ie x z N x z tgL L L L R V cos cos x z y ie L Vy x V f 2 sin y z x ie L Vx y V f 2 sin M y R V L f z g 6.3 惯导系统误差基本误差特性 z y x y x z y x y x R ie ie L R ie ie R ie ie R ie ie z y x y x L V V L L L L L L L g L g L V V N N M M 0 0 cos cos 0 0 0 sin sin 0 0 0 0 0 sin cos 0 0 0 0 0 2 sin 0 0 0 0 0 2 sin 0 0 0 tan 1 1 1 X(t) FX (t) W(t) 拉氏 变换 sX(s) X(0) FX (s) W(s) ( ) ( ) (0) ( ) 1 X s sI F X W s