基于激光雷达和图像数据融合的地形地貌特征构建方法
【专利摘要】本发明公开了基于激光雷达和图像数据融合的地形地貌特征构建方法，属于自动控制领域。该方法具体为：一、获取当前时刻地面无人移动平台周围环境的3D激光点云和全景图像；二、将3D激光点云和全景图像进行匹配，获得匹配图像：步骤三、根据各激光点对应的不同分布特征，对3D激光点云进行划分，并根据各分布特征的动态聚类算法进行聚类，获得多个区域类；四、根据地面无人移动平台的行驶能力，在多个区域类中找到可通行区域类；五、使用稠密SIFT算法获得可通行区域类的地貌识别向量；六、采用分类器按照地貌识别向量对可通行区域类进行地貌分类。本发明适用于地面无人移动平台的可通行地形地貌特征构建。
【专利说明】基于激光雷达和图像数据融合的地形地貌特征构建方法
【技术领域】
[0001]本发明属于自动控制领域，具体涉及一种利用地面无人移动平台搭载的3D激光雷达和摄像头图像信息建立地理环境地图的方法。
【背景技术】
[0002]无人地面移动平台UGP是一种集环境感知、动态决策与规划、行为控制与执行等多种功能于一体的综合系统，其在未来军事，智能交通，侦查救灾领域具有广泛的应用前景。而UGP的机动性与智能化程度取决于它的自主导航能力，而准确、快速的自主导航功能则是建立在精确的地理环境的地图信息基础上的。
[0003]研究先进的地理环境地图构建方法有助于增强地面无人移动平台的智能化，扩宽其现代化应用。
[0004]现有的基于车载激光雷达和摄像头图像信息的地面无人移动平台的地理环境地图构建方法包括如下:
[0005](I) 3D激光点云的处理:该方法是通过激光雷达采集3D点云数据，然后在柱坐标系下一定距离范围内对3D点云数据进行可通行性分析。由于3D激光雷达点云数据具有近密远疏的特性，则在进行可通行性分析时，远处稀疏点容易被忽略；而且如果仅采用点云数据的几何特征，遇到非结构环境，其障碍物具有不规则性，则会加大点云数据的处理难度，从而导致在提取地形特征方面出现较大误差。
[0006](2)基于图像信息进行地貌识别:该种方法是最符合人类对环境理解的一种方法。其中图像信息包括多种，例如:目前在目标跟随和目标识别中，通常采用尺度不变特征变换SIFT和梯度方向直方图HOGs来描述图像变化，若采用SIFT和HOGs来进行整幅图像的特征描述，则具有一定的难度。另外颜色直方图、纹理模型、区域分割、GIST描述符、词袋模型以及空间的金字塔等也可以用来表述图像的全局特征。而上述先进的算法和特征提取方法均是通过对图像进行分割来达到理解的效果，但是2D空间中通常采用透视投影，所获得的对象和背景的相似度高，图像分割效果不理想，对相应特征的提取有影响，最终则会影响到对图像彳目息的理解。
[0007](3) 3D激光点云数据与摄像头图像信息的匹配与融合:该方法是将摄像头与激光雷达坐标进行匹配，获得匹配后的结果并合并，该方法能够将激光雷达的获得的距离信息与图像中的颜色信息合并，以达到对环境更好的理解。然而由于匹配与融合的特征较少，无法发挥3D激光雷达的几何信息特征和图像多种特征的优势，无法保证匹配的准确度。
[0008]综上所述，基于现有的方法在进行地图构建时，无法保证地面无人移动平台对环境理解的准确度，同时复杂的算法以及巨大的计算量无法满足现代化的要求。
【发明内容】
[0009]有鉴于此，本发明提出了一种地面无人移动平台的地理环境地图构建方法，该方法能够保证所构建的全局地图的准确性，同时能够降低计算的复杂程度，使计算量减少。[0010]为达到上述目的，本发明的技术方案为:一种基于激光雷达和图像数据融合的地形地貌特征构建方法，具体包括如下步骤:
[0011]步骤一、获取当前时刻地面无人移动平台周围环境的3D激光点云和全景图像；
[0012]所获得3D激光点云为平台周围环境的特征点集，包括各特征点的三维坐标值以及反射率；
[0013]步骤二、对3D激光点云和全景图像进行匹配，获得匹配图像:
[0014]步骤三、对于3D激光点云中各激光点，选取其对应的不同分布特征，对3D激光点云进行划分，并根据各分布特征的动态聚类算法进行聚类，获得多个区域类；
[0015]其中，所选取分布特征包括:激光点所在面法向量、反射率以及该点映射到图像上的颜色特征；
[0016]步骤四、根据地面无人移动平台的行驶能力，对多个区域类的地形进行判断，获得可通行区域类；
[0017]步骤五、使用稠密SIFT算法获得可通行区域类的地貌识别向量；
[0018]步骤六、采用分类器按照地貌识别向量对可通行区域类进行地貌分类，最终获得地面无人移动平台周围可通行区域的地貌。
[0019]优选地，上述步骤三具体分为如下步骤:
[0020]步骤301、建立3D激光点云坐标系oxyz:该坐标系以激光雷达为原点，以水平面作为xoy平面，以垂直于xoy平面的方向作为z轴方向；
[0021]将3D激光点云中各激光点的在oxyz坐标系下的坐标转化为以激光雷达为原点的球坐标系下的表示(〃/?，其中，r为激光点距原点的距离，0和Cp分别为激光点所在的纬度和经度；
[0022]对于所获得的3D激光点云进行如下处理:
[0023]在经度方向上，按照0.5度的步长将大致均匀分布在360度的激光点划分进720个经度组；
[0024]在纬度方向上，按照0.45度的步长将大致均匀分布在180度的激光点划分进400个纬度组；
[0025]对于3D激光点云中每个激光点，找到其在经度方向上同属于一个经度组的相邻激光点作拟合直线，再找到其在纬度方向上同属于一个纬度组的相邻激光点作拟合直线，两拟合直线的单位向量叉乘获得该激光点的面法向量；
[0026]步骤302、在经度组中，将激光点依据z轴坐标差异和其在经度方向上拟合直线的斜率差异划分成子类，在进行子类划分时:若两激光点z方向坐标差异超过一定阈值，或者拟合直线的斜率差异达到一定程度，则两点划分入不同的子类；
[0027]针对划分出每个子类，统计其如下子类特征的特征值:法向量、中心点坐标、颜色和反射率；
[0028]其中各子类特征值的计算方法如下:
[0029]子类法向量:子类中每个点的面法向量进行相加并归一化，得到该子类的所在平面的法向量；
[0030]子类中心点坐标:获取每个子类中心点的经度、纟韦度和距激光雷达原点的距离，作为中心点坐标；[0031]子类颜色:获取每个激光点在全景图像上对应的0到255的rgb三维颜色向量；将0至255均匀划分为8段，在一个子类中，统计各维颜色向量的8段中激光点出现的频率，进行直方图统计，获得该子类的24维颜色向量；
[0032]子类反射率:通过3D激光雷达获得每个激光点的反射率，该反射率是一个0-255的整数，将0-255均匀划分为8个区域，在每一个子类中，统计反射率的8个区域中激光点出现的概率，进行直方图统计，获得该子类的8维反射率向量；
[0033]步骤303、计算每个子类与相邻子类之间各特征值的相似度，选取相似度最大的子类进行合并，获得簇，计算簇内的类间凝聚度，若凝聚度超过一定阈值，则取消合并；
[0034]步骤304、经过步骤303之后，激光点的聚类包括簇与子类两种，计算每一簇和每一子类的物理空间大小，将物理空间最大的簇或子类作为区域类，将除区域类以外的剩余的簇或子类返回步骤303进行聚类，直到剩余的簇或子类个数小于一定数值，最终获得多个区域类。 [0035]优选地，步骤四中，采用如下方法对区域类进行地形判断:
[0036]根据地面无人移动平台的行驶能力，建立地形分类模糊表；
[0037]地形分类模糊表将地形中所有区域分为可通行和不可通行两大类，其中可通行中分为平路，上坡，下坡；不可通行分为凸障碍和凹障碍，共五小类，地形分类模糊表以每一区域类的径向坡度和起始点为依据进行模糊分类，分类的结果即为地形判断的结果。
[0038]优选地，步骤五具体分为如下步骤:
[0039]步骤501、依据稠密SIFT算法，将匹配图像划分呈固定大小的像素块，每个像素块得到D维SIFT描述子；
[0040]步骤502、计算每一维SIFT描述子权重:
[0041]上述步骤501中划分的每个像素块覆盖多个区域类，设一像素块覆盖j个区域类Cp...、Cj,其中区域类Ci中被该像素块覆盖的激光点的个数为ni; I < i < j，整个像素块的激光点个数为N，Ci中的所有激光点个数为M,则D维SIFT描述子在区域类Ci中的所有
纹理特征中所占的权重为
【权利要求】
1.基于激光雷达和图像数据融合的地形地貌特征构建方法，其特征在于，该方法包括如下步骤: 步骤一、获取当前时刻地面无人移动平台周围环境的3D激光点云和全景图像； 所获得3D激光点云为平台周围环境的特征点集，包括各特征点的三维坐标值以及反射率； 步骤二、对3D激光点云和全景图像进行匹配，获得匹配图像: 步骤三、对于3D激光点云中各激光点，选取其对应的不同分布特征，对3D激光点云进行划分，并根据各分布特征的动态聚类算法进行聚类，获得多个区域类； 其中，所选取分布特征包括:激光点所在面法向量、反射率以及该点映射到图像上的颜色特征； 步骤四、根据地面无人移动平台的行驶能力，对多个区域类的地形进行判断，获得可通行区域类； 步骤五、使用稠密SIFT算法获得可通行区域类的地貌识别向量； 步骤六、采用分类器按照地貌识别向量对可通行区域类进行地貌分类，最终获得地面无人移动平台周围可通行区域的地貌。
2.如权利要求1所述的基于激光雷达和图像数据融合的地形地貌特征构建方法，其特征在于，所述步骤三具体分为如下步骤:` 步骤301、建立3D激光点云坐标系oxyz:该坐标系以激光雷达为原点，以水平面作为xoy平面，以垂直于xoy平面的方向作为z轴方向； 将3D激光点云中各激光点的在oxyz坐标系下的坐标转化为以激光雷达为原点的球坐标系下的表示其中，r为激光点距原点的距离，0和(p分别为激光点所在的纬度和经度； 对于所获得的3D激光点云进行如下处理: 在经度方向上，按照0.5度的步长将大致均匀分布在360度的激光点划分进720个经度组； 在纬度方向上，按照0.45度的步长将大致均匀分布在180度的激光点划分进400个纬度组； 对于3D激光点云中每个激光点，找到其在经度方向上同属于一个经度组的相邻激光点作拟合直线，再找到其在纬度方向上同属于一个纬度组的相邻激光点作拟合直线，两拟合直线的单位向量叉乘获得该激光点的面法向量； 步骤302、在经度组中，将激光点依据z轴坐标差异和其在经度方向上拟合直线的斜率差异划分成子类，在进行子类划分时:若两激光点z方向坐标差异超过一定阈值，或者拟合直线的斜率差异达到一定程度，则两点划分入不同的子类； 针对划分出每个子类，统计其如下子类特征的特征值:法向量、中心点坐标、颜色和反射率； 其中各子类特征值的计算方法如下: 子类法向量:子类中每个点的面法向量进行相加并归一化，得到该子类的所在平面的法向量；子类中心点坐标:获取每个子类中心点的经度、纬度和距激光雷达原点的距离，作为中心点坐标； 子类颜色:获取每个激光点在全景图像上对应的O到255的rgb三维颜色向量；将O至255均匀划分为8段，在一个子类中，统计各维颜色向量的8段中激光点出现的频率，进行直方图统计，获得该子类的24维颜色向量； 子类反射率:通过3D激光雷达获得每个激光点的反射率，该反射率是一个0-255的整数，将0-255均匀划分为8个区域，在每一个子类中，统计反射率的8个区域中激光点出现的概率，进行直方图统计，获得该子类的8维反射率向量； 步骤303、计算每个子类与相邻子类之间各特征值的相似度，选取相似度最大的子类进行合并，获得簇，计算簇内的类间凝聚度，若凝聚度超过一定阈值，则取消合并； 步骤304、经过步骤303之后，激光点的聚类包括簇与子类两种，计算每一簇和每一子类的物理空间大小，将物理空间最大的簇或子类作为区域类，将除区域类以外的剩余的簇或子类返回步骤303进行聚类，直到剩余的簇或子类个数小于一定数值，最终获得多个区域类。
3.如权利要求1所述的基于激光雷达和图像数据融合的地形地貌特征构建方法，其特征在于，所述步骤四中，采用如下方法对区域类进行地形判断: 根据地面无人移动平台的行驶能力，建立地形分类模糊表； 地形分类模糊表将地形中所有区域分为可通行和不可通行两大类，其中可通行中分为平路，上坡，下坡；不可通行分为凸障碍和凹障碍，共五小类，地形分类模糊表以每一区域类的径向坡度和起始点为依据进行模糊分类，分类的结果即为地形判断的结果。
4.如权利要求1所述的基于激光雷达和图像数据融合的地形地貌特征构建方法，其特征在于，所述步骤五具体分为如下步骤: 步骤501、依据稠密SIFT算法，将匹配图像划分呈固定大小的像素块，每个像素块得到D维SIFT描述子； 步骤502、计算每一维SIFT描述子权重: 所述步骤501中划分的每个像素块覆盖多个区域类，设一像素块覆盖j个区域类Cp...、Cj,其中区域类Ci中被该像素块覆盖的激光点的个数为ni; I < i < j，整个像素块的激光点个数为N，Ci中的所有激光点个数为M,则D维SIFT描述子在区域类Ci中的所有纹理特征中所占的权重为COij = \.1 M*N， 步骤503、采用词袋模型Bag of Words,使用Kneans算法聚类出所有SIFT描述子的P个中心点，作为视觉字典，其中p>D ； 对于区域类Ci,将每一个SIFT描述子对应视觉字典的概率值乘以其在该区域类Ci中的权重，所得的值组合获得该区域类Ci的地貌识别向量； 所述地貌识别向量表征该区域类对应图像的纹理信息，其维数和视觉字典的维数相同。
5.如权利要求1所述的一种地面无人移动平台的地理环境地图构建方法，其特征在于，所述步骤六中，使用分类器按照地貌识别向量对可通行区域类进行地貌分类的过程具体为:选取一部分地貌识别向量作为训练集，另一部分作为测试集，将训练集中地貌识别向量作为分类器的输入，训练获得地貌分类模型；将测试集中的地貌识别向量输入分类器，利用地貌分 类模型将输入的地貌识别向量划分到其对应的地貌特征类中。
【文档编号】G01S17/89GK103645480SQ201310645716
【公开日】2014年3月19日 申请日期:2013年12月4日 优先权日:2013年12月4日
【发明者】王美玲, 彭佳 申请人:北京理工大学