CN105866790A - 一种考虑激光发射强度的激光雷达障碍物识别方法及系统 - Google Patents
一种考虑激光发射强度的激光雷达障碍物识别方法及系统 Download PDFInfo
- Publication number
- CN105866790A CN105866790A CN201610213409.0A CN201610213409A CN105866790A CN 105866790 A CN105866790 A CN 105866790A CN 201610213409 A CN201610213409 A CN 201610213409A CN 105866790 A CN105866790 A CN 105866790A
- Authority
- CN
- China
- Prior art keywords
- point
- barrier
- data
- laser radar
- cluster
- 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.)
- Granted
Links
Classifications
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01S—RADIO DIRECTION-FINDING; RADIO NAVIGATION; DETERMINING DISTANCE OR VELOCITY BY USE OF RADIO WAVES; LOCATING OR PRESENCE-DETECTING BY USE OF THE REFLECTION OR RERADIATION OF RADIO WAVES; ANALOGOUS ARRANGEMENTS USING OTHER WAVES
- G01S17/00—Systems using the reflection or reradiation of electromagnetic waves other than radio waves, e.g. lidar systems
- G01S17/88—Lidar systems specially adapted for specific applications
Landscapes
- Physics & Mathematics (AREA)
- Engineering & Computer Science (AREA)
- Computer Networks & Wireless Communication (AREA)
- Electromagnetism (AREA)
- General Physics & Mathematics (AREA)
- Radar, Positioning & Navigation (AREA)
- Remote Sensing (AREA)
- Optical Radar Systems And Details Thereof (AREA)
Abstract
本发明公开了一种考虑激光发射强度的激光雷达障碍物识别方法,首先获取环境数据并以数组形式存储于计算机中,对获取的环境数据进行预处理,对激光雷达的距离信息、反射强度信息同时进行非平面ABD算法的环境数据分割聚类处理,得出的n个簇群集合,然后将不同簇群的数据集合与障碍物类别进行匹配,得到障碍物集合信息,所述障碍物集合信息包括尖峰型障碍物、凸圆弧形障碍物和凹形障碍物;本发明提供的考虑激光发射强度的激光雷达障碍物识别方法,利用激光雷达输出的环境反射强度信息,将常用的环境距离信息上升到非平面的三维空间,并提出基于非平面数据分割的障碍物识别方法,从而保证障碍物识别的实时性及准确性。
Description
技术领域
本发明涉及机器人及智能车辆的局部导航领域,特别涉及一种考虑激光发射强度的激光雷达障碍物识别方法。
背景技术
障碍物检测是移动机器人自主导航系统的必要组成部分,鲁棒的障碍检测是实现有效和安全导航的基础。现代移动机器人往往依赖多种传感器的搭配,选取合适的多传感器信息处理算法感知所处场景,进而做出相应的决策。对于机器人的环境识别,从传感器角度上看,主要有三种类型:利用立体视觉的障碍物的检测、利用激光雷达的障碍物的检测和利用多传感器融合的障碍物的检测。
立体视觉和人利用双目成像估计景物距离的原理类似,在计算机视觉中也有利用两个相互位置关系已知的摄像机组成立体视觉系统,根据同一景物在两个摄像机上成像的视差恢复出景物深度。与该方法相比,利用激光雷达的对障碍物进行检测可以实时的获取精度比较高的周围环境相关信息,使得机器人在周围未知的环境中对障碍物的检测更加有效和可靠,因此激光雷达具有环境适应能力强、精确度高等优势,目前在未知环境中的障碍物进行检测大多采用激光雷达检测技术。
近几年来,很多人已经对使用激光雷达对障碍物进行检测相关方面做了很多的相关研究,大多是用测量环境中的位置信息的方法来获得障碍物分布信息。比如:南京理工大学的Yuan等人利用64线激光雷达提出了适用于结构化和半结构化道路环境的路面提取算法,该算法是利用模糊聚类来对路面进行提取,对比连续几帧的雷达数据,确定正常路面的参考平面,进一步提取出路面上的障碍物;Moosmann等人采用基于图的方法对三维激光雷达数据进行了障碍物和地面分割,这种方法证明了在具有弯道的复杂环境中也能获得很好的效果;万忠涛利用激光雷达的平面模型和扩展的Kalman滤波算法对障碍物检测算法进行了改进,完成了对单帧雷达数据的分类;Himmelsbach针对64线雷达的特点,先用极坐标栅格地图来表示雷达数据,然后使用分块进行直线拟合的办法对障碍物进行分割,最后再对障碍物进行聚类处理,该方法的检测效果比较好;B.Douillard等联合使用均值高度图和最小最大高度图,先利用均值高度图对地面进行分割,然后用最大最小值栅格地图进一步分割障碍物,这 种混合高度图能够很好的提取地面并获得比较准确的障碍物信息。
然而多线激光雷达虽然提高环境描述的精度,却也因为增加了计算量而对数据处理单元提出了很高的挑战。而性价比较高的二维激光雷达却更适合实时性高的场合。在障碍物识别方面,多采用二维激光雷达输出的环境距离信息进行障碍物或其他物体的聚类分析,而在要求实时性较高的场合,激光雷达输出的距离信息将不足以满足环境识别系统的精确性要求,因此,将激光雷达输出的环境反射强度信息作为聚类样本之一,这样可以增加更多的信息量。而且目前对于一些实时性高、运算量小的聚类算法多为平面聚类算法,无法很好地融合位置和反射强度信息。
因此需要一种高效的障碍物识别方法来识别机器人和智能车辆前方的障碍物。
发明内容
本发明的目的就是提供一种考虑激光发射强度的激光雷达障碍物识别方法;该方法应用于局部导航中,采用单线激光雷达来识别障碍物。
本发明的目的是通过这样的技术方案实现的:
本发明提供的考虑激光发射强度的激光雷达障碍物识别方法,包括以下步骤:
步骤1:获取环境数据并以数组形式存储于计算机中,所述环境数据包括距离信息和反射强度信息;
步骤2:对获取的环境数据进行预处理,所述预处理包括去除有效范围外的数据点、滤除孤立噪声点和激光雷达测量机制的缺陷补偿;
步骤3:对激光雷达的距离信息、反射强度信息同时进行非平面ABD算法的环境数据分割聚类处理,得出的n个簇群集合,所述簇群集合采用以下公式来表达:
Ω={Ω1,Ω2,......,Ωj,......,Ωn},
其中,Ωj表示为第j个簇群类别,Ωj={Pj1,Pj2,......,Pjk,......,PjM},M为第j个簇群类别所包含的数据点个数,每个数据点内的信息包括上文中的时间坐标系下的坐标和对应的环境反射强度,即Pjk=(xi,yj,s);
步骤4:将不同簇群的数据集合与障碍物类别进行匹配,得到障碍物集合信息,所述障碍物集合信息包括尖峰型障碍物、凸圆弧形障碍物和凹形障碍物;所述障碍物集合信息采用以下公式来表示:
Obs={obs1,obs2,......obsj,......obsobscnt},
其中,obsj=obs(type,Pstart,Pend,dmin),type表示障碍物类型,Pstart表示障碍物在世界坐标系下的起点坐标,Pend表示障碍物在世界坐标系下的终点坐标,dmin表示障碍物与机器人之间的最小距离,obscnt为一帧激光雷达数据中,识别出来障碍物类型数据段个数。
进一步,所述步骤2中对获取的环境数据进行预处理,具体包括以下步骤:
21)通过以下公式来去除有效范围外的数据点:
其中,range的取值为激光雷达的最远有效测量距离;
21)通过以下方式来滤除孤立的噪声点:将激光雷达采集数据点进行离散得到离散数据序列{X(i)|i=1,2,3,...,N},以离散序列中的第K个位置为中心,前后共取m个数据;对这m个数据采用升序或者降序的方式进行排列,将排序后的中间值作为原序列中第K个位置的值;K的取值依次从小到大,循环重复直到所有激光雷达数据处理完毕结束。
21)通过以下公司来对激光雷达测量机制进行缺陷补偿:
其中,di表示当前第i线激光雷达返回的距离数据;di-2表示当前第i-2线激光雷达返回的距离数据;di-1表示当前第i-1线激光雷达返回的距离数据;di+1表示当前第i+1线激光雷达返回的距离数据;di+2表示当前第i+2线激光雷达返回的距离数据。
进一步,所述步骤3中对激光雷达的距离、反射强度信息同时进行非平面ABD算法的环境数据分割聚类处理,具体方法如下:
31)建立空间坐标系,将某激光束的点集按照如下公式表示:
bg={P1,P2,P3,......,Pi,......PN},
其中,任意一点Pi=(xi,yi,si)投影到空间坐标系下,(xi,yi)为XOY的投影坐标,Z轴即为si;
32)非平面ABD算法环境分割:循环比较空间坐标系下数据点集中每两个相邻点之间的差值,按照以下公式获得分割点点Pn和点Pn-1:
|dn-dn-1|>Dmax
其中:dn为当前扫描点的距离,dn-1为前一扫描点的距离,Dmax为分割阈值;
σ为反射强度的缩放系数;
Dmax通过以下公式来计算:
33)将点Pn和点Pn-1标记为分割点;
34)按照以下公式进行二次检测:
ξ(dn)=k*dn;
且ξ(dn)≤μ;
其中,k为常系数,ξ(dn)为阈值,μ为常值;
35)判断|dn-dn-1|>ξ(dn)是否成立,如果成立,则将点Pn和点Pn-1标记为分割点;
如果不成立,则取消分割点标记;
36)循环重复所有环境数据,得到簇群集合。
进一步,所述步骤4中不同簇群的数据集合与障碍物类别进行匹配,具体过程如下:
41)连接簇群的数据集合中的起点到顶点、终点到顶点及坐标原点形成三角形,并计算该三角形的面积S1;
42)逐个两两连接簇群数据集合中各个点并与坐标原点形成闭合图形,计算该闭合图形的面积S2;
43)判断第一面积与第二面积之差是否小于零,如果是,则连接顶点和起点、顶点和终点分别得到两条直线,记为L1、L2;判断簇群所有点能否在阈值内收敛于L1和L2;如果能,则簇群的点为尖峰形障碍物,如果否,则簇群的点为凸圆弧形障碍物;
44)如果第S1与S2之差不小于零,则进一步判断第一面积与第二面积之差是否小于直线阈值δ,如果是,则簇群的点为凹形障碍物。
进一步,所述步骤4中障碍物具体按照以下过程进行匹配:
S41)尖峰型障碍物是通过以下方式来获取的:计算簇群的数据集合中从起点到顶点、终点到顶点的所有数据的收敛直线,如果收敛直线为两条不同的直线且两条直线的交点在平面坐标系中,则数据集合为尖峰型障碍物;
S42)凸圆弧形障碍物是通过以下方式来获取的:计算簇群的数据集合中各个点与原点形成的微分区域面积,如果微分区域面积小于起点、终点及原点形成的三角形面积且该簇群不 收敛于两条直线,则数据集合为凸圆弧形障碍物;
S43)凹形障碍物是通过以下方式来获取的:计算簇群的数据集合中各个点与原点形成的微分区域面积,如果微分区域面积大于起点、终点及原点形成的三角形面积,则数据集合为凹形障碍物。
本发明还提供了一种考虑激光发射强度的激光雷达障碍物识别系统,包括环境数据生成模块、环境数据预处理模块、非平面ABD处理模块和障碍物匹配模块;
所述环境数据生成模块,用于获取环境数据并以数组形式存储于计算机中,所述环境数据包括距离信息和反射强度信息;
所述环境数据预处理模块,用于对获取的环境数据进行预处理,所述预处理包括去除有效范围外的数据点、滤除孤立噪声点和激光雷达测量机制的缺陷补偿;
所述非平面ABD处理模块,用于对激光雷达的距离信息、反射强度信息同时进行非平面ABD算法的环境数据分割聚类处理,得出的n个簇群集合,所述簇群集合采用以下公式来表达:
Ω={Ω1,Ω2,......,Ωj,......,Ωn},
其中,Ωj表示为第j个簇群类别,Ωj={Pj1,Pj2,......,Pjk,......,PjM},M为第j个簇群类别所包含的数据点个数,每个数据点内的信息包括上文中的时间坐标系下的坐标和对应的环境反射强度,即Pjk=(xi,yj,s);
所述障碍物匹配模块,用于将不同簇群的数据集合与障碍物类别进行匹配,得到障碍物集合信息,所述障碍物集合信息包括尖峰型障碍物、凸圆弧形障碍物和凹形障碍物;所述障碍物集合信息采用以下公式来表示:
Obs={obs1,obs2,......obsj,......obsobscnt},
其中,obsj=obs(type,Pstart,Pend,dmin),type表示障碍物类型,Pstart表示障碍物在世界坐标系下的起点坐标,Pend表示障碍物在世界坐标系下的终点坐标,dmin表示障碍物与机器人之间的最小距离,obscnt为一帧激光雷达数据中,识别出来障碍物类型数据段个数。
进一步,所述环境数据预处理模块中对获取的环境数据进行预处理,具体包括以下步骤:
21)通过以下公式来去除有效范围外的数据点:
其中,range的取值为激光雷达的最远有效测量距离;
21)通过以下方式来滤除孤立的噪声点:将激光雷达采集数据点进行离散得到离散数据序列{X(i)|i=1,2,3,......N},以离散序列中的第K个位置为中心,前后共取m个数据;对这m个数据采用升序或者降序的方式进行排列,将排序后的中间值作为原序列中第K个位置的值;K的取值依次从小到大,循环重复直到所有激光雷达数据处理完毕结束。
21)通过以下公司来对激光雷达测量机制进行缺陷补偿:
其中,di表示当前第i线激光雷达返回的距离数据;di-2表示当前第i-2线激光雷达返回的距离数据;di-1表示当前第i-1线激光雷达返回的距离数据;di+1表示当前第i+1线激光雷达返回的距离数据;di+2表示当前第i+2线激光雷达返回的距离数据。
进一步,所述非平面ABD处理模块中对激光雷达的距离、反射强度信息同时进行非平面ABD算法的环境数据分割聚类处理,具体方法如下:
31)建立空间坐标系,将某激光束的点集按照如下公式表示:
bg={P1,P2,P3,......,Pi,......PN},
其中,任意一点Pi=(xi,yi,si)投影到空间坐标系下,(xi,yi)为XOY的投影坐标,Z轴即为si;
32)非平面ABD算法环境分割:循环比较空间坐标系下数据点集中每两个相邻点之间的差值,按照以下公式获得分割点点Pn和点Pn-1:
|dn-dn-1|>Dmax
其中:dn为当前扫描点的距离,dn-1为前一扫描点的距离,Dmax为分割阈值;
σ为反射强度的缩放系数;
Dmax通过以下公式来计算:
33)将点Pn和点Pn-1标记为分割点;
34)按照以下公式进行二次检测:
ξ(dn)=k*dn;
且ξ(dn)≤μ;
其中,k为常系数,ξ(dn)为阈值,μ为常值;
35)判断|dn-dn-1|>ξ(dn)是否成立,如果成立,则将点Pn和点Pn-1标记为分割点;
如果不成立,则取消分割点标记;
36)循环重复所有环境数据,得到簇群集合。
进一步,所述障碍物匹配模块中不同簇群的数据集合与障碍物类别进行匹配,具体过程如下:
41)连接簇群的数据集合中的起点到顶点、终点到顶点及坐标原点形成闭合图形,计算第一面积S1;
42)逐个两两连接簇群数据集合中各个点并与坐标原点形成闭合图形,计算第二面积S2;
43)判断第一面积与第二面积之差是否小于零,如果是,则连接顶点和起点、顶点和终点;判断簇群所有点能否在直线阈值δ内收敛于L1和L2;如果能,则簇群的点为尖峰形障碍物,如果否,则簇群的点为凸圆弧形障碍物;
44)如果第一面积与第二面积之差不小于零,则进一步判断第一面积与第二面积之差是否小于直线阈值δ,如果是,则簇群的点为凹形障碍物。
进一步,所述障碍物匹配模块中障碍物具体按照以下过程进行匹配:
S41)尖峰型障碍物是通过以下方式来获取的:计算簇群的数据集合中从起点到顶点、终点到顶点的所有数据的收敛直线,如果收敛直线为两条不同的直线且两条直线的交点在平面坐标系中,则数据集合为尖峰型障碍物;
S42)凸圆弧形障碍物是通过以下方式来获取的:计算簇群的数据集合中各个点与原点形成的微分区域面积,如果微分区域面积小于起点、终点及原点形成的三角形面积且该簇群不收敛于两条直线,则数据集合为凸圆弧形障碍物;
S43)凹形障碍物是通过以下方式来获取的:计算簇群的数据集合中各个点与原点形成的微分区域面积,如果微分区域面积大于起点、终点及原点形成的三角形面积,则数据集合为凹形障碍物。
由于采用了上述技术方案,本发明具有如下的优点:
本发明提供的考虑激光发射强度的激光雷达障碍物识别方法,利用激光雷达输出的环境 反射强度信息,将常用的环境距离信息上升到非平面的三维空间,并提出基于非平面数据分割的障碍物识别方法,从而保证障碍物识别的实时性及准确性。
本发明的其他优点、目标和特征在某种程度上将在随后的说明书中进行阐述,并且在某种程度上,基于对下文的考察研究对本领域技术人员而言将是显而易见的,或者可以从本发明的实践中得到教导。本发明的目标和其他优点可以通过下面的说明书和权利要求书来实现和获得。
附图说明
本发明的附图说明如下。
图1a为本发明的ABD算法示意图。
图1b为本发明的非平面ABD算法示意图。
图2a为第一个点是障碍物的起点且最后一个点是障碍物的终点示意图。
图2b为凸形障碍物中离机器人最近的点是尖峰型障碍物的顶点示意图。
图2c为凸形障碍物中离机器人最近的点是圆弧形障碍物的顶点示意图。
图2d为凹形障碍物中离机器人最远的点是凹形障碍物的顶点或终点示意图。
图3a为尖峰型障碍物的起点到顶点、终点到顶点的所有数据示意图。
图3b为凸圆弧形障碍物的各个点与原点形成的微分区域面积小于起点、终点及原点形成的三角形面积且该簇群不收敛示意图。
图3c为凹形障碍物的各个点与原点形成的微分区域面积大于起点、终点及原点形成的三角形面积示意图。
图4为本发明的激光雷达数据预处理流程图。
图5为本发明的通道及障碍物特征匹配方法流程图。
具体实施方式
下面结合附图和实施例对本发明作进一步说明。
实施例1
如图所示,本实施例提供的考虑激光发射强度的激光雷达障碍物识别方法,包括以下步骤:
步骤1:获取环境数据并以数组形式存储于计算机中,所述环境数据包括距离信息和反射强度信息;
步骤2:对获取的环境数据进行预处理,所述预处理包括去除有效范围外的数据点、滤除孤立噪声点和激光雷达测量机制的缺陷补偿;
步骤3:对激光雷达的距离信息、反射强度信息同时进行非平面ABD算法的环境数据分割聚类处理,得出的n个簇群集合,所述簇群集合采用以下公式来表达:
Ω={Ω1,Ω2,......,Ωj,......,Ωn},
其中,Ωj表示为第j个簇群类别,Ωj={Pj1,Pj2,......,Pjk,......,PjM},M为第j个簇群类别所包含的数据点个数,每个数据点内的信息包括上文中的时间坐标系下的坐标和对应的环境反射强度,即Pjk=(xi,yj,s);
步骤4:将不同簇群的数据集合与障碍物类别进行匹配,得到障碍物集合信息,所述障碍物集合信息包括尖峰型障碍物、凸圆弧形障碍物和凹形障碍物;所述障碍物集合信息采用以下公式来表示:
Obs={obs1,obs2,......obsj,......obsobscnt},
其中,obsj=obs(type,Pstart,Pend,dmin),type表示障碍物类型,Pstart表示障碍物在世界坐标系下的起点坐标,Pend表示障碍物在世界坐标系下的终点坐标,dmin表示障碍物与机器人之间的最小距离,obscnt为一帧激光雷达数据中,识别出来障碍物类型数据段个数。
所述步骤2中对获取的环境数据进行预处理,具体包括以下步骤:
21)通过以下公式来去除有效范围外的数据点:
其中,range的取值为激光雷达的最远有效测量距离;
21)通过以下方式来滤除孤立的噪声点:将激光雷达采集数据点进行离散得到离散数据序列{X(i)|i=1,2,3,...,N},以离散序列中的第K个位置为中心,前后共取m个数据;对这m个数据采用升序或者降序的方式进行排列,将排序后的中间值作为原序列中第K个位置的值;K的取值依次从小到大,循环重复直到所有激光雷达数据处理完毕结束。
21)通过以下公司来对激光雷达测量机制进行缺陷补偿:
其中,di表示当前第i线激光雷达返回的距离数据;di-2表示当前第i-2线激光雷达返 回的距离数据;di-1表示当前第i-1线激光雷达返回的距离数据;di+1表示当前第i+1线激光雷达返回的距离数据;di+2表示当前第i+2线激光雷达返回的距离数据。
所述步骤3中对激光雷达的距离、反射强度信息同时进行非平面ABD算法的环境数据分割聚类处理,具体方法如下:
31)建立空间坐标系,将某激光束的点集按照如下公式表示:
bg={P1,P2,P3,......,Pi,......PN},
其中,任意一点Pi=(xi,yi,si)投影到空间坐标系下,(xi,yi)为XOY的投影坐标,Z轴即为si;
32)非平面ABD算法环境分割:循环比较空间坐标系下数据点集中每两个相邻点之间的差值,按照以下公式获得分割点点Pn和点Pn-1:
|dn-dn-1|>Dmax
其中:dn为当前扫描点的距离,dn-1为前一扫描点的距离,Dmax为分割阈值;
σ为反射强度的缩放系数;
Dmax通过以下公式来计算:
33)将点Pn和点Pn-1标记为分割点;
34)按照以下公式进行二次检测:
ξ(dn)=k*dn;
且ξ(dn)≤μ;
其中,k为常系数,ξ(dn)为阈值,μ为常值;
35)判断|dn-dn-1|>ξ(dn)是否成立,如果成立,则将点Pn和点Pn-1标记为分割点;
如果不成立,则取消分割点标记;
36)循环重复所有环境数据,得到簇群集合。
所述步骤4中不同簇群的数据集合与障碍物类别进行匹配,具体过程如下:
41)连接簇群的数据集合中的起点到顶点、终点到顶点及坐标原点形成三角形,并计算该三角形的面积S1;
42)逐个两两连接簇群数据集合中各个点并与坐标原点形成闭合图形,计算该闭合图形 的面积S2;
43)判断第一面积与第二面积之差是否小于零,如果是,则连接顶点和起点、顶点和终点分别得到两条直线,记为L1、L2;判断簇群所有点能否在阈值δ=5cm内收敛于L1和L2;如果能,则簇群的点为尖峰形障碍物,如果否,则簇群的点为凸圆弧形障碍物;
44)如果第S1与S2之差不小于零,则进一步判断第一面积与第二面积之差是否小于直线阈值δ,如果是,则簇群的点为凹形障碍物。
所述步骤4中障碍物具体按照以下过程进行匹配:
S41)尖峰型障碍物是通过以下方式来获取的:计算簇群的数据集合中从起点到顶点、终点到顶点的所有数据的收敛直线,如果收敛直线为两条不同的直线且两条直线的交点在平面坐标系中,则数据集合为尖峰型障碍物;
S42)凸圆弧形障碍物是通过以下方式来获取的:计算簇群的数据集合中各个点与原点形成的微分区域面积,如果微分区域面积小于起点、终点及原点形成的三角形面积且该簇群不收敛于两条直线,则数据集合为凸圆弧形障碍物;
S43)凹形障碍物是通过以下方式来获取的:计算簇群的数据集合中各个点与原点形成的微分区域面积,如果微分区域面积大于起点、终点及原点形成的三角形面积,则数据集合为凹形障碍物。
本实施例还提供了一种考虑激光发射强度的激光雷达障碍物识别系统,包括环境数据生成模块、环境数据预处理模块、非平面ABD处理模块和障碍物匹配模块;
所述环境数据生成模块,用于获取环境数据并以数组形式存储于计算机中,所述环境数据包括距离信息和反射强度信息;
所述环境数据预处理模块,用于对获取的环境数据进行预处理,所述预处理包括去除有效范围外的数据点、滤除孤立噪声点和激光雷达测量机制的缺陷补偿;
所述非平面ABD处理模块,用于对激光雷达的距离信息、反射强度信息同时进行非平面ABD算法的环境数据分割聚类处理,得出的n个簇群集合,所述簇群集合采用以下公式来表达:
Ω={Ω1,Ω2,......,Ωj,......,Ωn},
其中,Ωj表示为第j个簇群类别,Ωj={Pj1,Pj2,......,Pjk,......,PjM},M为第j个簇群类别所包含的数据点个数,每个数据点内的信息包括上文中的时间坐标系下的坐标和对应的环境反射 强度,即Pjk=(xi,yj,s);
所述障碍物匹配模块,用于将不同簇群的数据集合与障碍物类别进行匹配,得到障碍物集合信息,所述障碍物集合信息包括尖峰型障碍物、凸圆弧形障碍物和凹形障碍物;所述障碍物集合信息采用以下公式来表示:
Obs={obs1,obs2,......obsj,......obsobscnt},
其中,obsj=obs(type,Pstart,Pend,dmin),type表示障碍物类型,Pstart表示障碍物在世界坐标系下的起点坐标,Pend表示障碍物在世界坐标系下的终点坐标,dmin表示障碍物与机器人之间的最小距离,obscnt为一帧激光雷达数据中,识别出来障碍物类型数据段个数。
所述环境数据预处理模块中对获取的环境数据进行预处理,具体包括以下步骤:
21)通过以下公式来去除有效范围外的数据点:
其中,range的取值为激光雷达的最远有效测量距离;
21)通过以下方式来滤除孤立的噪声点:将激光雷达采集数据点进行离散得到离散数据序列{X(i)|i=1,2,3,......N},以离散序列中的第K个位置为中心,前后共取m个数据;对这m个数据采用升序或者降序的方式进行排列,将排序后的中间值作为原序列中第K个位置的值;K的取值依次从小到大,循环重复直到所有激光雷达数据处理完毕结束。
21)通过以下公司来对激光雷达测量机制进行缺陷补偿:
其中,di表示当前第i线激光雷达返回的距离数据;di-2表示当前第i-2线激光雷达返回的距离数据;di-1表示当前第i-1线激光雷达返回的距离数据;di+1表示当前第i+1线激光雷达返回的距离数据;di+2表示当前第i+2线激光雷达返回的距离数据。
所述非平面ABD处理模块中对激光雷达的距离、反射强度信息同时进行非平面ABD算法的环境数据分割聚类处理,具体方法如下:
31)建立空间坐标系,将某激光束的点集按照如下公式表示:
bg={P1,P2,P3,......,Pi,......PN},
其中,任意一点Pi=(xi,yi,si)投影到空间坐标系下,(xi,yi)为XOY的投影坐标,Z轴即 为si;
32)非平面ABD算法环境分割:循环比较空间坐标系下数据点集中每两个相邻点之间的差值,按照以下公式获得分割点点Pn和点Pn-1:
|dn-dn-1|>Dmax
其中:dn为当前扫描点的距离,dn-1为前一扫描点的距离,Dmax为分割阈值;
σ为反射强度的缩放系数;
Dmax通过以下公式来计算:
33)将点Pn和点Pn-1标记为分割点;
34)按照以下公式进行二次检测:
ξ(dn)=k*dn;
且ξ(dn)≤μ;
其中,k为常系数,ξ(dn)为阈值,μ为常值;
35)判断|dn-dn-1|>ξ(dn)是否成立,如果成立,则将点Pn和点Pn-1标记为分割点;
如果不成立,则取消分割点标记;
36)循环重复所有环境数据,得到簇群集合。
所述障碍物匹配模块中不同簇群的数据集合与障碍物类别进行匹配,具体过程如下:
41)连接簇群的数据集合中的起点到顶点、终点到顶点及坐标原点形成闭合图形,计算第一面积S1;
42)逐个两两连接簇群数据集合中各个点并与坐标原点形成闭合图形,计算第二面积S2;
43)判断第一面积与第二面积之差是否小于零,如果是,则连接顶点和起点、顶点和终点;判断簇群所有点能否在直线阈值δ内收敛于L1和L2;如果能,则簇群的点为尖峰形障碍物,如果否,则簇群的点为凸圆弧形障碍物;
44)如果第一面积与第二面积之差不小于零,则进一步判断第一面积与第二面积之差是否小于直线阈值δ,如果是,则簇群的点为凹形障碍物。
所述障碍物匹配模块中障碍物具体按照以下过程进行匹配:
S41)尖峰型障碍物是通过以下方式来获取的:计算簇群的数据集合中从起点到顶点、终点到顶点的所有数据的收敛直线,如果收敛直线为两条不同的直线且两条直线的交点在平面坐标系中,则数据集合为尖峰型障碍物;
S42)凸圆弧形障碍物是通过以下方式来获取的:计算簇群的数据集合中各个点与原点形成的微分区域面积,如果微分区域面积小于起点、终点及原点形成的三角形面积且该簇群不收敛于两条直线,则数据集合为凸圆弧形障碍物;
S43)凹形障碍物是通过以下方式来获取的:计算簇群的数据集合中各个点与原点形成的微分区域面积,如果微分区域面积大于起点、终点及原点形成的三角形面积,则数据集合为凹形障碍物。
实施例2
对障碍物进行识别的首先要将该点集里的数据进行聚类分析。考虑到传统的激光雷达障碍物识别方法的局限性,本实施例将利用激光雷达输出的环境反射强度信息,将常用的环境距离信息上升到非平面的三维空间,并提出基于非平面数据分割的障碍物识别方法,从而保证障碍物识别的实时性及准确性。
由于机器人在实时性要求较高的场景下避障行进时,往往不需要识别出障碍物的具体种类,只需要对障碍物形状进行大致的描述,考虑到二维扫描型激光雷达在环境检测时只能检测到障碍物的外部轮廓,因此,本发明将障碍物类型划分为凸形和凹形。而对于凸形障碍物,又可以分为尖峰型和圆弧形。
本实施例提供的考虑激光发射强度的激光雷达障碍物识别方法,具体包括以下步骤:
步骤1:连接二维扫描型激光雷达传感器,获取环境数据并以数组形式存储于计算机中,环境数据包括:
距离信息D={d1,d2,d3,...,di,...,dN}和反射强度信息S={s1,s2,s3,...,si,...,sN};
步骤2:对步骤1获取的环境数据进行预处理,包括去除有效范围外的数据点、滤除孤立的噪声点及对激光雷达测量机制的缺陷补偿。另外将环境数据从激光雷达的极坐标系下的数据转化为机器人或智能车辆的局部直角坐标系坐标,即将数据集合表示为:bg={P1,P2,P3,......,Pi,......PN},其中Pi表示为激光雷达第i线激光束反映的信息,即Pi=(xi,yi,si),(xi,yi)为第i线激光束检测到的环境在局部坐标系下的坐标,si为第i线激光束检测到的环境的反射强度。
步骤3:对激光雷达的距离、反射强度信息同时进行非平面ABD算法的环境数据分割聚类分析,具体方法如下:
建立空间坐标系
将某激光束的点集bg={P1,P2,P3,......,Pi,.....PN}中任意一点Pi=(xi,yi,si)投影到空间坐标系下,(xi,yi)为XOY的投影坐标,Z轴即为si,从而得到非平面下的点集分布情形。
非平面ABD算法环境分割
循环比较空间坐标系下数据点集中每两个相邻点之间的差值,当大于分割阈值时,则认为找到了分割点,公式如下:
|dn-dn-1|>Dmax
其中:dn为当前扫描点的距离,dn-1为前一扫描点的距离,Dmax为分割阈值;
σ为反射强度的缩放系数;
此处Dmax为:
其中:rn+1为dn和dn-1取得最小值,δ为余量。λ和Δφ如下图所示,图中φn和φn-1为点Pn和点Pn-1相当于激光雷达极坐标的角度值。
图1a、b为ABD算法示意图:图1a平面ABD算法,图1b非平面ABD算法。
如果点Pn和点Pn-1根据上述算法检测得出的结果都是分割点时,则暂时标记点Pn和点Pn-1为分割点,然后利用一个阈值ξ(dn)进行二次检测,ξ(dn)=k*dn,其中k为常系数。为了使分割点间的距离不至于太远,对阈值需要进行限定,规定ξ(dn)≤μ。若|dn-dn-1|>ξ(dn),则认为点Pn和点Pn-1为分割点,反之,则不是分割点,取消之前分割的标记。
对N个距离-反射强度数据通过基于非平面ABD算法的障碍物识别方法得出的n个簇群集合表示为Ω={Ω1,Ω2,......,Ωj,......,Ωn};
其中,Ωj表示为第j个簇群类别,Ωj={Pj1,Pj2,......,Pjk,......,PjM},M为第j个簇群类别所包含的数据点个数,每个数据点内的信息包括上文中的时间坐标系下的坐标和对应的环境反射强度,即Pjk=(xi,yj,s)。
步骤4:不同簇群的数据集与障碍物类别进行匹配。
图2a-d激光雷达距离数据分布与障碍类型的关系示意图,考虑到激光雷达是循环扫描机 制,因此每一簇的第一个点是障碍物的起点,每一簇的最后一个点是障碍物的终点,如图2a所示;对于凸形障碍物,每一簇数据中离机器人最近的点常常是尖峰型障碍物或圆弧形障碍物的顶点,如图2a、2b所示;对于凹形障碍物,每一簇数据中离机器人最远的点是该凹形障碍物的顶点或终点,如图2d所示。
通过上述分析以及对通道和障碍物的特征分析可以得出以下几点结论:
①如果某一簇群是尖峰型障碍物,那么该簇群的起点到顶点、终点到顶点的所有数据都收敛于不同的两条直线,且两条直线的交点在平面坐标系中,属于顶点的阈值范围内。如图3a所示;
②如果某一簇群是凸圆弧形障碍物,那么该簇群的各个点与原点形成的微分区域面积小于起点、终点及原点形成的三角形面积且该簇群不能很好地收敛于两条直线。如图3b所示;
③如果某一簇群是凹形障碍物,那么的各个点与原点形成的微分区域面积大于起点、终点及原点形成的三角形面积。如图3c所示;图3a-c通道与障碍物散点分布规律示意图。
因此,根据上述结论,可以得出障碍物特征匹配方法,流程图如图4所示,图4为通道及障碍物特征匹配方法流程图;
经过上述步骤,可以得出障碍物的信息:
障碍物集合:Obs={obs1,obs2,......obsj,......obsobscnt};
其中,obsj=obs(type,Pstart,Pend,dmin),其中,type表示障碍物类型,Pstart表示障碍物在世界坐标系下的起点坐标,Pend表示障碍物在世界坐标系下的终点坐标,dmin表示障碍物与机器人之间的最小距离,obscnt为一帧激光雷达数据中,识别出来障碍物类型数据段个数。
实施例3
本实施例将详细介绍各步骤的具体内容。
步骤1:连接二维扫描型激光雷达传感器,获取环境数据并以数组形式存储于计算机中,环境数据包括距离信息,采用以下形式记录:
D={d1,d2,d3,...,di,...,dN};
反射强度信息S={s1,s2,s3,...,si,...,sN},常用的N取值为1024线。
步骤2:对获取的环境数据进行预处理。
去除有效范围外的数据点
激光雷达具有一定的测量范围,在干扰因素下会测量到范围之外的数据点,这些数据点是不可靠的点,应该予以及时的去除。一般只需要考虑激光雷达的实际测量范围内的数据点,超出这个范围的数据点称作为无效数据点。去除有效范围外的无效数据点,保留有用信息点,这样就可以在后续处理中减少数据处理量,有利于提高系统实时性。参见下面公式:
一般range的取值为激光雷达的最远有效测量距离,常见的为4000mm。
滤除孤立的噪声点:激光雷达采集数据点的离散数据序列为{X(i)|i=1,2,3,......N},以序列中的第K个位置为中心,前后共取m个数据,m一般为奇数。对这m个数据采用升序或者降序的方式进行排列,将排序后的中间值作为原序列中第K个位置的值。K的取值依次从小到大,实现对整个激光雷达数据的滤波。一般m取10即可。
激光雷达测量机制的缺陷补偿:激光雷达缺陷补偿主要针对其零点现象,补偿公式如下:
流程图如图4所示,图4为激光雷达数据预处理流程图;
步骤3:对激光雷达的距离、反射强度信息同时进行非平面ABD算法的环境数据分割聚类分析,具体方法如下:
建立空间坐标系:将某激光束的点集,如下所示:
bg={P1,P2,P3,......,Pi,......PN}中任意一点Pi=(xi,yi,si)投影到空间坐标系下,(xi,yi)为XOY的投影坐标,Z轴即为si,从而得到非平面下的点集分布情形。
非平面ABD算法环境分割:循环比较空间坐标系下数据点集中每两个相邻点之间的差值,当大于分割阈值时,则认为找到了分割点,公式如下:
|dn-dn-1|>Dmax
其中:dn为当前扫描点的距离,dn-1为前一扫描点的距离,Dmax为分割阈值;
为了使sn和(xn,yn)在同一数量级,一般反射强度的缩放系数σ取值为0.3。
此处Dmax描述如下:
如果点Pn和点Pn-1根据上述算法检测得出的结果都是分割点时,则暂时标记点Pn和点Pn-1为分割点,然后利用一个阈值ξ(dn)进行二次检测,ξ(dn)=k*dn,其中k为常系数。为了使分割点间的距离不至于太远,本发明需要对阈值进行限定,规定ξ(dn)≤μ。若|dn-dn-1|>ξ(dn),则认为点Pn和点Pn-1为分割点,反之,则不是分割点,取消之前分割的标记。此处,μ常取值为10cm,k为0.15,δ为0.03m,λ=10°。
对N个距离-反射强度数据通过基于非平面ABD算法的障碍物识别方法得出的n个簇群集合表示为Ω={Ω1,Ω2,......,Ωj,......,Ωn};
其中,Ωj表示为第j个簇群类别,Ωj={Pj1,Pj2,......,Pjk,......,PjM},M为第j个簇群类别所包含的数据点个数,每个数据点内的信息包括上文中的时间坐标系下的坐标和对应的环境反射强度,即Pjk=(xi,yj,s)。
步骤4:不同簇群的数据集与障碍物类别进行匹配。匹配规则如下:
①如果某一簇群是尖峰型障碍物,那么该簇群的起点到顶点、终点到顶点的所有数据都收敛于不同的两条直线,且两条直线的交点在平面坐标系中,属于顶点的阈值范围内。
②如果某一簇群是凸圆弧形障碍物,那么该簇群的各个点与原点形成的微分区域面积小于起点、终点及原点形成的三角形面积且该簇群不能很好地收敛于两条直线。
③如果某一簇群是凹形障碍物,那么的各个点与原点形成的微分区域面积大于起点、终点及原点形成的三角形面积。
因此,根据上述结论,可以得出障碍物特征匹配方法,流程图如图5所示,图5为通道及障碍物特征匹配方法流程图;
经过上述步骤,可以得出障碍物的信息:
障碍物集合:Obs={obs1,obs2,......obsj,......obsobscnt};
其中obsj=obs(type,Pstart,Pend,dmin),其中,type表示障碍物类型,Pstart表示障碍物在世界坐标系下的起点坐标,Pend表示障碍物在世界坐标系下的终点坐标,dmin表示障碍物与机器人之间的最小距离,obscnt为一帧激光雷达数据中,识别出来障碍物类型数据段个数。
最后说明的是,以上实施例仅用以说明本发明的技术方案而非限制,尽管参照较佳实施例对本发明进行了详细说明,本领域的普通技术人员应当理解,可以对本发明的技术方案进行修改或者等同替换,而不脱离本技术方案的宗旨和范围,其均应涵盖在本发明的权利要 求范围当中。
Claims (10)
1.一种考虑激光发射强度的激光雷达障碍物识别方法,其特征在于:包括以下步骤:
步骤1:获取环境数据并以数组形式存储于计算机中,所述环境数据包括距离信息和反射强度信息;
步骤2:对获取的环境数据进行预处理,所述预处理包括去除有效范围外的数据点、滤除孤立噪声点和激光雷达测量机制的缺陷补偿;
步骤3:对激光雷达的距离信息、反射强度信息同时进行非平面ABD算法的环境数据分割聚类处理,得出的n个簇群集合,所述簇群集合采用以下公式来表达:
Ω={Ω1,Ω2,......,Ωj,......,Ωn},
其中,Ωj表示为第j个簇群类别,Ωj={Pj1,Pj2,......,Pjk,......,PjM},M为第j个簇群类别所包含的数据点个数,每个数据点内的信息包括上文中的时间坐标系下的坐标和对应的环境反射强度,即Pjk=(xi,yj,s);
步骤4:将不同簇群的数据集合与障碍物类别进行匹配,得到障碍物集合信息,所述障碍物集合信息包括尖峰型障碍物、凸圆弧形障碍物和凹形障碍物;所述障碍物集合信息采用以下公式来表示:
Obs={obs1,obs2,......obsj,......obsobscnt},
其中,obsj=obs(type,Pstart,Pend,dmin),type表示障碍物类型,Pstart表示障碍物在世界坐标系下的起点坐标,Pend表示障碍物在世界坐标系下的终点坐标,dmin表示障碍物与机器人之间的最小距离,obscnt为一帧激光雷达数据中,识别出来障碍物类型数据段个数。
2.如权利要求1所述的考虑激光发射强度的激光雷达障碍物识别方法,其特征在于:所述步骤2中对获取的环境数据进行预处理,具体包括以下步骤:
21)通过以下公式来去除有效范围外的数据点:
其中,range的取值为激光雷达的最远有效测量距离;
21)通过以下方式来滤除孤立的噪声点:将激光雷达采集数据点进行离散得到离散数据序列{X(i)|i=1,2,3,...,N},以离散序列中的第K个位置为中心,前后共取m个数据;对这m个数据采用升序或者降序的方式进行排列,将排序后的中间值作为原序列中第K个位置的值;K的取值依次从小到大,循环重复直到所有激光雷达数据处理完毕结束。
21)通过以下公司来对激光雷达测量机制进行缺陷补偿:
其中,di表示当前第i线激光雷达返回的距离数据;di-2表示当前第i-2线激光雷达返回的距离数据;di-1表示当前第i-1线激光雷达返回的距离数据;di+1表示当前第i+1线激光雷达返回的距离数据;di+2表示当前第i+2线激光雷达返回的距离数据。
3.如权利要求1所述的考虑激光发射强度的激光雷达障碍物识别方法,其特征在于:所述步骤3中对激光雷达的距离、反射强度信息同时进行非平面ABD算法的环境数据分割聚类处理,具体方法如下:
31)建立空间坐标系,将某激光束的点集按照如下公式表示:
bg={P1,P2,P3,......,Pi,......PN},
其中,任意一点Pi=(xi,yi,si)投影到空间坐标系下,(xi,yi)为XOY的投影坐标,Z轴即为si;
32)非平面ABD算法环境分割:循环比较空间坐标系下数据点集中每两个相邻点之间的差值,按照以下公式获得分割点点Pn和点Pn-1:
|dn-dn-1|>Dmax
其中:dn为当前扫描点的距离,dn-1为前一扫描点的距离,Dmax为分割阈值;
σ为反射强度的缩放系数;
Dmax通过以下公式来计算:
33)将点Pn和点Pn-1标记为分割点;
34)按照以下公式进行二次检测:
ξ(dn)=k*dn;
且ξ(dn)≤μ;
其中,k为常系数,ξ(dn)为阈值,μ为常值;
35)判断|dn-dn-1|>ξ(dn)是否成立,如果成立,则将点Pn和点Pn-1标记为分割点;
如果不成立,则取消分割点标记;
36)循环重复所有环境数据,得到簇群集合。
4.如权利要求1所述的考虑激光发射强度的激光雷达障碍物识别方法,其特征在于:所述步骤4中不同簇群的数据集合与障碍物类别进行匹配,具体过程如下:
41)连接簇群的数据集合中的起点到顶点、终点到顶点及坐标原点形成三角形,并计算该三角形的面积S1;
42)逐个两两连接簇群数据集合中各个点并与坐标原点形成闭合图形,计算该闭合图形的面积S2;
43)判断第一面积与第二面积之差是否小于零,如果是,则连接顶点和起点、顶点和终点分别得到两条直线,记为L1、L2;判断簇群所有点能否在阈值内收敛于L1和L2;如果能,则簇群的点为尖峰形障碍物,如果否,则簇群的点为凸圆弧形障碍物;
44)如果第S1与S2之差不小于零,则进一步判断第一面积与第二面积之差是否小于直线阈值δ,如果是,则簇群的点为凹形障碍物。
5.如权利要求4所述的考虑激光发射强度的激光雷达障碍物识别方法,其特征在于:所述步骤4中障碍物具体按照以下过程进行匹配:
41)尖峰型障碍物是通过以下方式来获取的:计算簇群的数据集合中从起点到顶点、终点到顶点的所有数据的收敛直线,如果收敛直线为两条不同的直线且两条直线的交点在平面坐标系中,则数据集合为尖峰型障碍物;
42)凸圆弧形障碍物是通过以下方式来获取的:计算簇群的数据集合中各个点与原点形成的微分区域面积,如果微分区域面积小于起点、终点及原点形成的三角形面积且该簇群不收敛于两条直线,则数据集合为凸圆弧形障碍物;
43)凹形障碍物是通过以下方式来获取的:计算簇群的数据集合中各个点与原点形成的微分区域面积,如果微分区域面积大于起点、终点及原点形成的三角形面积,则数据集合为凹形障碍物。
6.一种考虑激光发射强度的激光雷达障碍物识别系统,其特征在于:包括环境数据生成模块、环境数据预处理模块、非平面ABD处理模块和障碍物匹配模块;
所述环境数据生成模块,用于获取环境数据并以数组形式存储于计算机中,所述环境数据包括距离信息和反射强度信息;
所述环境数据预处理模块,用于对获取的环境数据进行预处理,所述预处理包括去除有效范围外的数据点、滤除孤立噪声点和激光雷达测量机制的缺陷补偿;
所述非平面ABD处理模块,用于对激光雷达的距离信息、反射强度信息同时进行非平面ABD算法的环境数据分割聚类处理,得出的n个簇群集合,所述簇群集合采用以下公式来表达:
Ω={Ω1,Ω2,......,Ωj,......,Ωn},
其中,Ωj表示为第j个簇群类别,Ωj={Pj1,Pj2,......,Pjk,......,PjM},M为第j个簇群类别所包含的数据点个数,每个数据点内的信息包括上文中的时间坐标系下的坐标和对应的环境反射强度,即Pjk=(xi,yj,s);
所述障碍物匹配模块,用于将不同簇群的数据集合与障碍物类别进行匹配,得到障碍物集合信息,所述障碍物集合信息包括尖峰型障碍物、凸圆弧形障碍物和凹形障碍物;所述障碍物集合信息采用以下公式来表示:
Obs={obs1,obs2,......obsj,......obsobscnt},
其中,obsj=obs(type,Pstart,Pend,dmin),type表示障碍物类型,Pstart表示障碍物在世界坐标系下的起点坐标,Pend表示障碍物在世界坐标系下的终点坐标,dmin表示障碍物与机器人之间的最小距离,obscnt为一帧激光雷达数据中,识别出来障碍物类型数据段个数。
7.如权利要求6所述的考虑激光发射强度的激光雷达障碍物识别系统,其特征在于:所述环境数据预处理模块中对获取的环境数据进行预处理,具体包括以下步骤:
21)通过以下公式来去除有效范围外的数据点:
其中,range的取值为激光雷达的最远有效测量距离;
21)通过以下方式来滤除孤立的噪声点:将激光雷达采集数据点进行离散得到离散数据序列{X(i)|i=1,2,3,......N},以离散序列中的第K个位置为中心,前后共取m个数据;对这m个数据采用升序或者降序的方式进行排列,将排序后的中间值作为原序列中第K个位置的值;K的取值依次从小到大,循环重复直到所有激光雷达数据处理完毕结束。
21)通过以下公司来对激光雷达测量机制进行缺陷补偿:
其中,di表示当前第i线激光雷达返回的距离数据;di-2表示当前第i-2线激光雷达返回的距离数据;di-1表示当前第i-1线激光雷达返回的距离数据;di+1表示当前第i+1线激光雷达返回的距离数据;di+2表示当前第i+2线激光雷达返回的距离数据。
8.如权利要求6所述的考虑激光发射强度的激光雷达障碍物识别系统,其特征在于:所述非平面ABD处理模块中对激光雷达的距离、反射强度信息同时进行非平面ABD算法的环境数据分割聚类处理,具体方法如下:
31)建立空间坐标系,将某激光束的点集按照如下公式表示:
bg={P1,P2,P3,......,Pi,......PN},
其中,任意一点Pi=(xi,yi,si)投影到空间坐标系下,(xi,yi)为XOY的投影坐标,Z轴即为si;
32)非平面ABD算法环境分割:循环比较空间坐标系下数据点集中每两个相邻点之间的差值,按照以下公式获得分割点点Pn和点Pn-1:
|dn-dn-1|>Dmax
其中:dn为当前扫描点的距离,dn-1为前一扫描点的距离,Dmax为分割阈值;
σ为反射强度的缩放系数;
Dmax通过以下公式来计算:
33)将点Pn和点Pn-1标记为分割点;
34)按照以下公式进行二次检测:
ξ(dn)=k*dn;
且ξ(dn)≤μ;
其中,k为常系数,ξ(dn)为阈值,μ为常值;
35)判断|dn-dn-1|>ξ(dn)是否成立,如果成立,则将点Pn和点Pn-1标记为分割点;
如果不成立,则取消分割点标记;
36)循环重复所有环境数据,得到簇群集合。
9.如权利要求6所述的考虑激光发射强度的激光雷达障碍物识别系统,其特征在于:所述障碍物匹配模块中不同簇群的数据集合与障碍物类别进行匹配,具体过程如下:
41)连接簇群的数据集合中的起点到顶点、终点到顶点及坐标原点形成闭合图形,计算第一面积S1;
42)逐个两两连接簇群数据集合中各个点并与坐标原点形成闭合图形,计算第二面积S2;
43)判断第一面积与第二面积之差是否小于零,如果是,则连接顶点和起点、顶点和终点;判断簇群所有点能否在直线阈值δ内收敛于L1和L2;如果能,则簇群的点为尖峰形障碍物,如果否,则簇群的点为凸圆弧形障碍物;
44)如果第一面积与第二面积之差不小于零,则进一步判断第一面积与第二面积之差是否小于直线阈值δ,如果是,则簇群的点为凹形障碍物。
10.如权利要求6所述的考虑激光发射强度的激光雷达障碍物识别系统,其特征在于:所述障碍物匹配模块中障碍物具体按照以下过程进行匹配:
S41)尖峰型障碍物是通过以下方式来获取的:计算簇群的数据集合中从起点到顶点、终点到顶点的所有数据的收敛直线,如果收敛直线为两条不同的直线且两条直线的交点在平面坐标系中,则数据集合为尖峰型障碍物;
S42)凸圆弧形障碍物是通过以下方式来获取的:计算簇群的数据集合中各个点与原点形成的微分区域面积,如果微分区域面积小于起点、终点及原点形成的三角形面积且该簇群不收敛于两条直线,则数据集合为凸圆弧形障碍物;
S43)凹形障碍物是通过以下方式来获取的:计算簇群的数据集合中各个点与原点形成的微分区域面积,如果微分区域面积大于起点、终点及原点形成的三角形面积,则数据集合为凹形障碍物。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201610213409.0A CN105866790B (zh) | 2016-04-07 | 2016-04-07 | 一种考虑激光发射强度的激光雷达障碍物识别方法及系统 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201610213409.0A CN105866790B (zh) | 2016-04-07 | 2016-04-07 | 一种考虑激光发射强度的激光雷达障碍物识别方法及系统 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN105866790A true CN105866790A (zh) | 2016-08-17 |
CN105866790B CN105866790B (zh) | 2018-08-10 |
Family
ID=56636198
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201610213409.0A Active CN105866790B (zh) | 2016-04-07 | 2016-04-07 | 一种考虑激光发射强度的激光雷达障碍物识别方法及系统 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN105866790B (zh) |
Cited By (29)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN108594264A (zh) * | 2018-04-28 | 2018-09-28 | 上海木木机器人技术有限公司 | 障碍物识别方法、系统及具有障碍物识别功能的机器人 |
CN108960738A (zh) * | 2018-07-17 | 2018-12-07 | 重庆大学 | 一种仓库通道环境下的激光雷达数据聚类方法 |
CN109188382A (zh) * | 2018-07-27 | 2019-01-11 | 惠州华阳通用电子有限公司 | 一种基于毫米波雷达的目标识别方法 |
CN109613553A (zh) * | 2018-12-18 | 2019-04-12 | 歌尔股份有限公司 | 基于激光雷达确定场景中物体数量的方法、装置及系统 |
CN109870705A (zh) * | 2017-12-01 | 2019-06-11 | 武汉万集信息技术有限公司 | 基于激光雷达的边界目标标识方法及装置 |
CN110091875A (zh) * | 2019-05-14 | 2019-08-06 | 长沙理工大学 | 基于物联网的深度学习型智能驾驶环境感知系统 |
CN110297256A (zh) * | 2019-07-23 | 2019-10-01 | 国网四川省电力公司信息通信公司 | 基于激光雷达扫描数据机器人机房巡视安全路线生成方法 |
CN110320531A (zh) * | 2018-03-30 | 2019-10-11 | 郑州宇通客车股份有限公司 | 基于激光雷达的障碍物识别方法、地图创建方法及装置 |
CN110412613A (zh) * | 2019-08-02 | 2019-11-05 | 上海木木机器人技术有限公司 | 基于激光的测量方法、移动装置、计算机设备和存储介质 |
CN110458055A (zh) * | 2019-07-29 | 2019-11-15 | 江苏必得科技股份有限公司 | 一种障碍物检测方法及系统 |
CN110815220A (zh) * | 2019-11-11 | 2020-02-21 | 深圳市荣盛智能装备有限公司 | 一种消防机器人的遇障处理方法 |
WO2020082947A1 (zh) * | 2018-10-22 | 2020-04-30 | 科沃斯机器人股份有限公司 | 行进控制的方法、设备及存储介质 |
CN111325229A (zh) * | 2018-12-17 | 2020-06-23 | 兰州大学 | 一种基于激光雷达的单线数据分析对物体空间封闭的聚类方法 |
CN111427355A (zh) * | 2020-04-13 | 2020-07-17 | 北京海益同展信息科技有限公司 | 障碍物数据处理方法、装置、设备及存储介质 |
CN111583257A (zh) * | 2020-05-28 | 2020-08-25 | 中国铁道科学研究院集团有限公司 | 铁路限界异物侵入检测方法、装置及系统 |
CN111624622A (zh) * | 2020-04-24 | 2020-09-04 | 库卡机器人(广东)有限公司 | 障碍物检测方法、装置 |
CN111937037A (zh) * | 2018-03-30 | 2020-11-13 | 日本电气方案创新株式会社 | 物体识别装置、物体识别方法和存储控制程序的非暂时性计算机可读介质 |
WO2020258703A1 (zh) * | 2019-06-27 | 2020-12-30 | 商汤集团有限公司 | 障碍物检测方法、智能驾驶控制方法、装置、介质及设备 |
CN112424629A (zh) * | 2018-06-26 | 2021-02-26 | 苏州宝时得电动工具有限公司 | 应用雷达的电动设备 |
WO2021104497A1 (zh) * | 2019-11-29 | 2021-06-03 | 广州视源电子科技股份有限公司 | 基于激光雷达的定位方法及系统、存储介质和处理器 |
CN112904841A (zh) * | 2021-01-12 | 2021-06-04 | 北京布科思科技有限公司 | 非水平朝向的单线定位避障方法和装置、设备及存储介质 |
CN113093176A (zh) * | 2019-12-23 | 2021-07-09 | 北京三快在线科技有限公司 | 线状障碍物检测方法、装置、电子设备和存储介质 |
CN113343835A (zh) * | 2021-06-02 | 2021-09-03 | 合肥泰瑞数创科技有限公司 | 一种适用于应急救援的物体识别方法、系统及存储介质 |
CN113432610A (zh) * | 2021-06-15 | 2021-09-24 | 云鲸智能(深圳)有限公司 | 机器人通行规划方法、装置、机器人及存储介质 |
CN115356747A (zh) * | 2022-10-19 | 2022-11-18 | 成都朴为科技有限公司 | 一种多线激光雷达障碍物识别方法和装置 |
WO2023045639A1 (zh) * | 2021-09-23 | 2023-03-30 | 追觅创新科技(苏州)有限公司 | 目标物体的确定方法、移动机器人、存储介质及电子装置 |
CN116048120A (zh) * | 2023-01-10 | 2023-05-02 | 中国建筑一局(集团)有限公司 | 一种未知动态环境下小型四旋翼无人机自主导航系统及方法 |
CN116972856A (zh) * | 2023-09-25 | 2023-10-31 | 中科开创(广州)智能科技发展有限公司 | 导轨移动式共享充电机器人路径规划方法、装置、设备及介质 |
CN113432610B (zh) * | 2021-06-15 | 2024-07-02 | 云鲸智能(深圳)有限公司 | 机器人通行规划方法、装置、机器人及存储介质 |
Families Citing this family (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
FR3137202A1 (fr) * | 2022-06-28 | 2023-12-29 | Continental Autonomous Mobility Germany | Procédé de détection d’une concavité globale sur une ligne polygonale |
Citations (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
KR0142605B1 (ko) * | 1995-03-18 | 1998-08-17 | 심상철 | 레이저를 이용한 3차원 시각인식장치 |
CN103400113A (zh) * | 2013-07-10 | 2013-11-20 | 重庆大学 | 基于图像处理的高速公路隧道行人检测方法 |
KR101392222B1 (ko) * | 2013-11-12 | 2014-05-08 | 국방과학연구소 | 표적 윤곽을 추출하는 레이저 레이더, 그것의 표적 윤곽 추출 방법 |
CN104408442A (zh) * | 2014-12-15 | 2015-03-11 | 长春理工大学 | 加速度传感器校正的激光雷达的路面类型识别方法及装置 |
CN104931977A (zh) * | 2015-06-11 | 2015-09-23 | 同济大学 | 一种用于智能车辆的障碍物识别方法 |
-
2016
- 2016-04-07 CN CN201610213409.0A patent/CN105866790B/zh active Active
Patent Citations (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
KR0142605B1 (ko) * | 1995-03-18 | 1998-08-17 | 심상철 | 레이저를 이용한 3차원 시각인식장치 |
CN103400113A (zh) * | 2013-07-10 | 2013-11-20 | 重庆大学 | 基于图像处理的高速公路隧道行人检测方法 |
KR101392222B1 (ko) * | 2013-11-12 | 2014-05-08 | 국방과학연구소 | 표적 윤곽을 추출하는 레이저 레이더, 그것의 표적 윤곽 추출 방법 |
CN104408442A (zh) * | 2014-12-15 | 2015-03-11 | 长春理工大学 | 加速度传感器校正的激光雷达的路面类型识别方法及装置 |
CN104931977A (zh) * | 2015-06-11 | 2015-09-23 | 同济大学 | 一种用于智能车辆的障碍物识别方法 |
Non-Patent Citations (2)
Title |
---|
JOHN HANCOCK ET.AL: "Laser Intensity -Based Obstacle Detection", 《CONFERENCE ON INTELLIGENT ROBOTS AND SYSTEMS》 * |
项志宇: "基于激光雷达的移动机器人障碍检测和自定位", 《中国优秀博硕士学位论文全文数据库(博士)信息科技辑》 * |
Cited By (41)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN109870705A (zh) * | 2017-12-01 | 2019-06-11 | 武汉万集信息技术有限公司 | 基于激光雷达的边界目标标识方法及装置 |
CN110320531B (zh) * | 2018-03-30 | 2021-09-03 | 郑州宇通客车股份有限公司 | 基于激光雷达的障碍物识别方法、地图创建方法及装置 |
CN111937037A (zh) * | 2018-03-30 | 2020-11-13 | 日本电气方案创新株式会社 | 物体识别装置、物体识别方法和存储控制程序的非暂时性计算机可读介质 |
CN110320531A (zh) * | 2018-03-30 | 2019-10-11 | 郑州宇通客车股份有限公司 | 基于激光雷达的障碍物识别方法、地图创建方法及装置 |
CN108594264A (zh) * | 2018-04-28 | 2018-09-28 | 上海木木机器人技术有限公司 | 障碍物识别方法、系统及具有障碍物识别功能的机器人 |
CN108594264B (zh) * | 2018-04-28 | 2021-10-22 | 诺亚机器人科技(上海)有限公司 | 障碍物识别方法、系统及具有障碍物识别功能的机器人 |
CN112424629A (zh) * | 2018-06-26 | 2021-02-26 | 苏州宝时得电动工具有限公司 | 应用雷达的电动设备 |
CN112424629B (zh) * | 2018-06-26 | 2024-04-09 | 苏州宝时得电动工具有限公司 | 应用雷达的电动设备 |
CN108960738B (zh) * | 2018-07-17 | 2022-02-15 | 重庆大学 | 一种仓库通道环境下的激光雷达数据聚类方法 |
CN108960738A (zh) * | 2018-07-17 | 2018-12-07 | 重庆大学 | 一种仓库通道环境下的激光雷达数据聚类方法 |
CN109188382A (zh) * | 2018-07-27 | 2019-01-11 | 惠州华阳通用电子有限公司 | 一种基于毫米波雷达的目标识别方法 |
CN109188382B (zh) * | 2018-07-27 | 2020-11-06 | 惠州华阳通用电子有限公司 | 一种基于毫米波雷达的目标识别方法 |
WO2020082947A1 (zh) * | 2018-10-22 | 2020-04-30 | 科沃斯机器人股份有限公司 | 行进控制的方法、设备及存储介质 |
US11487297B2 (en) | 2018-10-22 | 2022-11-01 | Ecovacs Robotics Co., Ltd. | Method of travel control, device and storage medium |
CN111325229A (zh) * | 2018-12-17 | 2020-06-23 | 兰州大学 | 一种基于激光雷达的单线数据分析对物体空间封闭的聚类方法 |
CN109613553A (zh) * | 2018-12-18 | 2019-04-12 | 歌尔股份有限公司 | 基于激光雷达确定场景中物体数量的方法、装置及系统 |
CN110091875A (zh) * | 2019-05-14 | 2019-08-06 | 长沙理工大学 | 基于物联网的深度学习型智能驾驶环境感知系统 |
WO2020258703A1 (zh) * | 2019-06-27 | 2020-12-30 | 商汤集团有限公司 | 障碍物检测方法、智能驾驶控制方法、装置、介质及设备 |
CN110297256A (zh) * | 2019-07-23 | 2019-10-01 | 国网四川省电力公司信息通信公司 | 基于激光雷达扫描数据机器人机房巡视安全路线生成方法 |
CN110458055A (zh) * | 2019-07-29 | 2019-11-15 | 江苏必得科技股份有限公司 | 一种障碍物检测方法及系统 |
CN110458055B (zh) * | 2019-07-29 | 2021-10-15 | 江苏必得科技股份有限公司 | 一种障碍物检测方法及系统 |
CN110412613B (zh) * | 2019-08-02 | 2021-08-10 | 上海智蕙林医疗科技有限公司 | 基于激光的测量方法、移动装置、计算机设备和存储介质 |
CN110412613A (zh) * | 2019-08-02 | 2019-11-05 | 上海木木机器人技术有限公司 | 基于激光的测量方法、移动装置、计算机设备和存储介质 |
CN110815220A (zh) * | 2019-11-11 | 2020-02-21 | 深圳市荣盛智能装备有限公司 | 一种消防机器人的遇障处理方法 |
WO2021104497A1 (zh) * | 2019-11-29 | 2021-06-03 | 广州视源电子科技股份有限公司 | 基于激光雷达的定位方法及系统、存储介质和处理器 |
CN113093176A (zh) * | 2019-12-23 | 2021-07-09 | 北京三快在线科技有限公司 | 线状障碍物检测方法、装置、电子设备和存储介质 |
CN111427355A (zh) * | 2020-04-13 | 2020-07-17 | 北京海益同展信息科技有限公司 | 障碍物数据处理方法、装置、设备及存储介质 |
CN111427355B (zh) * | 2020-04-13 | 2023-05-02 | 京东科技信息技术有限公司 | 障碍物数据处理方法、装置、设备及存储介质 |
CN111624622A (zh) * | 2020-04-24 | 2020-09-04 | 库卡机器人(广东)有限公司 | 障碍物检测方法、装置 |
CN111583257A (zh) * | 2020-05-28 | 2020-08-25 | 中国铁道科学研究院集团有限公司 | 铁路限界异物侵入检测方法、装置及系统 |
CN112904841B (zh) * | 2021-01-12 | 2023-11-03 | 北京布科思科技有限公司 | 非水平朝向的单线定位避障方法和装置、设备及存储介质 |
CN112904841A (zh) * | 2021-01-12 | 2021-06-04 | 北京布科思科技有限公司 | 非水平朝向的单线定位避障方法和装置、设备及存储介质 |
CN113343835A (zh) * | 2021-06-02 | 2021-09-03 | 合肥泰瑞数创科技有限公司 | 一种适用于应急救援的物体识别方法、系统及存储介质 |
CN113432610A (zh) * | 2021-06-15 | 2021-09-24 | 云鲸智能(深圳)有限公司 | 机器人通行规划方法、装置、机器人及存储介质 |
CN113432610B (zh) * | 2021-06-15 | 2024-07-02 | 云鲸智能(深圳)有限公司 | 机器人通行规划方法、装置、机器人及存储介质 |
WO2023045639A1 (zh) * | 2021-09-23 | 2023-03-30 | 追觅创新科技(苏州)有限公司 | 目标物体的确定方法、移动机器人、存储介质及电子装置 |
CN115356747A (zh) * | 2022-10-19 | 2022-11-18 | 成都朴为科技有限公司 | 一种多线激光雷达障碍物识别方法和装置 |
CN116048120A (zh) * | 2023-01-10 | 2023-05-02 | 中国建筑一局(集团)有限公司 | 一种未知动态环境下小型四旋翼无人机自主导航系统及方法 |
CN116048120B (zh) * | 2023-01-10 | 2024-04-16 | 中国建筑一局(集团)有限公司 | 一种未知动态环境下小型四旋翼无人机自主导航系统及方法 |
CN116972856A (zh) * | 2023-09-25 | 2023-10-31 | 中科开创(广州)智能科技发展有限公司 | 导轨移动式共享充电机器人路径规划方法、装置、设备及介质 |
CN116972856B (zh) * | 2023-09-25 | 2024-01-30 | 中科开创(广州)智能科技发展有限公司 | 导轨移动式共享充电机器人路径规划方法、装置、设备及介质 |
Also Published As
Publication number | Publication date |
---|---|
CN105866790B (zh) | 2018-08-10 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN105866790A (zh) | 一种考虑激光发射强度的激光雷达障碍物识别方法及系统 | |
CN109684921B (zh) | 一种基于三维激光雷达的道路边界检测与跟踪方法 | |
CN112014857B (zh) | 用于智能巡检的三维激光雷达定位导航方法及巡检机器人 | |
CN110988912B (zh) | 自动驾驶车辆的道路目标与距离检测方法、系统、装置 | |
Ozgunalp et al. | Multiple lane detection algorithm based on novel dense vanishing point estimation | |
CA2950791C (en) | Binocular visual navigation system and method based on power robot | |
CN109460709A (zh) | 基于rgb和d信息融合的rtg视觉障碍物检测的方法 | |
CN106595659A (zh) | 城市复杂环境下多无人机视觉slam的地图融合方法 | |
Lookingbill et al. | Reverse optical flow for self-supervised adaptive autonomous robot navigation | |
CN103424112B (zh) | 一种基于激光平面辅助的运动载体视觉导航方法 | |
US11379963B2 (en) | Information processing method and device, cloud-based processing device, and computer program product | |
CN110427797B (zh) | 一种基于几何条件限制的三维车辆检测方法 | |
CN110197173B (zh) | 一种基于双目视觉的路沿检测方法 | |
Shunsuke et al. | GNSS/INS/on-board camera integration for vehicle self-localization in urban canyon | |
CN115032651A (zh) | 一种基于激光雷达与机器视觉融合的目标检测方法 | |
CN107885224A (zh) | 基于三目立体视觉的无人机避障方法 | |
CN111862673A (zh) | 基于顶视图的停车场车辆自定位及地图构建方法 | |
CN110992424B (zh) | 基于双目视觉的定位方法和系统 | |
CN106446785A (zh) | 基于双目视觉的可行道路检测方法 | |
CN111178150A (zh) | 车道线检测方法、系统及存储介质 | |
CN113327297B (zh) | 基于深度学习的深海海底障碍物测量系统与识别方法 | |
Sehestedt et al. | Efficient lane detection and tracking in urban environments | |
Li et al. | A new 3D LIDAR-based lane markings recognition approach | |
Li et al. | Lane marking quality assessment for autonomous driving | |
CN115410181A (zh) | 双头解耦对齐的全场景目标检测方法、系统、装置及介质 |
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 | ||
TR01 | Transfer of patent right | ||
TR01 | Transfer of patent right |
Effective date of registration: 20230209 Address after: 213399 room 5025, building B, 218 Hongkou Road, Kunlun Street, Liyang City, Changzhou City, Jiangsu Province Patentee after: Liyang Smart City Research Institute of Chongqing University Address before: 400044 No. 174 Sha Jie street, Shapingba District, Chongqing Patentee before: Chongqing University |