一种基于均匀采样的固态激光雷达地面分割方法及系统与流程

摘要: 本技术涉及激光雷达点云处理,尤其涉及一种基于均匀采样的固态激光雷达地面分割方法及系统。背景技术:1、随着移动机器人及智能感知设备的发展,固态激光雷达被广泛用于环...
一种基于均匀采样的固态激光雷达地面分割方法及系统与流程

本技术涉及激光雷达点云处理,尤其涉及一种基于均匀采样的固态激光雷达地面分割方法及系统。

背景技术:

1、随着移动机器人及智能感知设备的发展,固态激光雷达被广泛用于环境感知和障碍物检测。固态激光雷达采集的点云中通常包含大量地面点云,在进行障碍物识别前,需要对地面点云与非地面点云进行分割。相较于机械旋转式激光雷达,固态激光雷达通常采用前向阵列式探测方式,其点云空间分布特征与机械旋转式激光雷达存在差异,传统基于同心圆区域划分的地面分割方式难以直接适配。

2、同时,实际地面可能包括平坦地面、坡面、草地及砂石地面等多种形态,不同地面的平面度、高度波动和倾斜程度存在差异,单一特征难以实现稳定判断;且直接利用局部区域内全部点云进行特征计算,会增加计算量。因此,如何降低固态激光雷达地面分割的计算负担,并提高复杂地面条件下的分割可靠性,仍是需要解决的技术问题。

技术实现思路

1、为至少在一定程度上克服相关技术中固态激光雷达地面分割计算量较大且复杂地面条件下分割可靠性不足的问题,本技术提供一种基于均匀采样的固态激光雷达地面分割方法及系统。

2、本技术的方案如下:

3、根据本技术实施例的第一部分,提供一种基于均匀采样的固态激光雷达地面分割方法,包括:

4、获取固态激光雷达采集的待处理点云数据及所述固态激光雷达的安装参数;

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、其中,所述处理器,用于调用并执行所述存储器中存储的程序;

45、所述存储器,用于存储程序,所述程序至少用于执行如以上任一项所述的一种基于均匀采样的固态激光雷达地面分割方法。

46、本技术提供的技术方案可以包括以下有益效果:

47、本技术通过根据固态激光雷达的探测特性对候选点云进行空间栅格划分,并进一步依据距离分辨率将各空间栅格划分为多个等面积采样单元,从不同等面积采样单元中选取候选点云点形成空间均匀采样点集,使参与平面拟合及主成分分析的点云在空间上分布更加均衡,在保留局部地面几何特征的同时减少参与计算的点云数量,从而降低地面分割过程的计算量。进一步地,通过联合利用空间栅格的平面度、高度均值与地面高度范围之间的关系、高度方差以及拟合平面法线与铅直方向之间的夹角进行地面判定,使地面识别不依赖单一几何特征,能够适应平坦地面、连续坡面及具有一定起伏的粗糙地面等不同地面形态,提高固态激光雷达在复杂地面环境下地面点云分割的准确性和可靠性。

48、应当理解的是,以上的一般描述和后文的细节描述仅是示例性和解释性的,并不能限制本技术。