CN111862629B - 一种弯道超速预警及主动限速方法和*** - Google Patents
一种弯道超速预警及主动限速方法和*** Download PDFInfo
- Publication number
- CN111862629B CN111862629B CN202010559618.7A CN202010559618A CN111862629B CN 111862629 B CN111862629 B CN 111862629B CN 202010559618 A CN202010559618 A CN 202010559618A CN 111862629 B CN111862629 B CN 111862629B
- Authority
- CN
- China
- Prior art keywords
- vehicle speed
- speed
- curve
- sequence
- acquiring
- 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
-
- G—PHYSICS
- G08—SIGNALLING
- G08G—TRAFFIC CONTROL SYSTEMS
- G08G1/00—Traffic control systems for road vehicles
- G08G1/01—Detecting movement of traffic to be counted or controlled
- G08G1/052—Detecting movement of traffic to be counted or controlled with provision for determining speed or overspeed
-
- G—PHYSICS
- G08—SIGNALLING
- G08G—TRAFFIC CONTROL SYSTEMS
- G08G1/00—Traffic control systems for road vehicles
- G08G1/16—Anti-collision systems
- G08G1/167—Driving aids for lane monitoring, lane changing, e.g. blind spot detection
Landscapes
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Traffic Control Systems (AREA)
Abstract
本发明公开了一种弯道超速预警及主动限速方法,包括检测车道信息,获取道路曲率序列,获取曲率最大值,及对应的相对纵向距离d;获取与道路曲率序列对应的允许车速序列V及允许车速最小值Vmin;获取当前车速,判断当前车速入弯是否存在偏离车道风险,若是,则获取到达弯最急点所需的时间TTCP;在允许车速序列V中查找与到达弯最急点所需的时间TTCP对应的限速值Vlimit,将限速值Vlimit输出至驱动制动***,根据驱动制动***执行接收到的速度值。本发明还公开了一种弯道超速预警及主动限速***。能配合自动驾驶功能,将车速控制在安全速度范围内,并在驶出弯道时自动恢复到预期车速。
Description
技术领域
本发明属于自动驾驶***等相关领域,具体涉及一种弯道超速预警及主动限速方法。
背景技术
近年来,互联网技术、高精度地图和人工智能的迅速发展和广泛应用促进了自动驾驶技术的发展。相关报道表明,自动驾驶技术可减少90%交通事故,降低70%出行成本,以及有望成为下一代计算平台。
自动驾驶技术主要包括感知、决策和执行三大环节。首先通过摄像头、激光雷达或毫米波雷达等传感器设备,采集与处理环境信息和车内信息;然后依据获取的信息和驾驶员意图进行决策判断,制定相应的控制策略;最后由执行***对车辆机械能控制,反馈到底层模块执行任务,包括线控加减速、线控制动和线控转向等。
弯道高速行驶是引发交通事故的很大原因,由于车辆在弯道行驶时离心力的作用,易发生侧滑或倾斜,使车辆变得难以驾驭,从而造成失控、侧滑甚至翻倾等事故。因此本发明提出一种弯道超速预警及主动限速的智能***,该***可进行弯道超速预警,及根据前方道路弯道的缓急主动限速,保证车辆安全及其舒适性。
发明内容:
为了克服上述背景技术的缺陷,本发明提供一种弯道超速预警及主动限速方法,能配合自动驾驶功能,将车速控制在安全速度范围内,并在驶出弯道时自动恢复到预期车速。
为了解决上述技术问题本发明的所采用的技术方案为:
一种弯道超速预警及主动限速方法,包括:
步骤1,检测车道信息,获取道路曲率序列,获取曲率最大值,及对应的相对纵向距离d;
步骤2,获取与道路曲率序列对应的允许车速序列V及允许车速最小值Vmin;
步骤3,获取当前车速,判断当前车速入弯是否存在偏离车道风险,若是,则进入步骤4,若否,则将输出***允许最大车速值输出至驱动制动***,并步骤6;
步骤4,结合当前车速、相对纵向距离d和允许车速vmin,获取到达弯最急点所需的时间TTCP;
步骤5,在允许车速序列V中查找与到达弯最急点所需的时间TTCP对应的限速值Vlimit,将限速值Vlimit输出至驱动制动***,并进入步骤6;
步骤6,根据驱动制动***执行接收到的速度值。
较佳地,步骤1检测车道信息包括:获取车道线信息车道线位置C0、航向角C1、车道线曲率C2和车道线曲率随Z的变化率C3。
较佳地,步骤1获取道路曲率序列的方法包括:根据传感器获取到的范围内道路的车道线信息通过以下公式计算曲率序列
较佳地,获取与道路曲率序列对应的允许车速序列V的方法包括:
较佳地,步骤3获取当前车速,判断当前车速入弯是否存在偏离车道风险的具体方法包括:
获取当前车速,判断当前车速是否大于允许车速最小值Vmin,若是,则存在偏离车道风险,若否,则不存在偏离车道风险。
较佳地,步骤4,结合当前车速Vcur、相对纵向距离d和允许车速Vmin,获取到达弯最急点所需的时间TTCP的具体方法包括:
较佳地,步骤4还包括通过仪表和声音发出提醒的步骤。
本发明还提供一种弯道超速预警及主动限速***,包括传感设备、弯道超速处理模块、弯道超速预警模块和主动限速模块。
较佳地,传感设备用于检测车道信息,获取道路曲率序列,获取曲率最大值,及对应的相对纵向距离d;
弯道超速处理模块用于获取与道路曲率序列对应的允许车速序列V及允许车速最小值Vmin,获取当前车速,判断当前车速入弯是否存在偏离车道风险,若是,则结合当前车速、相对纵向距离d和允许车速vmin,获取到达弯最急点所需的时间TTCP,在允许车速序列V中查找与到达弯最急点所需的时间TTCP对应的限速值Vlimit,将限速值Vlimit输出至驱动制动***;
主动限速模块用于驱动制动***执行接收到的速度值。
较佳地,弯道超速预警模块用于发出仪表和声音报警。
本发明的有益效果在于:本发明根据传感设备检测到的车道线信息、车辆运动状态及弯道中安全/舒适的侧向加速度要求等,判断以当前车速入弯是否存在偏离车道的风险,如果存在风险,通过仪表或扬声器等设备提示驾驶员;在搭载有定速巡航/自适应巡航等自动驾驶功能的车辆上,能配合自动驾驶功能,将车速控制在安全速度范围内,并在驶出弯道时自动恢复到预期车速。
附图说明
图1为本发明实施例方法所适用的场景示意图;
图2为本发明实施例一的方法流程图;
图3为本发明实施例二的***结构示意图;
图4为本发明实施例二中摄像头在坐标系中的位置示意图。
具体实施方式
下面结合附图和实施例对本发明做进一步的说明。
实施例一
一种弯道超速预警及主动限速的智能方法,其场景示意图如图1所示,本实施例主要包括以下步骤:
根据传感设备检测到的车道信息,计算车道曲率值ρ并搜索曲率最大值ρmax
步骤1,根据传感设备输出的车道线信息C0,C1,C2,C3,通过下式计算曲率ρ,
在传感设备的感知范围内,获取道路曲率序列ρ,并搜索曲率最大值ρmax,其对应道路弯最急点,并得到弯最急点与本车的相对纵向距离d;
如图4所示,测量原点是摄像头;前进方向为Z+、右侧向为X+、竖直向上为Y+。左手坐标系。航向角(绕Y的角度)向右为正
摄像头坐标系下的车道线方程如下:
X=C3*Z3+C2*Z2+C1*Z+C0
Z——车辆前进方向上的点距离摄像头的纵向距离
X——随Z变化的车道线相对于摄像头的偏移距离
C0——车道线位置
C1——航向角
C2——车道线曲率
C3——车道线曲率随Z的变化率。
步骤3,比较本车当前车速及允许车速最小值Vmin,判断以当前车速入弯是否存在偏离车道风险。当不存在偏离车道风险时,将***允许最大车速值作为最终输出的弯道限速值,即不需要限速(***允许最大车速值取道路限速牌(若支持)、驾驶员设定车速及***预设最大值中的较大值);当存在偏离车道风险时,进入步骤4;
步骤4,根据当前车速、纵向距离d、弯最急点对应的允许车速Vmin,判断在当前情况下到达弯最急点所需的时间TTCP,TTCP值的大小代表了入弯的风险程度,根据TTCP在允许车速序列V中查表得到最终的弯道限速值Vlimit;
TTCP计算方法如下:
d——距弯最急点的纵向距离,
Vcur——当前车速,
Vmin——弯最急点对应的允许车速,
步骤5,根据TTCP及设定阈值,TTCP达到阈值后***会通过仪表或扬声器等设备提示驾驶员。
步骤6,根据最终输出的弯道限速值,通过驱动/制动***,使车辆以安全舒适的速度过弯,并在驶出弯道后自动恢复至期望车速。
实施例二
一种弯道超速预警及主动限速***,包括传感设备、弯道超速处理模块、弯道超速预警模块和主动限速模块。
传感设备用于检测车道信息,获取道路曲率序列,获取曲率最大值,及对应的相对纵向距离d,本实施例地传感设备包括摄像头;
弯道超速处理模块用于获取与道路曲率序列对应的允许车速序列V及允许车速最小值Vmin,获取当前车速,判断当前车速入弯是否存在偏离车道风险,若是,则结合当前车速、相对纵向距离d和允许车速vmin,获取到达弯最急点所需的时间TTCP,在允许车速序列V中查找与到达弯最急点所需的时间TTCP对应的限速值Vlimit,将限速值Vlimit输出至驱动制动***;
主动限速模块用于驱动制动***执行接收到的速度值。
弯道超速预警模块用于发出仪表和声音报警。
本发明当车辆在直道行驶;或前方有弯道,以当前车速过弯不存在偏离风险时,弯道超速预警及限速功能处于待机状态;
当前方出现弯道,以当前车速过弯存在偏离风险时,弯道超速预警及限速功能激活,辅助驾驶员安全过弯;
限速功能激活时,TTCP越小,即存在较大的偏离车道风险,限速功能会越早将弯道最急点对应的限速值作为限速值输出,即越早将本车车速降低,安全入弯;
限速功能激活时,若TTCP较大,即偏离车道的风险较小,限速功能在限速值序列中选择较大的限速值输出,保证入弯的舒适性。
应当理解的是,对本领域普通技术人员来说,可以根据上述说明加以改进或变换,而所有这些改进和变换都应属于本发明所附权利要求的保护范围。
Claims (5)
1.一种弯道超速预警及主动限速方法,其特征在于,包括:
步骤1,检测车道信息,获取道路曲率序列,获取曲率最大值,及对应的相对纵向距离d;所述步骤1检测车道信息包括:获取车道线信息车道线位置C0、航向角C1、车道线曲率C2和车道线曲率随Z的变化率C3;获取道路曲率序列的方法包括:根据传感器获取到的范围内道路的车道线信息通过以下公式计算曲率序列
其中,X为随Z变化的车道线相对于摄像头的偏移距离,其中,x=C3*Z3+C2*Z2+C1*Z+C0,Z为车辆前进方向上的点距离摄像头的纵向距离;
步骤2,获取与所述道路曲率序列对应的允许车速序列V及允许车速最小值Vmin;所述获取与所述道路曲率序列对应的允许车速序列V的方法包括:
步骤3,获取当前车速,判断当前车速入弯是否存在偏离车道风险,若是,则进入步骤4,若否,则将输出***允许最大车速值输出至驱动制动***,并步骤6;
步骤4,结合当前车速、所述相对纵向距离d和允许车速vmin,获取到达弯最急点所需的时间TTCP;
结合当前车速Vcur、所述相对纵向距离d和允许车速Vmin,获取到达弯最急点所需的时间TTCP的具体方法包括:
步骤5,在所述允许车速序列V中查找与所述到达弯最急点所需的时间TTCP对应的限速值Vlimit,将所述限速值Vlimit输出至驱动制动***,并进入步骤6;
步骤6,根据所述驱动制动***执行接收到的速度值。
2.根据权利要求1所述的一种弯道超速预警及主动限速方法,其特征在于,所述步骤3获取当前车速,判断当前车速入弯是否存在偏离车道风险的具体方法包括:
获取当前车速,判断所述当前车速是否大于允许车速最小值Vmin,若是,则存在偏离车道风险,若否,则不存在偏离车道风险。
3.根据权利要求1所述的一种弯道超速预警及主动限速方法,其特征在于:所述步骤4还包括通过仪表和声音发出提醒的步骤。
4.一种利用如权利要求1—3任一项所述方法的弯道超速预警及主动限速***,其特征在于:包括传感设备、弯道超速处理模块、弯道超速预警模块和主动限速模块。
5.根据权利要求4所述的一种弯道超速预警及主动限速***,其特征在于:所述弯道超速预警模块用于发出仪表和声音报警。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202010559618.7A CN111862629B (zh) | 2020-06-18 | 2020-06-18 | 一种弯道超速预警及主动限速方法和*** |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202010559618.7A CN111862629B (zh) | 2020-06-18 | 2020-06-18 | 一种弯道超速预警及主动限速方法和*** |
Publications (2)
Publication Number | Publication Date |
---|---|
CN111862629A CN111862629A (zh) | 2020-10-30 |
CN111862629B true CN111862629B (zh) | 2021-11-23 |
Family
ID=72987441
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN202010559618.7A Active CN111862629B (zh) | 2020-06-18 | 2020-06-18 | 一种弯道超速预警及主动限速方法和*** |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN111862629B (zh) |
Families Citing this family (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN112937573A (zh) * | 2019-12-10 | 2021-06-11 | 华为技术有限公司 | 一种安全速度的确定方法、装置及*** |
CN114572275A (zh) * | 2020-12-02 | 2022-06-03 | 晋城三赢精密电子有限公司 | 车辆行车辅助方法、车载装置、车辆及存储介质 |
CN117549897B (zh) * | 2023-12-28 | 2024-05-10 | 上海保隆汽车科技股份有限公司 | 车辆过弯控制方法、***、存储介质及电子设备 |
Citations (12)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US5635922A (en) * | 1993-12-27 | 1997-06-03 | Hyundai Electronics Industries Co., Ltd. | Apparatus for and method of preventing car collision utilizing laser |
CN202345672U (zh) * | 2011-11-08 | 2012-07-25 | 长安大学 | 一种弯道超速报警辅助装置 |
CN202357979U (zh) * | 2011-12-08 | 2012-08-01 | 长安大学 | 一种基于视频图像识别的弯道超速预警装置 |
CN103129390A (zh) * | 2011-11-25 | 2013-06-05 | 北汽福田汽车股份有限公司 | 一种车辆限速***及其限速方法 |
CN103745607A (zh) * | 2014-01-09 | 2014-04-23 | 中国科学技术大学苏州研究院 | 基于车路协同的弯道速度预警方法 |
CN103832282A (zh) * | 2014-02-25 | 2014-06-04 | 长城汽车股份有限公司 | 一种汽车智能限速***及汽车限速方法 |
CN106355919A (zh) * | 2016-09-21 | 2017-01-25 | 山西省交通科学研究院 | 一种基于机器视觉的弯道车速限速计算方法及超速警示装置 |
CN107891860A (zh) * | 2017-11-14 | 2018-04-10 | 重庆长安汽车股份有限公司 | 基于道路曲率自适应调节车速的***及方法 |
CN109598937A (zh) * | 2018-12-19 | 2019-04-09 | 山东交通学院 | 一种道路弯道安全速度检测与警示装置及方法 |
CN110088807A (zh) * | 2016-12-16 | 2019-08-02 | 歌乐株式会社 | 分隔线识别装置 |
CN110361022A (zh) * | 2018-09-30 | 2019-10-22 | 长城汽车股份有限公司 | 行车坐标系构建方法及*** |
CN110949395A (zh) * | 2019-11-15 | 2020-04-03 | 江苏大学 | 一种基于多传感器融合的弯道acc目标车辆识别方法 |
-
2020
- 2020-06-18 CN CN202010559618.7A patent/CN111862629B/zh active Active
Patent Citations (12)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US5635922A (en) * | 1993-12-27 | 1997-06-03 | Hyundai Electronics Industries Co., Ltd. | Apparatus for and method of preventing car collision utilizing laser |
CN202345672U (zh) * | 2011-11-08 | 2012-07-25 | 长安大学 | 一种弯道超速报警辅助装置 |
CN103129390A (zh) * | 2011-11-25 | 2013-06-05 | 北汽福田汽车股份有限公司 | 一种车辆限速***及其限速方法 |
CN202357979U (zh) * | 2011-12-08 | 2012-08-01 | 长安大学 | 一种基于视频图像识别的弯道超速预警装置 |
CN103745607A (zh) * | 2014-01-09 | 2014-04-23 | 中国科学技术大学苏州研究院 | 基于车路协同的弯道速度预警方法 |
CN103832282A (zh) * | 2014-02-25 | 2014-06-04 | 长城汽车股份有限公司 | 一种汽车智能限速***及汽车限速方法 |
CN106355919A (zh) * | 2016-09-21 | 2017-01-25 | 山西省交通科学研究院 | 一种基于机器视觉的弯道车速限速计算方法及超速警示装置 |
CN110088807A (zh) * | 2016-12-16 | 2019-08-02 | 歌乐株式会社 | 分隔线识别装置 |
CN107891860A (zh) * | 2017-11-14 | 2018-04-10 | 重庆长安汽车股份有限公司 | 基于道路曲率自适应调节车速的***及方法 |
CN110361022A (zh) * | 2018-09-30 | 2019-10-22 | 长城汽车股份有限公司 | 行车坐标系构建方法及*** |
CN109598937A (zh) * | 2018-12-19 | 2019-04-09 | 山东交通学院 | 一种道路弯道安全速度检测与警示装置及方法 |
CN110949395A (zh) * | 2019-11-15 | 2020-04-03 | 江苏大学 | 一种基于多传感器融合的弯道acc目标车辆识别方法 |
Non-Patent Citations (1)
Title |
---|
基于弯道行驶的车辆自适应巡航控制;张德兆;《中国博士学位论文全文数据库(电子期刊)工程科技Ⅱ辑》;20140415(第04期);全文 * |
Also Published As
Publication number | Publication date |
---|---|
CN111862629A (zh) | 2020-10-30 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN111862629B (zh) | 一种弯道超速预警及主动限速方法和*** | |
CN109789873B (zh) | 车辆控制装置 | |
EP2982565B1 (en) | Vehicle control device | |
CN107867283B (zh) | 基于预测模型的集成式fcw/acc/aeb***及车辆 | |
US8762021B2 (en) | Driving support system | |
US6778896B1 (en) | Curve approach control apparatus | |
CN104773172A (zh) | 用于控制追踪目标车辆的车辆的设备及计算机程序 | |
CN109804420B (zh) | 车辆控制装置 | |
EP2712780B1 (en) | Method and apparatus for performing driving assistance | |
CN109760678A (zh) | 一种汽车自适应巡航***的限速方法 | |
US10875508B2 (en) | Vehicle traveling assistance method and vehicle traveling assistance device | |
CN109774473B (zh) | 一种基于摄像头与导航数据融合的限速控制方法 | |
US11072334B2 (en) | Vehicle control system | |
US20190172355A1 (en) | Control system and control method for driving a motor vehicle and for avoiding a collision with another motor vehicle | |
US11231710B2 (en) | Automatic driving system | |
KR101545054B1 (ko) | 풍속 측정 기반의 제동장치 및 그 제어방법 | |
CN113428141A (zh) | 一种前车紧急切入及时响应的智能检测方法及*** | |
CN110103961B (zh) | 智能跟车控制方法、装置、***及终端 | |
US20220371580A1 (en) | Vehicle driving support system and vehicle driving support method | |
US11801863B2 (en) | Vehicle control device, vehicle control method, and storage medium | |
US9177040B2 (en) | Information processing device for vehicle and database | |
CN114954454A (zh) | 一种自动驾驶低速跟车巡航控制方法及装置 | |
CN202271993U (zh) | 车辆的驾驶辅助装置 | |
CN202413789U (zh) | 车辆用驾驶辅助装置 | |
CN112026767B (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 |