专利名称：一种基于扫描激光的大尺度三维地形建模方法
技术领域：
本发明涉及一种基于扫描激光的大尺度三维地形建模方法，特别是基于高斯混合模型的概率化大尺度环境的三维地形建模，属于地理信息系统(GIS)、无人平台自主导航、机器人技术等领域。
背景技术：
在诸如地理信息系统(GIS)、无人自主平台导航、勘测科考、计算机图形学、遥感、虚拟现实等应用领域，ー个精确的实时三维地形模型起着至关重要的作用，直接决定着整个系统的运行效率和整体的经济效益。与室内环境不同，野外环境呈现更为多祥的非结构 化和不确定特征，而环境的大尺度特征加剧了问题的复杂性，从而为其应用带来了较大的挑战。通常采用的获取三维地形数据的方式有立体视觉、激光雷达和ニ维扫描激光等。其中立体视觉的图像数据处理较为繁琐，计算损耗大，在精度和实时性方面均存在问题；激光雷达则因其高昂的价格而未被广泛采用；相比之下ニ维扫描激光成本低，精度高，因而受到业界的关注，但如何构建较为合理的地形建模算法仍是ー个急需解决的难题。三维地形建模ー种较为直接的描述方式是点云法，该方法是采用离散的激光反射点来表示地形特征，进而可以简明直接地表述空间的基本信息。但是这种方法只能表示出稀疏的地形几何特征，而且随着扫描范围的増大，其数据量也呈线性增长，导致空间复杂度过高。另ー种较为常见的三维地形建模方式是体素法，即将周边环境划分为许多规则的三维几何体，例如最常用的立方体划分，然后通过这些立方体的占据状态来描述三维环境。该方法可以产生稠密合理的空间地形，但是其数据量会随着激光数据和扫描环境的范围的增长呈线性增长，使得地形的创建和更新的计算损耗相当严重。在野外非结构化地形环境应用较为广泛的建模方法是高程图。该方法采用ニ维的网格来表示平面位置，每个网格存储ー个能代表该网格地形高度信息的高程值，从而构成了对空间的描述。然而对数据的处理较为粗糙，所建立的地形模型缺乏弹性，且未能描述地形的多层次细节。总的来说，上述常用的三维地形建模方法存在以下问题1)较高的空间和时间需求导致其无法用于野外大尺度地形建模问题，海量数据的存储和处理将占据大量的存储空间和计算时间；2)没有考虑环境建模中存在的多源不确定性，例如诸多传感器测量所存在的不确定性，因而所建立的地形模型缺乏弹性，精度和容错性不够，无法应用于精确的建模和导航领域；3)这些现有方法在构建地形模型时没有考虑精度和计算复杂度之间的平衡问题，导致很难应用与实时三维地形建模场景。
发明内容
本发明的目的是为了克服已有的技术缺陷，解决基于扫描激光的大尺度三维地形建模中海量传感器数据的压缩存储和处理问题、地形建模的不确定性问题以及地形建模算法的精度和计算复杂度的平衡问题，提出了一种基于低成本ニ维扫描激光的大尺度三维地形建模方法，实现野外地形环境的高效、实时建摸。本发明米用的技术方案为一种基于扫描激光的大尺度三维地形建模方法，首先采用安装在移动机器人平台上的扫描激光对周边环境进行感知，并通过坐标变换将原始激光数据转化为三维点云；其次采用中值滤波方法对点云进行预处理，并构建八叉树结构完成数据的存储；然后采用了基于高斯混合模型的概率化方法对数据进行融合处理，以实时建立地形环境模型；最后对地形模型中存在的遮挡区域进行检测和处理以进一步提高模型精度。 (I)三维地形数据的获取首先采用安装在移动平台上的ニ维扫描激光对周围环境进行扫描以获取环境数据；其次采用卡尔曼滤波的方法利用里程计和GPS数据对移动平台进行融合定位，以获得移动平台的全局坐标；最后在移动平台的定位和激光对环境扫描的基础上，结合ニ维扫描激光在移动平台的相对位姿将扫描激光的数据转化为三维点云。(2)点云数据的预处理和存储首先对点云的采样点构建权值窗ロ，通过中值滤波滤除激光的孤立点和混合像素干扰；然后采用八叉树的数据结构对激光的数据进行存储，以实现海量点云数据的压缩存储。(3)概率化地形建模首先对传感器进行概率化建模，构建高斯描述的传感器模型，从而将传感器坐标系中的測量数据转化为全局坐标系中的高程估计；然后采用高斯分布的3 O值作为不确定性边界进行高斯关联实现全局高程估计信息关联到网格；最后通过构建高斯分布间的马氏距离对地形进行分类更新。(4)地形模型的遮挡处理首先根据传感器測量时间和空间上的相关性，结合移动平台本身的机械性能特征和越障能力，采用局部窗ロ检测的方法对遮挡区域进行检测；然后对遮挡区域做进ー步的处理以进ー步提高地形模型的精度。有益效果本发明采用低成本的ニ维扫描激光有效解决了大范围复杂地形的实时建模问题，通过对模型中存在的各种不确定性进行概率化处理，实现了模型精度和实时性之间的良好平衡，所采用的方法简单高效，可满足GIS系统、城市规划、仿真建模、天气预报、自主无人驾驶等不同领域的广泛需求，具有广阔的应用前景和良好的经济效益。
图I为算法总体流程图；图2为概率化高程地形示意图；图3为激光扫描感知示意图；图4为移动平台定位示意图；图5为中值滤波权值窗ロ示意图；图6为八叉树空间描述图；图7为八叉树的树状结构图；图8为闻程"[目息关联不意图；图9为遮挡区域处理示意图。
具体实施例方式下面结合附图和具体实施方式
对本发明做进ー步说明。
图I为本专利所提出的基于扫描激光的大尺度三维地形建模方法的总体流程图，所采用的地形模型为概率化高程地图(如图2所示)。算法的具体步骤如下I、地形数据的获取和转化地形数据的采集是地形建模的基础，通过安装在移动平台(如移动机器人平台)上的ニ维扫描激光对周边地形环境进行扫描以获取环境感知数据，然后根据定位传感器信息(里程计和GPS)对移动平台进行融合定位获得其位姿的全局坐标。在此基础上，通过坐标变换的方法将原始激光数据转化为三维点云。具体步骤包括第一歩基于扫描激光的地形感知。本发明设计实验采用安装在移动机器人平台上向地面倾斜10°方向的ニ维SICK LMS激光对周围环境进行扫描，如图3所示。激光扫描的精度为180度/0. 5度，因此每次扫描可获取361个数据，扫描频率为50Hz，由此可获得地形感知的原始数据。第二步移动平台定位。为了将原始数据转化为空间高程信息，需要对移动平台 进行大范围精确定位。本发明采用里程计和GPS进行Kalman滤波组合定位。如图4所示，Fw=OwXwYwZw和分别表示所定义的全局Cartesian坐标系和与移动机器人固连的相对坐标系。机器人存在平动速度V和转动速度《，其位姿状态量为(x，y，e)T，则可建立其离散的运动学模型为
xk + cos %prk+1 =f{prk)= yk+VkAtsinOk(I)
+ ん A/ ノ由于里程计和GPS数据的采样时刻不同，因此需要采用不同的观测模型对机器人的位姿进行更新，通过GPS数据校正里程计定位的累积误差，以实现移动机器人的长距离精确定位。其中GPS采样得到的经纬度数据需要首先转化为全局坐标系的坐标方可用于更新。在定位过程中根据运动学模型的位姿预测和根据传感器测量的位姿更新两个步骤均采用经典的Kalman滤波方法完成。第三步点云数据的转化。依据激光获取的深度信息并结合平台位姿估计，通过坐标变换的方法将原始激光扫描数据转化为全局坐标中的三维点云。如图3所示，F1=O1X1Y1Z1表示激光传感器固连的坐标系，X1O1Y1平面为激光扫描平面；r为激光扫描深度数据。从而可通过坐标变换的方法获得全局三维点云X为x=f (p, r) (2)其中f为坐标变换矩阵左乘得到的转换函数，通过FpF,和Fw三级坐标变换获得；P是坐标变换中所包含的平台位姿參数和标定參数。2、点云数据的预处理和存储对点云数据进行中值滤波预处理以剔除点云数据中由于激光误差造成的孤立点和混合像素干扰，从而可获取环境较为准确的描述。此外采用八叉树对海量点云数据进行压缩存储以节约存储空间。具体步骤包括第一歩中值滤波。根据激光扫描数据的关联性，针对某个测量rt,k构建如图5所不的权值窗ロ，其中t表不激光各次扫描的时间，k表不单次测量对应扫描中的序号,不同位置的測量具有不同的权重。由此采用中值滤波方法对得到的点云数据进行处理，从而剔除点云数据中存在的不正确的孤立值和混合像素干扰。
第二步构建八叉树结构对点云数据进行压缩存储。由于获取的点云数据随扫描距离的増大而呈线性增长，因此采取有效的八叉树存储结构对点云数据进行压缩和存储，如图6所示，即将三维空间划分为若干相等的立方体，根据有无点云数据落入其中对其赋予ニ值占据状态，从而实现对海量数据的压缩，降低存储空间和计算复杂度的需求。如图7所示即为八叉树的树状结构图。注意八叉树的尺寸可根据需要灵活选择，以适应不同的地形精度需求。3、概率化实时地形建模针对移动平台各传感器本身固有性能和相对于移动平台的位置，对传感器进行概率化建模，将测量数据转化为全局坐标系中的高程估计，采用高斯分布的3 O值作为不确定性边界进行关联以将全局高程估计信息关联到网格，并通过构建马氏距离判据对地形进行实时分类更新。具体步骤包括第一歩传感器概率建模。对传感器进行概率化建模，从而将传感器坐标系中的測量数据通过坐标变换转化为全局坐标系中的高程估计。为了合理的处理统计意义上的传感器误差和建模误差，将式(I)中存在的坐标变换參数P和传感器原始測量r更准确地建模为如下的不确定性干扰形式P = ++ 其中多和f为所使用的參数參考值；Sp和Sr是这些观测结果中的误差。从而对点云数据修正并线性化得到
权利要求
1.一种基于扫描激光的大尺度三维地形建模方法，其特征在于包括以下步骤 (1)首先采用安装在移动机器人平台上的扫描激光对周边环境进行感知，并通过坐标变换将原始激光数据转化为三维点云； (2)其次采用中值滤波方法对点云进行预处理，并构建八叉树结构完成数据的存储； (3)然后采用了基于高斯混合模型的概率化方法对数据进行融合处理，以实时建立地形环境模型； (4)最后对地形模型中存在的遮挡区域进行检测和处理以进一步提高模型精度。
2.根据权利要求I所述的ー种基于扫描激光的大尺度三维地形建模方法，其特征在于所述步骤(I)具体为首先采用安装在移动平台上的ニ维扫描激光对周围环境进行扫描以获取环境数据；其次采用卡尔曼滤波的方法利用里程计和GPS数据对移动平台进行融合定位，以获得移动平台的全局坐标；最后在移动平台的定位和激光对环境扫描的基础上，结合ニ维扫描激光在移动平台的相对位姿将扫描激光的数据转化为三维点云。
3.根据权利要求I所述的ー种基于扫描激光的大尺度三维地形建模方法，其特征在于所述步骤(2)具体为首先对点云的采样点构建权值窗ロ，通过中值滤波滤除激光的孤立点和混合像素干扰；然后采用八叉树的数据结构对激光的数据进行存储，以实现海量点云数据的压缩存储。
4.根据权利要求I所述的ー种基于扫描激光的大尺度三维地形建模方法，其特征在于所述步骤(3)具体为首先对传感器进行概率化建模，构建高斯描述的传感器模型，从而将传感器坐标系中的測量数据转化为全局坐标系中的高程估计；然后采用高斯分布的30值作为不确定性边界进行高斯关联实现全局高程估计信息关联到网格；最后通过构建高斯分布间的马氏距离对地形进行分类更新。
5.根据权利要求I所述的ー种基于扫描激光的大尺度三维地形建模方法，其特征在于所述步骤(4)具体为首先根据传感器測量时间和空间上的相关性，结合移动平台本身的机械性能特征和越障能力，采用局部窗ロ检测的方法对遮挡区域进行检测；然后对遮挡区域做进一步的处通以进一步提闻地形ネ旲型的精度。
全文摘要
本发明公开了一种基于扫描激光的大尺度三维地形建模方法，首先通过安装在移动机器人平台上的扫描激光对周边环境进行感知，并通过坐标变换将原始激光数据转化为三维点云；其次采用中值滤波方法对点云进行预处理，并构建八叉树结构完成数据的存储；然后采用了基于高斯混合模型的概率化方法对数据进行融合处理，以实时建立地形环境模型；最后对地形模型中存在的遮挡区域进行检测和处理以进一步提高模型精度。本发明采用低成本的二维扫描激光有效解决了大范围复杂地形的实时建模问题，通过对模型中存在的各种不确定性进行概率化处理，实现了模型精度和实时性之间的良好平衡，可满足GIS系统或无人自主导航等不同领域的广泛需求。
文档编号G06T17/05GK102831646SQ20121028782
公开日2012年12月19日 申请日期2012年8月13日 优先权日2012年8月13日
发明者周波, 戴先中, 马旭东, 钱来 申请人:东南大学