CN106650640B - 一种基于激光雷达点云局部结构特征的负障碍物检测方法 - Google Patents
一种基于激光雷达点云局部结构特征的负障碍物检测方法 Download PDFInfo
- Publication number
- CN106650640B CN106650640B CN201611101791.2A CN201611101791A CN106650640B CN 106650640 B CN106650640 B CN 106650640B CN 201611101791 A CN201611101791 A CN 201611101791A CN 106650640 B CN106650640 B CN 106650640B
- Authority
- CN
- China
- Prior art keywords
- point
- grid
- laser
- point cloud
- candidate
- 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.)
- Expired - Fee Related
Links
- 238000001514 detection method Methods 0.000 title claims abstract description 35
- 238000000034 method Methods 0.000 claims abstract description 53
- 238000001914 filtration Methods 0.000 claims abstract description 15
- 238000012216 screening Methods 0.000 claims abstract description 6
- 238000000605 extraction Methods 0.000 claims abstract description 4
- 239000013598 vector Substances 0.000 claims description 47
- 230000009191 jumping Effects 0.000 claims description 12
- 238000012545 processing Methods 0.000 claims description 11
- 238000009499 grossing Methods 0.000 claims description 10
- 239000011159 matrix material Substances 0.000 claims description 4
- 239000000126 substance Substances 0.000 claims description 4
- 230000007704 transition Effects 0.000 claims description 4
- 230000000717 retained effect Effects 0.000 claims description 3
- 210000000746 body region Anatomy 0.000 claims 2
- 230000004888 barrier function Effects 0.000 abstract description 2
- 238000005286 illumination Methods 0.000 description 7
- 238000010586 diagram Methods 0.000 description 3
- 238000002474 experimental method Methods 0.000 description 3
- 230000000694 effects Effects 0.000 description 2
- 230000004927 fusion Effects 0.000 description 2
- 238000009434 installation Methods 0.000 description 2
- 238000009877 rendering Methods 0.000 description 2
- 238000012549 training Methods 0.000 description 2
- 230000009286 beneficial effect Effects 0.000 description 1
- 238000007796 conventional method Methods 0.000 description 1
- 230000007547 defect Effects 0.000 description 1
- 239000000284 extract Substances 0.000 description 1
- 230000035040 seed growth Effects 0.000 description 1
- 230000003068 static effect Effects 0.000 description 1
- 238000012876 topography Methods 0.000 description 1
Images
Classifications
-
- G—PHYSICS
- G06—COMPUTING; CALCULATING OR COUNTING
- G06V—IMAGE OR VIDEO RECOGNITION OR UNDERSTANDING
- G06V20/00—Scenes; Scene-specific elements
- G06V20/50—Context or environment of the image
- G06V20/56—Context or environment of the image exterior to a vehicle by using sensors mounted on the vehicle
- G06V20/58—Recognition of moving objects or obstacles, e.g. vehicles or pedestrians; Recognition of traffic objects, e.g. traffic signs, traffic lights or roads
-
- G—PHYSICS
- G06—COMPUTING; CALCULATING OR COUNTING
- G06F—ELECTRIC DIGITAL DATA PROCESSING
- G06F18/00—Pattern recognition
- G06F18/20—Analysing
- G06F18/23—Clustering techniques
Landscapes
- Engineering & Computer Science (AREA)
- Data Mining & Analysis (AREA)
- Theoretical Computer Science (AREA)
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Bioinformatics & Cheminformatics (AREA)
- Computer Vision & Pattern Recognition (AREA)
- Evolutionary Biology (AREA)
- Evolutionary Computation (AREA)
- Bioinformatics & Computational Biology (AREA)
- General Engineering & Computer Science (AREA)
- Artificial Intelligence (AREA)
- Life Sciences & Earth Sciences (AREA)
- Multimedia (AREA)
- Traffic Control Systems (AREA)
- Optical Radar Systems And Details Thereof (AREA)
Abstract
本发明公开了一种基于激光雷达点云局部结构特征的负障碍物检测方法。已采集的激光雷达点云数据,逐线检测局部点云距离跳变、局部点云分布密集和局部点云高度下降的三个结构特征,依据三个结构特征在单线激光点云中提取筛选获得可能属于负障碍物的候选点对;由各线激光的激光点云获得的所有候选点对,依据点对长度一致性和空间位置一致性进行聚类,得到负障碍物候选区域,再经过面积过滤、点对数量过滤得到负障碍物区域。本发明能够有效检测环境中的负障碍物,具备良好的检测成功率,计算代价小,实时性强。
Description
技术领域
本发明涉及机器人避障检测方法,特别是涉及面向无人车导航的一种基于激光雷达点云局部结构特征的负障碍物检测方法。
背景技术
传统的用于负障碍物检测的方法有基于热红外图像、基于彩色图像和基于双目视觉的检测方法。基于热红外图像的负障碍物检测方法使用热红外相机采集图像,根据负障碍物与环境温度存在温差的特点检测环境中的负障碍物。这种检测方法的缺点是对环境温度变化十分敏感。基于彩色图像的负障碍物检测方法使用彩色相机采集图像,在图像序列中提取颜色模型和几何模型检测负障碍物,这种方法受光照条件影响强烈。基于双目视觉的方法使用双目图像并利用种子生长法检测负障碍物,这种方法同样受到光照条件影响。除了受到光照条件影响,传统使用单相机图像的负障碍物检测方法无法确定负障碍物的实际距离,使用双目视觉的负障碍物检测方法虽然能计算距离,但也存在精度不高的缺点。
为解决使用传统图像检测负障碍物易受到光照条件影响以及无法准确定位的问题,在无人车导航领域一类方法是使用三维激光雷达作为导航传感器。
三维激光雷达能够获取环境的点云数据,探测范围广,精度高,且不受光照条件影响,能够精确描述环境结构信息。
目前基于激光雷达检测负障碍物有基于多帧融合的检测方法和基于SVM分类的方法。
多帧融合的负障碍物检测方法通过融合多帧点云得到高密度局部地图,进而通过遮挡关系确定负障碍物位置。这种方法对静态环境中的负障碍检测效果较好,但计算复杂度高且不适用于环境中存在大量运动物体的情况。
基于SVM的负障碍物检测方法通过计算点云的局部特征,例如高度-长度-密度特征,再通过大量样本训练得到负障碍物分类器,进而用于对候选负障碍物点云的分类与位置检测。这种方法缺点在于需要预先进行大量样本训练,并且对未训练过的负障碍物种类的检测效果较差。
发明内容
在无人车越野行驶环境中,存在沟壑、坑洞等负障碍物,本发明的目的在于提供了一种基于激光雷达点云局部结构特征的负障碍物检测方法,即利用垂直扫描激光雷达点云的局部结构特征提取负障碍物候选点对,进而聚类形成负障碍物候选区域,最后进行过滤得到负障碍物结果。
本发明所述的负障碍物检测方法采取先在单线激光点云中提取候选点对,再将多线激光提取的候选点对集合进行聚类的方案。首先是计算了点云中负障碍物的三类结构特征,即局部点云距离跳变、局部点云分布密集和局部点云高度下降。根据三类结构特征提取出负障碍物候选点对,通过空间位置一致性和点对长度一致性聚类得到负障碍物候选区域,通过面积过滤、点对数量过滤得到负障碍物结果区域。
本发明采用的具体技术方案包括如下步骤:
1)已采集的激光雷达点云数据,针对单线激光点云,逐线检测局部点云距离跳变、局部点云分布密集和局部点云高度下降的三个结构特征,依据三个结构特征在单线激光点云中提取筛选获得可能属于负障碍物的候选点对;
2)由各线激光的激光点云获得的所有候选点对,依据点对长度一致性和空间位置一致性进行聚类,得到一系列负障碍物候选区域,再经过面积过滤得到负障碍物区域。
本发明的负障碍物一般指的是地面上的凹坑、壕沟等障碍物。
本发明涉及的点云数据由激光雷达采集得到,激光雷达为多线激光旋转扫描的工作方式,一根激光线对应一段连续分布的点云。
所述步骤1)具体是针对单线激光点云,采用以下方式进行处理:
1.1)逐激光点计算邻近点间距与局部平滑度,并根据局部平滑度判断获得平滑点;
1.2)逐激光点通过检测局部点云距离跳变特征选取邻近点间距局部极大值的候选点对,作为初始候选点对;
1.3)在初始候选点对中,通过检测局部点云分布密集特征选取初始候选点对中后沿点所在位置点云局部密集的点对,获得筛选后的初始候选点对;
1.4)通过局部点云高度下降特征进行进一步筛选,获得最终的候选点对。
经过步骤1.4)得到的点对即是满足负障碍物三个局部结构特征,即邻接点距离跳变、后沿点密集分布、后沿点高度下降的候选点对集合。
所述步骤1.1)具体为:
1.1.1)计算邻近点间距
1.1.2)计算局部平滑度
除邻近点间距外,还需要计算单线激光点云的局部平滑度。对于单线激光而言,其扫描方式为平面扫描,因而单线激光扫描局部地形所形成的点云可看做该扫描平面与地面的交线。在平坦的地面上,该交线呈直线分布,在地形起伏剧烈的地面上,该交线则呈现出蜿蜒曲折的折线形状。基于此,采用以下公式计算单线激光点云中每个激光点的局部平滑度sl:
式中,Nneighbor表示预设的邻近点个数,一般取n=5,l表示单线激光点云中的激光点序号,k表示该激光点的邻近点的序号;
上述的sl大小体现了该激光点局部区域的平滑度,sl值非常小表明该激光点处于平滑的近似平面上,sl值非常大表明该激光点所处的位置地形起伏剧烈。
预设平滑阈值Thssmooth和非平滑阈值Thssharp,通过将激光点的局部平滑度sl分别与平滑阈值Thssmooth和非平滑阈值Thssharp进行比较获得激光点是否为平滑点的结果:若满足sl≤Thssmooth,该激光点为平滑点;若满足sl≥Thssharp,该激光点为非平滑点。
所述步骤1.2)具体是:对于单线激光点云上的各激光点,按以下公式处理并提取获得邻近点间距跳变点集合Pjump:
式中,Njump_nbr表示预设的邻近点个数,Thsdis为邻近点间距跳变阈值,l表示单线激光点云中的激光点序号,k表示该激光点的邻近点的序号;
邻近点间距跳变点集合Pjump中的点是作为候选点对中的后沿点,候选点对中包括前沿点和后沿点,前沿点是序号靠前的激光点,后沿点是序号靠后的激光点,判断负障碍往往需要前后沿的点对,因此再取邻近点间距跳变点集合Pjump中的每个激光点作为后沿点,其在单线激光点云中之前的一个激光点作为前沿点,形成邻近点间距跳变点对并获得邻近点间距跳变点对集合Pneg_pair,具体是采用以下公式:
式中,l表示单线激光点云中的激光点序号。
以邻近点间距跳变点对集合Pneg_pair中的邻近点间距跳变点对作为初始候选点对。
所述的步骤1.3)具体为:将初始候选点对投影到激光雷达点云空间所对应的栅格属性地图上,每个栅格统计落在该栅格内激光点的数目,针对初始候选点对的后沿点判断是否满足以下公式:
PtNum(k,l)-PtNum(m,n)≥Thsdense
m∈[k-Ngrid,k+Ngrid],m≠k
n∈[l-Ngrid,l+Ngrid],n≠l
式中,Ngrid表示预设栅格邻近距离,PtNum(k,l)表示当前栅格中包含的所有激光点总数,PtNum(m,n)表示当前栅格在预设栅格邻近距离Ngrid邻域内的一栅格内包含的所有激光点总数,Thsdense是预设的点云密集阈值,当前栅格是指初始候选点对的后沿点所在的栅格,m、n分别表示当前栅格在预设栅格邻近距离Ngrid邻域内的栅格行号与列号。
初始候选点对的后沿点满足公式,则认为满足局部点云分布密集特征,将该初始候选点对保留,继续下一步的处理;否则,将该初始候选点对舍弃,不继续下一步的处理。
所述步骤1.4)具体为:
对于步骤1.3)筛选后的每个初始候选点对,选取后沿点前方的Nline个平滑点形成平滑点集Plocal_smooth,Nline表示选取的平滑点总数,为预设值,将滑点集Plocal_smooth中的所有平滑点通过最小二乘法进行直线拟合获得直线方程;
再将后沿点空间坐标[xl,yl,zl]中位于水平平面的x,y坐标代入直线方程,并与后沿点的z坐标相比较,具体是采用以下公式进行判断筛选:
式中,dzl是筛选后的初始候选点对前方的平滑点拟合直线在后沿点处的估计高度与实际高度之差,Thsz为预设的候选点对后沿点高度下降阈值,l表示候选点对序号;
若满足上述公式,则表明该后沿点位于直线的下方,满足局部点云高度下降特征,保留该后沿点所在的初始候选点对,继续下一步的处理;否则,将该后沿点所在的初始候选点对舍弃,不继续下一步的处理。
本发明的激光点云空间的xyz坐标中,x是沿朝车辆的右方向,y是沿朝车辆的正前方向,z是沿垂直于底面朝向正上方向。
所述的直线方程采用以下方式拟合计算得到:
设空间直线经过点[x0,y0,0],方向向量为[a,b,1],则空间直线方程表示为:
其中,a、b分别表示空间直线的归一化的方向向量在x、y坐标轴的两个分量,x0、y0分别表示空间直线经过点的坐标的x、y坐标轴的两个分量。
上述方程写成矩阵形式为:
将这Nline个平滑点代入上述矩阵,得到:
化简得到:
上式中,l是平滑点序号;
解出上述a、b、x0、y0即求出直线方程。
所述的步骤2)中聚类具体为:
2.1)将步骤1)获得各线激光点云中的候选点对进行合并,然后采用以下方式进行聚类,聚类过程在栅格属性地图上进行,栅格属性地图中的坐标具有行u与列v,将候选点对投影到栅格属性地图上获得对应的栅格点对,栅格点对由前沿栅格点pfront和后沿栅格点pback构成;
取前沿栅格点pfront和后沿栅格点pback之间的中点表示该候选点对在栅格属性地图上的空间位置:
其中,u、v分别表示该候选点对在栅格属性地图上的行坐标和列坐标,ufront、vfront分别表示前沿栅格点pfront在栅格属性地图上的行坐标和列坐标,uback、vback分别表示后沿栅格点pback在栅格属性地图上的行坐标和列坐标;
采用以下公式取前沿栅格点pfront和后沿栅格点pback之间的距离表示候选点对的点对长度w:
其中,Npars表示步骤1)获得所有线激光上的候选点对总数;
2.3)使用均值偏移的方法进行聚类:
初始的质心向量集合Gcenters满足Gcenters=Gpars;
其中,为高斯核函数,l、k均为质心向量的序号,h为预先设定的核函数带宽;
其中,h为核函数带宽;
从而得到加权质心向量集合Gshfts:
2.4)对加权质心向量集合Gshfts中的每个加权质心向量,采用以下公式计算其与其对应的质心向量之间的欧氏距离Dshftl:
式中,l表示加权质心向量的序号。将欧氏距离Dshftl与误差阈值Epsilon采用以下公式相比较,判断获得质心向量是否达到局部概率密度极大条件:
Dshftl≤Epsilon
2.5)重复步骤2.2)-2.4),直到所有候选点对的向量对应的所有质心向量均达到局部概率密度极大条件,即对任意i∈{0,1,…,Npairs-1},均满足Dshifti≤Epsilon;
所述步骤1.3)或者步骤2.1)中的栅格属性地图具体是:栅格属性地图为基于大地平面假设,将激光雷达点云空间所在的x-y水平平面分割成大小相等的栅格,每个栅格尺寸为gridsize×gridsize,激光雷达点云空间的三维激光点坐标投影到栅格属性地图所在的栅格坐标(row,col)为:
其中,row、col分别表示该三维激光点投影到栅格属性地图所在的栅格坐标的行号与列号,Yoffset、Xoffset分别表示预设的偏移量;
并且每一个栅格包含车体区域标志位isCar、负障碍物标志位isNegObs和栅格内点云数目PtNum(row,col)的属性。本发明将负障碍物区域使用栅格属性地图来呈现,属性为负障碍的栅格表示负障碍物所在位置。
所述的步骤2)中过滤具体为:得到负障碍的若干聚类之后,还需进行过滤操作。通常认为负障碍物应当大于一定尺寸以排除点云稀疏造成的误判。负障碍物区域的面积尺寸由两个值描述:该类中的候选点对个数Numpar,以及候选点对构成多边形的面积Areaneg,多边形为该类中候选点对的所有点的最小外接多边形。由同一类的所有候选点对所形成的区域作为负障碍物候选区域,遍历所有负障碍物候选区域,采用以下公式判断是否满足:
Numpar≥Thsnum
Areaneg≥Thsarea
式中,Numpar表示负障碍物候选区域中所有候选点对的总对数,Areaneg表示负障碍物候选区域中所有候选点对构成多边形的面积,多边形为包围在负障碍物候选区域中所有候选点对外的最小外接多边形,Thsnum为区域候选点对数量阈值,Thsarea为负障碍物在栅格属性地图中形成多边形的面积阈值;
若同时满足以上两个条件,则负障碍物候选区域保留,为最终的负障碍物区域;
若不同时满足以上两个条件,则负障碍物候选区域舍弃,不为最终的负障碍物区域。
与背景技术比较,本发明具有的有益效果是:
1)本发明不依赖彩色相机、红外相机等二维传感器,因此检测结果不受光照条件的影响;
2)本发明使用激光雷达传感器检测负障碍物,能够直接测量负障碍物的距离,检测结果位置精度高;
3)本发明先将大规模点云提取出小数量的候选点对集合,从小数量的候选点对中进行负障碍物聚类,相比直接使用图像数据建模的计算复杂度更低,实时性更强;
附图说明
图1是本发明方法的流程图。
图2是垂直扫描激光雷达的安装侧视图。
图3是垂直扫描激光雷达的安装俯视图。
图4是本发明的典型使用场景,其中左上是点云俯视图,右上是场景实拍图像,右中为栅格属性地图,下方是对应点云三维渲染图。
图5是对典型场景点云实施本发明内容(1.1)计算邻近点间距(左图)与局部平滑度(右图)之结果,越亮表示值越大。其中P1、P2、P3、P4、P5是负障碍物候选点对的后沿点,可见在负障碍物候选点对中后沿点的邻近点间距为局部极大值,负障碍物候选点对前方点云的局部平滑度较小,属于平滑点。
图6是对典型场景点云实施本发明内容(1.4)拟合直线的结果,P6、P7、P8、P9、P10为负障碍物候选点对前方的5个平滑点,白色长虚线为这5个平滑点拟合的直线,可见负障碍物候选点对中后沿点相对拟合直线呈现高度下降特征。
图7是对典型场景点云实施本发明内容(1)、(2)提取负障碍物候选点对与聚类后的结果。左图为提取获得的负障碍物候选点对,用白色线段标出,右图为聚类结果,用序号标识。
图8是对典型场景点云实施本发明内容(2)过滤负障碍物候选区域的结果。左图为过滤结果,只有0号和1号两个负障碍物候选区域保留下来,右上为场景实拍图像,右下为对应栅格属性地图,可见只保留过滤后的两个负障碍物区域。
图9是对4个野外场景点云实施本发明负障碍物检测方法的结果图。对每一张子图,左边是提取的负障碍物候选点对的聚类结果,右上为场景实拍图像,右下为对应的栅格属性地图,其中标识出过滤后输出的负障碍物区域。
具体实施方式
下面结合附图和实施例对本发明做进一步说明。
如图1所示,本发明方法的实施例及其实施过程如下:
以一个典型的包含负障碍的场景例子来更清楚地表示本发明的过程。
实施例的点云数据由车辆前部安装的两个激光雷达采集得到,两个激光雷达布置方式和采集方式如图2和图3所示,激光雷达为多线激光旋转扫描的工作方式,一根激光线对应一段连续分布的点云。
场景示意见图4,其中左上为激光雷达点云俯视图,右上为场景实拍图像,右中为对应的栅格属性地图,下方位激光雷达点云三维渲染图。取gridsize为20cm,Yoffset为1500cm,Xoffset为2000cm。
步骤一:对该场景实施本发明之(1.1),逐线计算邻近点间距、局部平滑度,其中Nneighbor取值5,Thssmooth取值50,Thssharp取值350。如图5所示,左边为邻近点间距示意图,越亮表示值越大,可见负障碍物候选点对中后沿点的邻近点间距数值较大;右边为局部平滑度示意图,越亮表示值越大,可见负障碍物候选点对前方点云的局部平滑度较小,为平滑点。
步骤二:对该场景实施本发明之(1.2),逐激光点通过检测局部点云距离跳变特征选取点云邻近点间距局部极大值的候选点对,作为初始候选点对。其中Thsdis取值40cm,Njump_nbr取值5。
步骤三:对该场景实施本发明之(1.3),在初始候选点对中,通过检测局部点云分布密集特征选取初始候选点对中后沿点所在位置点云局部密集的点对,获得筛选后的初始候选点对。其中Thsdense取值4,Ngrid取值2。
步骤四:对该场景实施本发明之(1.4),在筛选后的初始候选点对中,通过局部点云高度下降特征进行进一步筛选获得最终的候选点对。选取候选点对前方Nline个平滑度数值较小的点,其中Nline取值为5,用以拟合直线,继而选取后沿点高度显著低于直线位置的负障碍点对。如图6所示,其中白色长虚线代表候选点对前方5个平滑点拟合的直线,可见负障碍物候选点对中的后沿点相对拟合直线呈现高度下降特征。
步骤五:对该场景实施本发明之(2.1)~(2.6),将步骤四选取的负障碍物候选点对进行空间位置一致性、点对长度一致性聚类,其中核函数带宽h取值4.0,误差阈值Epsilon取值0.0001。如图7所示,左图为经过步骤四获得的最终的候选点对,用白色线段标出,右图为聚类结果,共聚成6类,用序号标识。
步骤六:对该场景实施本发明之(4),对聚类结果根据区域面积、点对数量过滤,其中Thsnum的值取3,Thsarea值取20。如图8所示,左图为负障碍物候选区域经过滤后的结果,仅0、1号负障碍物候选区域被保留下来;右图为对应输出的栅格属性地图,其中车体前方两个白色区域代表过滤后得到的负障碍物区域。
另外测试了4组不同的场景数据来评估本发明的效果,以激光雷达点云作为输入,检测输出的栅格属性地图中负障碍物标识个数、位置。如图9所示,4张子图表示4个不同场景的检测结果。对每一张子图,左边为激光雷达点云俯视图,右上为对应场景彩色图像,右下为输出的栅格属性地图。检测的具体结果如表1所示。表1中场景1、场景2、场景3、场景4分别对应图9中的左上、右上、左下和右下四个子图。表1记录了4组实验的场景描述、光照条件、总帧数、成功检测出负障碍物的帧数、负障碍物首次检出距离、检测成功率、平均位置误差和平均每帧耗时。
表1
从上表1结果可见,在不同光照条件下本方法均能够达到90%以上的检测成功率,平均位置误差约为0.2m。对于直径为1m,深0.5m的凹坑,本方法的首次检出距离约为12.4m,而宽度为0.6m,深0.5m的壕沟,本方法的首次检出距离为12.0m。实验采用一台配备4核心主频为2.6GHz的Intel i5处理器的电脑,实验中每帧激光雷达点云的平均处理耗时约为10ms,所以本发明方法的计算代价很小。
可以看出,本发明提出的面向无人车导航的基于点云数据局部结构特征的负障碍物检测方法具有检测结果不受光照条件影响、检测结果位置精度高的特点,此外,本方法计算代价小,可以实时运行。
Claims (10)
1.一种基于激光雷达点云局部结构特征的负障碍物检测方法,其特征在于包括如下步骤:
1)已采集的激光雷达点云数据,逐线检测局部点云距离跳变、局部点云分布密集和局部点云高度下降的三个结构特征,依据三个结构特征在单线激光点云中提取筛选获得可能属于负障碍物的候选点对;
2)由各线激光的激光点云获得的所有候选点对,依据点对长度一致性和空间位置一致性进行聚类,得负障碍物候选区域,再经过面积过滤得到负障碍物区域;
所述步骤1)具体是针对单线激光点云,采用以下方式进行处理:
1.1)逐激光点计算邻近点间距与局部平滑度,并根据局部平滑度判断获得平滑点;
1.2)逐激光点通过检测局部点云距离跳变特征选取邻近点间距局部极大值的候选点对,作为初始候选点对;
1.3)在初始候选点对中,通过检测局部点云分布密集特征选取初始候选点对中后沿点所在位置点云局部密集的点对,获得筛选后的初始候选点对;
1.4)通过局部点云高度下降特征进行进一步筛选,获得最终的候选点对。
2.根据权利要求1所述的一种基于激光雷达点云局部结构特征的负障碍物检测方法,其特征在于:
所述步骤1.1)具体为:
1.1.1)计算邻近点间距
1.1.2)计算局部平滑度
采用以下公式计算单线激光点云中每个激光点的局部平滑度sl:
式中,Nneighbor表示预设的邻近点个数,l表示单线激光点云中的激光点序号,k表示该激光点的邻近点的序号;
预设平滑阈值Thssmooth和非平滑阈值Thssharp,通过将激光点的局部平滑度sl分别与平滑阈值Thssmooth和非平滑阈值Thssharp进行比较获得激光点是否为平滑点的结果:若满足sl≤Thssmooth,该激光点为平滑点;若满足sl≥Thssharp,该激光点为非平滑点。
3.根据权利要求1所述的一种基于激光雷达点云局部结构特征的负障碍物检测方法,其特征在于:所述步骤1.2)具体是:对于单线激光点云上的各激光点,按以下公式处理并提取获得邻近点间距跳变点集合Pjump:
k∈[l-Njump_nbr,l+Njump_nbr],k≠l}
式中,Njump_nbr表示预设的邻近点个数,Thsdis为邻近点间距跳变阈值,l表示单线激光点云中的激光点序号,k表示该激光点的邻近点的序号;
再取邻近点间距跳变点集合Pjump中的每个激光点作为后沿点,在单线激光点云中将在其之前的一个激光点作为前沿点,形成邻近点间距跳变点对并获得邻近点间距跳变点对集合Pneg_pair,具体是采用以下公式:
式中,l表示单线激光点云中的激光点序号;
以邻近点间距跳变点对集合Pneg_pair中的邻近点间距跳变点对作为初始候选点对。
4.根据权利要求1所述的一种基于激光雷达点云局部结构特征的负障碍物检测方法,其特征在于:所述的步骤1.3)具体为:将初始候选点对投影到激光雷达点云空间所对应的栅格属性地图上,每个栅格统计落在该栅格内激光点的数目,针对初始候选点对的后沿点判断是否满足以下公式:
PtNum(k,l)-PtNum(m,n)≥Thsdense
m∈[k-Ngrid,k+Ngrid],m≠k
n∈[l-Ngrid,l+Ngrid],n≠l
式中,Ngrid表示预设栅格邻近距离,PtNum(k,l)表示当前栅格中包含的所有激光点总数,PtNum(m,n)表示当前栅格在预设栅格邻近距离Ngrid邻域内的一栅格内包含的所有激光点总数,Thsdense是预设的点云密集阈值,当前栅格是指初始候选点对的后沿点所在的栅格,m、n分别表示当前栅格在预设栅格邻近距离Ngrid邻域内的栅格行号与列号;
初始候选点对的后沿点满足公式,则认为满足局部点云分布密集特征,将该初始候选点对保留,继续下一步的处理;否则,将该初始候选点对舍弃,不继续下一步的处理。
5.根据权利要求1所述的一种基于激光雷达点云局部结构特征的负障碍物检测方法,其特征在于:所述步骤1.4)具体为:
对于步骤1.3)筛选后的每个初始候选点对,选取后沿点前方的Nline个平滑点形成平滑点集Plocal_smooth,将滑点集Plocal_smooth中的所有平滑点通过最小二乘法进行直线拟合获得直线方程;
再将后沿点空间坐标[xl,yl,zl]中位于水平平面的x,y坐标代入直线方程,并与后沿点的z坐标相比较,具体是采用以下公式进行判断筛选:
式中,dzl是筛选后的初始候选点对前方的平滑点拟合直线在后沿点处的估计高度与实际高度之差,Thsz为预设的候选点对后沿点高度下降阈值,l表示候选点对序号;x0、y0分别表示空间直线经过点的坐标的x、y坐标轴的两个分量;
若满足上述公式,则表明该后沿点位于直线的下方,满足局部点云高度下降特征,保留该后沿点所在的初始候选点对,继续下一步的处理;否则,将该后沿点所在的初始候选点对舍弃,不继续下一步的处理。
7.根据权利要求1所述的一种基于激光雷达点云局部结构特征的负障碍物检测方法,其特征在于:所述的步骤2)中聚类具体为:2.1)将步骤1)获得各线激光点云中的候选点对进行合并,然后采用以下方式进行聚类,将候选点对投影到栅格属性地图上获得对应的栅格点对,栅格点对由前沿栅格点pfront和后沿栅格点pback构成;
取前沿栅格点pfront和后沿栅格点pback之间的中点表示该候选点对在栅格属性地图上的空间位置:
其中,u、v分别表示该候选点对在栅格属性地图上的行坐标和列坐标,ufront、vfront分别表示前沿栅格点pfront在栅格属性地图上的行坐标和列坐标,uback、vback分别表示后沿栅格点pback在栅格属性地图上的行坐标和列坐标;
采用以下公式取前沿栅格点pfront和后沿栅格点pback之间的距离表示候选点对的点对长度w:
其中,Npars表示步骤1)获得所有线激光上的候选点对总数;
2.4)使用均值偏移的方法进行聚类:
从而得到加权质心向量集合Gshfts:
2.5)对加权质心向量集合Gshfts中的每个加权质心向量,采用以下公式计算其与其对应的质心向量之间的欧氏距离Dshftl:
Dshftl≤Epsilon
2.7)将相同质心向量对应的候选点对归为同一类,完成候选点对集合的聚类。
9.根据权利要求1所述的一种基于激光雷达点云局部结构特征的负障碍物检测方法,其特征在于:所述的步骤2)中过滤具体为:由同一类的所有候选点对所形成的区域作为负障碍物候选区域,遍历所有负障碍物候选区域,采用以下公式判断是否满足:
Numpar≥Thsnum
Areaneg≥Thsarea
式中,Numpar表示负障碍物候选区域中所有候选点对的总对数,Areaneg表示负障碍物候选区域中所有候选点对构成多边形的面积,多边形为包围在负障碍物候选区域中所有候选点对外的最小外接多边形,Thsnum为区域候选点对数量阈值,Thsarea为负障碍物在栅格属性地图中形成多边形的面积阈值;
若同时满足以上两个条件,则负障碍物候选区域保留,为最终的负障碍物区域;
若不同时满足以上两个条件,则负障碍物候选区域舍弃,不为最终的负障碍物区域。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201611101791.2A CN106650640B (zh) | 2016-12-05 | 2016-12-05 | 一种基于激光雷达点云局部结构特征的负障碍物检测方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201611101791.2A CN106650640B (zh) | 2016-12-05 | 2016-12-05 | 一种基于激光雷达点云局部结构特征的负障碍物检测方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN106650640A CN106650640A (zh) | 2017-05-10 |
CN106650640B true CN106650640B (zh) | 2020-03-03 |
Family
ID=58818378
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201611101791.2A Expired - Fee Related CN106650640B (zh) | 2016-12-05 | 2016-12-05 | 一种基于激光雷达点云局部结构特征的负障碍物检测方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN106650640B (zh) |
Families Citing this family (33)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN107169986B (zh) * | 2017-05-23 | 2019-09-17 | 北京理工大学 | 一种障碍物检测方法及系统 |
CN109145680B (zh) * | 2017-06-16 | 2022-05-27 | 阿波罗智能技术(北京)有限公司 | 一种获取障碍物信息的方法、装置、设备和计算机存储介质 |
CN109285188B (zh) * | 2017-07-21 | 2020-04-21 | 百度在线网络技术(北京)有限公司 | 用于生成目标物体的位置信息的方法和装置 |
CN109492656B (zh) * | 2017-09-11 | 2022-04-29 | 阿波罗智能技术(北京)有限公司 | 用于输出信息的方法和装置 |
EP3467784A1 (en) * | 2017-10-06 | 2019-04-10 | Thomson Licensing | Method and device for up-sampling a point cloud |
CN109753982B (zh) * | 2017-11-07 | 2021-09-03 | 北京京东乾石科技有限公司 | 障碍点检测方法、装置和计算机可读存储介质 |
CN108334080B (zh) * | 2018-01-18 | 2021-01-05 | 大连理工大学 | 一种针对机器人导航的虚拟墙自动生成方法 |
CN108256577B (zh) * | 2018-01-18 | 2021-09-28 | 东南大学 | 一种基于多线激光雷达的障碍物聚类方法 |
CN108459319A (zh) * | 2018-03-13 | 2018-08-28 | 燕山大学 | 一种车辆行驶区域地形高度快速扫描系统 |
CN108648219B (zh) * | 2018-04-08 | 2022-02-22 | 浙江大承机器人科技有限公司 | 一种基于双目的障碍物与可行区域检测方法 |
CN109001756A (zh) * | 2018-05-04 | 2018-12-14 | 上海交通大学 | 基于嵌入式设备的多线激光雷达障碍物检测系统及方法 |
CN108873013B (zh) * | 2018-06-27 | 2022-07-22 | 江苏大学 | 一种采用多线激光雷达的道路可通行区域获取方法 |
CN109284348B (zh) * | 2018-10-30 | 2021-02-05 | 百度在线网络技术(北京)有限公司 | 一种电子地图的更新方法、装置、设备和存储介质 |
JP2021508815A (ja) * | 2018-11-15 | 2021-03-11 | ベイジン ディディ インフィニティ テクノロジー アンド ディベロップメント カンパニー リミティッド | 妨害物体の検出に基づいて高精細度マップを補正するためのシステムおよび方法 |
CN111273314A (zh) * | 2018-11-16 | 2020-06-12 | 北京四维图新科技股份有限公司 | 点云数据处理方法、装置和存储介质 |
CN109614886B (zh) * | 2018-11-23 | 2022-06-24 | 中国人民解放军63966部队 | 一种无人/自主驾驶系统的性能评测方法及装置 |
CN109407115B (zh) * | 2018-12-25 | 2022-12-27 | 中山大学 | 一种基于激光雷达的路面提取系统及其提取方法 |
CN109773783B (zh) * | 2018-12-27 | 2020-04-24 | 北京宇琪云联科技发展有限公司 | 一种基于空间点云识别的巡防智能机器人及其警务系统 |
CN109934141B (zh) * | 2019-03-01 | 2021-05-04 | 北京百度网讯科技有限公司 | 用于标注数据的方法和装置 |
CN110084116B (zh) * | 2019-03-22 | 2022-02-01 | 深圳市速腾聚创科技有限公司 | 路面检测方法、装置、计算机设备和存储介质 |
CN110221603B (zh) * | 2019-05-13 | 2020-08-14 | 浙江大学 | 一种基于激光雷达多帧点云融合的远距离障碍物检测方法 |
CN111684382B (zh) * | 2019-06-28 | 2024-06-11 | 深圳市卓驭科技有限公司 | 可移动平台状态估计方法、系统、可移动平台及存储介质 |
CN110554409B (zh) * | 2019-08-30 | 2021-06-04 | 江苏徐工工程机械研究院有限公司 | 一种凹障碍物检测方法及系统 |
CN110674705B (zh) * | 2019-09-05 | 2022-11-29 | 北京智行者科技股份有限公司 | 基于多线激光雷达的小型障碍物检测方法及装置 |
CN110609290B (zh) * | 2019-09-19 | 2021-07-23 | 北京智行者科技有限公司 | 激光雷达匹配定位方法及装置 |
CN110542422B (zh) * | 2019-10-10 | 2021-03-23 | 上海钛米机器人科技有限公司 | 机器人定位方法、装置、机器人及存储介质 |
CN111429520B (zh) * | 2020-03-02 | 2023-11-03 | 广州视源电子科技股份有限公司 | 负障碍物检测方法、装置、终端设备和存储介质 |
CN111339996B (zh) * | 2020-03-20 | 2023-05-09 | 北京百度网讯科技有限公司 | 静态障碍物的检测方法、装置、设备及存储介质 |
CN113496160B (zh) * | 2020-03-20 | 2023-07-11 | 百度在线网络技术(北京)有限公司 | 三维物体检测方法、装置、电子设备和存储介质 |
CN113393423A (zh) * | 2021-05-18 | 2021-09-14 | 深圳拓邦股份有限公司 | 一种基于点云的悬崖检测方法、装置及移动机器人 |
CN117677976A (zh) * | 2021-07-21 | 2024-03-08 | 深圳市大疆创新科技有限公司 | 可行驶区域生成方法、可移动平台及存储介质 |
CN114089376A (zh) * | 2021-09-30 | 2022-02-25 | 江苏金陵智造研究院有限公司 | 一种基于单激光雷达的负障碍物检测方法 |
CN114815821B (zh) * | 2022-04-19 | 2022-12-09 | 山东亚历山大智能科技有限公司 | 基于多线激光雷达的室内自适应全景避障方法及系统 |
Citations (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN101408978A (zh) * | 2008-11-27 | 2009-04-15 | 东软集团股份有限公司 | 一种基于单目视觉的障碍物检测方法及装置 |
CN101975951A (zh) * | 2010-06-09 | 2011-02-16 | 北京理工大学 | 一种融合距离和图像信息的野外环境障碍检测方法 |
CN102779280A (zh) * | 2012-06-19 | 2012-11-14 | 武汉大学 | 一种基于激光传感器的交通信息提取方法 |
CN103955920A (zh) * | 2014-04-14 | 2014-07-30 | 桂林电子科技大学 | 基于三维点云分割的双目视觉障碍物检测方法 |
Family Cites Families (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US9110163B2 (en) * | 2013-06-14 | 2015-08-18 | Microsoft Technology Licensing, Llc | Lidar-based classification of object movement |
-
2016
- 2016-12-05 CN CN201611101791.2A patent/CN106650640B/zh not_active Expired - Fee Related
Patent Citations (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN101408978A (zh) * | 2008-11-27 | 2009-04-15 | 东软集团股份有限公司 | 一种基于单目视觉的障碍物检测方法及装置 |
CN101975951A (zh) * | 2010-06-09 | 2011-02-16 | 北京理工大学 | 一种融合距离和图像信息的野外环境障碍检测方法 |
CN102779280A (zh) * | 2012-06-19 | 2012-11-14 | 武汉大学 | 一种基于激光传感器的交通信息提取方法 |
CN103955920A (zh) * | 2014-04-14 | 2014-07-30 | 桂林电子科技大学 | 基于三维点云分割的双目视觉障碍物检测方法 |
Non-Patent Citations (2)
Title |
---|
Lidar Based Off-road Negative Obstacle Detection and Analysis;Jacoby Larson et al.;《2011 14th International IEEE Conference on Intelligent Transportation Systems》;20111231;第192-197页 * |
基于多谱融合的植被环境中障碍物检测;王盛 等;《浙江大学学报(工学版)》;20151130;第2223-2229页 * |
Also Published As
Publication number | Publication date |
---|---|
CN106650640A (zh) | 2017-05-10 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN106650640B (zh) | 一种基于激光雷达点云局部结构特征的负障碍物检测方法 | |
CN110781827B (zh) | 一种基于激光雷达与扇状空间分割的路沿检测系统及其方法 | |
Cheng et al. | Extraction and classification of road markings using mobile laser scanning point clouds | |
CN112070769B (zh) | 一种基于dbscan的分层点云分割方法 | |
Rottensteiner et al. | The ISPRS benchmark on urban object classification and 3D building reconstruction | |
CN107563413B (zh) | 无人机航拍影像农田块对象精准提取方法 | |
CN107392929B (zh) | 一种基于人眼视觉模型的智能化目标检测及尺寸测量方法 | |
CN110379004B (zh) | 一种对倾斜摄影成果进行地物分类及单体化提取的方法 | |
CN103632167B (zh) | 类地重力场环境下单目视觉空间识别方法 | |
CN113221648B (zh) | 一种基于移动测量系统的融合点云序列影像路牌检测方法 | |
CN106503170B (zh) | 一种基于遮挡维度的图像库构建方法 | |
CN110210428B (zh) | 一种基于mser的远距离复杂环境下的烟雾根节点检测方法 | |
CN108074232B (zh) | 一种基于体元分割的机载lidar建筑物检测方法 | |
CN115049700A (zh) | 一种目标检测方法及装置 | |
CN111222511B (zh) | 一种红外无人机目标检测方法及系统 | |
CN111325138A (zh) | 一种基于点云局部凹凸特征的道路边界实时检测方法 | |
CN114332134B (zh) | 一种基于密集点云的建筑物立面提取方法和装置 | |
CN112464812A (zh) | 一种基于车辆的凹陷类障碍物检测方法 | |
CN116704333B (zh) | 一种基于激光点云数据的单株林木检测方法 | |
CN114782729A (zh) | 一种基于激光雷达与视觉融合的实时目标检测方法 | |
CN113281782A (zh) | 一种基于无人驾驶车的激光雷达雪点滤除方法 | |
CN111783721A (zh) | 一种激光点云的车道线提取方法及电子设备 | |
CN116452852A (zh) | 一种高精度矢量地图的自动生成方法 | |
CN117765006A (zh) | 基于无人机影像与激光点云的多层次密集树冠分割方法 | |
CN108388854A (zh) | 一种基于改进fast-surf算法的定位方法 |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
PB01 | Publication | ||
PB01 | Publication | ||
SE01 | Entry into force of request for substantive examination | ||
SE01 | Entry into force of request for substantive examination | ||
GR01 | Patent grant | ||
GR01 | Patent grant | ||
CF01 | Termination of patent right due to non-payment of annual fee |
Granted publication date: 20200303 |