实时检测地下障碍物的方法及装置与流程

1.本专利涉及一种基于相机点云的机器车局部规划实时检测地下障碍物的方法、装置，属于实时检测领域。


背景技术：

2.在现有的机器人技术中，大部分的移动机器人依靠2d激光雷达实现自动避障功能，还有通过双目相机计算障碍物深度和利用彩色图像对障碍物进行分割，此种算法较为复杂而且计算量大，实时性较低；以及使用rgbd相机点云进行自适应密度聚类算法，通过计算质心来计算地面断层面积的方法，此种算法在遇到地面大大断层等室内楼梯口，在宽敞的环境中易检测失败。
3.目前已有的解决方法，包括：如，基于yolo算法的视觉系统，可以识别可能成为移动机器人路径障碍的静态物体；对比传统机器车避障方法，可以预定义障碍物进行训练，得到较好的识别准确率，误差低于3,64％；但对于机器车而言，需要用到深度学习，消耗算力，无法满足前进过程中的实时性要求；还有，如根据rgbd深度相机生成三维点云，做自适应点云聚类，分割出障碍物点云簇，根据障碍物三维点云点簇质心及大小得出障碍物的信息，最后转换为2d激光雷达信息；但是这种方案在点云信息不全时会误检，无法达到避障目的。
4.一种具有实时检测地下障碍物的方法及装置亟待研发。


技术实现要素：

5.为了解决现有技术的不足，本发明提供一种实时检测地下障碍物的方法及装置，其技术方案如下：
6.一种实时检测地下障碍物的方法，包括：
7.生成点云数据后，对点云数据进行体素化降采样处理，得到处理后的点云数据；
8.将点云分割成若干块地面断层点云，聚类出若干个点云簇作为地面断层点簇；
9.通过所述地面断层点簇，获取每一个点簇的最大深度位置以及宽度信息，利用所述机器车的位姿约束，得到地面断层的地面面积；
10.根据所述地面断层点簇的位置、大小信息以及所述地面断层的地面面积，得到平面点云信息，获取地下障碍物的信息。
11.所述“生成点云数据后，对点云数据进行体素化降采样处理，得到处理后的点云数据”，包括：
12.使用astra相机驱动生成点云数据；
13.利用pcl点云库对所述点云数据进行体素化降采样处理，设置体素栅格大小，并将降采样后的点云保存为sorcloud，格式为pointxyz。
14.在所述“生成点云数据后，对点云数据进行体素化降采样处理，得到处理后的点云数据”之后，还包括：无关点云剔除的步骤：
15.通过直通滤波器，将高于地面的点云以及设定距离之外的点云剔除。
16.所述“将点云分割成若干块地面断层点云，聚类出若干个点云簇作为地面断层点簇”，包括：
17.利用pcl点云库中的欧式聚类算法对所述点云数据进行聚类，将点云分割成若干块地面断层点云；
18.设置每一簇点云数据的最低点云点数和最大点云点数，得到地下障碍物点云。
19.所述“通过所述地面断层点簇，获取每一个点簇的最大深度位置以及宽度信息，利用所述机器车的位姿约束，得到地面断层的地面面积”，包括：
20.通过所述地面断层点簇，获取每一个点簇的最大深度位置以及宽度信息，得到最大深度点与机器车相机间的连线，并且获取该连线与水平面的夹角；
21.通过三角形相似性，得到地面断层的宽度，进而得到地面断层地面面积。
22.一种如上所述的实时检测地下障碍物的方法在机器车局部规划方向上的应用。
23.一种实时检测地下障碍物的装置，包括：
24.采集模块，用于生成点云数据；
25.聚类模块，与所述采集模块进行数据交互，用于对所述点云数据进行聚类，获得若干个点云簇作为地面断层点簇；
26.处理模块，与所述聚类模块进行数据交互，用于通过所述地面断层点簇获得地下障碍物地面面积，并将该地下障碍物地面面积转换为平面点云信息；
27.通信模块，与所述处理模块进行数据交互，用于通过所述通信模块将所述平面点云信息发送至机器车的局部规划器，实现避障。
28.一种实时检测地下障碍物的系统，包括：
29.机器车，用于巡航；
30.如上所述的实时检测地下障碍物的装置，与所述机器车进行数据通信，用于向所述机器车发送平面点云信息，实现所述机器车的避障。
31.一种实时检测地下障碍物的电子装置，包括：
32.存储介质，用于存储计算机程序；
33.处理单元，与所述存储介质进行数据交换，用于在进行实时检测地下障碍物时，通过所述处理单元执行所述计算机程序，进行如上所述的一种实时检测地下障碍物的方法的步骤。
34.一种计算机可读存储介质，所述计算机可读存储介质内存储有计算机程序；
35.所述计算机程序在运行时，执行如上所述的一种实时检测地下障碍物的方法的步骤。
36.本发明的有益效果是：
37.本发明所述的方法，在生成点云数据后，对点云数据进行体素化降采样处理，得到处理后的点云数据；然后，将点云分割成若干块地面断层点云，聚类出若干个点云簇作为地面断层点簇；再通过所述地面断层点簇，获取每一个点簇的最大深度位置以及宽度信息，利用所述机器车的位姿约束，得到地面断层的地面面积；最后，根据所述地面断层点簇的位置、大小信息以及所述地面断层的地面面积，得到平面点云信息，获取地下障碍物的信息；对于本发明所述的方法，其整个过程的计算量较使用了深度学习的障碍物识别算法以及图像分割算法低，在三维点云的计算方法中较计算质心的方法更为准确，能够实时提高机器
车避障功能的准确性、稳定性。
38.本发明所述的装置，通过采集模块生成点云数据；聚类模块与所述采集模块进行数据交互，对所述点云数据进行聚类，获得若干个点云簇作为地面断层点簇；然后通过处理模块与所述聚类模块进行数据交互，用于通过所述地面断层点簇获得地下障碍物地面面积，并将该地下障碍物地面面积转换为平面点云信息；最后，利用通信模块与所述处理模块进行数据交互，用于通过所述通信模块将所述平面点云信息发送至机器车的局部规划器，实现避障。本发明所述的装置，解决了机器车在未知环境下只能得到地面断层洞内单侧竖直面点云，无法完整检测到地面断层面积大小，进而无法实现避障一个难题，同时能满足机器车前进的实时性要求。
附图说明
39.图1为本发明的地面断层识别的整体流程框图；
40.图2为本发明地下障碍物检测识别结果示意图；
41.图3为本发明的地面断层宽度计算示意图；
42.图4为本发明所述的装置的结构框图。
43.其中，1.深度相机；2.欧式聚类后的地面断层点云；3.识别后构造的地面断层边缘的描点点云；100.采集模块；200.聚类模块；300.处理模块；400.通信模块；500.机器车。
具体实施方式
44.本发明所述的方法步骤如图1所示，在本部分提供本发明所述方法在机器车局部规划方向上应用的实施例。
45.实施例：
46.如图1和图2所示，本实例提供了基于rgbd相机点云的机器车局部规划实时检测地面断层的方法，包括：降采样预处理、无关点云剔除、点云欧式聚类、计算地下障碍物地面面积和数据转换五个部分；在本实例中，使用了乐视三合一体感摄像头letmc-520作为深度相机，如图2中相机1所示。
47.下面分别介绍每一部分的具体实现步骤：
48.1.预处理：使用ros中的astra相机驱动生成点云数据，在得到点云数据后，用pcl点云库对点云数据进行体素化降采样处理，设置体素栅格大小为1立方厘米，并将降采样后的点云保存为sorcloud，优选格式为pointxyz；在本步骤中，对点云数据进行降采样能够保证计算结果的实时性；
49.2.无关点云剔除：在本文所述场景中，仅需实现对机器车前方两米范围内的地下障碍物的识别检测，故通过直通滤波器，将高于地面的点云以及两米之外的点云剔除；可以节省不必要的算力；
50.3.欧式聚类：利用pcl点云库中的欧式聚类算法对上一步中的三维点云进行聚类，这种聚类办法可以剔除三维点云中的噪点，去除干扰，将点云分割成若干块地面断层点云；优选的，设置每一簇最低的点云点数50，以保证去除深度相机点云干扰，所得结果均为地下障碍物点云；具体的，对点云构造kd数，然后设定最小点数为50，最大点数25000，点间最大距离为2厘米，从而聚类出若干个点云簇；
51.4.计算地下障碍物地面面积：通过上一步获得的地面断层点簇，计算每一个点簇的最大深度位置以及宽度信息，根据已知的位姿约束，可以得到最大深度点与相机间的连线与水平面的夹角，通过三角形相似性，得到地面断层的宽度，进而得到地面断层地面面积；如图3所示，可计算得到地面断层宽度信息：
[0052][0053]
5.数据转换：根据点簇的位置、大小信息以及上一步计算的地面断层地面面积信息，用2d矩形生成高度为0.2米的平面点云信息，传递给机器车局部规划器，供小车局部规划器避障使用；其中，每一个点簇都会在0.2米的高度出构造出一个矩形，地面断层点云越复杂，最终的拟合效果就会越好。
[0054]
本文还提供一种实施例：
[0055]
如图4，一种实时检测地下障碍物的装置，包括：采集模块100、聚类模块200、处理模块300以及通信模块400；其中，采集模块100用于生成点云数据；聚类模块200与所述采集模块100进行数据交互，用于对所述点云数据进行聚类，获得若干个点云簇作为地面断层点簇；处理模块300与所述聚类模块200进行数据交互，用于通过所述地面断层点簇获得地下障碍物地面面积，并将该地下障碍物地面面积转换为平面点云信息；通信模块400与所述处理模块300进行数据交互，用于通过所述通信模块400将所述平面点云信息发送至机器车500的局部规划器，实现避障。
[0056]
本发明还提供一种实施例：
[0057]
一种实时检测地下障碍物的系统，包括：机器车，用于巡航和如上所述的实时检测地下障碍物的装置；实时检测地下障碍物的装置与所述机器车进行数据通信，用于向所述机器车发送平面点云信息，实现所述机器车的避障。
[0058]
本发明还提供一种实施例：
[0059]
一种实时检测地下障碍物的电子装置，包括：存储介质和处理单元；其中，存储介质用于存储计算机程序；处理单元与所述存储介质进行数据交换，用于在进行实时检测地下障碍物时，通过所述处理单元执行所述计算机程序，进行如上所述的一种实时检测地下障碍物的方法的步骤。
[0060]
本发明还提供一种实施例：
[0061]
一种计算机程序产品，其包括承载在计算机可读介质上的计算机程序，该计算机程序包含用于执行如上所示的方法的程序代码。该计算机程序可以从网络上被下载和安装。在该计算机程序被cpu执行时，执行本发明的系统中限定的上述功能。
[0062]
本发明还提供一种实施例：
[0063]
一种计算机可读存储介质，所述计算机可读存储介质内存储有计算机程序；所述计算机程序在运行时，执行如上所述的一种实时检测地下障碍物的方法的步骤。
[0064]
在本发明中，计算机可读的存储介质可以是任何包含或存储程序的有形介质，该程序可以被指令执行系统、装置或者器件使用或者与其结合使用。而在本发明中，计算机可读的信号介质可以包括在基带中或者作为载波一部分传播的数据信号，其中承载了计算机可读的程序代码。这种传播的数据信号可以采用多种形式，包括但不限于电磁信号、光信号或上述的任意合适的组合。计算机可读的信号介质还可以是计算机可读存储介质以外的任
何计算机可读介质，该计算机可读介质可以发送、传播或者传输用于由指令执行系统、装置或者器件使用或者与其结合使用的程序。计算机可读介质上包含的程序代码可以用任何适当的介质传输，包括但不限于：无线、电线、光缆、rf等等，或者上述的任意合适的组合。
[0065]
以上公开的仅为本发明的几个具体实施场景，但是，本发明并非局限于此，任何本领域的技术人员能思之的变化都应落入本发明的保护范围。