2016/11/11本章的学习目的全日制学位研究生专业必修课《现代导航技术》1地球物理场寻航的意义。第10章地球物理场和视觉导航技术2、掌握地形匹配、景像匹配、地磁匹配、重力匹配和视觉导航定位技术的原理。3、掌握惯性/地球物现场组合导航数学模型的建立10.1、概述10.1、概述地球物理场》地球物理场导航技术各种地球物理方法在地表成地表附近测重的各种物理地球物理场寻航定位技术是通过就体上地球物理场现象的信息可以绕称为地球物场的信惠。可分为天然存测量传感器别量的信息与储存在教体导航计算机中的地在的地球物理场和人工激发的地球物理场。球物理场基准信想相比较确定股体导航参数的技术。北航数字导航中心长潮从事地球物理场导航与定位技术研究,从理论、算法,仿真和皮用方面取得了一柔列的成果,都分成票已经在实际中进行应用。光场地形场重力异常场地碟异常场10.1、概述10.1、概述景像相关景像匹配相关分景像信息景像相关景像匹配(2D)析原理典型算法按工作原理高度相关按地形信感分TERCOM地形TERCOM匹配高程信息地形匹配扩展Kalman典型算法SITAN滤波原理(1D)SITAN1
2016/11/11 1 第10章 地球物理场和视觉导航技术 全日制学位研究生专业必修课《现代导航技术》 本章的学习目的 1、地球物理场导航的意义。 2、掌握地形匹配、景像匹配、地磁匹配、重力匹配和 视觉导航定位技术的原理。 3、掌握惯性/地球物理场组合导航数学模型的建立 地球物理场 10.1、概述 各种地球物理方法在地表或地表附近测量的各种物理 现象的信息可以统称为地球物理场的信息。可分为天然存 在的地球物理场和人工激发的地球物理场。 重力异常场 地磁异常场 地形场 光场 地球物理场导航技术 地球物理场导航定位技术是通过载体上地球物理场 测量传感器测量的信息与储存在载体导航计算机中的地 球物理场基准信息相比较确定载体导航参数的技术。 北航数字导航中心长期从事地球物理场导航与定位 技术研究,从理论、算法、仿真和应用方面取得了一系 列的成果,部分成果已经在实际中进行应用。 10.1、概述 按 工 作 原 理 相关分 析原理 扩展Kalman 滤波原理 景像相关 高度相关 景像匹配 典型算法 典型算法 TERCOM SITAN 地 形 匹 配 10.1、概述 按 地 形 信 息 分 景像信息 (2D) 高程信息 (1D) 景像相关 景像匹配 TERCOM SITAN 地形匹配 10.1、概述
2016/11/1110.1、概述10.1、概述》在GNSS信号不可用时,地球物理场可提供定位信息DSMACTERCOM战荞运航弹重力异常地形起伏D十-10#折O0精硫制导式地磁异常地物纹理10.1、概述10.1、概述TomahawkWeaponSystemEvolutionTPODSTUANCaTrASUCSEPTAENaemeerooeProvenPeoigreewithBeneritsorMurtformDeveiopmentrSupport美国GPS成熟,地形匹配为备份导航系统,景像还在用TERPROM10.1、概述10.2、地形匹配和地形辅助惯性导航匹配导航h.海拔高度h地形的高度海平面h:相对高度5,000 Plush,=h,-heBUTP惯性导航系统可提供全部导航信惠;无线电高度表测量飞行爵对地面的相对高度:气压式高度表戒大气数据中心一单独或与惯导系统综合地提供飞行器的海拔或绝对高度;TERPROM导航计算机和大容量存储器完成导航计其和存储数字地图。2
2016/11/11 2 www.buaa.edu.cn dnc.buaa.edu.cn 地磁异常 重力异常 在GNSS信号不可用时,地球物理场可提供定位信息 地形起伏 地物纹理 战斧巡航弹 DH-10巡航弹 精确制导武器 10.1、概述 www.buaa.edu.cn dnc.buaa.edu.cn TERCOM DSMAC 10.1、概述 www.buaa.edu.cn dnc.buaa.edu.cn 美国GPS成熟,地形匹配为备份导航系统,景像还在用 10.1、概述 www.buaa.edu.cn dnc.buaa.edu.cn TERPROM 10.1、概述 www.buaa.edu.cn dnc.buaa.edu.cn TERPROM 10.1、概述 www.buaa.edu.cn dnc.buaa.edu.cn ha:海拔高度 hr:地形的高度 hc:相对高度 hr=ha -hc • 惯性导航系统——可提供全部导航信息; • 无线电高度表——测量飞行器对地面的相对高度; • 气压式高度表或大气数据中心——单独或与惯导系统综合地提 供飞行器的海拔或绝对高度; • 导航计算机和大容量存储器——完成导航计算和存储数字地图。 匹配导航 10.2、地形匹配和地形辅助惯性导航
2016/11/1110.2、地形匹配和地形辅助惯性导航10.2、地形匹配和地形辅助惯性导航地形松助导航(TAN)TeTemen地形康随(TF一TerrainFollow)Figip地形(TA-TerrainAvoid)夏季型C10.2、地形匹配和地形辅助惯性导航10.2、地形匹配和地形辅助惯性导航相关分析算法的三种典型算法雷达高度表气压高度表·交叉相关算法(COR-CrossCoRelation)高度实测标高h.(x+iax,y+joy)h,(i)MAXJcOR=惯性导航仪相关处理14位置·平均绝对值算法(MAD-MeanAbsoluteDifference)地图指示标高数字地图h.(x+iar,y+jar)-h,(0)MINJMAD均方整算法(MSD-MeanSquareDifference)位置修正相关分析原理MINJasp(jar)[h.(+iax,y+jo)-h())10.2、地形匹配和地形辅助惯性导航10.2、地形匹配和地形辅助惯性导航慢导/地形匹配组合系统状态方程的建立气压高度表高度修正X()=[A度导航仪核改了的X(t)= F(0)X(t)+W(t)中尔曼港波器惯导/地形匹配组合系统量测方程的建立P地图参教数字地图-{-[[][]Z(0)==H()X()+V(0)位置修正雷达高度表[00000100基于扩展Kalman滤波的方法L000000103
2016/11/11 3 地形辅助导航(TAN) 地形跟随(TF-Terrain Follow) 地形回避(TA-Terrain Avoid) 10.2、地形匹配和地形辅助惯性导航 10.2、地形匹配和地形辅助惯性导航 相关分析原理 10.2、地形匹配和地形辅助惯性导航 L i MAD m r h x i x y j x h i L J 1 | ( , ) ( )| 1 相关分析算法的三种典型算法 L i COR m r h x i x y j y h i L J 1 ( , ) ( ) 1 L i MSD m r h x i x y j y h i L J j x 1 2 [ ( , ) ( )] 1 ( ) 交叉相关算法(COR-Cross CoRelation) 平均绝对值算法(MAD-Mean Absolute Difference) 均方差算法(MSD-Mean Square Difference) MAX MIN MIN 10.2、地形匹配和地形辅助惯性导航 T X(t) [ E N U vE vN L h] 惯导/地形匹配组合系统状态方程的建立 X t F t X t W t ( ) ( ) ( ) ( ) ( ) ( ) ( ) ( ) I S N N I S E E L L L N N L Z t H t X t V t N N 惯导/地形匹配组合系统量测方程的建立 0 0 0 0 0 0 1 0 0 0 0 0 0 1 0 0 H T T 10.2、地形匹配和地形辅助惯性导航 基于扩展Kalman滤波的方法 10.2、地形匹配和地形辅助惯性导航
2016/11/1110.2、地形匹配和地形辅助惯性导航10.2、地形匹配和地形辅助惯性导航》SITAN算法的数学模型>SITAN算法的数学模型系统状态方程的建立量测方程的建立h =h.-h(x,j)Xa]h(x,j)=h()+mX+1 =D+IX++IrOkh(x,y)=h(x,y)+y,10.2、地形匹配和地形辅助惯性导航10.2、地形匹配和地形辅助惯性导航>SITAN算法的数学模型》SITAN算法的数学模型·量测方程的建立量测方程的意立h-h。-h(x,y)=0h =h.-ha(x,j)h(x,y)=h(x,y)+y,Z=h-h,=h,-h(x,))-h(x)-htah-h(x+a.yton)-Hh(.D-n)ch,(xyah,(x,y)_ ah,(a, sy=h-h-h,(x,y)Sxah.(x,y)=h-h.-h(x,y)-oxaxayaxay+h-mY,-+h-m-Y-Y10.2、地形匹配和地形辅助惯性导航10.2、地形匹配和地形辅助惯性导航>BITAN(BUAAInertialTerrainAided Navigation)算法>SITAN算法的数学模型(b)量测方程的建立ah,(x,y)h,(x,y)Z-y+&h-m-,-axayah,(x,y)ah,(x,y)h.:=&h-m-Y,-h,=axdyZ=HX+aLong Zhao, et al A Novel Terrain Aided NavigationAlgorithm Combined with theTERCOMAlgorithm and Particle Filter IEEE Sensors Journal, 2015,15(2): 1124-H=-h-h,1 0 o11314
2016/11/11 4 • 系统状态方程的建立 SITAN算法的数学模型 10.2、地形匹配和地形辅助惯性导航 d r m h x y h (x ˆ , y ˆ) ˆ (ˆ , ˆ) ˆ c c r h (x, y) h (x, y) ~ • 量测方程的建立 SITAN算法的数学模型 10.2、地形匹配和地形辅助惯性导航 (ˆ , ˆ) ˆ ˆ ˆ h h h x y c a d (ˆ , ˆ) ˆ ˆ ˆ h h h x y c a d c c r h (x, y) h (x, y) ~ (ˆ , ˆ) ~ (ˆ , ˆ) ˆ ˆ ~ ˆ Z h h h h x y h x y c c a d c r m c r h h h (x x, y y) h (x ˆ , y ˆ) ˆ m r l r r c r h y y h x y x x h x y h h h x y ( , ) ( , ) ( , ) • 量测方程的建立 SITAN算法的数学模型 10.2、地形匹配和地形辅助惯性导航 h hc hr (x, y) 0 m r l r r c r h y y h x y x x h x y Z h h h x y ( , ) ( , ) ( , ) • 量测方程的建立 SITAN算法的数学模型 10.2、地形匹配和地形辅助惯性导航 m r l r r y h y h x y x x h x y Z ( , ) ( , ) x h x y h r x ( , ) y h x y h r y ( , ) h m r l Z HX 1 0 0 H hx hy • 量测方程的建立 SITAN算法的数学模型 10.2、地形匹配和地形辅助惯性导航 BITAN(BUAA Inertial Terrain Aided Navigation )算法 10.2、地形匹配和地形辅助惯性导航 Terrain contour State distribution TSL State State Expected measurement Distribution k k i Length of fitting area Small error Small error (a) Terrain contour Length of fitting area k k i State distribution High Sm error all error TSL State State Expected measurement Distribution (b) Long Zhao, et al. A Novel Terrain Aided Navigation Algorithm Combined with the TERCOM Algorithm and Particle Filter. IEEE Sensors Journal, 2015,15(2): 1124- 1131
2016/11/1110.2、地形匹配和地形辅助惯性导航10.3景像匹配和惯导/景像匹配组合导航·试飞实验肤得了39.4米(CEP)的定位精度!在三维空间环境中,人可以利用视觉进行导航定位·填补了我圆在战术爽炸机上使用地形匹配技术的空白;荣族就空总公司科技进步二等奖金10.3景像匹配和惯导/景像匹配组合导航10.3景像匹配和惯导/景像匹配组合导航培训中心景像匹配导航技术办公楼利用飞行器实时来集的量像实时图与预如心会议中心完成这一过程的要素:体育馆先制备的景像基准图进行匹配,获得飞行器精(1)基准信息逸夫馆确定位的一项技术。(2)实时获取信息新主楼航空航天馆(3)对实时获取信息处理晨兴音乐厅10.3景像匹配和惯导/景像匹配组合导航10.3景像匹配和惯导/景像匹配组合导航景像匹配粗匹配算法景像匹配一粗匹配算法基准图实时图:平均绝对差(MaanAbsoluteDifferenge)之MAD(x,y)=g(x,y,Eu12MINNx-Ny-·修正相关系数(Correotion Correlation Funation)Cor(g(x,y)y.J.,)MAXCOR(x,y):D(g(x,XDU)基准图和实时图互协方垫基准图自协方整5
2016/11/11 5 • 试飞实验获得了39.4米(CEP)的定位精度; • 填补了我国在战术轰炸机上使用地形匹配技术的空白; • 荣获航空总公司科技进步二等奖 。 10.2、地形匹配和地形辅助惯性导航 在三维空间环境中,人可以利用视觉进行导航定位 10.3 景像匹配和惯导/景像匹配组合导航 办公楼 完成这一过程的要素: (1)基准信息 (2)实时获取信息 (3)对实时获取信息处理 10.3 景像匹配和惯导/景像匹配组合导航 培训中心 晨兴音乐厅 航空航天馆 逸夫馆 如心会议中心 景像匹配导航技术 利用飞行器实时采集的景像实时图与预 先制备的景像基准图进行匹配,获得飞行器精 确定位的一项技术。 10.3 景像匹配和惯导/景像匹配组合导航 景像匹配——粗匹配算法 10.3 景像匹配和惯导/景像匹配组合导航 景像匹配——粗匹配算法 10.3 景像匹配和惯导/景像匹配组合导航 Nx i Ny j i j i j g x y f Nx Ny MAD x y 1 1 , , | ( , ) | 1 ( , ) i j W i j i j i j i j D g x y D f Cov g x y f COR x y , , , , , ( ( , ) ) ( ) ( ( , ) , ) ( , ) • 平均绝对差(Mean Absolute Difference) • 修正相关系数(Correction Correlation Function) MIN MAX 基准图 实时图 基准图和实时图互协方差 基准图自协方差 景像匹配——粗匹配算法 10.3 景像匹配和惯导/景像匹配组合导航