CN111267862B - 一种依赖跟随目标的虚拟车道线构造方法和系统 - Google Patents
一种依赖跟随目标的虚拟车道线构造方法和系统 Download PDFInfo
- Publication number
- CN111267862B CN111267862B CN202010030964.6A CN202010030964A CN111267862B CN 111267862 B CN111267862 B CN 111267862B CN 202010030964 A CN202010030964 A CN 202010030964A CN 111267862 B CN111267862 B CN 111267862B
- Authority
- CN
- China
- Prior art keywords
- target
- deviation
- lane line
- following
- distance
- 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
Images
Classifications
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B60—VEHICLES IN GENERAL
- B60W—CONJOINT CONTROL OF VEHICLE SUB-UNITS OF DIFFERENT TYPE OR DIFFERENT FUNCTION; CONTROL SYSTEMS SPECIALLY ADAPTED FOR HYBRID VEHICLES; ROAD VEHICLE DRIVE CONTROL SYSTEMS FOR PURPOSES NOT RELATED TO THE CONTROL OF A PARTICULAR SUB-UNIT
- B60W40/00—Estimation or calculation of non-directly measurable driving parameters for road vehicle drive control systems not related to the control of a particular sub unit, e.g. by using mathematical models
- B60W40/02—Estimation or calculation of non-directly measurable driving parameters for road vehicle drive control systems not related to the control of a particular sub unit, e.g. by using mathematical models related to ambient conditions
- B60W40/06—Road conditions
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B60—VEHICLES IN GENERAL
- B60W—CONJOINT CONTROL OF VEHICLE SUB-UNITS OF DIFFERENT TYPE OR DIFFERENT FUNCTION; CONTROL SYSTEMS SPECIALLY ADAPTED FOR HYBRID VEHICLES; ROAD VEHICLE DRIVE CONTROL SYSTEMS FOR PURPOSES NOT RELATED TO THE CONTROL OF A PARTICULAR SUB-UNIT
- B60W50/00—Details of control systems for road vehicle drive control not related to the control of a particular sub-unit, e.g. process diagnostic or vehicle driver interfaces
- B60W50/0098—Details of control systems ensuring comfort, safety or stability not otherwise provided for
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B60—VEHICLES IN GENERAL
- B60W—CONJOINT CONTROL OF VEHICLE SUB-UNITS OF DIFFERENT TYPE OR DIFFERENT FUNCTION; CONTROL SYSTEMS SPECIALLY ADAPTED FOR HYBRID VEHICLES; ROAD VEHICLE DRIVE CONTROL SYSTEMS FOR PURPOSES NOT RELATED TO THE CONTROL OF A PARTICULAR SUB-UNIT
- B60W50/00—Details of control systems for road vehicle drive control not related to the control of a particular sub-unit, e.g. process diagnostic or vehicle driver interfaces
- B60W2050/0001—Details of the control system
- B60W2050/0043—Signal treatments, identification of variables or parameters, parameter estimation or state estimation
Abstract
本发明涉及一种依赖跟随目标的虚拟车道线构造方法和系统,包括以下步骤:判断当前车道线是否不能由摄像头获取,若是,则从感知结果中提取所有目标检测信息,否则,持续判断;根据预先建立的感知坐标系,计算各个目标的初始目标偏差;计算各个目标的偏差补偿量;根据各个目标的初始目标偏差和偏差补偿量,计算各个目标进行偏差补偿之后的目标偏差;根据目标中心点相对于感知坐标系原点的距离及各个目标的目标偏差确定自车与跟随目标之间的可行驶区域,并在可行驶区域内选取跟随目标;基于跟随目标中心点及自车中心点构造虚拟车道线。本发明可以广泛应用于高级驾驶辅助系统技术领域。
Description
技术领域
本发明属于高级驾驶辅助系统技术领域,具体涉及一种依赖跟随目标的虚拟车道线构造方法和系统。
背景技术
摄像头和毫米波雷达是高级辅助驾驶中最常使用的两类传感器。摄像头可以给出目标检测、红绿灯、车道线等信息,毫米波雷达可以给出目标检测信息。目标检测信息中一般包含物体的位置、速度、属性等信息。高级驾驶辅助系统依赖摄像头、毫米波雷达等单一传感器或多传感器融合的感知结果,实现自适应巡航、自动紧急制动等纵向功能或车道保持、车道偏移预警等横向功能。
对横向功能而言,车道线一般从摄像头获取。但当道路上无车道线或者车道线被覆盖等条件下,摄像头无法获取车道线信息,此时横向功能需退出。这对高级辅助驾驶而言,带来不便。
发明内容
针对上述车道线无法由摄像头获取的问题,本发明的目的是提供一种依赖跟随目标的虚拟车道线构造方法和系统,通过筛选目标检测信息获取满足特定条件的跟随目标,并确定自车与跟随目标之间的可行驶区域,基于该可行驶区域构造虚拟车道线,进而可以扩大横向功能的使用范围。
为实现上述目的,本发明采取以下技术方案:
本发明的第一个方面,是提供一种依赖跟随目标的虚拟车道线构造方法,其包括以下步骤:
1)判断当前车道线是否不能由摄像头获取,若是,则从感知系统的感知结果中提取所有目标检测信息,包括物体的位置、速度、属性信息,否则,持续判断;
2)根据预先建立的感知坐标系和步骤1)中提取的目标检测信息,计算得到感知系统探测范围内各个目标的初始目标偏差dt;
3)计算各个目标的偏差补偿量C;
4)根据各个目标的初始目标偏差dt和偏差补偿量C,计算各个目标进行偏差补偿之后的目标偏差dr;
5)根据各个目标的中心点O2相对于感知坐标系原点O1的距离lt及各个目标的目标偏差dr确定自车与跟随目标之间的可行驶区域,并在可行驶区域内选取跟随目标;
6)基于跟随目标的中心点及自车的中心点构造虚拟车道线。
进一步的,所述步骤2)中,所述初始目标偏差dt的计算公式为:
dt=lt×sin(θt),
其中,lt是目标中心点O2相对于感知坐标系原点O1的距离,θt是目标中心点O2相对于感知坐标系纵轴y的角度;初始目标偏差dt的正负由目标中心点O2相对于感知坐标系纵轴y的位置决定,当目标中心点O2在y轴右侧时,dt为正,当目标中心点O2在y轴左侧时,dt为负。
进一步的,所述步骤3)中,所述偏差补偿量C的计算公式为:
C=ω×(lt+ld)2/2v,
其中,v是自车车速,ω是自车横摆角速度,ld是感知坐标系原点O1至后轴的距离;偏差补偿量C的正负由ω决定,ω顺时针方向计算得到的偏差补偿量C为正,ω逆时针方向计算得到的偏差补偿量C为负。
进一步的,所述步骤4)中,所述目标偏差dr的计算公式为:
dr=dt-C。
进一步的,所述步骤5)中,根据各个目标的中心点O2相对于感知坐标系原点O1的距离lt及各个目标的目标偏差dr确定自车与跟随目标之间的可行驶区域,并在可行驶区域内选取跟随目标的方法,包括以下步骤:
5.1)判断目标中心点O2与感知坐标系原点O1的距离lt是否满足距离阈值条件:lmin<lt<lmax,其中,lmax和lmin分别为距离的上、下限阈值,若不满足,则返回步骤1),若满足,则进入步骤5.2);
5.2)判断各个目标的目标偏差dr是否满足目标偏差阈值条件:dmin<dr<dmax,其中,dmax和dmin分别为目标偏差的上、下限阈值,若不满足,则返回步骤1),若满足,则进入步骤5.3);
5.3)将步骤5.2)中得到的感知区域作为可行驶区域,在可行驶区域内选取距自车最近的目标作为跟随目标,若该可行驶区域内没有目标,则返回步骤1)。
进一步的,所述步骤6)中,所述虚拟车道线以跟随目标的中心点与自车的中心点的连线作为中心线,所述虚拟车道线宽度d由自车车速决定。
本发明的第二个方面,是提供一种依赖跟随目标的虚拟车道线构造系统,其包括:
目标检测信息获取模块,用于判断当前车道线是否不能由摄像头获取,若是,则从感知结果中提取所有目标检测信息,包括物体的位置、速度、属性信息,否则,持续判断;
初始目标偏差计算模块,用于根据预先建立感知坐标系,计算感知系统探测范围内各个目标的初始目标偏差dt;
偏差补偿量计算模块,用于计算各个目标的偏差补偿量C;
目标偏差计算模块,用于根据各个目标的初始目标偏差dt和偏差补偿量C,计算各个目标进行偏差补偿之后的目标偏差dr;
跟随目标筛选模块,用于根据目标中心点O2相对于感知坐标系原点O1的距离lt及各个目标的目标偏差dr确定自车与跟随目标之间的可行驶区域,并在可行驶区域内选取跟随目标;
虚拟车道线绘制模块,用于基于跟随目标中心点及自车中心点构造虚拟车道线。
进一步的,所述跟随目标筛选模块包括:
距离筛选模块,用于判断目标中心点O2与感知坐标系原点O1的距离lt是否满足距离阈值条件:lmin<lt<lmax,其中,lmax和lmin分别为距离的上、下限阈值;
目标偏差筛选模块,用于判断各个目标的目标偏差dr是否满足目标偏差阈值条件:dmin<dr<dmax,其中,dmax和dmin分别为目标偏差的上、下限阈值;
跟随目标筛选模块,用于在所述距离筛选模块和目标偏差筛选模块确定的可行驶区域内选取距自车最近的目标作为跟随目标。
本发明由于采取以上技术方案,其具有以下优点:本发明提出的解决方案能够在车道线无法由摄像头获取时,通过筛选感知结果中的特定目标构造出虚拟车道线,从而扩大横向功能的使用范围,保障车辆行车安全。本发明所提出的解决方案易于实现和推广。
附图说明
图1是本发明的初始目标偏差、偏差补偿量及补偿之后的目标偏差示意图;
图2是本发明的跟随目标选取示意图;
图3是本发明的虚拟车道线构造示意图。
具体实施方式
下面结合附图和实施例对本发明进行详细的描述。
本发明提供的一种依赖跟随目标的虚拟车道线构造方法,包括以下步骤:
1)判断当前车道线是否不能由摄像头获取,若是,则从现有感知系统的感知结果中提取所有目标检测信息,包括物体的位置、速度、属性等信息,否则,持续判断。
2)根据预先建立的感知坐标系和步骤1)中提取的目标检测信息,计算得到感知系统探测范围内各个目标的初始目标偏差dt。
如图1所示,根据建立的感知坐标系,计算感知系统探测范围内各个目标的初始目标偏差dt时的计算公式为:
dt=lt×sin(θt)
式中,lt是目标中心点O2相对于感知坐标系原点O1的距离,θt是目标中心点O2相对于感知坐标系纵轴y的角度;初始目标偏差dt的正负由目标中心点O2相对于感知坐标系纵轴y的位置决定,当目标中心点O2在y轴右侧时,dt为正,当目标中心点O2在y轴左侧时,dt为负。
其中,感知坐标系可以以自车的前保险杠中心为原点建立,也可以直接采用原有感知系统的坐标系。本发明中,将感知坐标系下纵向距离(图1中y轴)大于0的所有目标作为感知系统的探测范围,对探测范围内的所有目标进行计算,得到所有目标的初始目标偏差dt。
3)计算感知系统探测范围内各个目标的偏差补偿量C,计算公式为:
C=ω×(lt+ld)2/2v
式中,v是自车车速,ω是自车横摆角速度,ld是感知坐标系原点O1至后轴的距离;偏差补偿量C的正负由ω决定,ω顺时针方向计算得到的偏差补偿量C为正,ω逆时针方向计算得到的偏差补偿量C为负。
4)根据感知系统探测范围内各个目标的初始目标偏差dt和偏差补偿量C,计算各个目标进行偏差补偿之后的目标偏差dr,目标偏差dr的计算公式为:
dr=dt-C。
5)根据目标中心点O2相对于感知坐标系原点O1的距离lt以及各个目标的目标偏差dr确定自车与跟随目标之间的可行驶区域,并在可行驶区域内选取跟随目标。
具体的,包括以下步骤:
5.1)判断目标中心点O2与感知坐标系原点O1的距离lt是否满足距离阈值条件:lmin<lt<lamx,其中,lamx和lmin分别为距离的上、下限阈值,若不满足,则返回步骤1),若满足,则进入步骤5.2);
5.2)判断各个目标的目标偏差dr是否满足目标偏差阈值条件:dmin<dr<dmax,其中,dmax和dmin分别为目标偏差的上、下限阈值,若不满足,则返回步骤1),若满足,则进入步骤5.3);
5.3)如图2所示,将步骤5.2)中得到的感知区域作为可行驶区域,在可行驶区域内选取距自车最近的目标(也即lt最小的目标车辆)作为跟随目标,若该可行驶区域内没有目标,则返回步骤1)。
其中,lmax、lmin、dmax和dmin的取值受车速影响,车速越高,取值越大,各阈值的初值可以根据经验给定。
6)基于跟随目标的中心点Tc及自车中心点Sc构造虚拟车道线。
如图3所示,所构建的虚拟车道线的中心线为跟随目标中心点Tc与自车中心点Sc的连线,虚拟车道线宽度d的取值受车速影响,车速越高,取值越大,初值可以根据经验给定。
基于上述依赖跟随目标的虚拟车道线构造方法,本发明还提供一种依赖跟随目标的虚拟车道线构造系统,其包括:
目标检测信息获取模块,用于判断当前车道线是否不能由摄像头获取,若是,则从感知结果中提取所有目标检测信息,包括物体的位置、速度、属性信息,否则,持续判断;
初始目标偏差计算模块,用于根据预先建立感知坐标系,计算感知系统感知范围内各目标的初始目标偏差dt;
偏差补偿量计算模块,用于计算各个目标的偏差补偿量C;
目标偏差计算模块,用于根据各个目标的初始目标偏差dt和偏差补偿量C,计算各个目标进行偏差补偿之后的目标偏差dr;
跟随目标筛选模块,用于根据目标中心点O2相对于感知坐标系原点O1的距离lt及各个目标的目标偏差dr确定自车与跟随目标之间的可行驶区域,并在可行驶区域内选取跟随目标;
虚拟车道线绘制模块,用于基于跟随目标中心点及自车中心点构造虚拟车道线。
优选地,跟随目标筛选模块包括:
距离筛选模块,用于判断目标中心点O2与感知坐标系原点O1的距离lt是否满足距离阈值条件:lmin<lt<lmax,其中,lmax和lmin分别为距离的上、下限阈值;
目标偏差筛选模块,用于判断各个目标的目标偏差dr是否满足目标偏差阈值条件:dmin<dr<dmax,其中,dmax和dmin分别为目标偏差的上、下限阈值;
跟随目标筛选模块,用于在所述距离筛选模块和目标偏差筛选模块确定的可行驶区域内选取距自车最近的目标作为跟随目标。
以上给出一种具体的实施方式,但本发明不局限于所描述的实施方式。本发明的基本思路在于上述方案,对本领域普通技术人员而言,根据本发明的教导,设计出各种变形的模型、公式、参数并不需要花费创造性劳动。在不脱离本发明的原理和精神的情况下对实施方式进行的变化、修改、替换和变形仍落入本发明的保护范围内。
Claims (8)
1.一种依赖跟随目标的虚拟车道线构造方法,其特征在于包括以下步骤:
1)判断当前车道线是否不能由摄像头获取,若是,则从感知系统的感知结果中提取所有目标检测信息,包括物体的位置、速度、属性信息,否则,持续判断;
6)基于跟随目标的中心点及自车的中心点构造虚拟车道线。
5.如权利要求1所述的一种依赖跟随目标的虚拟车道线构造方法,其特征在于:所述步骤5)中,根据各个目标的中心点相对于感知坐标系原点的距离及各个目标的目标偏差确定自车与跟随目标之间的可行驶区域,并在可行驶区域内选取跟随目标的方法,包括以下步骤:
5.3)将步骤5.2)中得到的感知区域作为可行驶区域,在可行驶区域内选取距自车最近的目标作为跟随目标,若该可行驶区域内没有目标,则返回步骤1)。
7.一种依赖跟随目标的虚拟车道线构造系统,其特征在于:其包括:
目标检测信息获取模块,用于判断当前车道线是否不能由摄像头获取,若是,则从感知结果中提取所有目标检测信息,包括物体的位置、速度、属性信息,否则,持续判断;
虚拟车道线绘制模块,用于基于跟随目标中心点及自车中心点构造虚拟车道线。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202010030964.6A CN111267862B (zh) | 2020-01-13 | 2020-01-13 | 一种依赖跟随目标的虚拟车道线构造方法和系统 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202010030964.6A CN111267862B (zh) | 2020-01-13 | 2020-01-13 | 一种依赖跟随目标的虚拟车道线构造方法和系统 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN111267862A CN111267862A (zh) | 2020-06-12 |
CN111267862B true CN111267862B (zh) | 2021-04-02 |
Family
ID=70993712
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN202010030964.6A Active CN111267862B (zh) | 2020-01-13 | 2020-01-13 | 一种依赖跟随目标的虚拟车道线构造方法和系统 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN111267862B (zh) |
Families Citing this family (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN112249014B (zh) * | 2020-10-22 | 2021-09-28 | 英博超算(南京)科技有限公司 | 车辆横向控制方法、车辆以及计算机可读存储介质 |
CN113682313B (zh) * | 2021-08-11 | 2023-08-22 | 中汽创智科技有限公司 | 一种车道线确定方法、确定装置及存储介质 |
CN114537393A (zh) * | 2022-04-25 | 2022-05-27 | 北京主线科技有限公司 | 车辆控制方法、装置、设备及存储介质 |
CN114648877B (zh) * | 2022-05-13 | 2022-08-09 | 北京理工大学前沿技术研究院 | 一种无信号交叉口车辆通行方法、系统、设备和存储介质 |
Citations (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN103802766A (zh) * | 2012-11-14 | 2014-05-21 | 现代摩比斯株式会社 | 车道线识别系统及方法 |
CN104670229A (zh) * | 2013-11-28 | 2015-06-03 | 现代摩比斯株式会社 | 假想车道线生成装置与方法及车道线保持控制系统 |
CN108177524A (zh) * | 2017-12-22 | 2018-06-19 | 联创汽车电子有限公司 | Arhud系统及其车道线绘制方法 |
CN108573272A (zh) * | 2017-12-15 | 2018-09-25 | 蔚来汽车有限公司 | 车道拟合方法 |
CN110239536A (zh) * | 2019-05-22 | 2019-09-17 | 浙江吉利控股集团有限公司 | 一种车道保持控制方法、装置及终端 |
Family Cites Families (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
KR20180051836A (ko) * | 2016-11-09 | 2018-05-17 | 삼성전자주식회사 | 주행 차량을 위한 가상의 주행 차선을 생성하는 방법 및 장치 |
KR102568114B1 (ko) * | 2016-11-30 | 2023-08-18 | 현대오토에버 주식회사 | 자율 주행 제어 장치 및 방법 |
-
2020
- 2020-01-13 CN CN202010030964.6A patent/CN111267862B/zh active Active
Patent Citations (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN103802766A (zh) * | 2012-11-14 | 2014-05-21 | 现代摩比斯株式会社 | 车道线识别系统及方法 |
CN104670229A (zh) * | 2013-11-28 | 2015-06-03 | 现代摩比斯株式会社 | 假想车道线生成装置与方法及车道线保持控制系统 |
CN108573272A (zh) * | 2017-12-15 | 2018-09-25 | 蔚来汽车有限公司 | 车道拟合方法 |
CN108177524A (zh) * | 2017-12-22 | 2018-06-19 | 联创汽车电子有限公司 | Arhud系统及其车道线绘制方法 |
CN110239536A (zh) * | 2019-05-22 | 2019-09-17 | 浙江吉利控股集团有限公司 | 一种车道保持控制方法、装置及终端 |
Also Published As
Publication number | Publication date |
---|---|
CN111267862A (zh) | 2020-06-12 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN111267862B (zh) | 一种依赖跟随目标的虚拟车道线构造方法和系统 | |
CN109017780B (zh) | 一种车辆智能驾驶控制方法 | |
CN109649393B (zh) | 一种自动驾驶变换车道的路径规划方法及装置 | |
US10494022B2 (en) | Driving assistance device | |
CN110239535B (zh) | 一种基于多传感器融合的弯道主动避撞控制方法 | |
US10414397B2 (en) | Operational design domain decision apparatus | |
US9669760B2 (en) | Warning device | |
CN110293967B (zh) | 一种汽车低速主动安全执行控制方法及控制系统 | |
CN110606082A (zh) | 基于自动驾驶的制动系统、方法、装置及车辆 | |
EP3888985A1 (en) | Lane changing method and system for autonomous vehicles, and vehicle | |
JP6805965B2 (ja) | 衝突回避制御装置 | |
US20200238980A1 (en) | Vehicle control device | |
US10569781B2 (en) | Traveling assistance apparatus | |
US10053087B2 (en) | Driving assistance apparatus | |
DE102016209966A1 (de) | Autonomfahrtvorrichtung und Fahrzeugsteuervorrichtung | |
US20200164873A1 (en) | Action Prediction Method and Action Prediction Device of Traveling Assistance Device | |
CN110816540B (zh) | 交通拥堵的确定方法、装置、系统及车辆 | |
US20130274959A1 (en) | Driving support apparatus, driving support method, and vehicle | |
CN106184232A (zh) | 一种基于驾驶员视角的车道偏离预警控制方法 | |
JP6020729B2 (ja) | 車両位置姿勢角推定装置及び車両位置姿勢角推定方法 | |
US11042759B2 (en) | Roadside object recognition apparatus | |
WO2016194168A1 (ja) | 走行制御装置及び方法 | |
JPWO2019065564A1 (ja) | 自動運転制御装置及び方法 | |
US20210357663A1 (en) | Road recognition device | |
CN113183960B (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 |