CN106204705B - 一种基于多线激光雷达的3d点云分割方法 - Google Patents
一种基于多线激光雷达的3d点云分割方法 Download PDFInfo
- Publication number
- CN106204705B CN106204705B CN201610529212.8A CN201610529212A CN106204705B CN 106204705 B CN106204705 B CN 106204705B CN 201610529212 A CN201610529212 A CN 201610529212A CN 106204705 B CN106204705 B CN 106204705B
- Authority
- CN
- China
- Prior art keywords
- point cloud
- cloud data
- point
- grid
- node
- Prior art date
- Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
- Active
Links
Classifications
-
- G—PHYSICS
- G06—COMPUTING; CALCULATING OR COUNTING
- G06T—IMAGE DATA PROCESSING OR GENERATION, IN GENERAL
- G06T15/00—3D [Three Dimensional] image rendering
-
- G—PHYSICS
- G06—COMPUTING; CALCULATING OR COUNTING
- G06T—IMAGE DATA PROCESSING OR GENERATION, IN GENERAL
- G06T17/00—Three dimensional [3D] modelling, e.g. data description of 3D objects
- G06T17/005—Tree description, e.g. octree, quadtree
Landscapes
- Engineering & Computer Science (AREA)
- Physics & Mathematics (AREA)
- Computer Graphics (AREA)
- General Physics & Mathematics (AREA)
- Theoretical Computer Science (AREA)
- Geometry (AREA)
- Software Systems (AREA)
- Optical Radar Systems And Details Thereof (AREA)
- Traffic Control Systems (AREA)
Abstract
本发明公开了一种基于多线激光雷达的3D点云分割方法,包括步骤:1)利用多线激光雷达扫描360°范围内的3D点云数据,建立笛卡尔坐标系OXYZ,将3D点云数据转换到笛卡尔坐标系下,对笛卡尔坐标系下的3D点云数据进行预处理,确定3D点云数据中的感兴趣区域;2)利用近邻点的统计特性滤除感兴趣区域中的悬空障碍点;3)构建极坐标网格地图,将滤除悬空障碍点后的3D点云数据映射到极坐标网格地图中,然后从极坐标网格地图中的3D点云数据中分割出非地面点云数据;4)将非地面点云数据利用八叉树进行体素化,采用基于八叉树体素网格的区域生长方法进行聚类分割。本发明能提高运算效率,检测精度高,可靠性强,可以广泛在车辆环境感知技术领域中应用。
Description
技术领域
本发明涉及雷达点云数据处理技术领域,特别涉及一种基于多线激光雷达3D点云数据的分割方法。
背景技术
近年来,由于Velodyne等3D激光传感器可以获得精确的深度信息并且不受光照、天气变化等复杂环境因素的影响,在无人驾驶车的环境感知、三维重建等领域得到了广泛的应用。利用Velodyne等多线激光传感器对周围场景进行扫描得到的3D点云数据中,包含了传感器周围环境中几乎所有物体的反射数据。通过对扫描得到的点云数据进行相应的处理,就可以达到对扫描场景中障碍物检测和识别的目的。
由于传感器自身的原因偶尔会遇到少数雷达错误反射点,而这些错误点往往是单点孤立存在的;还有一些是悬空小障碍物如悬挂的树枝,小飞虫等等,也会引入一些障碍误检。在无人驾驶车路径规划中,若是碰到这些异常点就会使自主车紧急刹车,致使无人驾驶车辆无法通行的假象,因此需要采用一种有效的方法对采集的点云进行预处理以消除这些异常点,提高检查准确率。
在城市场景中最常见的障碍物有车辆、行人、交通信号灯、建筑物等等,这些障碍物都是建立在地面之上,所以在在对这些目标进行分割之前首先必须将地面提取出来,否则地面点的存在会使所有地面上的物体相互连接在一起,无法完成分割。现有的地面分割方法主要有基于障碍栅格的检测的方法、基于极坐标网格线性拟合、面拟合的方法、基于扫描线梯度的方法。基于障碍栅格的检测方法优点在于将三维信息降低到二维信息,大大降低了传感器数据分析的复杂度和计算量,有较好的稳定性和实时性,但是由于障碍栅格判定和滤波严格,减少了误检点,但是由于雷达点云分布不均匀,特别是在远处,雷达三维点云稀疏,容易导致远处的栅格因部分点云缺少而出现漏检。基于极坐标网格线拟合、面拟合的方法,虽然解决了雷达点云分布不均的影响,但是由于拟合过程需要不断迭代,影响实时性。基于扫描线梯度的方法在点云分割中需要建立复杂的邻域关系和提取复杂的特征,并且基于扫描线梯度的方法,在近处时,由于雷达的分辨率较高,点云密集,当点离得比较近时,只要稍微凸起的高度差就可能得到较大的梯度值,因此在雷达近处的点云分割中有可能将小凸起的地面点误检成障碍点。
在对非地面的点云聚类分割时,最常用的就是分割方式有基于欧式距离的聚类分割、基于k-近邻区域生长的方式、基于栅格投影后采用近邻搜索的方式等,基于欧式距离和k近邻区域生长的方式方法复杂度低、易于实现,但是需要对每个点进行近邻搜索,对于Velodye 等每秒可产生百万点云的深度传感器来说,分割难以满足实时性的要求;对于栅格投影的分割方法,将非地面点投影到平面栅格上,以栅格为聚类对象通过八邻域搜索的方式聚类,避免了对每个点云都进行聚类,对于具有大量点云的数据的聚类来说,提高了计算速度,但是,当多个障碍重叠时(如在树下的车辆),点云的投影会将两个障碍物叠加在一起,难以分开。
发明内容
针对上述现有技术存在的问题或缺陷,本发明的目的在于,提供。一种基于八叉树体素区域生长的点云聚类分割算法。
为了实现上述目的,本发明采用如下技术方案:
一种基于多线激光雷达的3D点云分割方法,包括以下步骤:
步骤1,利用安装在车辆顶部的多线激光雷达扫描360°范围内的3D点云数据,建立笛卡尔坐标系OXYZ,将3D点云数据转换到笛卡尔坐标系下,对笛卡尔坐标系下的3D点云数据进行预处理,确定 3D点云数据中的感兴趣区域;
步骤2,利用近邻点的统计特性滤除所述感兴趣区域中的悬空障碍点;
步骤3,构建极坐标网格地图,将所述的滤除悬空障碍点后的3D 点云数据映射到极坐标网格地图中,然后从极坐标网格地图中的3D 点云数据中分割出非地面点云数据;
步骤4,将所述的非地面点云数据映射到3D体素网格中,对非地面点云数据进行聚类分割。
所述步骤1中,构建所述笛卡尔坐标系OXYZ的具体过程包括:
在多线激光雷达位于水平面上处于静止状态时,以所述激光雷达为中心点,以激光雷达的垂直轴线方向为Z轴,以扫描起始平面的水平射线方向为X轴,Y轴是由Z轴和X轴根据右手螺旋定则确定。
所述步骤1中,对所述笛卡尔坐标系下的3D点云数据进行预处理是指保留范围在-20m<X<20m,-50m<Y<50m,-3m<Z<3m范围内的 3D点云数据。
所述步骤2中,利用近邻点的统计特性滤除所述感兴趣区域中的悬空障碍点:
(2-1)将步骤1得到的感兴趣区域中的3D点云数据以Octree 的数据结构进行存储;
(2-2)将3D点云数据分割为三维阵列,将3D点云数据中的每一点依次作为当前点,在半径为L的360°范围内找到该当前点在8 邻域内所有的3D点云数据记为近邻点;
(2-3)设置阈值Threshold,比较所述的近邻点的个数与阈值 Threshold,若近邻点的个数小于阈值Threshold,则该近邻点对应的当前点为标记为悬空点,并滤除该悬空点。
所述步骤3中,构建所述极坐标网格地图的方法为:
以笛卡尔坐标系OXYZ的原点为中心点,以Z轴为中心对称轴,建立半径为R的极坐标网格地图,将网格地图划分为M个等圆周的扇形,每个扇形的圆周角为:Δα=360°/M。
所述步骤3中,在极坐标网格地图下,从步骤2中得到的滤除悬空障碍点的3D点云数据中分割出非地面点云数据的具体方法过程包括:
(3-1)在所述极坐标网格地图中每个划分的扇形中,将距离极坐标网格地图中心点5至R米范围内的区域划分为N个栅格,栅格的分辨率为Δd=(R-5)/N;
(3-2)计算落入每个栅格内的3D点云数据的最大高度差和平均高度;
(3-3)设置阈值thresh1和thresh2,依次将所有栅格分别作为当前栅格,判断当前栅格内3D点云数据的最大高度差、平均高度与阈值thresh1、thresh2的大小关系,若最大高度差小于thresh1且平均高度也小于thresh2,则当前栅格标记为地面栅格,否则标记为非地面栅格;
(3-4)在以极坐标网格地图中心点为原点半径为20米的圆形区域内,设置阈值thresh3,依次从步骤(3-3)中标记为非地面栅格中选取一个作为当前非地面栅格,若当前非地面栅格3*3邻域内的栅格全部为被标记为地面栅格,且该当前非地面栅格内的3D点云数据个数小于thresh3,则将当前非地面栅格标记为地面栅格;
(3-5)将所有标记为地面栅格内的3D点云数据滤除,剩下3D 点云数据的则为非地面3D点云数据。
进一步地,步骤4中,对非地面点云数据进行聚类分割的具体方法过程包括:
(4-1)采用八叉树数据结构将步骤三得到的非地面3D点云数据体素化,将3D点云数据分割成叶节点,计算每个叶节点的剩余值,并形成叶节点集V;
(4-2)设定循环次数a=1;
(4-3)将剩余值最小的叶节点作为当前种子节点vi,其中vi∈V,设定种子节点集Sc和当前生长节点集Rc,将该当前种子节点vi从V中取出并放入Sc和Rc中;
(4-4)查找当前种子节点的近邻叶节点vj,设定阈值θth,若vj∈V 且vj与vi的法向量夹角小于θth,则将vj从V中取出并放入Rc中;
(4-5)设定阈值rth,若vj的剩余值小于rth,则将vj放入Sc中。
(4-6)将vi从Sc中移除;
(4-7)重复步骤(4-3)、(4-4)、(4-5)、(4-6),直到Sc为空集,将当前生长节点集Rc中的叶节点全部放入至Ra,其中a为循环次数, Ra为第a个分割区域;
(4-8)将a的值加1,重复步骤(4-3)~(4-7),直到V为空集;
(4-9)提取每个分割区域所包含的叶节点中的3D点云数据作为一个障碍物目标,即完成了3D点云数据的聚类分割。
进一步地,步骤(4-1)中将所述的3D点云数据分割成叶节点的具体步骤包括:
(4-1-1)首先在非地面点云数据中分别找出X,Y,Z轴上的最大值 xmax、ymax、zmax和最小值xmin、ymin、zmin,利用该6个值确定一个最小立方体,以所述最小立方体作为根节点或零级节点;
(4-1-2)将根节点分为八个体素,每个体素作为一个子节点进行编码,同时保存每个子节点内的3D点云数据;
(4-1-3)对第i个子节点内的点云数据建立协方差矩阵M,i∈ (1,8),通过对M进行特征值分解,得到M的最小特征值的特征向量,即为第i个子节点的法向量ni;
(4-1-4)利用下式计算第i个子节点的剩余值ri:
其中
dj=(pj-pi),
其中,ni为第i个子节点的法向量,pi为第i个子节点中3D点云数据的中心点,pj为第i个子节点中第j个3D点云数据,m为第i 个子节点所包含的3D点云数据个数;
(4-1-5)设定阈值T,若ri等于0,则所述子节点设为空节点;
否则,若ri小于阈值T或者pi不大于阈值T,则所述子节点为叶节点;
否则,对所述子节点作为新的根节点,依次重复步骤(4-1-2)、 (4-1-3)、(4-1-4)和(4-1-5),直至所述子节点为叶节点为止;
(4-1-6)对步骤(4-1-5)中的所有叶节点进行一次遍历,将所有的空节点删除,对剩余的所有非空叶节点按照其剩余值从小到大进行排序,组成叶节点集V。
本发明有如下特点:
1.本发明提出基于雷达点近邻点的统计特性去除悬浮点的方法简单,滤波效果非常好;
2.本发明采用的地面分割方法通过构建极坐标网格地图,符合多线激光雷达的工作原理,该方法在一定程度上克服了随着距离的增加,激光雷达返回点变得越来越稀疏所带来的数据分布不均的问题, 并且根据每个非地面栅格的八邻域栅格属性滤除了单点障碍栅格。
3.本发明提出的分割方法是八叉树的体素网格为聚类分割对象,采用区域生长的方法大大提高了聚类的速度,在保证精度的同时满足了实时性的要求。
附图说明
图1为本发明的整体流程图;
图2为本发明实施例中采集到的一帧原始点云数据;
图3为本发明实施例中对悬空障碍点的滤除原理示意图;
图4为本发明实施例中3D极坐标网格地图示意图;
图5为本发明实施例中单点滤波原理示意图;
图6为本发明实时例中基于八叉树的区域生长分割示意图
图7为实施例中依照本发明得到路面障碍物点云分割结果图。
具体实施方式
下面结合附图和实施例对本发明进行详细的描述。
本实施例记载了一种基于车载移动平台的多线激光雷达3D点云分割方法,其包括以下步骤:
步骤1,如图1所示,利用安装在车辆顶部的多线激光雷达扫描 360°范围内的3D点云数据,建立笛卡尔坐标系OXYZ,将3D点云数据转换到笛卡尔坐标系下,对笛卡尔坐标系下的3D点云数据进行预处理,确定3D点云数据中的感兴趣区域;
其中,构建所述笛卡尔坐标系OXYZ的具体过程包括:
在多线激光雷达位于水平面上处于静止状态时,以所述激光雷达为中心点,以激光雷达的垂直轴线方向为Z轴,以扫描起始平面的水平射线方向为X轴,Y轴是由Z轴和X轴根据右手螺旋定则确定。
其中,对所述笛卡尔坐标系下的3D点云数据进行预处理是指保留范围在-20m<X<20m,-50m<Y<50m,-3m<Z<3m范围内的3D点云数据。
步骤2,利用近邻点的统计特性滤除所述感兴趣区域中的悬空障碍点,如图3所示为悬空障碍点滤除原理图,其具体步骤包括:
(2-1)将步骤1得到的感兴趣区域中的3D点云数据以Octree 的数据结构进行存储;
(2-2)将3D点云数据分割为三维阵列,将3D点云数据中的每一点依次作为当前点,在半径为L的360°范围内找到该当前点在8 邻域内所有的3D点云数据记为近邻点,其中半径L的取值与多线激光雷达的分辨率有关,一般取值范围为0.3-0.8米,本实施例取0.3;
(2-3)设置阈值Threshold,比较所述的近邻点的个数与阈值 Threshold,若近邻点的个数小于阈值Threshold,则该近邻点对应的当前点为标记为悬空点,并滤除该悬空点,其中阈值Threshold的取值与多线激光雷达的线数有关,一般取值不超过5,本实施例取2。
步骤3,构建极坐标网格地图,将所述的滤除悬空障碍点后的3D 点云数据映射到极坐标网格地图中,然后从极坐标网格地图中的3D 点云数据中分割出非地面点云数据;
其中构建所述极坐标网格地图的方法为:
以笛卡尔坐标系OXYZ的原点为中心点,以Z轴为中心对称轴,建立半径为R的极坐标网格地图,将网格地图划分为M个等圆周的扇形,每个扇形的圆周角为:Δα=360°/M,本实施例中Δα取0.5。
从步骤2中得到的滤除悬空障碍点的3D点云数据中分割出非地面点云数据的具体方法过程包括:
(3-1)在所述极坐标网格地图中每个划分的扇形中,将距离极坐标网格地图中心点5至R米范围内的区域划分为N个栅格,栅格的分辨率为Δd=(R-5)/N,本实例中Δd取0.2米;
(3-2)计算落入每个栅格内的3D点云数据的最大高度差和平均高度;
(3-3)设置阈值thresh1和thresh2,依次将所有栅格分别作为当前栅格,判断当前栅格内3D点云数据的最大高度差、平均高度与阈值thresh1、thresh2的大小关系,若最大高度差小于thresh1且平均高度也小于thresh2,则当前栅格标记为地面栅格,否则标记为非地面栅格,thresh1和thresh2的取值和具体的道路情况有关,城市道路一般取值范围在0.1-0.3米,乡村道路一般取值范围在0.2-0.5米,本实施例针对校园环境,thresh1取0.25米,thresh2取0.15米;
(3-4)在以极坐标网格地图中心点为原点半径为20米的圆形区域内,设置阈值thresh3,依次从步骤(3-3)中标记为非地面栅格中选取一个作为当前非地面栅格,若当前非地面栅格3*3邻域内的栅格全部为被标记为地面栅格,且该当前非地面栅格内的3D点云数据个数小于thresh3,则将当前非地面栅格标记为地面栅格,如图5所示为祛除孤立点云示意图;
(3-5)将所有标记为地面栅格内的3D点云数据滤除,剩下3D 点云数据的则为非地面3D点云数据。
其中,判断每个点云所属扇形和所属扇形中的栅格的方法包括以下步骤:
从X正半轴开始对极坐标网格地图中的M个扇形进行1至M编号,并且针对每个扇形中的N个栅格从极坐标地图中心至Rm处进行1至N编号;
计算所述点云中第i个点与X正半轴的夹角:βi=atan2(yi,xi),则第i个点所属扇形编号为m=βi/Δα;
计算所述点云中第i个点距离原点的距离第i个点所属扇形中的栅格编号为n=(di-5)/Δd;
步骤4,将步骤3中的非地面点云数据利用八叉树进行体素化,采用基于八叉树体素网格的区域生长方法进行聚类分割
其中,对非地面点云数据进行聚类分割的具体方法过程包括:
(4-1)采用八叉树数据结构将步骤三得到的非地面3D点云数据体素化,将3D点云数据分割成叶节点,计算每个叶节点的剩余值,并形成叶节点集V;
(4-1-1)首先在非地面点云数据中分别找出X,Y,Z轴上的最大值 xmax、ymax、zmax和最小值xmin、ymin、zmin,利用该6个值确定一个最小立方体,以所述最小立方体作为根节点或零级节点;
(4-1-2)将根节点分为八个体素,每个体素作为一个子节点进行编码,同时保存每个子节点内的3D点云数据;
(4-1-3)对第i个子节点内的点云数据建立协方差矩阵M,i∈ (1,8),通过对M进行特征值分解,得到M的最小特征值的特征向量,即为第i个子节点的法向量ni;
(4-1-4)利用下式计算第i个子节点的剩余值ri:
其中
dj=(pj-pi),
其中,ni为第i个子节点的法向量,pi为第i个子节点中3D点云数据的中心点,pj为第i个子节点中第j个3D点云数据,m为第i 个子节点所包含的3D点云数据个数;
(4-1-5)设定阈值T,若ri等于0,则所述子节点设为空节点;
否则,若ri小于阈值T或者pi不大于阈值T,则所述子节点为叶节点;本实施例中,T取0.5;
否则,对所述子节点作为新的根节点,依次重复步骤(4-1-2)、 (4-1-3)、(4-1-4)和(4-1-5),直至所述子节点为叶节点为止; (4-1-6)对步骤(4-1-5)中的所有叶节点进行一次遍历,将所有的空节点删除,对剩余的所有非空叶节点按照其剩余值从小到大进行排序,组成叶节点集V。
(4-2)设定循环次数a=1;
(4-3)将剩余值最小的叶节点作为当前种子节点vi,其中vi∈V,设定种子节点集Sc和当前生长节点集Rc,将该当前种子节点vi从V中取出并放入Sc和Rc中;
(4-4)查找当前种子节点的近邻叶节点vj,设定阈值θth,若vj∈V 且vj与vi的法向量夹角小于θth,则将vj从V中取出并放入Rc中;
(4-5)设定阈值rth,若vj的剩余值小于rth,则将vj放入Sc中。
(4-6)将vi从Sc中移除;
(4-7)重复步骤(4-3)、(4-4)、(4-5)、(4-6),直到Sc为空集,将当前生长节点集Rc中的叶节点全部放入至Ra,其中a为循环次数, Ra为第a个分割区域;
(4-8)将a的值加1,重复步骤(4-3)~(4-7),直到V为空集;
(4-9)提取每个分割区域所包含的叶节点中的3D点云数据作为一个障碍物目标,即完成了3D点云数据的聚类分割。
Claims (8)
1.一种基于多线激光雷达的3D点云分割方法,其特征在于,包括以下步骤:
步骤1,利用多线激光雷达扫描360°范围内的3D点云数据,建立笛卡尔坐标系OXYZ,将3D点云数据转换到笛卡尔坐标系下,对笛卡尔坐标系下的3D点云数据进行预处理,确定3D点云数据中的感兴趣区域;
步骤2,利用近邻点的统计特性滤除所述感兴趣区域中的悬空障碍点;
步骤3,构建极坐标网格地图,将所述的滤除悬空障碍点后的3D点云数据映射到极坐标网格地图中,然后从极坐标网格地图中的3D点云数据中分割出非地面点云数据;
步骤4,将步骤3得到的非地面点云数据利用八叉树进行体素化,采用基于八叉树体素网格的区域生长方法进行聚类分割。
2.如权利要求1所述的基于多线激光雷达的3D点云分割方法,其特征在于,所述步骤1中,构建所述笛卡尔坐标系OXYZ的具体过程包括:
在多线激光雷达位于水平面上处于静止状态时,以所述激光雷达为中心点,以激光雷达的垂直轴线方向为Z轴,以扫描起始平面的水平射线方向为X轴,Y轴是由Z轴和X轴根据右手螺旋定则确定。
3.如权利要求2所述的基于多线激光雷达的3D点云分割方法,其特征在于,所述步骤1中,对所述笛卡尔坐标系下的3D点云数据进行预处理是指保留范围在-20m<X<20m,-50m<Y<50m,-3m<Z<3m范围内的3D点云数据。
4.如权利要求1所述的基于多线激光雷达的3D点云分割方法,其特征在于,所述步骤2中,利用近邻点的统计特性滤除所述感兴趣区域中的悬空障碍点的过程包括:
(2-1)将步骤1得到的感兴趣区域中的3D点云数据以Octree的数据结构进行存储;
(2-2)将3D点云数据分割为三维阵列,将3D点云数据中的每一点依次作为当前点,在半径为L的360°范围内找到该当前点在8邻域内所有的3D点云数据记为近邻点;
(2-3)设置阈值Threshold,比较所述的近邻点的个数与阈值Threshold,若近邻点的个数小于阈值Threshold,则该近邻点对应的当前点为标记为悬空点,并滤除该悬空点。
5.如权利要求1所述的基于多线激光雷达的3D点云分割方法,其特征在于,所述步骤3中,构建所述极坐标网格地图的方法为:
以笛卡尔坐标系OXYZ的原点为中心点,以Z轴为中心对称轴,建立半径为R的极坐标网格地图,将网格地图划分为M个等圆周的扇形,每个扇形的圆周角为:Δα=360°/M。
6.如权利要求5所述的基于多线激光雷达的3D点云分割方法,其特征在于,所述步骤3中,在极坐标网格地图下,从步骤2中得到的滤除悬空障碍点的3D点云数据中分割出非地面点云数据的具体方法过程包括:
(3-1)在所述极坐标网格地图中每个划分的扇形中,将距离极坐标网格地图中心点5至R米范围内的区域划分为N个栅格,栅格的分辨率为Δd=(R-5)/N;
(3-2)计算落入每个栅格内的3D点云数据的最大高度差和平均高度;
(3-3)设置阈值thresh1和thresh2,依次将所有栅格分别作为当前栅格,判断当前栅格内3D点云数据的最大高度差、平均高度与阈值thresh1、thresh2的大小关系,若最大高度差小于thresh1且平均高度也小于thresh2,则当前栅格标记为地面栅格,否则标记为非地面栅格;(3-4)在以极坐标网格地图中心点为原点半径为20米的圆形区域内,设置阈值thresh3,依次从步骤(3-3)中标记为非地面栅格中选取一个作为当前非地面栅格,若当前非地面栅格3*3邻域内的栅格全部为被标记为地面栅格,且该当前非地面栅格内的3D点云数据个数小于thresh3,则将当前非地面栅格标记为地面栅格;
(3-5)将所有标记为地面栅格内的3D点云数据滤除,剩下3D点云数据的则为非地面3D点云数据。
7.如权利要求1所述的基于多线激光雷达的3D点云分割方法,其特征在于,所述步骤4中,对非地面点云数据进行聚类分割的具体方法过程包括:
(4-1)采用八叉树数据结构将步骤3得到的非地面3D点云数据体素化,将3D点云数据分割成叶节点,计算每个叶节点的剩余值,并形成叶节点集V;
(4-2)设定循环次数a=1;
(4-3)将剩余值最小的叶节点作为当前种子节点vi,其中vi∈V,设定种子节点集Sc和当前生长节点集Rc,将该当前种子节点vi从V中取出并放入Sc和Rc中;
(4-4)查找当前种子节点的近邻叶节点vj,设定阈值θth,若vj∈V且vj与vi的法向量夹角小于θth,则将vj从V中取出并放入Rc中;
(4-5)设定阈值rth,若vj的剩余值小于rth,则将vj放入Sc中;
(4-6)将vi从Sc中移除;
(4-7)重复步骤(4-3)、(4-4)、(4-5)、(4-6),直到Sc为空集,将当前生长节点集Rc中的叶节点全部放入至Ra,其中a为循环次数,Ra为第a个分割区域;
(4-8)将a的值加1,重复步骤(4-3)~(4-7),直到V为空集;
(4-9)提取每个分割区域所包含的叶节点中的3D点云数据作为一个障碍物目标,即完成了3D点云数据的聚类分割。
8.如权利要求7所述的基于多线激光雷达的3D点云分割方法,其特征在于,步骤(4-1)中将所述的3D点云数据分割成叶节点的具体步骤包括:
(4-1-1)首先在非地面点云数据中分别找出X,Y,Z轴上的最大值xmax、ymax、zmax和最小值xmin、ymin、zmin,利用该6个值确定一个最小立方体,以所述最小立方体作为根节点;
(4-1-2)将根节点分为八个体素,每个体素作为一个子节点进行编码,同时保存每个子节点内的3D点云数据;
(4-1-3)对第i个子节点内的点云数据建立协方差矩阵M,i∈(1,8),通过对M进行特征值分解,得到M的最小特征值的特征向量,即为第i个子节点的法向量ni;
(4-1-4)利用下式计算第i个子节点的剩余值ri:
其中
dj=(pj-pi),
其中,ni为第i个子节点的法向量,pi为第i个子节点中3D点云数据的中心点,pj为第i个子节点中第j个3D点云数据,m为第i个子节点所包含的3D点云数据个数;
(4-1-5)设定阈值T,若ri等于0,则所述子节点设为空节点;
否则,若ri小于阈值T或者pi不大于阈值T,则所述子节点为叶节点;
否则,对所述子节点作为新的根节点,依次重复步骤(4-1-2)、(4-1-3)、(4-1-4)和(4-1-5),直至所述子节点为叶节点为止;
(4-1-6)对步骤(4-1-5)中的所有叶节点进行一次遍历,将所有的空节点删除,对剩余的所有非空叶节点按照其剩余值从小到大进行排序,组成叶节点集V。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201610529212.8A CN106204705B (zh) | 2016-07-05 | 2016-07-05 | 一种基于多线激光雷达的3d点云分割方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201610529212.8A CN106204705B (zh) | 2016-07-05 | 2016-07-05 | 一种基于多线激光雷达的3d点云分割方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN106204705A CN106204705A (zh) | 2016-12-07 |
CN106204705B true CN106204705B (zh) | 2018-12-07 |
Family
ID=57465570
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201610529212.8A Active CN106204705B (zh) | 2016-07-05 | 2016-07-05 | 一种基于多线激光雷达的3d点云分割方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN106204705B (zh) |
Cited By (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US11776143B2 (en) * | 2019-03-28 | 2023-10-03 | Nec Corporation | Foreign matter detection device, foreign matter detection method, and program |
US11902577B2 (en) * | 2019-02-06 | 2024-02-13 | Panasonic Intellectual Property Corporation Of America | Three-dimensional data encoding method, three-dimensional data decoding method, three-dimensional data encoding device, and three-dimensional data decoding device |
Families Citing this family (54)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN108345008A (zh) * | 2017-01-23 | 2018-07-31 | 郑州宇通客车股份有限公司 | 一种目标物检测方法、点云数据提取方法及装置 |
CN106706481A (zh) * | 2017-03-31 | 2017-05-24 | 中国工程物理研究院电子工程研究所 | 一种电极烧蚀颗粒分布测量方法 |
CN107170033A (zh) * | 2017-04-12 | 2017-09-15 | 青岛市光电工程技术研究院 | 基于激光雷达技术的智慧城市3d实景地图*** |
CN107657621B (zh) * | 2017-10-20 | 2021-04-13 | 南京林业大学 | 基于线性区域生长的二维激光点云序列实时分割方法 |
CN109753982B (zh) * | 2017-11-07 | 2021-09-03 | 北京京东乾石科技有限公司 | 障碍点检测方法、装置和计算机可读存储介质 |
US20190197167A1 (en) * | 2017-12-21 | 2019-06-27 | Ford Global Technologies, Llc | Depth-data segmentation |
CN110390706B (zh) * | 2018-04-13 | 2023-08-08 | 北京京东尚科信息技术有限公司 | 一种物体检测的方法和装置 |
US10705534B2 (en) * | 2018-04-19 | 2020-07-07 | Faraday&Future Inc. | System and method for ground plane detection |
CN108828621A (zh) * | 2018-04-20 | 2018-11-16 | 武汉理工大学 | 基于三维激光雷达的障碍检测和路面分割算法 |
US10916014B2 (en) | 2018-06-01 | 2021-02-09 | Ford Global Technologies, Llc | Distinguishing virtual objects from one another |
CN109144097B (zh) * | 2018-08-15 | 2021-04-06 | 广州极飞科技有限公司 | 障碍物或地面识别及飞行控制方法、装置、设备及介质 |
CN109213763B (zh) * | 2018-08-15 | 2020-10-13 | 武汉中海庭数据技术有限公司 | 车载激光扫描点云的组织管理方法及*** |
CN108931983B (zh) * | 2018-09-07 | 2020-04-24 | 深圳市银星智能科技股份有限公司 | 地图构建方法及其机器人 |
CN109633686B (zh) * | 2018-11-22 | 2021-01-19 | 浙江中车电车有限公司 | 一种基于激光雷达侦测地面障碍物的方法及*** |
CN109737974B (zh) * | 2018-12-14 | 2020-11-27 | 中国科学院深圳先进技术研究院 | 一种3d导航语义地图更新方法、装置及设备 |
CN111353969B (zh) * | 2018-12-20 | 2023-09-26 | 长沙智能驾驶研究院有限公司 | 道路可行驶区域的确定方法、装置及计算机设备 |
CN110033457B (zh) * | 2019-03-11 | 2021-11-30 | 北京理工大学 | 一种目标点云分割方法 |
CN110458805B (zh) * | 2019-03-26 | 2022-05-13 | 华为技术有限公司 | 一种平面检测方法、计算设备以及电路*** |
CN110111422B (zh) * | 2019-03-28 | 2023-03-28 | 浙江碧晟环境科技有限公司 | 一种水体底部三角面网构建方法 |
CN110163871B (zh) * | 2019-05-07 | 2021-04-13 | 北京易控智驾科技有限公司 | 一种多线激光雷达的地面分割方法及装置 |
WO2020248118A1 (zh) * | 2019-06-11 | 2020-12-17 | 深圳市大疆创新科技有限公司 | 点云处理方法、***、设备及存储介质 |
CN110458764A (zh) * | 2019-07-08 | 2019-11-15 | 天津大学 | 一种基于形态学图形处理的点云数据平滑方法 |
CN110674705B (zh) * | 2019-09-05 | 2022-11-29 | 北京智行者科技股份有限公司 | 基于多线激光雷达的小型障碍物检测方法及装置 |
CN110807412B (zh) * | 2019-10-30 | 2022-09-23 | 驭势科技(北京)有限公司 | 一种车辆激光定位的方法、车载设备和存储介质 |
CN110764108B (zh) * | 2019-11-05 | 2023-05-02 | 畅加风行(苏州)智能科技有限公司 | 一种用于港口自动驾驶场景的障碍物检测方法及装置 |
CN111080659A (zh) * | 2019-12-19 | 2020-04-28 | 哈尔滨工业大学 | 一种基于视觉信息的环境语义感知方法 |
WO2021134339A1 (zh) * | 2019-12-30 | 2021-07-08 | 深圳元戎启行科技有限公司 | 基于点云的分割处理方法、装置、计算机设备和存储介质 |
CN111192310A (zh) * | 2019-12-31 | 2020-05-22 | 武汉中海庭数据技术有限公司 | 基于激光点云的高速地面快速提取***及方法 |
CN113077473B (zh) * | 2020-01-03 | 2024-06-18 | 广州汽车集团股份有限公司 | 三维激光点云路面分割方法、***、计算机设备及介质 |
CN111275810B (zh) * | 2020-01-17 | 2022-06-24 | 五邑大学 | 基于图像处理的k近邻点云滤波方法、装置和存储介质 |
CN111308499A (zh) * | 2020-03-09 | 2020-06-19 | 中振同辂(江苏)机器人有限公司 | 一种基于多线激光雷达的障碍物检测方法 |
CN113496491B (zh) * | 2020-03-19 | 2023-12-15 | 广州汽车集团股份有限公司 | 一种基于多线激光雷达的路面分割方法及装置 |
CN111738945B (zh) * | 2020-06-15 | 2023-11-10 | 鞍钢集团矿业有限公司 | 一种基于矿山的点云数据预处理方法 |
CN112070770B (zh) * | 2020-07-16 | 2022-11-01 | 国网安徽省电力有限公司超高压分公司 | 一种高精度三维地图与二维栅格地图同步构建方法 |
CN112199991B (zh) * | 2020-08-27 | 2024-04-30 | 广州中国科学院软件应用技术研究所 | 一种应用于车路协同路侧感知的仿真点云滤波方法和*** |
CN112180343A (zh) * | 2020-09-30 | 2021-01-05 | 东软睿驰汽车技术(沈阳)有限公司 | 激光点云数据处理方法、装置、设备及无人驾驶*** |
CN112365592B (zh) * | 2020-11-10 | 2022-09-20 | 大连理工大学 | 一种基于双向高程模型的局部环境特征描述方法 |
CN112446907B (zh) * | 2020-11-19 | 2022-09-06 | 武汉中海庭数据技术有限公司 | 一种单线点云与多线点云配准的方法及装置 |
CN112904306A (zh) * | 2021-01-18 | 2021-06-04 | 深圳市普渡科技有限公司 | 斜坡感知方法、装置、机器人和存储介质 |
CN112907685A (zh) * | 2021-02-05 | 2021-06-04 | 泉州装备制造研究所 | 一种点云极坐标编码方法及装置 |
CN113031004B (zh) * | 2021-03-05 | 2024-04-16 | 西北工业大学 | 基于三维激光雷达的无人船水面目标检测及路径规划方法 |
CN113031010B (zh) * | 2021-03-31 | 2023-04-28 | 小马易行科技(上海)有限公司 | 检测天气的方法、装置、计算机可读存储介质与处理器 |
CN113177966B (zh) * | 2021-04-15 | 2022-06-28 | 中国科学院上海光学精密机械研究所 | 基于速度聚类统计的三维扫描相干激光雷达点云处理方法 |
CN113340266A (zh) * | 2021-06-02 | 2021-09-03 | 江苏豪杰测绘科技有限公司 | 一种室内空间测绘***及方法 |
CN113518226A (zh) * | 2021-06-29 | 2021-10-19 | 福州大学 | 一种基于地面分割的g-pcc点云编码改进方法 |
CN113640822B (zh) * | 2021-07-07 | 2023-08-18 | 华南理工大学 | 一种基于非地图元素过滤的高精度地图构建方法 |
CN114488073A (zh) * | 2022-02-14 | 2022-05-13 | 中国第一汽车股份有限公司 | 激光雷达采集到的点云数据的处理方法 |
CN114384491B (zh) * | 2022-03-24 | 2022-07-12 | 北京一径科技有限公司 | 用于激光雷达的点云处理方法及装置、存储介质 |
CN114384492B (zh) * | 2022-03-24 | 2022-06-24 | 北京一径科技有限公司 | 用于激光雷达的点云处理方法及装置、存储介质 |
CN114815821B (zh) * | 2022-04-19 | 2022-12-09 | 山东亚历山大智能科技有限公司 | 基于多线激光雷达的室内自适应全景避障方法及*** |
CN115236674B (zh) * | 2022-06-15 | 2024-06-04 | 北京踏歌智行科技有限公司 | 一种基于4d毫米波雷达的矿区环境感知方法 |
CN114755695B (zh) * | 2022-06-15 | 2022-09-13 | 北京海天瑞声科技股份有限公司 | 关于激光雷达点云数据的路面检测方法、装置及介质 |
CN115082641B (zh) * | 2022-08-19 | 2022-12-02 | 航天宏图信息技术股份有限公司 | 一种基于网格化多邻域插值的点云栅格化方法及装置 |
CN116071571B (zh) * | 2023-03-03 | 2023-07-14 | 北京理工大学深圳汽车研究院(电动车辆国家工程实验室深圳研究院) | 一种鲁棒快速的车用单线激光雷达点云聚类方法 |
Citations (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US8294712B2 (en) * | 2003-09-19 | 2012-10-23 | The Boeing Company | Scalable method for rapidly detecting potential ground vehicle under cover using visualization of total occlusion footprint in point cloud population |
CN103226833A (zh) * | 2013-05-08 | 2013-07-31 | 清华大学 | 一种基于三维激光雷达的点云数据分割方法 |
CN103745459A (zh) * | 2013-12-26 | 2014-04-23 | 西安交通大学 | 一种非结构化点云特征点检测方法及其提取方法 |
-
2016
- 2016-07-05 CN CN201610529212.8A patent/CN106204705B/zh active Active
Patent Citations (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US8294712B2 (en) * | 2003-09-19 | 2012-10-23 | The Boeing Company | Scalable method for rapidly detecting potential ground vehicle under cover using visualization of total occlusion footprint in point cloud population |
CN103226833A (zh) * | 2013-05-08 | 2013-07-31 | 清华大学 | 一种基于三维激光雷达的点云数据分割方法 |
CN103745459A (zh) * | 2013-12-26 | 2014-04-23 | 西安交通大学 | 一种非结构化点云特征点检测方法及其提取方法 |
Non-Patent Citations (5)
Title |
---|
Fast Segmentation of 3D Point Clouds for Ground Vehicles;M.Himmelsbach et al.;《2010 IEEE Intelligent Vehicles Symposium 》;20100624;第560-565页 * |
Octree-based region growing for point cloud segmentation;Anh-Vu Vo et al.;《ISPRS Journal of Photogrammetry and Remote Sensing》;20150324;第104卷;第88-100页 * |
Octree-based segmentation for terrestrial LiDAR point cloud data in industrial applications;Yun-Ting Su et al.;《ISPRS Journal of Photogrammetry and Remote Sensing》;20160119;第113卷;第59-74页 * |
机载激光雷达点云数据滤波算法的研究与应用;周晓明;《中国博士学位论文全文数据库 信息科技辑》;20120715;第四章 * |
采用局部凸性和八叉树的点云分割;傅欢 等;《西安交通大学学报》;20121031;第46卷(第10期);第60-65页 * |
Cited By (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US11902577B2 (en) * | 2019-02-06 | 2024-02-13 | Panasonic Intellectual Property Corporation Of America | Three-dimensional data encoding method, three-dimensional data decoding method, three-dimensional data encoding device, and three-dimensional data decoding device |
US11776143B2 (en) * | 2019-03-28 | 2023-10-03 | Nec Corporation | Foreign matter detection device, foreign matter detection method, and program |
Also Published As
Publication number | Publication date |
---|---|
CN106204705A (zh) | 2016-12-07 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN106204705B (zh) | 一种基于多线激光雷达的3d点云分割方法 | |
CN106842231B (zh) | 一种道路边界检测及跟踪方法 | |
CN110781827B (zh) | 一种基于激光雷达与扇状空间分割的路沿检测***及其方法 | |
CN111928862B (zh) | 利用激光雷达和视觉传感器融合在线构建语义地图的方法 | |
CN110084272B (zh) | 一种聚类地图创建方法及基于聚类地图和位置描述子匹配的重定位方法 | |
CN101975951B (zh) | 一种融合距离和图像信息的野外环境障碍检测方法 | |
CN109144072A (zh) | 一种基于三维激光的机器人智能避障方法 | |
CN108171131B (zh) | 基于改进MeanShift的Lidar点云数据道路标识线提取方法 | |
CN106570454B (zh) | 基于移动激光扫描的行人交通参数提取方法 | |
CN106199558A (zh) | 障碍物快速检测方法 | |
CN109509256A (zh) | 基于激光雷达的建筑结构自动测量及3d模型生成方法 | |
CN106780524A (zh) | 一种三维点云道路边界自动提取方法 | |
CN109270544A (zh) | 基于杆状物识别的移动机器人自定位*** | |
CN108564650B (zh) | 基于车载2D LiDAR点云数据的行道树靶标识别方法 | |
CN113009453B (zh) | 矿山路沿检测及建图方法及装置 | |
CN108764012A (zh) | 基于多帧联合的车载激光雷达数据的城市道路杆状物识别算法 | |
CN110910407B (zh) | 基于移动激光扫描点云数据的行道树树干提取方法 | |
Zhang et al. | Rapid inspection of pavement markings using mobile LiDAR point clouds | |
WO2023060632A1 (zh) | 基于点云数据的街景地物多维度提取方法和*** | |
CN116109601A (zh) | 一种基于三维激光雷达点云的实时目标检测方法 | |
CN114782729A (zh) | 一种基于激光雷达与视觉融合的实时目标检测方法 | |
Qian et al. | Hy-Seg: A hybrid method for ground segmentation using point clouds | |
Sun et al. | Objects detection with 3-D roadside LiDAR under snowy weather | |
CN111861946B (zh) | 自适应多尺度车载激光雷达稠密点云数据滤波方法 | |
Boerner et al. | Voxel based segmentation of large airborne topobathymetric lidar data |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
C06 | Publication | ||
PB01 | Publication | ||
C10 | Entry into substantive examination | ||
SE01 | Entry into force of request for substantive examination | ||
GR01 | Patent grant | ||
GR01 | Patent grant |