CN112650230A - 基于单线激光雷达的自适应贴边作业方法、装置及机器人 - Google Patents
基于单线激光雷达的自适应贴边作业方法、装置及机器人 Download PDFInfo
- Publication number
- CN112650230A CN112650230A CN202011479111.7A CN202011479111A CN112650230A CN 112650230 A CN112650230 A CN 112650230A CN 202011479111 A CN202011479111 A CN 202011479111A CN 112650230 A CN112650230 A CN 112650230A
- Authority
- CN
- China
- Prior art keywords
- point cloud
- road edge
- laser radar
- line laser
- distance detection
- 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
- 238000000034 method Methods 0.000 title claims abstract description 49
- 238000001514 detection method Methods 0.000 claims abstract description 90
- 238000003708 edge detection Methods 0.000 claims abstract description 25
- 238000001914 filtration Methods 0.000 claims abstract description 22
- 230000000875 corresponding effect Effects 0.000 claims abstract description 14
- 238000012217 deletion Methods 0.000 claims abstract description 3
- 230000003044 adaptive effect Effects 0.000 claims description 20
- 230000033001 locomotion Effects 0.000 claims description 18
- 230000001276 controlling effect Effects 0.000 claims description 10
- 238000009499 grossing Methods 0.000 claims description 5
- 230000002159 abnormal effect Effects 0.000 claims description 3
- 238000005457 optimization Methods 0.000 claims description 3
- 238000007781 pre-processing Methods 0.000 claims description 3
- 230000037430 deletion Effects 0.000 abstract 1
- 238000010586 diagram Methods 0.000 description 7
- 238000004422 calculation algorithm Methods 0.000 description 4
- 238000005286 illumination Methods 0.000 description 4
- 238000004364 calculation method Methods 0.000 description 3
- 238000004590 computer program Methods 0.000 description 3
- 230000009286 beneficial effect Effects 0.000 description 2
- 230000000694 effects Effects 0.000 description 2
- 230000007613 environmental effect Effects 0.000 description 2
- 230000004927 fusion Effects 0.000 description 2
- 238000009434 installation Methods 0.000 description 2
- 230000004048 modification Effects 0.000 description 2
- 238000012986 modification Methods 0.000 description 2
- 239000000523 sample Substances 0.000 description 2
- 239000004575 stone Substances 0.000 description 2
- 238000009825 accumulation Methods 0.000 description 1
- 230000004888 barrier function Effects 0.000 description 1
- 230000005540 biological transmission Effects 0.000 description 1
- 239000004568 cement Substances 0.000 description 1
- 230000007812 deficiency Effects 0.000 description 1
- 230000009977 dual effect Effects 0.000 description 1
- 230000006872 improvement Effects 0.000 description 1
- 230000003287 optical effect Effects 0.000 description 1
- 230000002265 prevention Effects 0.000 description 1
- 230000035939 shock Effects 0.000 description 1
- 230000003068 static effect Effects 0.000 description 1
- 238000010408 sweeping Methods 0.000 description 1
Images
Classifications
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
- G05D1/00—Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
- G05D1/02—Control of position or course in two dimensions
- G05D1/021—Control of position or course in two dimensions specially adapted to land vehicles
- G05D1/0231—Control of position or course in two dimensions specially adapted to land vehicles using optical position detecting means
- G05D1/0238—Control of position or course in two dimensions specially adapted to land vehicles using optical position detecting means using obstacle or wall sensors
- G05D1/024—Control of position or course in two dimensions specially adapted to land vehicles using optical position detecting means using obstacle or wall sensors in combination with a laser
-
- 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
- G01S17/89—Lidar systems specially adapted for specific applications for mapping or imaging
-
- 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
- G01S17/93—Lidar systems specially adapted for specific applications for anti-collision purposes
- G01S17/931—Lidar systems specially adapted for specific applications for anti-collision purposes of land vehicles
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
- G05D1/00—Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
- G05D1/02—Control of position or course in two dimensions
- G05D1/021—Control of position or course in two dimensions specially adapted to land vehicles
- G05D1/0212—Control of position or course in two dimensions specially adapted to land vehicles with means for defining a desired trajectory
- G05D1/0214—Control of position or course in two dimensions specially adapted to land vehicles with means for defining a desired trajectory in accordance with safety or protection criteria, e.g. avoiding hazardous areas
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
- G05D1/00—Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
- G05D1/02—Control of position or course in two dimensions
- G05D1/021—Control of position or course in two dimensions specially adapted to land vehicles
- G05D1/0212—Control of position or course in two dimensions specially adapted to land vehicles with means for defining a desired trajectory
- G05D1/0221—Control of position or course in two dimensions specially adapted to land vehicles with means for defining a desired trajectory involving a learning process
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
- G05D1/00—Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
- G05D1/02—Control of position or course in two dimensions
- G05D1/021—Control of position or course in two dimensions specially adapted to land vehicles
- G05D1/0255—Control of position or course in two dimensions specially adapted to land vehicles using acoustic signals, e.g. ultra-sonic singals
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
- G05D1/00—Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
- G05D1/02—Control of position or course in two dimensions
- G05D1/021—Control of position or course in two dimensions specially adapted to land vehicles
- G05D1/0257—Control of position or course in two dimensions specially adapted to land vehicles using a radar
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
- G05D1/00—Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
- G05D1/02—Control of position or course in two dimensions
- G05D1/021—Control of position or course in two dimensions specially adapted to land vehicles
- G05D1/0276—Control of position or course in two dimensions specially adapted to land vehicles using signals provided by a source external to the vehicle
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
- G05D1/00—Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
- G05D1/02—Control of position or course in two dimensions
- G05D1/021—Control of position or course in two dimensions specially adapted to land vehicles
- G05D1/0287—Control of position or course in two dimensions specially adapted to land vehicles involving a plurality of land vehicles, e.g. fleet or convoy travelling
- G05D1/0291—Fleet control
Landscapes
- Engineering & Computer Science (AREA)
- Physics & Mathematics (AREA)
- Remote Sensing (AREA)
- Radar, Positioning & Navigation (AREA)
- General Physics & Mathematics (AREA)
- Aviation & Aerospace Engineering (AREA)
- Automation & Control Theory (AREA)
- Electromagnetism (AREA)
- Computer Networks & Wireless Communication (AREA)
- Optics & Photonics (AREA)
- Acoustics & Sound (AREA)
- Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)
- Optical Radar Systems And Details Thereof (AREA)
- Traffic Control Systems (AREA)
Abstract
本发明公开了一种基于单线激光雷达的自适应贴边作业方法、装置及机器人,所述方法包括步骤:将单线激光雷达扫描所得的点云分解到XY平面;依次进行两次差分运算,并对两次差分运算后进行滤波删除;将点云进行DBSCAN聚类;利用路沿侧边点云的几何特征找出路沿侧边点云聚类,并将所述路沿侧边点云聚类中第一个点云ξ1的X分量ξ1_X作为当前帧路沿距离检测值;将满足设定条件各帧路沿检测结果的平均值Ω作为路沿距离检测值d发送至机器人的整车控制器;发送指令使整车控制器根据路沿距离检测值d控制转向系统执行相应的动作实现机器人贴边运动。本发明检测距离广,检测精度高,且对环境具有较强的适应性及抗干扰能力,成本低。
Description
技术领域
本发明涉及机器人控制技术领域,特别地,涉及一种基于单线激光雷达的自适应贴边作业系统、装置及机器人。
背景技术
传统作业中,在环卫装备进行路面清洁时依靠眼睛观察,控制方向盘保持扫盘与路沿的距离,准确性较差,对作业效果影响较大。驾驶员观察路沿的同时还需观察前方路况保障驾驶,劳动强度较大。驾驶员同时处理多种工作,对驾驶安全影响大,因此,为降低驾驶员劳动强度,提高驾驶安全性,目前有些环卫装备设置了通过融合多种传感器进行路沿检测的辅助驾驶系统,以降低对驾驶员的依赖。常用的传感器包括GPS定位、轮速计、IMU传感器、双16线激光雷达、摄像头等,然而,工程实践证明,上述传感器存在诸多不足,包括:
1、GPS定位、轮速计、IMU传感器会随着机器人移动自身误差不断累积,贴边检测信息精度较差。
2、采用GPS定位精度较差,采用视觉对车道线进行识别容易受周围环境、光照影响。
3、采用双16线激光雷达,由于主控制器要求算力较高,因此对主控制器的硬件要求高,成本高企。
4、采用多传感器融合方式,成本过高,不利于商业化推广。
发明内容
本发明一方面提供了一种基于单线激光雷达的自适应贴边作业方法,以解决现有辅助驾驶系统检测精度较差、易受环境光照影响、以及成本过高的技术问题。
本发明采用的技术方案如下:
一种基于单线激光雷达的自适应贴边作业方法,包括步骤:
将单线激光雷达扫描所得的点云ξi分解到XY平面,得到针对每一个点云ξi的X、Y分量分别为ξi_X、ξi_Y,保存到集合A中,其中,XY平面与单线激光雷达的扫描面共面,且以单线激光雷达的中心为原点,Y轴向上垂直地面,X轴指向路沿方向;对集合A中的ξi_Y依次进行两次差分运算,并对两次差分运算后将ξi_Y>=0的点云进行滤波删除,得到ξi_Y<0的所有点云;
将滤波删除后所得到的ξi_Y<0的所有点云进行DBSCAN聚类,得到数量为n的聚类集合φi;
利用路沿侧边点云的几何特征从聚类集合φi中找出路沿侧边点云聚类,并将所述路沿侧边点云聚类中第一个点云ξ1的X分量ξ1_X作为当前帧路沿距离检测值;
若当前帧路沿距离检测值与历史帧路沿距离检测值之差满足设定条件时,将满足设定条件各帧路沿检测结果的平均值Ω作为路沿距离检测值d发送至机器人的整车控制器;
发送指令使整车控制器根据路沿距离检测值d控制转向系统执行相应的动作以实现机器人贴边运动。
进一步地,将单线激光雷达扫描所得的点云ξi分解到XY平面之前,还包括步骤:
将单线激光雷达扫描所得的点云数据进行预处理,剔除噪声点、异常点数据。
进一步地,将单线激光雷达扫描所得的点云ξi分解到XY平面之前,还包括步骤:
对预处理后的点云进行直通滤波,保留序号ID为设定范围值的点云。
进一步地,将单线激光雷达扫描所得的点云ξi分解到XY平面之前,还包括步骤:
对直通滤波后的点云进行曲线平滑,保留曲线趋势特征。
进一步地,对集合A中的ξi_Y依次进行两次差分运算,并对两次差分运算后将ξi_Y>=0的点云进行滤波删除,得到ξi_Y<0的所有点云,具体包括步骤:
对集合A中的ξi_Y进行第一次差分运算,得到集合A1;
对集合A1中的ξi_Y进行第二次差分运算,得到集合A2;
将集合A2中ξi_Y>=0的点云数据进行滤波删除,在集合A2中保留ξi_Y<0的所有点云。
进一步地,利用路沿侧边点云的几何特征从聚类集合φi中找出路沿侧边点云聚类,并将所述路沿侧边点云聚类中第一个点云ξ1的X分量ξ1_X作为当前帧路沿检测结果,具体包括步骤:
针对每一个聚类集合φi,判断其中的点云是否满足(ξi_Y–ξi-1_Y<δ)&&(ξmax_Y–ξmin_Y>σ)&&(ξmax_X-ξmin_X<λ)&&(ξi>m),其中,ξmax_Y为点云的最大Y分量,ξmin_Y为点云的最小Y分量,ξmax_X为点云的最大X分量,ξmin_X为点云的最小X分量,δ、σ、λ、m均为设定阈值;
若满足,则对应的聚类集合φi即为路沿侧边点云聚类,将所述路沿侧边点云聚类中第一个点云ξ1的X分量ξ1_X作为当前帧路沿距离检测值,记为ε。
进一步地,若当前帧路沿距离检测值与历史帧路沿距离检测值之差满足设定条件时,将满足设定条件各帧路沿检测结果的平均值Ω作为路沿距离检测值d发送至机器人的整车控制器,具体包括步骤:
在第i时刻,若(|εi-1-εi|<η),则将εi存入队列L中;
取队列L中εi的平均值Ω作为路沿距离检测值d发送至机器人的整车控制器。
进一步地,发送指令使整车控制器根据路沿距离检测值d控制转向系统执行相应的动作实现机器人贴边运动,具体包括步骤:
启动前根据路沿距离检测值d进行车身姿态调整,若α<d<β,则车身方向与行进方向一致,通过整车控制器控制转向系统回正;若d>β,则通过整车控制器控制转向系统右转一定角度,完成车身姿态调整;若d<α,则通过整车控制器控制转向系统左转一定角度,完成车身姿态调整;
完成车身姿态调整后,发送指令使整车控制器根据当前路沿距离检测值d、车身姿态及停障信息控制转向系统执行进行横向、纵向、制动控制,以实现机器人贴边运动。
本发明另一个方面还提供了一种基于单线激光雷达的自适应贴边作业装置,包括:
点云分量获取模块,用于将单线激光雷达扫描所得的点云ξi分解到XY平面,得到针对每一个点云ξi的X、Y分量分别为ξi_X、ξi_Y,保存到集合A中,其中,XY平面与单线激光雷达的扫描面共面,且以单线激光雷达的中心为原点,Y轴向上垂直地面,X轴指向路沿方向;
差分运算模块,用于对集合A中的ξi_Y依次进行两次差分运算,并对两次差分运算后将ξi_Y>=0的点云进行滤波删除,得到ξi_Y<0的所有点云;
点云聚类模块,用于将滤波删除后所得到的ξi_Y<0的所有点云进行DBSCAN聚类,得到数量为n的聚类集合φi;
路沿距离检测模块,用于利用路沿侧边点云的几何特征从聚类集合φi中找出路沿侧边点云聚类,并将所述路沿侧边点云聚类中第一个点云ξ1的X分量ξ1_X作为当前帧路沿距离检测值;
路沿距离优化模块,用于若当前帧路沿距离检测值与历史帧路沿距离检测值之差满足设定条件时,将满足设定条件各帧路沿检测结果的平均值Ω作为路沿距离检测值d发送至机器人的整车控制器;
贴边运动控制模块,用于发送指令使整车控制器根据路沿距离检测值d控制转向系统执行相应的动作以实现机器人贴边运动。
本发明另一个方面还提供了一种机器人,包括:
单线激光雷达,安装于机器人前侧,其扫描面与地面垂直且与路沿相交设定夹角;
整车控制器,用于根据指令控制机器人的横向、纵向移动及制动;
工控机,分别与所述单线激光雷达和整车控制器信号连接,用于实现所述的自适应贴边作业方法。
本发明另一方面还提供了一种电子设备,包括存储器、处理器及存储在存储器上并可在处理器上运行的计算机程序,所述处理器执行所述程序时实现所述的自适应贴边作业方法。
本发明另一方面还提供了一种存储介质,所述存储介质包括存储的程序,在所述程序运行时控制所述存储介质所在的设备执行所述的自适应贴边作业方法。
本发明具有以下有益效果:
本发明的自适应贴边作业方法基于单线激光雷达准确识别路沿,充分挖掘路沿几何形态,通过计算二阶差分获得点云数据曲线趋势并利用点云聚类算法,求取路沿与地面的几何分割点,同时结合历史轨迹数据,最终获得路沿检测信息;由于单线激光雷达角分辨率高,不受环境光影响,因此本发明检测距离广,检测精度高,且对环境具有较强的适应性及抗干扰能力,对环境光照要求低,白天夜晚均适用,环境适应性好;仅采用单线激光雷达,所需算力很小,硬件成本低,能快速检测出路沿信息;可作为机器人辅助驾驶系统智能自适应检测路沿,控制机器人贴边作业,安全可靠,能够大大降低环卫工人的劳动强度,提高贴边作业的安全性、可靠性。
除了上面所描述的目的、特征和优点之外,本发明还有其它的目的、特征和优点。下面将参照附图,对本发明作进一步详细的说明。
附图说明
构成本申请的一部分的附图用来提供对本发明的进一步理解,本发明的示意性实施例及其说明用于解释本发明,并不构成对本发明的不当限定。在附图中:
图1为本发明优选实施例的基于单线激光雷达的自适应贴边作业方法流程示意图。
图2为本发明另一优选实施例的基于单线激光雷达的自适应贴边作业方法流程示意图。
图3是点云预处理后的效果示意图。
图4为本发明另一优选实施例的基于单线激光雷达的自适应贴边作业方法流程示意图。
图5为另一优选实施例的基于单线激光雷达的自适应贴边作业方法流程示意图。
图6为本发明优选实施例的自适应贴边作业方法中步骤S5的子流程示意图。
图7为二次差分及滤波原理示意图。
图8为DBSCAN聚类后结果示意图。
图9为本发明优选实施例的自适应贴边作业方法中步骤S7的子流程示意图。
图10是聚类后路沿点云在XY平面的分布示意图。
图11为本发明优选实施例的自适应贴边作业方法中步骤S8的子流程示意图。
图12为本发明另一优选实施例的自适应贴边作业方法中步骤S8的子流程示意图。
图13为本发明优选实施例的自适应贴边作业方法中步骤S9的子流程示意图。
图14为本发明优选实施例的基于单线激光雷达的自适应贴边作业装置模块示意图。
图15为本发明优选实施例的电子设备实体示意框图。
图16为本发明优选实施例的机器人组成示意图。
图17为本发明优选实施例的机器人扫描俯视示意图。
具体实施方式
需要说明的是,在不冲突的情况下,本申请中的实施例及实施例中的特征可以相互组合。下面将参考附图并结合实施例来详细说明本发明。
如图1所示,本发明的优选实施例提供了一种基于单线激光雷达的自适应贴边作业方法,包括步骤:
S4、将单线激光雷达扫描所得的点云ξi分解到XY平面,得到针对每一个点云ξi的X、Y分量分别为ξi_X、ξi_Y,保存到集合A中,其中,XY平面与单线激光雷达的扫描面共面,且以单线激光雷达的中心为原点,Y轴向上垂直地面,X轴指向路沿方向;
S5、对集合A中的ξi_Y依次进行两次差分运算,并对两次差分运算后将ξi_Y>=0的点云进行滤波删除,得到ξi_Y<0的所有点云;
S6、将滤波删除后所得到的ξi_Y<0的所有点云进行DBSCAN聚类,得到数量为n的聚类集合φi(聚类结果见图8);
S7、利用路沿侧边点云的几何特征从聚类集合φi中找出路沿侧边点云聚类,并将所述路沿侧边点云聚类中第一个点云ξ1的X分量ξ1_X作为当前帧路沿距离检测值;
S8、若当前帧路沿距离检测值与历史帧路沿距离检测值之差满足设定条件时,将满足设定条件各帧路沿检测结果的平均值Ω作为路沿距离检测值d发送至机器人的整车控制器;
S9、发送指令使整车控制器根据路沿距离检测值d控制转向系统执行相应的动作以实现机器人贴边运动。
本发明的自适应贴边作业方法基于单线激光雷达准确识别路沿,充分挖掘路沿几何形态,通过计算二阶差分获得点云数据曲线趋势并利用点云聚类算法,求取路沿与地面的几何分割点,同时结合历史轨迹数据,最终获得路沿检测信息;由于单线激光雷达角分辨率高,角分辨率为0.33,不受环境光影响,且扫描一周点云一共811个点,分别对811个点云设定序号ID为0-810,适用于高度>=5cm路沿石及高度为20cm-2m的水泥矮墙检测,在3m范围内检测精度<3cm,2m范围内检测精度<1cm,能够有效过滤井盖,因此本发明检测距离广,检测精度高,静态检测误差<1cm,动态检测误差<3cm;且对环境具有较强的适应性及抗干扰能力,对环境光照要求低,白天夜晚均适用,环境适应性好;仅采用单线激光雷达,所需算力很小,硬件成本低,能快速检测出路沿信息,商业推广度好;可作为机器人辅助驾驶系统智能自适应检测路沿,控制机器人贴边作业,安全可靠,能够大大降低环卫工人的劳动强度,提高贴边作业的安全性、可靠性。
如图2和3所示,在本发明的优选实施例中,将单线激光雷达扫描所得的点云ξi分解到XY平面之前,还包括步骤:
S1、将单线激光雷达扫描所得的点云数据进行预处理,剔除噪声点、异常点数据,确保后续点云数据的处理效率和精度。
如图4所示,在本发明的优选实施例中,将单线激光雷达扫描所得的点云ξi分解到XY平面之前,还包括步骤:
S2、对预处理后的点云进行直通滤波,保留序号ID为设定范围值的点云。
本实施例通过直通滤波保留序号ID为90-540的点云,选取此范围内的点云有助于保留路沿关键信息,同时过滤部分无效特征,节省后续算法使用的计算资源。
如图5所示,在本发明的优选实施例中,将单线激光雷达扫描所得的点云ξi分解到XY平面之前,还包括步骤:
S3、对直通滤波后的点云进行曲线平滑,保留曲线趋势特征。
本实施例通过对点云进行曲线平滑,达到滤波目的,从而排除少数很高或很低的点对曲线形成向上或向下的突刺,这时候使用平滑方法,使新的曲线相对平稳,更为准确的反应出曲线的整体趋势。
如图6所示,在本发明的优选实施例中,对集合A中的ξi_Y依次进行两次差分运算,并对两次差分运算后将ξi_Y>=0的点云进行滤波删除,得到ξi_Y<0的所有点云,具体包括步骤:
S51、对集合A中的ξi_Y进行第一次差分运算,得到集合A1;
S52、对集合A1中的ξi_Y进行第二次差分运算,得到集合A2;
S53、将集合A2中ξi_Y>=0的点云数据进行滤波删除,在集合A2中保留ξi_Y<0的所有点云。
本实施例通过对集合A中的ξi_Y依次进行两次差分运算后,将ξi_Y>=0的点云数据进行滤波删除,仅保留ξi_Y<0的所有点云,其中ξi_Y<0点云即为路沿石侧边所对应的点云(见图7),从而在进行贴边检测时排除其他不相关的点云,确保后续路沿检测的准确性和可靠性。
如图9所示,在本发明的优选实施例中,利用路沿侧边点云的几何特征从聚类集合φi中找出路沿侧边点云聚类,并将所述路沿侧边点云聚类中第一个点云ξ1的X分量ξ1_X作为当前帧路沿检测结果,具体包括步骤:
S71、针对每一个聚类集合φi,判断其中的点云是否满足(ξi_Y–ξi-1_Y<δ)&&(ξmax_Y–ξmin_Y>σ)&&(ξmax_X-ξmin_X<λ)&&(ξi>m),其中,ξmax_Y为点云的最大Y分量,ξmin_Y为点云的最小Y分量,ξmax_X为点云的最大X分量,ξmin_X为点云的最小X分量,δ、σ、λ、m均为设定阈值,本实施例中δ=1.5cm、σ=8cm、λ=5cm、m=10,m表示点云个数,从而避免误检,提高检测准确性;
S72、若满足,则对应的聚类集合φi即为路沿侧边点云聚类,将所述路沿侧边点云聚类中第一个点云ξ1的X分量ξ1_X作为当前帧路沿距离检测值,记为ε。
如图10所示,图中竖直虚线部分即为路沿侧边,由于路沿侧边垂直于地面,因此,本实施例的上述判断公式用于表示激光雷达扫描路沿侧边点云的几何特征,其中,扫描路沿侧边点云在XY平面的Y轴上投影即Y分量沿Y轴方向垂直分布,因此,一方面,点云在Y轴上最大Y分量ξmax_Y与最小Y分量ξmin_Y的高度差较大且满足ξmax_Y–ξmin_Y>σ;另一方面,路沿侧边点云在XY平面的X轴上的投影较为集中,这样点云在X轴上最大X分量ξmax_X与最小X分量ξmin_X的距离差较小且满足ξmax_X-ξmin_X<λ;由于路沿侧边是连续面,因此,路沿侧边点云聚类中相邻点云的Y分量高度差较小且满足ξi_Y–ξi-1_Y<δ,而为了进一步准确判断点云是否是路沿侧边需要加强约束条件ξi>m,以减少算法对路边障碍物(如地面树叶、小石块)的误识别。
本实施例利用路沿侧边点云的几何特征在聚类集合φi中准确找出路沿侧边点云聚类,同时,将所述路沿侧边点云聚类中第一个点云ξ1的X分量ξ1_X作为当前帧路沿距离检测值,也即将所述路沿侧边点云聚类中最接近地面处的点云的X分量作为当前帧路沿距离检测值,从而确保所得的当前帧路沿距离检测值能体现出机器人与路沿的真实距离。
如图11所示,在本发明的优选实施例中,若当前帧路沿距离检测值与历史帧路沿距离检测值之差满足设定条件时,将满足设定条件各帧路沿检测结果的平均值Ω作为路沿距离检测值d发送至机器人的整车控制器,具体包括步骤:
S81、在第i时刻,若(|εi-1-εi|<η),则将εi存入队列L中;
S82、取队列L中εi的平均值Ω作为路沿距离检测值d发送至机器人的整车控制器。
本实施例通过将当前时刻所得的路沿检测结果与历史时刻所得的路沿检测结果进行比较,若两者的差的绝对值小于设定阈值时,则表明两次检测的结果的误差符合设定要求,数值波动在运行的范围内,属于符合精度要求的有效数据,同时,为了进一步提高路沿检测结果的准确性,减少误差,本实施例通过求取不同时刻的有效路沿检测结果的平均值Ω作为路沿距离检测值d。
如图12所示,在本发明的优选实施例中,若当前帧路沿距离检测值与历史帧路沿距离检测值之差满足设定条件时,将满足设定条件各帧路沿检测结果的平均值Ω作为路沿距离检测值d发送至机器人的整车控制器,具体还包括步骤:
S83、若(|εi-1-εi|≧η),则返回结果0,计数器CT加1;
S84、若计数器CT在设定时间Ψ=1000ms内,满足CT>=3,则通过主控制器控制整车系统停障并进行声光报警。
本实施例通过将当前时刻所得的路沿检测结果与历史时刻所得的路沿检测结果进行比较,若两者的差的绝对值大于等于设定阈值时,则表明两次检测的结果的误差太大,数值波动超出允许范围,属于不符合要求的无效数据,同时,为了保证贴边作业的安全性,当设定时间内所统计的异常波动的次数超出设定阈值时,则表明当前贴边作业存在安全问题,必须马上停止作业,通过主控制器控制整车系统停障并同时进行声光报警,确保人机安全。
如图13所示,在本发明的优选实施例中,发送指令使整车控制器根据路沿距离检测值d控制转向系统执行相应的动作实现机器人贴边运动,具体包括步骤:
S91、启动前根据路沿距离检测值d进行车身姿态调整,若α<d<β,则车身方向与行进方向一致,通过整车控制器控制转向系统回正;若d>β,则通过整车控制器控制转向系统右转一定角度,完成车身姿态调整;若d<α,则通过整车控制器控制转向系统左转一定角度,完成车身姿态调整;
S92、完成车身姿态调整后,发送指令使整车控制器根据当前路沿距离检测值d、车身姿态及停障信息控制转向系统执行进行横向、纵向、制动控制,实现机器人贴边运动。
本实施例中,当获得路沿距离检测值d时,在机器人车身尚未启动前,需要先检测机器人的当前车身姿态,确保贴边作业前先使车身与行车方向保持一致。本实施例利用路沿距离检测值d与设定阈值a、b的大小关系来判断当前车身姿态:若α<d<β,则表示车身方向已经与行进方向一致,通过整车控制器控制转向系统回正,而路沿距离检测值d超过设定阈值a、b的范围时,则通过整车控制器控制转向系统左转或右转一定角度,使车身与行车方向首先保持一致,完成车身姿态调整,接着再发送指令使整车控制器根据当前路沿距离检测值d、车身姿态及停障信息控制转向系统执行进行横向、纵向、制动控制,实现机器人贴边运动,提高机器人贴边运动的平稳性和可靠性。
如图14所示,本发明另一实施例还提供了一种基于单线激光雷达的自适应贴边作业装置,包括:
点云分量获取模块,用于将单线激光雷达扫描所得的点云ξi分解到XY平面,得到针对每一个点云ξi的X、Y分量分别为ξi_X、ξi_Y,保存到集合A中,其中,XY平面与单线激光雷达的扫描面共面,且以单线激光雷达的中心为原点,Y轴向上垂直地面,X轴指向路沿方向;差分运算模块,用于对集合A中的ξi_Y依次进行两次差分运算,并对两次差分运算后将ξi_Y>=0的点云进行滤波删除,得到ξi_Y<0的所有点云;
点云聚类模块,用于将滤波删除后所得到的ξi_Y<0的所有点云进行DBSCAN聚类,得到数量为n的聚类集合φi;
路沿距离检测模块,用于利用路沿侧边点云的几何特征从聚类集合φi中找出路沿侧边点云聚类,并将所述路沿侧边点云聚类中第一个点云ξ1的X分量ξ1_X作为当前帧路沿距离检测值;
路沿距离优化模块,用于若当前帧路沿距离检测值与历史帧路沿距离检测值之差满足设定条件时,将满足设定条件各帧路沿检测结果的平均值Ω作为路沿距离检测值d发送至机器人的整车控制器;
贴边运动控制模块,用于发送指令使整车控制器根据路沿距离检测值d控制转向系统执行相应的动作实现机器人贴边运动。
如图15所示,本发明另一实施例还提供了一种电子设备,包括存储器、处理器及存储在存储器上并可在处理器上运行的计算机程序,所述处理器执行所述程序时实现所述的自适应贴边作业方法。
本发明另一实施例还提供了一种存储介质,所述存储介质包括存储的程序,在所述程序运行时控制所述存储介质所在的设备执行所述的自适应贴边作业方法。
如图16和图17所示,本发明另一实施例还提供了一种机器人,包括:
单线激光雷达,安装于机器人前侧,采用固定安装支架安装于机器人车身,所述固定安装支架用于防震。具体的,所述单线激光雷达的离地高度设置为1m,其扫描面与地面垂直且与路沿成45°夹角;
整车控制器,用于根据指令控制机器人的横向、纵向移动及制动;
工控机,分别与所述单线激光雷达和整车控制器信号连接,用于实现所述的自适应贴边作业方法。
本实施例的机器人还设置有超声波雷达作为停障系统,采用超声波雷达双探头模式,在机器人前、左、右四个面分别布置2组,一共12个探头,用于检测机器人四周障碍物情况,在障碍物离机器人过近时发出停障信号,机器人进行自动停障,具体为:若超声波雷达探测距离d_ultra<dv,工控机控制整车控制器停障并进行声光报警,整车控制器包含转向系统、制动系统、传动系统及机器人上装作业装置。
具体地,工控机作为核心控制器接收单线激光雷达、超声波雷达的数据进行传感器数据融合,控制整车控制器进行机器人制动、转向及对应上装作业控制。其中单线激光雷达对路沿进行几何形态检测,返回单线激光雷达识别的角度及距离。
需要说明的是,在附图的流程图示出的步骤可以在诸如一组计算机可执行指令的计算机系统中执行,并且,虽然在流程图中示出了逻辑顺序,但是在某些情况下,可以以不同于此处的顺序执行所示出或描述的步骤。
上述实施例的方法的功能如果以软件功能单元的形式实现并作为独立的产品销售或使用时,可以存储在一个或者多个计算设备可读取存储介质中。基于这样的理解,本发明实施例对现有技术做出贡献的部分或者该技术方案的部分可以以软件产品的形式体现出来,该软件产品存储在一个存储介质中,包括若干指令用以使得一台计算设备(可以是个人计算机,服务器,移动计算设备或者网络设备等)执行本发明各个实施例所述方法的全部或部分步骤。而前述的存储介质包括:U盘、移动硬盘、只读存储器(ROM,Read-OnlyMemory)、随机存取存储器(RAM,Random Access Memory),磁碟或者光盘等各种可以存储程序代码的介质。
以上所述仅为本发明的优选实施例而已,并不用于限制本发明,对于本领域的技术人员来说,本发明可以有各种更改和变化。凡在本发明的精神和原则之内,所作的任何修改、等同替换、改进等,均应包含在本发明的保护范围之内。
Claims (10)
1.一种基于单线激光雷达的自适应贴边作业方法,其特征在于,包括步骤:
将单线激光雷达扫描所得的点云ξi分解到XY平面,得到针对每一个点云ξi的X、Y分量分别为ξi_X、ξi_Y,保存到集合A中,其中,XY平面与单线激光雷达的扫描面共面,且以单线激光雷达的中心为原点,Y轴向上垂直地面,X轴指向路沿方向;
对集合A中的ξi_Y依次进行两次差分运算,并对两次差分运算后将ξi_Y>=0的点云进行滤波删除,得到ξi_Y<0的所有点云;
将滤波删除后所得到的ξi_Y<0的所有点云进行DBSCAN聚类,得到数量为n的聚类集合φi;
利用路沿侧边点云的几何特征从聚类集合φi中找出路沿侧边点云聚类,并将所述路沿侧边点云聚类中第一个点云ξ1的X分量ξ1_X作为当前帧路沿距离检测值;
若当前帧路沿距离检测值与历史帧路沿距离检测值之差满足设定条件时,将满足设定条件各帧路沿检测结果的平均值Ω作为路沿距离检测值d发送至机器人的整车控制器;
发送指令使整车控制器根据路沿距离检测值d控制转向系统执行相应的动作以实现机器人贴边运动。
2.根据权利要求1所述的基于单线激光雷达的自适应贴边作业方法,其特征在于,将单线激光雷达扫描所得的点云ξi分解到XY平面之前,还包括步骤:
将单线激光雷达扫描所得的点云数据进行预处理,剔除噪声点、异常点数据。
3.根据权利要求2所述的基于单线激光雷达的自适应贴边作业方法,其特征在于,将单线激光雷达扫描所得的点云ξi分解到XY平面之前,还包括步骤:
对预处理后的点云进行直通滤波,保留序号ID为设定范围值的点云。
4.根据权利要求3所述的基于单线激光雷达的自适应贴边作业方法,其特征在于,将单线激光雷达扫描所得的点云ξi分解到XY平面之前,还包括步骤:
对直通滤波后的点云进行曲线平滑,保留曲线趋势特征。
5.根据权利要求1所述的基于单线激光雷达的自适应贴边作业方法,其特征在于,对集合A中的ξi_Y依次进行两次差分运算,并对两次差分运算后将ξi_Y>=0的点云进行滤波删除,得到ξi_Y<0的所有点云,具体包括步骤:
对集合A中的ξi_Y进行第一次差分运算,得到集合A1;
对集合A1中的ξi_Y进行第二次差分运算,得到集合A2;
将集合A2中ξi_Y>=0的点云数据进行滤波删除,在集合A2中保留ξi_Y<0的所有点云。
6.根据权利要求1所述的基于单线激光雷达的自适应贴边作业方法,其特征在于,利用路沿侧边点云的几何特征从聚类集合φi中找出路沿侧边点云聚类,并将所述路沿侧边点云聚类中第一个点云ξ1的X分量ξ1_X作为当前帧路沿检测结果,具体包括步骤:
针对每一个聚类集合φi,判断其中的点云是否满足(ξi_Y–ξi-1_Y<δ)&&(ξmax_Y–ξmin_Y>σ)&&(ξmax_X-ξmin_X<λ)&&(ξi>m),其中,ξmax_Y为点云的最大Y分量,ξmin_Y为点云的最小Y分量,ξmax_X为点云的最大X分量,ξmin_X为点云的最小X分量,δ、σ、λ、m均为设定阈值;
若满足,则对应的聚类集合φi即为路沿侧边点云聚类,将所述路沿侧边点云聚类中第一个点云ξ1的X分量ξ1_X作为当前帧路沿距离检测值,记为ε。
7.根据权利要求6所述的基于单线激光雷达的自适应贴边作业方法,其特征在于,若当前帧路沿距离检测值与历史帧路沿距离检测值之差满足设定条件时,将满足设定条件各帧路沿检测结果的平均值Ω作为路沿距离检测值d发送至机器人的整车控制器,具体包括步骤:
在第i时刻,若(|εi-1-εi|<η),则将εi存入队列L中;
取队列L中εi的平均值Ω作为路沿距离检测值d发送至机器人的整车控制器。
8.根据权利要求1所述的基于单线激光雷达的自适应贴边作业方法,其特征在于,发送指令使整车控制器根据路沿距离检测值d控制转向系统执行相应的动作实现机器人贴边运动,具体包括步骤:
启动前根据路沿距离检测值d进行车身姿态调整,若α<d<β,则车身方向与行进方向一致,通过整车控制器控制转向系统回正;若d>β,则通过整车控制器控制转向系统右转一定角度,完成车身姿态调整;若d<α,则通过整车控制器控制转向系统左转一定角度,完成车身姿态调整;
完成车身姿态调整后,发送指令使整车控制器根据当前路沿距离检测值d、车身姿态及停障信息控制转向系统执行进行横向、纵向、制动控制,以实现机器人贴边运动。
9.一种基于单线激光雷达的自适应贴边作业装置,其特征在于,包括:
点云分量获取模块,用于将单线激光雷达扫描所得的点云ξi分解到XY平面,得到针对每一个点云ξi的X、Y分量分别为ξi_X、ξi_Y,保存到集合A中,其中,XY平面与单线激光雷达的扫描面共面,且以单线激光雷达的中心为原点,Y轴向上垂直地面,X轴指向路沿方向;
差分运算模块,用于对集合A中的ξi_Y依次进行两次差分运算,并对两次差分运算后将ξi_Y>=0的点云进行滤波删除,得到ξi_Y<0的所有点云;
点云聚类模块,用于将滤波删除后所得到的ξi_Y<0的所有点云进行DBSCAN聚类,得到数量为n的聚类集合φi;
路沿距离检测模块,用于利用路沿侧边点云的几何特征从聚类集合φi中找出路沿侧边点云聚类,并将所述路沿侧边点云聚类中第一个点云ξ1的X分量ξ1_X作为当前帧路沿距离检测值;
路沿距离优化模块,用于若当前帧路沿距离检测值与历史帧路沿距离检测值之差满足设定条件时,将满足设定条件各帧路沿检测结果的平均值Ω作为路沿距离检测值d发送至机器人的整车控制器;
贴边运动控制模块,用于发送指令使整车控制器根据路沿距离检测值d控制转向系统执行相应的动作实现机器人贴边运动。
10.一种机器人,其特征在于,包括:
单线激光雷达,安装于机器人前侧,其扫描面与地面垂直且与路沿相交设定夹角;
整车控制器,用于根据指令控制机器人的横向、纵向移动及制动;
工控机,分别与所述单线激光雷达和整车控制器信号连接,用于实现如权利要求1至8中任一项所述的自适应贴边作业方法。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202011479111.7A CN112650230B (zh) | 2020-12-15 | 2020-12-15 | 基于单线激光雷达的自适应贴边作业方法、装置及机器人 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202011479111.7A CN112650230B (zh) | 2020-12-15 | 2020-12-15 | 基于单线激光雷达的自适应贴边作业方法、装置及机器人 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN112650230A true CN112650230A (zh) | 2021-04-13 |
CN112650230B CN112650230B (zh) | 2024-05-03 |
Family
ID=75354073
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN202011479111.7A Active CN112650230B (zh) | 2020-12-15 | 2020-12-15 | 基于单线激光雷达的自适应贴边作业方法、装置及机器人 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN112650230B (zh) |
Cited By (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN115248447A (zh) * | 2021-09-29 | 2022-10-28 | 上海仙途智能科技有限公司 | 一种基于激光点云的路沿识别方法及系统 |
Citations (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN106444768A (zh) * | 2016-10-20 | 2017-02-22 | 上海物景智能科技有限公司 | 一种机器人的贴边行走方法及系统 |
WO2018205119A1 (zh) * | 2017-05-09 | 2018-11-15 | 深圳市速腾聚创科技有限公司 | 基于激光雷达扫描的路沿检测方法和系统 |
CN110197173A (zh) * | 2019-06-13 | 2019-09-03 | 重庆邮电大学 | 一种基于双目视觉的路沿检测方法 |
CN110781827A (zh) * | 2019-10-25 | 2020-02-11 | 中山大学 | 一种基于激光雷达与扇状空间分割的路沿检测系统及其方法 |
CN111538338A (zh) * | 2020-05-28 | 2020-08-14 | 长沙中联重科环境产业有限公司 | 一种机器人贴边运动控制系统及方法 |
-
2020
- 2020-12-15 CN CN202011479111.7A patent/CN112650230B/zh active Active
Patent Citations (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN106444768A (zh) * | 2016-10-20 | 2017-02-22 | 上海物景智能科技有限公司 | 一种机器人的贴边行走方法及系统 |
WO2018205119A1 (zh) * | 2017-05-09 | 2018-11-15 | 深圳市速腾聚创科技有限公司 | 基于激光雷达扫描的路沿检测方法和系统 |
CN110197173A (zh) * | 2019-06-13 | 2019-09-03 | 重庆邮电大学 | 一种基于双目视觉的路沿检测方法 |
CN110781827A (zh) * | 2019-10-25 | 2020-02-11 | 中山大学 | 一种基于激光雷达与扇状空间分割的路沿检测系统及其方法 |
CN111538338A (zh) * | 2020-05-28 | 2020-08-14 | 长沙中联重科环境产业有限公司 | 一种机器人贴边运动控制系统及方法 |
Cited By (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN115248447A (zh) * | 2021-09-29 | 2022-10-28 | 上海仙途智能科技有限公司 | 一种基于激光点云的路沿识别方法及系统 |
CN115248447B (zh) * | 2021-09-29 | 2023-06-02 | 上海仙途智能科技有限公司 | 一种基于激光点云的路沿识别方法及系统 |
Also Published As
Publication number | Publication date |
---|---|
CN112650230B (zh) | 2024-05-03 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN108647646B (zh) | 基于低线束雷达的低矮障碍物的优化检测方法及装置 | |
US20190251370A1 (en) | Estimating friction based on image data | |
CN113176585B (zh) | 一种基于三维激光雷达的路面异常检测方法 | |
CN101469991B (zh) | 全天时结构化道路多行道线检测方法 | |
CN111736603A (zh) | 一种无人驾驶清扫车及其长距离贴边清扫方法 | |
CN112257522B (zh) | 基于环境特征的多传感器融合环境感知方法 | |
CN111399505A (zh) | 一种基于神经网络的移动机器人避障方法 | |
CN112674646B (zh) | 基于多算法融合的自适应贴边作业方法及机器人 | |
CN113009453B (zh) | 矿山路沿检测及建图方法及装置 | |
CN114442101B (zh) | 基于成像毫米波雷达的车辆导航方法、装置、设备及介质 | |
CN114415171A (zh) | 一种基于4d毫米波雷达的汽车可行驶区域检测方法 | |
CN114475573B (zh) | 基于v2x与视觉融合的起伏路况识别及车辆控制方法 | |
CN212322114U (zh) | 一种用于自动驾驶车辆的环境感知及道路环境裂纹检测系统 | |
CN114537374A (zh) | 一种基于可行驶区域的车辆前方防碰撞系统 | |
CN115562281A (zh) | 一种复杂环境下自动泊车系统动态路径规划方法 | |
CN114372375A (zh) | 一种越野车安全行驶区域求解方法及系统 | |
CN112650230A (zh) | 基于单线激光雷达的自适应贴边作业方法、装置及机器人 | |
CN115546749A (zh) | 基于摄像机和激光雷达的路面坑洼检测及清扫和避让方法 | |
CN113432615B (zh) | 基于多传感器融合可驾驶区域的检测方法、系统和车辆 | |
CN116429145B (zh) | 一种复杂场景下无人车与垃圾桶自动对接导航方法及系统 | |
CN114084129A (zh) | 一种基于融合的车辆自动驾驶控制方法及系统 | |
CN109278759A (zh) | 一种车辆安全驾驶辅助系统 | |
CN117075146A (zh) | 一种基于毫米波雷达和双目激光模块的无人机全向避障方法 | |
WO2022050006A1 (ja) | 画像処理装置 | |
CN114495059A (zh) | 一种环卫清扫车路面识别方法及装置 |
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 |