[发明专利]基于激光雷达和图像数据融合的地形地貌特征构建方法

说明书

技术领域

本发明属于自动控制领域，具体涉及一种利用地面无人移动平台搭载的3D激光雷达和摄像头图像信息建立地理环境地图的方法。

背景技术

无人地面移动平台UGP是一种集环境感知、动态决策与规划、行为控制与执行等多种功能于一体的综合系统，其在未来军事，智能交通，侦查救灾领域具有广泛的应用前景。而UGP的机动性与智能化程度取决于它的自主导航能力，而准确、快速的自主导航功能则是建立在精确的地理环境的地图信息基础上的。

研究先进的地理环境地图构建方法有助于增强地面无人移动平台的智能化，扩宽其现代化应用。

现有的基于车载激光雷达和摄像头图像信息的地面无人移动平台的地理环境地图构建方法包括如下：

（1）3D激光点云的处理：该方法是通过激光雷达采集3D点云数据，然后在柱坐标系下一定距离范围内对3D点云数据进行可通行性分析。由于3D激光雷达点云数据具有近密远疏的特性，则在进行可通行性分析时，远处稀疏点容易被忽略；而且如果仅采用点云数据的几何特征，遇到非结构环境，其障碍物具有不规则性，则会加大点云数据的处理难度，从而导致在提取地形特征方面出现较大误差。

（2）基于图像信息进行地貌识别：该种方法是最符合人类对环境理解的一种方法。其中图像信息包括多种，例如：目前在目标跟随和目标识别中，通常采用尺度不变特征变换SIFT和梯度方向直方图HOGs来描述图像变化，若采用SIFT和HOGs来进行整幅图像的特征描述，则具有一定的难度。另外颜色直方图、纹理模型、区域分割、GIST描述符、词袋模型以及空间的金字塔等也可以用来表述图像的全局特征。而上述先进的算法和特征提取方法均是通过对图像进行分割来达到理解的效果，但是2D空间中通常采用透视投影，所获得的对象和背景的相似度高，图像分割效果不理想，对相应特征的提取有影响，最终则会影响到对图像信息的理解。

（3）3D激光点云数据与摄像头图像信息的匹配与融合：该方法是将摄像头与激光雷达坐标进行匹配，获得匹配后的结果并合并，该方法能够将激光雷达的获得的距离信息与图像中的颜色信息合并，以达到对环境更好的理解。然而由于匹配与融合的特征较少，无法发挥3D激光雷达的几何信息特征和图像多种特征的优势，无法保证匹配的准确度。

综上所述，基于现有的方法在进行地图构建时，无法保证地面无人移动平台对环境理解的准确度，同时复杂的算法以及巨大的计算量无法满足现代化的要求。

发明内容

有鉴于此，本发明提出了一种地面无人移动平台的地理环境地图构建方法，该方法能够保证所构建的全局地图的准确性，同时能够降低计算的复杂程度，使计算量减少。

为达到上述目的，本发明的技术方案为：一种基于激光雷达和图像数据融合的地形地貌特征构建方法，具体包括如下步骤：

步骤一、获取当前时刻地面无人移动平台周围环境的3D激光点云和全景图像；

所获得3D激光点云为平台周围环境的特征点集，包括各特征点的三维坐标值以及反射率；

步骤二、对3D激光点云和全景图像进行匹配，获得匹配图像：

步骤三、对于3D激光点云中各激光点，选取其对应的不同分布特征，对3D激光点云进行划分，并根据各分布特征的动态聚类算法进行聚类，获得多个区域类；

其中，所选取分布特征包括：激光点所在面法向量、反射率以及该点映射到图像上的颜色特征；

步骤四、根据地面无人移动平台的行驶能力，对多个区域类的地形进行判断，获得可通行区域类；

步骤五、使用稠密SIFT算法获得可通行区域类的地貌识别向量；

步骤六、采用分类器按照地貌识别向量对可通行区域类进行地貌分类，最终获得地面无人移动平台周围可通行区域的地貌。

优选地，上述步骤三具体分为如下步骤：

步骤301、建立3D激光点云坐标系oxyz：该坐标系以激光雷达为原点，以水平面作为xoy平面，以垂直于xoy平面的方向作为z轴方向；

将3D激光点云中各激光点的在oxyz坐标系下的坐标转化为以激光雷达为原点的球坐标系下的表示其中，r为激光点距原点的距离，θ和分别为激光点所在的纬度和经度；

对于所获得的3D激光点云进行如下处理：

在经度方向上，按照0.5度的步长将大致均匀分布在360度的激光点划分进720个经度组；

在纬度方向上，按照0.45度的步长将大致均匀分布在180度的激光点划分进400个纬度组；