CN109613544B - 一种基于激光雷达的高速公路视距检测方法 - Google Patents
一种基于激光雷达的高速公路视距检测方法 Download PDFInfo
- Publication number
- CN109613544B CN109613544B CN201811599698.8A CN201811599698A CN109613544B CN 109613544 B CN109613544 B CN 109613544B CN 201811599698 A CN201811599698 A CN 201811599698A CN 109613544 B CN109613544 B CN 109613544B
- Authority
- CN
- China
- Prior art keywords
- laser radar
- point
- coordinate system
- sight distance
- max
- 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
- 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/02—Systems using the reflection of electromagnetic waves other than radio waves
- G01S17/06—Systems determining position data of a target
- G01S17/08—Systems determining position data of a target for measuring distance only
Landscapes
- Physics & Mathematics (AREA)
- Electromagnetism (AREA)
- Engineering & Computer Science (AREA)
- Computer Networks & Wireless Communication (AREA)
- General Physics & Mathematics (AREA)
- Radar, Positioning & Navigation (AREA)
- Remote Sensing (AREA)
- Optical Radar Systems And Details Thereof (AREA)
- Traffic Control Systems (AREA)
Abstract
本发明公开了一种基于激光雷达的高速公路视距检测方法,包括以下步骤:首先设定道路安全视距阈值ls;对待使用的激光雷达进行参数设定;然后将待使用的激光雷达搭载于检测车辆的顶部,距离地面高度h0,使激光雷达的扫描范围满足:lmax=h0·tanαmax>ls;再以激光雷达所处的位置为原点,建立球面坐标系和三维直角坐标系;最后使检测车辆在被检测道路上行驶,激光雷达旋转扫描,获取车辆前方的护栏上的采集点,并计算激光雷达扫描到的护栏长度l0以及车辆距离最远处的特征点之间的护栏长度l;若l<ls,则被检测的道路的视距实值为l;若l≥ls,则ls作为被检测的道路的视距实值。本发明的检测方法测量方便、准确,可有效弥补传统视距检测方法在精确性、时效性以及动态测距方面的不足。
Description
技术领域
本发明涉及道路交通安全评价技术领域,尤其涉及一种基于激光雷达的高速公路视距检测方法。
背景技术
视距是保证道路行车安全的一个重要设计因素,在道路建设标准中是一项强制性指标。道路沿线的每一条车道都应具有足够的视距,以保证驾驶人在遇到紧急情况时能够及时做出相应的反应,保证行车安全。尤其对于高速公路来说,车辆行驶速度快,因此更需要有充足的视距保障。
从测距的手段来看,现在应用的测距技术主要分为以下几种:激光测距、微波雷达测距、超声波测距以及机器视觉系统测距。在道路交通领域,就测距对象来说,人们多集中于对障碍物的距离检测,对道路视距的检测缺乏行之有效的方法,尤其是高速公路,由于车辆在其上高速行驶,对视距的要求也就更为严格。就测距过程来说,传统方法多为静态检测,检测速度受到很大限制。而道路交通安全评价需要得到一条路多处的视距,而不同地点的视距相差很大,这就需要进行动态检测,对技术的要求也就更高。
综上,提出一种动态的、精度高的高速公路视距检测方法势在必行。
发明内容
针对现有技术中存在的问题,本发明的目的在于提供一种基于激光雷达的高速公路视距检测方法,可弥补传统视距检测方法在精确性、时效性以及动态测距方面的不足。
为达到上述目的,本发明采用以下技术方案予以实现。
一种基于激光雷达的高速公路视距检测方法,包括以下步骤:
S1:设定道路安全视距阈值ls;
S2:对待使用的激光雷达进行参数设定;所述参数包含:每束激光与竖直方向所成的锐角αi,激光雷达转动的角速度ω,以及激光束发射的频率f;
S3:将待使用的激光雷达搭载于检测车辆的顶部,距离地面高度h0,使激光雷达的扫描范围满足:
lmax=h0·tanαmax>ls
其中,lmax是指与竖直方向夹角最大的那束激光在地面上所画圆的半径;αmax是该束激光与竖直方向的夹角;
其中,在三维直角坐标系中,x轴正方向为检测车辆的行驶方向,y 轴正方向为x正方向垂直向左,z轴正方向为竖直向上;
z=ρcosθ;
S5:使检测车辆在被检测道路上行驶,激光雷达按照S2中设定的角速度ω旋转,采集检测车辆周围的环境信息,并获取采集点信息;
其中,所述采集点信息包含:激光雷达旋转时所采集到的点数、各采集点在球面坐标系和三维直角坐标系中的坐标、以及各采集点距离地面的高度;
S6:提取激光雷达扫描到检测车辆前方的护栏上的采集点,记提取的特征点为Pk,并获得各个特征点Pk在三维直角坐标系中的坐标 (xk,yk,zk);其中,k=1,2,...,n;n为激光雷达的激光束数目;
S7:采用以下公式计算激光雷达扫描到的护栏长度l0:
S8:采用以下公式计算检测车辆距离最远处的特征点之间的护栏长度l:
其中,x1是距离检测车辆最近的特征点与检测车辆之间的距离;
S9:若l<ls,则被检测的道路的视距实值为l;
若l≥ls,则被检测的道路的视距实值为ls。
本发明技术方案的特点和进一步的改进在于:
zij=ρij cos(π-αi)。
(3)S5中,采集点Pij距离地面的高度hij为:hij=h0-|zij|。
(4)S6中,所述提取的方法具体为:
S61:保留xij≥0的点,剔除不符合xij≥0的点;
S62:设置护栏高度的双阈值hmin和hmax,保留hmin≤hij≤hmax的点,剔除不符合hmin≤hij≤hmax的点;
(5)S6中,各个特征点Pk在三维直角坐标系中的坐标为(xk,yk,zk):
zk=ρk cos(π-αk)。
与现有技术相比,本发明的有益效果为:
本发明的基于激光雷达的高速公路视距检测方法测量方便、准确,可有效弥补传统视距检测方法在精确性、时效性以及动态测距方面的不足。
具体实施方式
下面对本发明实施例中的技术方案进行清楚、完整地描述,显然,所描述的实施例仅仅是本发明一部分实施例,而不是全部的实施例。基于本发明中的实施例,本领域普通技术人员在没有做出创造性劳动前提下所获得的所有其他实施例,都属于本发明保护的范围。
本发明实施例提供了一种基于激光雷达的高速公路视距检测方法,包括以下步骤:
S1:设定道路安全视距阈值ls;安全视距的大小只在一定范围内才有意义,超出这个范围说明视距足够大,也就符合要求。本发明中的道路安全视距阈值ls根据有关道路安全条例选取。
S2:对待使用的激光雷达进行参数设定;所述参数包含:每束激光与竖直方向所成的锐角αi,激光雷达转动的角速度ω,以及激光束发射的频率f;其中,激光雷达转动的角速度ω为激光雷达的各束激光每秒钟转动的角度;激光束发射的频率f为激光束每秒发射的频数; i=1,2,...,n,n为激光雷达的激光束数目;
本发明实施例中的激光雷达采用的是16线束的激光雷达,即n为 16。
S3:将待使用的激光雷达搭载于检测车辆的顶部,距离地面高度h0,使激光雷达的扫描范围满足:
lmax=h0·tanαmax>ls
其中,lmax是指与竖直方向夹角最大的那束激光在地面上所画圆的半径;αmax是该束激光与竖直方向的夹角;
其中,在三维直角坐标系中,x轴正方向为检测车辆的行驶方向,y 轴正方向为x正方向垂直向左,z轴正方向为竖直向上;
z=ρcosθ;
S5:使检测车辆在被检测道路上以速度v匀速行驶,激光雷达按照 S2中设定的角速度ω旋转,采集检测车辆周围的环境信息,并获取采集点信息;
其中,所述采集点信息包含:激光雷达旋转时所采集到的点数、各采集点在球面坐标系和三维直角坐标系中的坐标、以及各采集点距离地面的高度;
zij=ρijcos(π-αi)。
由于坐标原点O距地面的高度为h0,则采集点Pij距地面的高度hij为: hij=h0-|zij|。
S6:提取激光雷达扫描到检测车辆前方的护栏上的采集点,采用基于护栏高度特征的提取方法进行提取,激光雷达在旋转过程中会在检测车辆的前方和后方都进行打点,本发明实施例只提取扫描到检测车辆前方护栏上的点,故当xij≥0时,保留,否则剔除。
由于护栏高度相对于路面是固定的,因此设置护栏高度的双阈值 hmin和hmax,若hmin≤hij≤hmax,这说明Pij为打到护栏上的点,作提取保留,并删除其余不符合条件的点。
本实施例最终提取的特征点记为Pk,k=1,2,...,n,n为16。获得各个特征点Pk在三维直角坐标系中的坐标(xk,yk,zk):
zk=ρkcos(π-αk)。
S7:计算激光雷达扫描到的护栏长度l0,记提取的特征点数目为 n(n≤16)。两相邻特征点之间的距离用直线长度代替,则激光雷达扫描到的护栏长度采用以下公式计算
S8:采用以下公式计算检测车辆距离最远处的特征点Pn之间的护栏长度l:
其中,x1是距离检测车辆最近的特征点P1与检测车辆之间的距离;
S9:若l<ls,则被检测的道路的视距实值即为l;
若l≥ls,则视ls为被检测的道路的视距实值。
在S8中,检测车辆所处位置到第一个特征点距离很近,之间的道路和护栏线型接近于直线,故可用x1代替第一个特征点P1到车辆之间的护栏长度,则l=l0+x1为最后一个特征点Pn到车辆之间的护栏长度,并用l代替视距实值。
本发明主要应用于道路交通安全评价场合,其基本思想是考虑到高速公路有护栏且护栏特征连续、明显,因此考虑把激光雷达检测到的前方护栏的长度作为该处的道路视距。
以上所述,仅为本发明的具体实施方式,但本发明的保护范围并不局限于此,任何熟悉本技术领域的技术人员在本发明揭露的技术范围内,可轻易想到变化或替换,都应涵盖在本发明的保护范围之内。因此,本发明的保护范围应以所述权利要求的保护范围为准。
Claims (9)
1.一种基于激光雷达的高速公路视距检测方法,其特征在于,包括以下步骤:
S1:设定道路安全视距阈值ls;
S2:对待使用的激光雷达进行参数设定;所述参数包含:每束激光与竖直方向所成的锐角αi,激光雷达转动的角速度ω,以及激光束发射的频率f;
S3:将待使用的激光雷达搭载于检测车辆的顶部,距离地面高度h0,使激光雷达的扫描范围满足:
lmax=h0·tanαmax>ls
其中,lmax是指与竖直方向夹角最大的那束激光在地面上所画圆的半径;αmax是该束激光与竖直方向的夹角;
其中,在三维直角坐标系中,x轴正方向为检测车辆的行驶方向,y轴正方向为x正方向垂直向左,z轴正方向为竖直向上;
z=ρcosθ;
S5:使检测车辆在被检测道路上行驶,激光雷达按照S2中设定的角速度ω旋转,采集检测车辆周围的环境信息,并获取采集点信息;
其中,所述采集点信息包含:激光雷达旋转时所采集到的点数、各采集点在球面坐标系和三维直角坐标系中的坐标、以及各采集点距离地面的高度;
S6:提取激光雷达扫描到检测车辆前方的护栏上的采集点,记提取的特征点为Pk,并获得各个特征点Pk在三维直角坐标系中的坐标(xk,yk,zk);其中,k=1,2,...,n;n为激光雷达的激光束数目;
S7:采用以下公式计算激光雷达扫描到的护栏长度l0:
S8:采用以下公式计算检测车辆距离最远处的特征点之间的护栏长度l:
其中,x1是距离检测车辆最近的特征点与检测车辆之间的距离;
S9:若l<ls,则被检测的道路的视距实值为l;
若l≥ls,则被检测的道路的视距实值为ls。
2.根据权利要求1所述的基于激光雷达的高速公路视距检测方法,其特征在于,S1中,所述道路安全视距阈值ls根据有关道路安全条例选取。
3.根据权利要求1所述的基于激光雷达的高速公路视距检测方法,其特征在于,S2中,所述激光雷达转动的角速度ω为激光雷达的各束激光每秒钟转动的角度;所述激光束发射的频率f为激光束每秒发射的频数。
4.根据权利要求1所述的基于激光雷达的高速公路视距检测方法,其特征在于,S5中,检测车辆在被检测道路上匀速行驶。
7.根据权利要求6所述的基于激光雷达的高速公路视距检测方法,其特征在于,S5中,采集点Pij距离地面的高度hij为:hij=h0-|zij|。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201811599698.8A CN109613544B (zh) | 2018-12-26 | 2018-12-26 | 一种基于激光雷达的高速公路视距检测方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201811599698.8A CN109613544B (zh) | 2018-12-26 | 2018-12-26 | 一种基于激光雷达的高速公路视距检测方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN109613544A CN109613544A (zh) | 2019-04-12 |
CN109613544B true CN109613544B (zh) | 2022-11-11 |
Family
ID=66012280
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201811599698.8A Active CN109613544B (zh) | 2018-12-26 | 2018-12-26 | 一种基于激光雷达的高速公路视距检测方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN109613544B (zh) |
Families Citing this family (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN110133624B (zh) * | 2019-05-14 | 2021-11-23 | 阿波罗智能技术(北京)有限公司 | 无人驾驶异常检测方法、装置、设备和介质 |
CN111121714B (zh) * | 2019-12-25 | 2021-10-26 | 中公高科养护科技股份有限公司 | 一种行车视距的测量方法及系统 |
CN115273549B (zh) * | 2022-07-29 | 2023-10-31 | 山东高速集团有限公司 | 一种基于路侧激光雷达的高速公路分流区防撞方法 |
CN117309898B (zh) * | 2023-11-30 | 2024-03-26 | 云翔赛博(山东)数字技术有限公司 | 基于同步单线激光雷达的皮带磨损度检测装置及检测方法 |
Citations (7)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN103547939A (zh) * | 2011-05-13 | 2014-01-29 | 赫克斯冈技术中心 | 用于具有扫描功能的装置的校准方法 |
JP2015075382A (ja) * | 2013-10-08 | 2015-04-20 | 株式会社デンソー | 物体検出装置 |
CN104569998A (zh) * | 2015-01-27 | 2015-04-29 | 长春理工大学 | 基于激光雷达的车辆安全行驶区域的检测方法及装置 |
CN105404844A (zh) * | 2014-09-12 | 2016-03-16 | 广州汽车集团股份有限公司 | 一种基于多线激光雷达的道路边界检测方法 |
CN106503636A (zh) * | 2016-10-12 | 2017-03-15 | 同济大学 | 一种基于视觉图像的道路视距检测方法及装置 |
CN106842231A (zh) * | 2016-11-08 | 2017-06-13 | 长安大学 | 一种道路边界检测及跟踪方法 |
CN107462223A (zh) * | 2017-08-08 | 2017-12-12 | 长安大学 | 一种公路转弯前行车视距自动测量装置及测量方法 |
-
2018
- 2018-12-26 CN CN201811599698.8A patent/CN109613544B/zh active Active
Patent Citations (7)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN103547939A (zh) * | 2011-05-13 | 2014-01-29 | 赫克斯冈技术中心 | 用于具有扫描功能的装置的校准方法 |
JP2015075382A (ja) * | 2013-10-08 | 2015-04-20 | 株式会社デンソー | 物体検出装置 |
CN105404844A (zh) * | 2014-09-12 | 2016-03-16 | 广州汽车集团股份有限公司 | 一种基于多线激光雷达的道路边界检测方法 |
CN104569998A (zh) * | 2015-01-27 | 2015-04-29 | 长春理工大学 | 基于激光雷达的车辆安全行驶区域的检测方法及装置 |
CN106503636A (zh) * | 2016-10-12 | 2017-03-15 | 同济大学 | 一种基于视觉图像的道路视距检测方法及装置 |
CN106842231A (zh) * | 2016-11-08 | 2017-06-13 | 长安大学 | 一种道路边界检测及跟踪方法 |
CN107462223A (zh) * | 2017-08-08 | 2017-12-12 | 长安大学 | 一种公路转弯前行车视距自动测量装置及测量方法 |
Non-Patent Citations (2)
Title |
---|
基于3D激光雷达城市道路边界鲁棒检测算法;孙朋朋 等;《浙江大学学报(工学版)》;20180331;第52卷(第3期);第504-514页 * |
激光点云在无人驾驶路径检测中的应用;张永博等;《测绘通报》;20161125(第11期);第67-71页 * |
Also Published As
Publication number | Publication date |
---|---|
CN109613544A (zh) | 2019-04-12 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN109613544B (zh) | 一种基于激光雷达的高速公路视距检测方法 | |
CN109858460B (zh) | 一种基于三维激光雷达的车道线检测方法 | |
WO2018068653A1 (zh) | 点云数据处理方法、装置及存储介质 | |
US9141870B2 (en) | Three-dimensional object detection device and three-dimensional object detection method | |
EP2372310B1 (en) | Image processing system and position measurement system | |
CN102508246B (zh) | 车辆前方障碍物检测跟踪方法 | |
EP2372304B1 (en) | Vehicle position recognition system | |
CN109017780A (zh) | 一种车辆智能驾驶控制方法 | |
US20150233720A1 (en) | Geographic feature-based localization with feature weighting | |
EP2372607A2 (en) | Scene matching reference data generation system and position measurement system | |
CN107192994A (zh) | 多线激光雷达海量点云数据快速有效提取及车辆、车道线特征识别方法 | |
CN109657686A (zh) | 车道线生成方法、装置、设备以及存储介质 | |
CN113009453B (zh) | 矿山路沿检测及建图方法及装置 | |
CN111308499A (zh) | 一种基于多线激光雷达的障碍物检测方法 | |
CN112674646B (zh) | 基于多算法融合的自适应贴边作业方法及机器人 | |
CN109635737A (zh) | 基于道路标记线视觉识别辅助车辆导航定位方法 | |
CN112673280A (zh) | 用于装配有lidar传感器的机动车辆的道路检测方法 | |
CN110082783A (zh) | 一种悬崖检测的方法及装置 | |
CN113281782A (zh) | 一种基于无人驾驶车的激光雷达雪点滤除方法 | |
CN109241855A (zh) | 基于立体视觉的智能车辆可行驶区域探测方法 | |
CN111325187A (zh) | 一种车道位置的识别方法及装置 | |
US20200372264A1 (en) | Image-based road cone recognition method and appartus, storage medium, and vehicle | |
CN111401176B (zh) | 一种基于多线激光雷达的路沿检测方法 | |
Hofmann et al. | Quality assessment of automatically generated feature maps for future driver assistance systems | |
CN109389643B (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 |