[发明专利]一种激光雷达无反射区域的测量方法

说明书

本发明公开了一种激光雷达无反射区域的测量方法。首先采集激光雷达数据，进行激光雷达预处理；其次对有反射区域的激光信息进行聚类分区域和对各个区域选取两个端点，以确定局部无反射区域；然后对局部无反射区域进行延伸与激光雷达量程匹配，得到完整无反射区域；最后通过更新该区域的栅格占用概率来构建完整的地图。

技术领域

本发明属于激光SLAM技术领域，具体涉及一种激光雷达无反射区域的测量方法。

技术背景

同时定位与建图(SLAM，Simultaneous Localization and Mapping)技术一直是机器人研究热点。其中激光雷达传感器凭借制图精确，有很高的实时性，适应性强，不像视觉传感器受光影响巨大，所以激光雷达得到了广泛应用。但是利用激光雷达对较长的走道、公路或较空旷区域(大于激光雷达测量范围)等场景建图时经常会有无反射区域，导致机器人无法构建完整的地图，降低了建图的效率，同时也为导航造成了不便。

发明内容

为了解决上述技术问题，本发明提供一种激光雷达无反射区域的测量方法，该方法首先对有反射信号区域的激光数据进行聚类分成多个区域，然后对各个区域选取端点确定局部无反射区域，其次通过与激光雷达量程对比确定完整无反射区域，最后通过更新该区域的栅格占用概率来构建完整的地图。

技术方案：本发明所述的一种激光雷达无反射区域的测量方法包括以下步骤：

步骤1、采集激光雷达数据，获取数据极坐标；

步骤2、对激光雷达数据进行采样，获取单帧数据并进行预处理；

步骤3、激光雷达数据点坐标进行转换并计算各点之间的距离；

步骤4、根据步骤3得到的距离设置自适应阈值，对激光数据进行聚类；

步骤5、当前帧的激光雷达数据经过步骤4后，分成若干个数据区域，选出各自区域的两个端点；

步骤6、将步骤5得到的各个数据区域的端点按角度大小进行排序；

步骤7、根据步骤6的排序关系，确定局部无反射区域；

步骤8、根据步骤7的局部无反射区域来确定完整的无反射区域；

步骤9、利用方程表示该区域；

步骤10、更新栅格地图。

进一步的，步骤1采集激光雷达数据具体为得到障碍物离激光雷达的距离和角度。

进一步的，步骤2为了降低噪声干扰、环境光的干扰以及提高低反射物检测的能力，对激光雷达数据进行中值滤波预处理。

进一步的，步骤3首先将激光雷达极坐标转换为直角坐标，再根据激光雷达的平移向量和旋转角度，将直角坐标转换为全局坐标并计算相邻点的欧式距离。

进一步的，步骤4对激光雷达数据激光采用最近邻聚类，由于雷达数据点之间的距离会随着光束距离的变化而变化，对此设置自适应阈值，降低聚类错误概率。

进一步的，步骤5在各自区域里面根据数据点在极坐标下的角度大小，分别取其中角度值最大和最小两个点，作为该区域的两个端点。

进一步的，步骤6排序时要保证同区域的两端点角度值必然相邻，否则说明不同类之间有交叉区域，最近邻聚类对交叉区域算为同一类。

进一步的，步骤7对不同区域的相邻的端点以及激光雷达原点分别进行连线，形成三角区域，该区域即局部无反射区域。

进一步的，步骤8延长激光雷达原点与端点的线段，使其长度达到激光雷达量程(激光雷达扫描范围是以量程距离为半径的圆)距离，三角区域便成了扇形区域，即该量程内完整的无反射区域。