2017/4/61、概述金用制专性研究生专业品修解《身航乐统设计》惯性导航其导第7章INS/GPS组合导航2星导航导业天文导航视觉导放1概述1、概述组合导航同一平台、多传感器实施互补、互验、互校的导航系统。特点:各传感器独立输出导航信息。>融合导航一一同一平台、多传感器实施信息融合的导航系惯性导航系统GPS导航系统统。特点:多传感器、统一输出导航信息。·状态信息究蓝?长时间定位销度高组合导航一般强调硬件的最佳组合:·自主性粥提供密座位置信应·频带宽、输出平稳>融合导航一般强调多传感器数据融合其法:频率低误整随时间积氧·信号不稳定融合导航与组合导航既有联系又有区别,融合导航是基于组合导航(杨元喜院士)惯性/卫星组合导航采统2惯性导航系统误差基本方程2惯性导航系统误整基本方程》平台角误差方程>速度误差方程"=f"x"+P-(2&+&m)xV"-(20,+0)xV"+g""=&+&"-(o+o)$+P18-1(-+o,sinL+-gLecosl202i2Ja,+v81,= -4-20, sin +tanL aV-8,-sinlo-020,c0sL+secV&+VcosL+S0e2N00s1+28,-20, inLV&+V,-o,-,0+20,cos+vR.1
2017/4/6 1 第7章 INS/GPS组合导航 全日制学位研究生专业必修课《导航系统设计》 1、概述 卫星导航 导航手段 视觉导航 惯性导航 地球物理 场导航 无线电 导航 其它导航 天文导航 组合 导航 融合 导航 1 概述 组合导航——同一平台、多传感器实施互补、互验、互校 的导航系统。特点:各传感器独立输出导航信息。 融合导航——同一平台、多传感器实施信息融合的导航系 统。特点:多传感器、统一输出导航信息。 组合导航一般强调硬件的最佳组合; 融合导航一般强调多传感器数据融合算法; 融合导航与组合导航既有联系又有区别,融合导航是基于 组合导航(杨元喜 院士)。 惯性导航系统 •状态信息完整 •自主性强 •频带宽、输出平稳 •误差随时间积累 GPS导航系统 •长时间定位精度高 •提供速度位置信息 •频率低 •信号不稳定 惯性/卫星组合导航系统 1、概述 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 2 惯性导航系统误差基本方程 速度误差方程 z x N x ie z ie N x y ie y y N x x ie M z M 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
2017/4/62 惯性导航系统误整基本方程3INS/GPS组合导航数学模型>位量误差方程XT=[,y,,V,V,L,a,EsEby,E]Vi=(Ry +h)cos LX(t)= F()X()+G(0)W(0)Vi=(L,-L,)R 1.[R&+N,Ru+hZ,(t)=- H,(0)X(0)+V,()[(-,RcosRcos&+[v.-v.]i=secLtanLalsecL-t= H,(0)X(0)+V,(0)Z,(t)=Rw+hRw+h[V-Vy]H,-[02s diag(Rm RvcosL) 02e]oISidh=oV.Ru+hH, =[02diag(1 1) 0]3INS/GPS组合导航数学模型X, =@u-X-I+IW-X(t)=F(t)X(t)+G(t)W()Z =H,XI+VZ()=H(0)X(0)+V(0)Xu- = Pua-I-Xt-Pu-- =@u-P.on- +I-OI.X, =Xw-I +K(Z -H,X-I)K, = PuA-,HI(H, Pu-,H, +R,)-P = Pxk-I -K,H, PAuk-2
2017/4/6 2 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 3 INS/GPS组合导航数学模型 [ , , , , , , , , , ] T x y z Vx Vy L b x b y b z X X(t) F(t)X(t) G(t)W(t) ( ) ( ) ( ) ( ) cos cos ( ) ( ) t t t R L N R L N R L L L R t p p N y M x I s M I s N Zp H X V 2 5 02 3 0 ( cos ) Hp diag RM RN L ( ) (t) (t) (t) V V V V t V V Iy sy Ix sx ZV H X V 2 3 02 5 0 (1 1) HV diag 3 INS/GPS组合导航数学模型 X(t) F(t)X(t) G(t)W(t) Z(t) H(t)X(t) V(t) Xk Φk|k1Xk1 Γk1Wk1 Zk HkXk Vk | 1 | 1 1 ˆ ˆ Xk k Φk k Xk ) ˆ ( ˆ ˆ Xk Xk|k 1 Kk Zk HkXk|k 1 T 1 | 1 T | 1 ( ) Kk Pk k Hk HkPk k Hk Rk T 1 1 T | 1 | 1 1 | 1 1 k Pk k Φk k Pk Φk k Γk Qk Γ Pk Pk|k 1 KkHkPk|k 1