一种基于多线激光雷达的斜坡地面点云分割方法及系统与流程

1.本发明涉及室内外三维复杂场景地面分割技术领域，特别涉及一种基于多线激光雷达的斜坡地面点云分割方法及系统。


背景技术：

2.本部分的陈述仅仅是提供了与本发明相关的背景技术，并不必然构成现有技术。
3.随着5g技术和无人驾驶技术的快速发展，三维slam(simultaneous localization and mapping)渐渐成为室外复杂环境领域的研究热点，无人驾驶技术难关在于精准避障，而精准避障关键在于地面分割去除，确保所有物体都孤立存在。
4.常见激光点云地面分割方法主要分为三大类，其一，利用实际地面到雷达的相对高度或者绝对高度筛选出地面种子点，再利用svd(singular value decomposition)分解进行地面拟合，实现地面分割；其二，利用pcl(point cloud library)点云库中随机采样一致性方法对全局地面进行地面拟合，实现全局地面分割；其三，利用点云间的坡度以及相对高度融合的方法实现地面分割。
5.发明人发现，由于现实场景中地面并不是垂直于雷达竖直方向，地面会存在斜坡或者不平整等情况，上述三种方法系统都有可能会将斜坡视为障碍物，导致地面分割的准确性较低，无法满足三维复杂斜坡环境的地面分割需求。


技术实现要素：

6.为了解决现有技术的不足，本发明提供了一种基于多线激光雷达的斜坡地面点云分割方法及系统，能够有效地识别并分割三维复杂斜坡环境的地面，提高了斜坡地面分割的准确性。
7.为了实现上述目的，本发明采用如下技术方案：
8.本发明第一方面提供了一种基于多线激光雷达的斜坡地面点云分割方法。
9.一种基于多线激光雷达的斜坡地面点云分割方法，包括以下过程：
10.获取多线激光雷达原始点云数据；
11.对原始点云数据进行预处理；
12.对预处理后的点云数据进行初步地面分割处理，得到非地面点云；
13.对非地面点云进行欧式聚类，对每一类进行随机采样一致性平面拟合，根据拟合结果筛选得到斜坡地面点云。
14.进一步的，对预处理后的点云数据分割得到原始地面点云，如果判断聚类后的某一类为斜坡地面点云，则将此类对应的聚类拟合平面与原始地面进行拼接。
15.进一步的，对预处理后的点云数据进行分割，包括：
16.将预处理后的点云数据根据雷达分辨率划分为多个区域；
17.对每个区域按照点云水平距离对点云升序处理；
18.在各个区域内进行局部阈值判断，在某一区域中，如果当前点的前一点是地面点
且两点高度差小于坡度阈值，则该点为地面点；否则，进行全局阈值判断，如果当前点测量高度小于根据当前点水平距离计算得到的全局坡度阈值，则当前点属于地面点，否则当前点属于非地面点。
19.进一步的，对非地面点云进行欧式聚类，对每一类进行随机采样一致性平面拟合，根据拟合结果得到斜坡地面点云，包括以下过程：
20.对非地面点云进行欧式聚类；
21.利用原始地面点云获得原始地面法向量和原始地面点高度平均值；
22.遍历每一聚类并对其进行随机采样一致性处理，对拟合平面进行数据处理，获得某类的拟合平面的法向量、该类拟合平面所占该类点云的数量比以及该类所拟合平面种子点云的高度平均值；
23.根据拟合平面的法向量和原始地面法向量，得到该类拟合平面与原始地面的夹角；
24.当夹角小于设定角度阈值，原始地面平均高度与该类点云种子点的高度平均值的差值小于距离阈值，且拟合平面所占点云的数量比大于给定比例时，该类非地面点云为斜坡地面点云；否则，该类非地面点云为障碍物点云。
25.更进一步的，当夹角大于或等于设定角度阈值时，该类非地面点云为障碍物点云。
26.更进一步的，当夹角小于设定角度阈值，原始地面平均高度与该类点云种子点的高度平均值的差值大于或等于距离阈值时，该类非地面点云为障碍物点云。
27.更进一步的，当夹角小于设定角度阈值，拟合平面所占点云的数量比小于或等于给定比例时，该类非地面点云为障碍物点云。
28.进一步的，对点云数据进行预处理，包括：
29.根据激光雷达的最大俯角，得到激光雷达扫到地面的最小距离；
30.计算所有点的水平距离，去除距离小于最小距离的点；
31.根据预设避障要求，去除大于最大距离的点；
32.根据距离初始地面下方的高度设定第一高度阈值，根据高于雷达上方的高度设定第二阈值，根据第一高度阈值和第二高度阈值去除竖直方向的无用点。
33.更进一步的，对点云数据进行预处理，还包括：
34.多线激光雷达的两条激光线映射到地面后，计算两者之间的最小距离和最大距离，在最小距离和最大距离之间查找使每一条激光线映射到地面的不同水平区域的数值，根据得到数值进行点云区域分割。
35.本发明第二方面提供了一种基于多线激光雷达的斜坡地面点云分割系统。
36.一种基于多线激光雷达的斜坡地面点云分割系统，包括：
37.数据获取模块，被配置为：获取多线激光雷达原始点云数据；
38.预处理模块，被配置为：对原始点云数据进行预处理；
39.点云分割模块，被配置为：对预处理后的点云数据进行初步地面分割处理，得到非地面点云；
40.斜坡地面点云获取模块，被配置为：对非地面点云进行欧式聚类，对每一类进行随机采样一致性平面拟合，根据拟合结果筛选得到斜坡地面点云。
41.本发明第三方面提供了一种计算机可读存储介质，其上存储有程序，该程序被处
理器执行时实现如本发明第一方面所述的基于多线激光雷达的斜坡地面点云分割方法中的步骤。
42.本发明第四方面提供了一种电子设备，包括存储器、处理器及存储在存储器上并可在处理器上运行的程序，所述处理器执行所述程序时实现如本发明第一方面所述的基于多线激光雷达的斜坡地面点云分割方法中的步骤。
43.与现有技术相比，本发明的有益效果是：
44.1、本发明基于多线激光雷达获取数据及安装原理，利用点云的几何信息对点云进行预处理，先利用点云水平、竖直方向的阈值区间去除无用点，减少点云数量；再利用两条激光线之间的距离阈值及雷达分辨率对点云进行高效最优化的区域划分，有效提高后续点云处理效率。
45.2、本发明利用基于坡度的地面分割算法，实时地实现原始地面点云与非地面点云的初步分割，对非地面点云进行欧式聚类，对每一类进行平面一致性拟合处理，根据平面的几何拼接原理，利用平面法向量夹角、斜坡最低处与原始地面平均高度差及拟合平面点云所占数量比例来实现地面的拼接，实现了斜坡地面的准确和高效分割。
46.本发明附加方面的优点将在下面的描述中部分给出，部分将从下面的描述中变得明显，或通过本发明的实践了解到。
附图说明
47.构成本发明的一部分的说明书附图用来提供对本发明的进一步理解，本发明的示意性实施例及其说明用于解释本发明，并不构成对本发明的不当限定。
48.图1为本发明实施例1提供的基于多线激光雷达的斜坡地面点云分割方法的流程示意图。
49.图2为本发明实施例1提供的点云预处理原理图。
50.图3为本发明实施例1提供的基于坡度的地面分割算法的流程示意图。
51.图4为本发明实施例1提供的非地面点云的地面分割及拼接流程示意图。
具体实施方式
52.下面结合附图与实施例对本发明作进一步说明。
53.应该指出，以下详细说明都是示例性的，旨在对本发明提供进一步的说明。除非另有指明，本文使用的所有技术和科学术语具有与本发明所属技术领域的普通技术人员通常理解的相同含义。
54.需要注意的是，这里所使用的术语仅是为了描述具体实施方式，而非意图限制根据本发明的示例性实施方式。如在这里所使用的，除非上下文另外明确指出，否则单数形式也意图包括复数形式，此外，还应当理解的是，当在本说明书中使用术语“包含”和/或“包括”时，其指明存在特征、步骤、操作、器件、组件和/或它们的组合。
55.在不冲突的情况下，本发明中的实施例及实施例中的特征可以相互组合。
56.实施例1：
57.如图1所示，本发明实施例1提供了一种基于多线激光雷达的斜坡地面点云分割方法，包括以下过程：
58.s1：基于多线激光雷达获取点云信息的原理，对原始点云进行预处理，分割合理区域。
59.s2：利用基于坡度的地面分割算法，将原始点云分割为原始地面点和非地面点。
60.s3：实现非地面点云的欧式聚类，再对每一类进行随机采样一致性平面拟合，将符合要求的点云与原始地面点云拼接，实现斜坡场景的地面分割。
61.具体的，s1中：
62.首先，由于激光雷达存在最大俯角θ
max
，因此，激光雷达扫到地面的最小距离：
[0063][0064]
然后，利用获取的点云信息计算得到所有点的水平距离，最大化去除距离小于distance
min
的点云；再根据避障要求，再利用最远水平距离distance
max
去除较远距离点云；
[0065]
最后，根据距离初始地面下方高度和高于雷达上方高度分别设定相应的阈值h
min
和h
max
，去除竖直方向的无用点云，有效降低点云后续处理的计算量，提高地面分割效率。
[0066]
在确定激光点云范围之后，需要对点云划分区域，圆周方向根据雷达分辨率设置区域，半径方向需要根据水平距离设定合理的区域，两条线映射到地面后，两者之间的最小距离为：
[0067][0068]
最大距离为：
[0069][0070]
其中，θ
max-i-1
为根据最大水平距离计算得到的理论映射到地面的最小俯角，在l
min
和l
max
之间找到合理值(可以按照8分制计算，即将区间平均分成8份，然后以二分法寻找最优值)，使每一条激光映射到地面的不同水平区域。
[0071]
通过上述点云预处理，最终实现点云区域的合理分割，多线激光雷达预处理点云原理如图2所示。
[0072]
本实施例中，半径方向分区用于将三维点云信息投影到二维深度图像上，保证每一径向区域都有点云，避免无效区域划分，便于非地面点云的分段欧式聚类(根据不同的径向区域进行不同距离、聚类大小阈值的设置)。
[0073]
s2中：
[0074]
将预处理后的点云按照雷达分辨率进行投影，将点云按如下公式划分为多个区域：
[0075][0076]
对每个区域按照点云水平距离对点云升序处理，在所有区域内进行局部阈值判断；
[0077]
根据相邻前一点是否为地面点以及利用相邻两点之间的水平距离计算得到的局
部坡度阈值来判断是否为地面点，即如果前一点是地面点且两点高度差小于局部坡度阈值，则该点为地面点；否则，再根据全局阈值判断，即如果该点测量高度小于根据该点水平距离计算得到的全局坡度阈值，则该点属于地面点，否则该点属于非地面点。
[0078]
本实施例中，局部坡度阈值＝相邻两点水平距离*预设局部坡度(两点之间的竖直仰角，一般设为6～8
°
)；全局坡度阈值＝该点距离雷达水平距离*预设全局坡度(两点之间的竖直仰角，一般预设为较局部坡度高2～3度)。
[0079]
将地面点归为原始地面点和非地面点分别保存起来，供后续地面分割优化处理。基于坡度的地面分割算法流程如图3所示。
[0080]
s3中：
[0081]
首先，将初步地面分割后的非地面点云进行欧式聚类；
[0082]
然后，利用原始地面点云获得原始地面法向量n1及原始地面点高度平均值z1，同时，遍历每一聚类并对其进行随机采样一致性处理，对拟合平面进行数据处理，获得拟合平面的法向量n2、该平面所占该类点云的数量比rate及该类点云种子点的高度平均值z2；
[0083]
利用平面法向量判断该聚类拟合的平面与原始地面的夹角是否小于给定角度阈值t_angle，如果满足要求，再判断原始地面平均高度z1与该类点云种子点的高度平均值z2的差值是否小于距离阈值t_distance，同时，判断该聚类拟合平面所占点云的数量比rate是否大于给定比例t_rate，如果满足，则将该聚类拟合平面与原始地面进行拼接，不断地完善地面点云，最终实现斜坡地面的分割及与原始地面的拼接。非地面点云的地面分割及拼接流程如图4所示。
[0084]
实施例2：
[0085]
本发明实施例2提供了一种基于多线激光雷达的斜坡地面点云分割系统，包括：
[0086]
数据获取模块，被配置为：获取多线激光雷达原始点云数据；
[0087]
预处理模块，被配置为：对原始点云数据进行预处理；
[0088]
点云分割模块，被配置为：对预处理后的点云数据进行初步地面分割处理，得到非地面点云；
[0089]
斜坡地面点云获取模块，被配置为：对非地面点云进行欧式聚类，对每一类进行随机采样一致性平面拟合，根据拟合结果筛选得到斜坡地面点云。
[0090]
所述系统的工作方法与实施例1提供的基于多线激光雷达的斜坡地面点云分割方法相同，这里不再赘述。
[0091]
实施例3：
[0092]
本发明实施例3提供了一种计算机可读存储介质，其上存储有程序，该程序被处理器执行时实现如本发明实施例1所述的基于多线激光雷达的斜坡地面点云分割方法中的步骤。
[0093]
实施例4：
[0094]
本发明实施例4提供了一种电子设备，包括存储器、处理器及存储在存储器上并可在处理器上运行的程序，所述处理器执行所述程序时实现如本发明实施例1所述的基于多线激光雷达的斜坡地面点云分割方法中的步骤。
[0095]
本领域内的技术人员应明白，本发明的实施例可提供为方法、系统、或计算机程序产品。因此，本发明可采用硬件实施例、软件实施例、或结合软件和硬件方面的实施例的形
式。而且，本发明可采用在一个或多个其中包含有计算机可用程序代码的计算机可用存储介质(包括但不限于磁盘存储器和光学存储器等)上实施的计算机程序产品的形式。
[0096]
本发明是参照根据本发明实施例的方法、设备(系统)、和计算机程序产品的流程图和/或方框图来描述的。应理解可由计算机程序指令实现流程图和/或方框图中的每一流程和/或方框、以及流程图和/或方框图中的流程和/或方框的结合。可提供这些计算机程序指令到通用计算机、专用计算机、嵌入式处理机或其他可编程数据处理设备的处理器以产生一个机器，使得通过计算机或其他可编程数据处理设备的处理器执行的指令产生用于实现在流程图一个流程或多个流程和/或方框图一个方框或多个方框中指定的功能的装置。
[0097]
这些计算机程序指令也可存储在能引导计算机或其他可编程数据处理设备以特定方式工作的计算机可读存储器中，使得存储在该计算机可读存储器中的指令产生包括指令装置的制造品，该指令装置实现在流程图一个流程或多个流程和/或方框图一个方框或多个方框中指定的功能。
[0098]
这些计算机程序指令也可装载到计算机或其他可编程数据处理设备上，使得在计算机或其他可编程设备上执行一系列操作步骤以产生计算机实现的处理，从而在计算机或其他可编程设备上执行的指令提供用于实现在流程图一个流程或多个流程和/或方框图一个方框或多个方框中指定的功能的步骤。
[0099]
本领域普通技术人员可以理解实现上述实施例方法中的全部或部分流程，是可以通过计算机程序来指令相关的硬件来完成，所述的程序可存储于一计算机可读取存储介质中，该程序在执行时，可包括如上述各方法的实施例的流程。其中，所述的存储介质可为磁碟、光盘、只读存储记忆体(read-only memory，rom)或随机存储记忆体(random accessmemory，ram)等。
[0100]
以上所述仅为本发明的优选实施例而已，并不用于限制本发明，对于本领域的技术人员来说，本发明可以有各种更改和变化。凡在本发明的精神和原则之内，所作的任何修改、等同替换、改进等，均应包含在本发明的保护范围之内。