[发明专利]一种基于三维点云高程分布相似度的可通行区域检测方法

说明书

本发明提出一种基于三维点云高程分布相似度的可通行区域检测方法。本发明对三维点云数据进行栅格化表述，并对栅格内点云在高程上的分布用向量来表示，其中向量的每个元素代表在对应高程范围内激光点的数量。由于相邻的两个可通行栅格内点云在高程上是连续且分布大致相同的，因此通过计算可通行栅格与邻接栅格间向量的相似度，判断邻接栅格是否为可通行栅格。基于此判断条件对种子栅格进行区域扩张，最终得到可通行区域地图。利用高程分布相似度对三维点云地图进行了可通行区域检测，特别是针对大尺度栅格具有更准确的检测效果，并可有效避免悬空物体的干扰，从而保证了栅格的准确扩张。

技术领域

本发明属于环境感知技术领域，具体涉及一种基于三维点云高程分布相似度的可通行区域检测方法。

背景技术

随着移动机器人在各个领域的广泛应用，移动机器人应用的场景越来越复杂，例如，三维空间中存在的障碍物、坑洞、斜坡以及悬空物体对移动机器人的安全行驶提出了更高的挑战。移动机器人需要对环境中的可通行区域进行检测，用于移动机器人的路径规划和路径跟踪，从而实现移动机器人的安全导航。因此可通行区域的准确识别对移动机器人导航具有重要意义。

工程上常用的可通行区域检测方法有基于原始点云检测和基于栅格地图检测。基于原始点云的可通行区域检测方法需要对单帧激光点云中的单线点云进行操作，该检测方法适用于结构化路面，在野外以及其它路况下不具有普遍性。

基于栅格地图的可通行区域检测方法将点云转化为栅格的特征，并通过比较相邻栅格的特征来判断栅格的可通行性，进而检测出三维点云地图的可通行区域。在可通行区域检测过程中，栅格特征的选取至关重要，现有的基于栅格的可通行区域检测方法中，部分直接选取栅格中高程的极值作为栅格特征，这种做法会导致高处悬空物体的高程值屏蔽低处物体特征，还会造成与悬空结构相对应的环境信息的丢失。

由于在实际工程应用中栅格的尺度和判断可通行区域的计算量相关，对于大范围(例如平方公里级别)场景下的可通行区域检测，通常通过增大栅格尺度来减少计算量。另一方面，通常室外工作的机器人尺寸较大(例如平方米级)，如果使用较小尺度的栅格会造成多余的计算。因此在实际应用中通常增大栅格尺度(例如1米*1米)来减少计算量。由于栅格尺度变大，导致栅格内点云的数量显著增多，这就导致了栅格内的噪声干扰显著增加，因此使用栅格内高程的极值不能准确表示栅格特征，从而会影响可通行区域检测的准确性；

文献(Stelzer A,Hirschmüller H, M.Stereo-vision-basednavigation of a six-legged walking robot in unknown rough terrain[J].International Journal of Robotics Research,2012,31(4):381-402)针对双目相机构建出的数字地形模型提出了一种移动机器人可通行区域检测方法，这种方法通过计算粗糙度，高度和坡度角对可通行区域进行检测。但该方法不考虑环境中存在悬空物体情况，而实际室外场景中常常存在树冠，路灯等悬空物体，因此该方法在存在悬空物体的场景中无法准确识别可通行区域。

专利(一种采用多线激光雷达的道路可通行区域获取方法,专利申请号：CN201810674683.7)提出了一种采用多线激光雷达的道路可通行区域获取方法，这种方法将每个栅格中点云按照高程进行排序，分割平面块，得到平面块高度特征以及强度特征，求解最底层表面块高度均值，并且根据高度均值及平面强度将平面块分为地面或障碍物，最终获取道路可通行区域。该方法虽然可以处理悬空物体的干扰，但由于使用高度均值，导致此方法在有斜坡的场景中无法准确识别地面和障碍物。

发明内容