CN110667574A - 一种多情景车道偏离预警***及方法 - Google Patents
一种多情景车道偏离预警***及方法 Download PDFInfo
- Publication number
- CN110667574A CN110667574A CN201910909593.6A CN201910909593A CN110667574A CN 110667574 A CN110667574 A CN 110667574A CN 201910909593 A CN201910909593 A CN 201910909593A CN 110667574 A CN110667574 A CN 110667574A
- Authority
- CN
- China
- Prior art keywords
- vehicle
- lane
- current
- deviation
- early warning
- 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 56
- 230000000903 blocking effect Effects 0.000 claims description 18
- 230000002401 inhibitory effect Effects 0.000 claims description 16
- 230000005764 inhibitory process Effects 0.000 claims description 12
- 230000001629 suppression Effects 0.000 claims description 11
- 238000004364 calculation method Methods 0.000 claims description 10
- 230000009286 beneficial effect Effects 0.000 description 2
- 230000035484 reaction time Effects 0.000 description 2
- 230000035945 sensitivity Effects 0.000 description 2
- 208000003443 Unconsciousness Diseases 0.000 description 1
- 230000006978 adaptation Effects 0.000 description 1
- 230000007547 defect Effects 0.000 description 1
- 238000010586 diagram Methods 0.000 description 1
- 230000000694 effects Effects 0.000 description 1
- 238000005516 engineering process Methods 0.000 description 1
- 238000002474 experimental method Methods 0.000 description 1
- 230000000452 restraining effect Effects 0.000 description 1
- 230000000007 visual effect Effects 0.000 description 1
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
- B60W30/00—Purposes of road vehicle drive control systems not related to the control of a particular sub-unit, e.g. of systems using conjoint control of vehicle sub-units
- B60W30/08—Active safety systems predicting or avoiding probable or impending collision or attempting to minimise its consequences
-
- 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
-
- 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
- B60W40/072—Curvature of the road
-
- 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/10—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 vehicle motion
- B60W40/105—Speed
-
- 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/08—Interaction between the driver and the control system
- B60W50/14—Means for informing the driver, warning the driver or prompting a driver intervention
-
- 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/08—Interaction between the driver and the control system
- B60W50/14—Means for informing the driver, warning the driver or prompting a driver intervention
- B60W2050/143—Alarm means
Landscapes
- Engineering & Computer Science (AREA)
- Automation & Control Theory (AREA)
- Transportation (AREA)
- Mechanical Engineering (AREA)
- Physics & Mathematics (AREA)
- Mathematical Physics (AREA)
- Human Computer Interaction (AREA)
- Traffic Control Systems (AREA)
Abstract
本发明公开了一种多情景车道偏离预警决策方法。该预警决策方法根据当前道路状况、车辆行驶速度的不同将车辆预警环境分为高速、低速弯道和低速直道三种情景,并根据各种算法运用过程中的优缺点以及车辆实际运行的预警需求选择合适预警决策算法,实现一种应用于多情景的车道偏离预警,大大减少了传统预警方法采用单一车道偏离预警决策算法带来的误报,有效地规范了驾驶员高速行驶时的驾驶行为,增加了车辆弯道行使时的预警准确性。
Description
技术领域
本发明属于汽车主动安全技术领域,尤其涉及一种多情景车道偏离预警***及方法。
背景技术
交通安全问题的影响日益显著催生并促进了汽车主动安全技术领域的不断发展,其中,车道偏离预警***(Lane Departure Warning System,LDWS,在驾驶员无意识且未打转向灯的情况下车辆偏离车道时,***提前做出判断,并对驾驶员进行预警提醒)通过车辆电控***智能判断目标车辆的偏离状态,并提前对驾驶员进行预警提醒,从而大大减少了因驾驶员疲劳、长时间驾驶或者转向***失控造成的车道偏离,减少碰撞事故的发生。
现有车道偏离***大多采用单一算法结合其他车辆或道路状态判断目标车辆的偏离状态,存在一定判断偏差;使用估计算法大多是根据时间或距离来计算阈值,没有考虑驾驶员弯道越线转弯的驾驶习惯,其中存在一定误报,造成驾驶员的驾驶困扰;同时***不适用于非结构道路等难以检测出车道线的复杂道路环境。
现有车道偏离预警方案中,比较有代表性的算法模型主要有:横向速度决策模型、TLC(Time to Lane Crossing)决策模型和FOD(Future Offset Distance)决策模型。其中,横向速度决策算法以侧向速度作为决策指标,但作为单一的决策算法,当车辆左右摆动或驾驶员急调方向时,则会产生过多误警;TLC决策模型应用最为广泛,其预警时间比较长,能给驾驶员预留较长的反应时间,假设车辆当前的行驶状态,即方向盘转角、车速等保持不变;FOD决策模型根据驾驶员的驾驶习惯设置虚拟车道边界线,有多个阈值,可以避免驾驶员在弯道转弯行驶时,由于驾驶习惯而跨越部分车道线引起的误警。
发明内容
发明目的:针对现有发明中的不足和缺陷,本发明基于各种算法的优点和适用范围,提出了一种应用于多情景的车道偏离预警方法,在不同的驾驶环境和驾驶状况下分别使用适当的预警决策算法,判断车辆是否偏离当前车道,从而有效提高车道偏离预警控制***的灵敏度,减少车道偏离误报警,增加偏离判断的准确性。
技术方案:为实现本发明的目的,本发明所采用的技术方案是:一种应用于多情景的车道偏离预警***及方法。
所述预警***包括数据采集单元、数据判断单元和偏离预警单元;
所述数据采集单元,安装于车辆内部,用于实时采集数据,并将采集到的数据传递至数据判断单元;
所述数据判断单元,用于接收采集到的数据,并进行偏离预警判断,将预警指令传递至偏离预警单元;
所述偏离预警单元,用于接收偏离预警指令,提醒驾驶员阻止车辆进一步偏离。
进一步,所述数据采集单元包括摄像头、车速传感器、方向盘转角传感器、转向灯和危险警报灯;
通过车速传感器获取当前车速;
通过方向盘转角传感器获取方向盘转向转角;
通过摄像头采集车辆的偏移距离和偏移角度、当前道路车道线位置、车道宽度、道路曲率半径;
通过捕捉转向灯和危险警报灯信号线上的信号获取转向灯和危险警报灯状态。
进一步,所述数据判断单元包括抑制偏离判断单元、车速判断单元、道路曲率半径判断单元、车道偏离判断单元。
为了避免在驾驶员转弯、变道或起步情况下,车道偏离预警***发生不必要的报警,影响驾驶员的驾驶体验,因此,在进行车道偏离判断之前,首先进行抑制偏离预警条件的判断。
所述抑制偏离预警条件包括:当前车速、转向灯与危险警报灯状态、车辆偏离距离、方向盘转角速率、两次报警时间间隔。
所述抑制偏离判断单元,用于接收数据采集单元传递的数据,判断当前时刻是否满足抑制偏离预警条件,并将判断信号传递到车速判断单元;
所述车速判断单元,用于接收数据采集单元传递的数据,以及抑制偏离判断单元的判断信号,判断车辆是否大于预先设定的车速阈值,并将判断信号传递给车道偏离判断单元和道路曲率半径判断单元;
所述道路曲率半径判断单元,用于接收数据采集单元传递的数据,以及车速判断单元发送的判断信号,判断当前道路为直道或弯道,并将判断信号传递给车道偏离判断单元;
所述车道偏离判断单元,用于接收数据采集单元传递的数据,以及车速判断单元和道路曲率半径判断单元传递的判断信号,判断车辆是否偏离当前车道,并将判断信号传递给偏离预警单元。
进一步,所述偏离预警单元在车辆偏离车道时,通过视觉、触觉或者听觉提醒驾驶员,或者向转向盘施加适当阻力,以阻止车辆的进一步偏离。
一种多情景的车道偏离预警决策方法,包括以下步骤:
步骤1,实时采集车辆的当前车速、偏移距离和偏移角度、方向盘转向转角、当前道路车道线位置、车道宽度、道路曲率半径、转向灯和危险警报灯状态;
步骤2,根据步骤1中采集的数据,判断当前时刻是否满足抑制偏离预警条件;
若满足抑制条件,设定阻断时长,阻断后续操作,达到阻断时长后,继续判断下一时刻采集的数据;若不满足抑制条件,执行步骤3;
所述抑制偏离预警条件包括:当前车速、转向灯与危险警报灯状态、车辆偏离距离、方向盘转角速率、两次报警时间间隔;
步骤3,判断当前车速是否大于预先设定的车速阈值Vth2,如果小于阈值Vth2,执行步骤4;如果大于或等于阈值Vth2,执行步骤5;
步骤4,判断当前道路曲率半径是否大于设定的曲率半径阈值Rth;如果大于阈值Rth,判断当前车道为直道,执行步骤6;如果小于或等于阈值Rth,判断当前车道为弯道,执行步骤7;
步骤5,采用基于横向偏移速度的预警决策方法,判断车辆是否偏离当前车道,转入步骤8;
步骤6,采用基于车辆跨越车道线的剩余时间(Time to Lane Crossing,TLC)的预警决策方法,判断车辆是否偏离当前车道,转入步骤8;
步骤7,采用基于未来偏移距离(Future Offset Distance,FOD)的预警决策方法,判断车辆是否偏离当前车道,进入步骤8;
步骤8,若车辆没有偏离车道,则返回步骤1;若车辆偏离车道,发出偏离预警指令,阻止车辆的进一步偏离。
优选地,车速阈值Vth2取值为60km/h;曲率半径阈值Rth取值为250m。
进一步,所述步骤1中,采集当前道路车道线位置时,需要检测并识别两侧车道线和道路宽度;具体如下:
如果可以检测到车道线,获取道路线和道路宽度;
如果未能获取当前道路车道线,根据检测的路基宽度,分别在与车道两边路缘内侧一定距离处划分出虚拟车道线,以代替真实车道线;
车道宽度与路基宽度的计算方法为:
其中,D为车道宽度,Dsubgrade为路基宽度,Dsmax为路基宽度最大值。
进一步,所述步骤2,根据采集的数据,判断当前时刻是否满足抑制偏离预警条件;具体如下:
2-1,当前车速V小于车速阈值Vth1时,表明车辆处于起步或者预备靠边停车状况,满足抑制偏离预警条件;
2-2,驾驶员开启危险警报灯或偏离侧的转向灯时,表明驾驶员有变换车道、掉头或者停车意图,满足抑制偏离预警条件;
2-3,直道行驶时,检测到车辆距离其偏离侧车道线的横向距离小于设定的距离阈值时,表明车辆处于预备变换车道或者掉头的状况,满足抑制偏离预警条件;
2-4,检测到驾驶员向偏离侧相反方向转动转向盘,且转角速率大于设定速率阈值时,表明驾驶员发现车辆偏离并有调整偏离方向的意图,满足抑制偏离预警条件;
2-5,在距离上一次偏离报警的t1时间段内,满足抑制偏离预警条件;
2-6,在满足以上任意一种抑制偏离预警条件时,阻断后续操作,阻断时长设为t2,达到阻断时长后,继续判断下一时刻数据。
优选地,车速阈值Vth1取值为30km/h;t1取值为3s,t2取值为1min。
进一步,所述步骤5中,采用基于横向偏移速度的预警决策方法,判断车辆是否偏离当前车道,具体如下:
以车辆的当前侧向速度vy作为车辆是否偏离当前车道的决策指标;
所述侧向速度vy是与车辆当前纵向速度Vx垂直方向的速度;
将侧向速度vy与给定的速度阈值Vde进行比较,若vy>Vde,车辆偏离当前车道,若vy≤Vde,车辆没有偏离当前车道。
进一步,所述步骤6中,采用基于车辆跨越车道线的剩余时间(TLC)的预警决策方法,判断车辆是否偏离当前车道,具体如下:
车辆跨越车道线的剩余时间(TLC)是指车辆从当前时刻位置到偏离侧车道线的剩余时间,其计算方法是:
首先计算当前时刻车辆前轮到偏离侧车道线的纵向距离;
然后根据该纵向距离,以及车辆当前的纵向速度,计算车辆跨越车道线的剩余时间;
TLC的计算公式为:
其中,TLC表示车辆跨越车道线的剩余时间,Vx表示车辆当前纵向速度,L表示从当前时刻车辆前轮到偏离侧车道线的纵向距离。
设车辆偏离过程中航向角,纵向和横向速度保持不变,转向盘转角保持恒定;
将车辆跨越车道线的剩余时间(TLC)与给定的时间阈值Tde进行比较,若TLC<Tde,车辆偏离当前车道,若TLC≥Tde,车辆没有偏离当前车道。
优选地,时间阈值Tde取0.3s。
进一步,所述步骤7中,采用基于未来偏移距离(FOD)的预警决策方法,判断车辆是否偏离当前车道;具体如下:
判断驾驶员在前n次行程中行驶至弯道处转向时是否存在跨越车道线的行为;
若跨越车道线,将实际车道线向外侧一定距离拓展,得到虚拟的车道边界线;
若没有跨越车道线,虚拟车道边界线和真实车道线重合;
计算预测汽车未来状态的时刻距当前时刻的时间,即前视时间Tlookahead;
前视时间Tlookahead的计算公式为:
式中,Lvirtual是车辆跨越虚拟车道边界线的纵向距离,Lwarning是偏离预警期望出发位置,vy是车辆当前侧向速度;
计算经过前视时间Tlookahead后车辆的侧向位置LT;
车辆侧向位置LT的计算公式为:
LT=Lcurrent+Tlookahea*vy
式中,Lcurrent是当前车辆与虚拟车道线的距离;
将车辆跨越虚拟车道边界线的纵向距离Lvirtual与车辆的侧向位置LT进行比较;
若LT>Lvirtual,车辆偏离当前车道,若LT≤Lvirtual,车辆没有偏离当前车道。
进一步,本发明中所涉及的各种阈值可以由实验或者经验所得,凡是符合车辆偏离预警实际要求的都可以作为决策判断阈值。
有益效果:与现有技术相比,本发明的技术方案具有以下有益的技术效果:
本发明***符合中国驾驶员在各种路况之下的驾驶习惯,在驾驶员高速行驶时,***的高度灵敏性,有助于纠正驾驶员不良驾驶习惯。低速行驶时,增加驾驶员的预留反应时间,增加驾驶员对于***的驾驶适应,减少预警偏差,适应多种道路条件。并在驾驶员有车辆起步、转向、变道等意识时或者上一次报警刚刚结束时抑制报警,防止频繁报警,提高驾驶的舒适性。
附图说明
图1是本发明提供的一种车道偏离预警***的结构示意图;
图2是本发明提供的一种车道偏离预警方法的流程示意图。
具体实施方式
下面将结合本发明中提供的附图,对本发明中的技术流程和实例结构进行清晰、完整的描述。基于本发明中的例子,本领域普通技术人员在没有做出创造性劳动的前提下所获得的所有其他实施例,都属于本发明的保护范围之内。
如图1所示,本发明所述的一种车道偏离预警***,包括数据采集单元、数据判断单元和偏离预警单元。
所述数据采集单元,安装于车辆内部,用于实时采集数据,并将采集到的数据传递至数据判断单元;
所述数据采集单元包括摄像头、车速传感器、方向盘转角传感器、转向灯和危险警报灯;
通过车速传感器获取当前车速;
通过方向盘转角传感器获取方向盘转向转角;
通过摄像头采集车辆的偏移距离和偏移角度、当前道路车道线位置、车道宽度、道路曲率半径;
通过捕捉转向灯和危险警报灯信号线上的信号获取转向灯和危险警报灯状态。
所述数据判断单元,用于接收采集到的数据,并进行偏离预警判断,将预警指令传递至偏离预警单元;
为了避免在驾驶员转弯、变道或起步情况下,车道偏离预警***发生不必要的报警,影响驾驶员的驾驶体验,因此,在进行车道偏离判断之前,要首先进行抑制偏离预警条件的判断。
所述抑制偏离预警条件包括:当前车速、转向灯与危险警报灯状态、车辆偏离距离、方向盘转角速率、两次报警时间间隔。
所述抑制偏离判断单元,用于接收数据采集单元传递的数据,判断当前时刻是否满足抑制偏离预警条件,并将判断信号传递到车速判断单元;
所述车速判断单元,用于接收数据采集单元传递的数据,以及抑制偏离判断单元的判断信号,判断车辆是否大于预先设定的车速阈值,并将判断信号传递给车道偏离判断单元和道路曲率半径判断单元;
所述道路曲率半径判断单元,用于接收数据采集单元传递的数据,以及车速判断单元发送的判断信号,判断当前道路为直道或弯道,并将判断信号传递给车道偏离判断单元;
所述车道偏离判断单元,用于接收数据采集单元传递的数据,以及车速判断单元和道路曲率半径判断单元传递的判断信号,判断车辆是否偏离当前车道,并将判断信号传递给偏离预警单元。
所述偏离预警单元,用于接收偏离预警指令,提醒驾驶员阻止车辆进一步偏离。
所述偏离预警单元在车辆继续偏离车道时,通过视觉、触觉或者听觉提醒驾驶员,或者向转向盘施加适当阻力,以阻止车辆的进一步偏离。
如图2所示,一种多情景车道偏离预警方法,包括以下步骤:
S101、实时采集车辆的当前车速、偏移距离和偏移角度、方向盘转向转角、当前道路车道线位置、车道宽度、道路曲率半径、转向灯和危险警报灯状态;
如果可以检测到车道线,获取道路线和道路宽度;
如果未能获取当前道路车道线,根据检测的路基宽度,分别在与车道两边路缘内侧一定距离处划分出虚拟车道线,以代替真实车道线;
车道宽度与路基宽度的计算方法为:
其中,D为车道宽度(m),Dsubgrade为路基宽度(m),Dsmax为路基宽度最大值。
S102、根据步骤S101中采集的数据,判断当前时刻是否满足抑制偏离预警条件;
若满足抑制条件,设定阻断时长,阻断后续操作,达到阻断时长后,继续判断下一时刻采集的数据;若不满足抑制条件,执行步骤S103;
根据采集的数据,判断当前时刻是否满足抑制偏离预警条件;具体如下:
S1021、当前车速y小于车速阈值Vth1时,表明车辆处于起步或者预备靠边停车状况,满足抑制偏离预警条件;本实施例中车速阈值Vth1取值为30km/h;
S1022、驾驶员开启危险警报灯或偏离侧的转向灯时,表明驾驶员有变换车道、掉头或者停车意图,满足抑制偏离预警条件;
S1023、直道行驶时,检测到车辆距离其偏离侧车道线的横向距离小于设定的距离阈值时,表明车辆处于预备变换车道或者掉头的状况,满足抑制偏离预警条件;
S1024、检测到驾驶员向偏离侧相反方向转动转向盘,且转角速率大于设定速率阈值时,表明驾驶员发现车辆偏离并有调整偏离方向的意图,满足抑制偏离预警条件;
S1025、在上一次偏离报警之后3秒内,满足抑制偏离预警条件;
S1026、在满足以上任意一种抑制偏离预警条件时,阻断后续操作,阻断时长设为1min,达到阻断时长后,继续判断下一时刻数据。
S103、判断当前车速是否大于预先设定的车速阈值Vth2;如果小于阈值Vth2,执行步骤S104;如果大于或等于阈值Vth2,执行步骤S105;
S104、判断当前道路曲率半径是否大于设定的曲率半径阈值Rth;如果大于阈值Rth,判断当前车道为直道,执行步骤S106;如果小于或等于阈值Rth,判断当前车道为弯道,执行步骤S107;
本实施例中车速阈值Vth2取60km/h;曲率半径阈值Rth取250m;
S105、采用基于横向偏移速度的预警决策方法,判断车辆是否偏离当前车道,转入步骤S108;
S106、采用车辆跨越车道线的剩余时间(TLC)与时间阈值进行比较的预警决策方法,判断车辆是否偏离当前车道,转入步骤S108;
S107、采用基于未来偏移距离(FOD)的预警决策方法,判断车辆是否偏离当前车道,进入步骤S108;
S108、根据相应情景下的预警决策方法,判断车辆是否偏离车道;
若车辆没有偏离车道,则返回步骤S101;
若车辆偏离车道,在车辆继续偏离车道时,车道偏离判断单元向偏离预警单元发出指令,通过视觉、触觉或者听觉提醒驾驶员,或者向转向盘施加适当阻力,阻止车辆的进一步偏离。
所述步骤S105中,采用基于横向偏移速度的预警决策方法,判断车辆是否偏离当前车道,具体如下:
以车辆的当前侧向速度vy作为车辆是否偏离当前车道的决策指标;
所述侧向速度vy是与车辆当前纵向速度Vx垂直方向的速度;
将侧向速度vy与给定的速度阈值Vde进行比较,若vy>Vde,车辆偏离当前车道,若vy≤Vde,车辆没有偏离当前车道。
所述步骤S106中,采用基于车辆跨越车道线的剩余时间(TLC)的预警决策方法,判断车辆是否偏离当前车道,具体如下:
车辆跨越车道线的剩余时间(TLC)是指车辆从当前时刻位置到偏离侧车道线的剩余时间,其计算方法是:
首先计算当前时刻车辆前轮到偏离侧车道线的纵向距离;
然后根据该纵向距离,以及车辆当前的纵向速度,计算车辆跨越车道线的剩余时间;
TLC的计算公式为:
其中,TLC表示车辆跨越车道线的剩余时间,Vx表示车辆当前纵向速度,L表示从当前时刻车辆前轮到偏离侧车道线的纵向距离。
设车辆偏离过程中航向角,纵向和横向速度保持不变,转向盘转角保持恒定;
将车辆跨越车道线的剩余时间(TLC)与给定的时间阈值Tde进行比较,若TLC<Tde,车辆偏离当前车道,若TLC≥Tde,车辆没有偏离当前车道。
本实施例中,时间阈值Tde取0.3s。
所述步骤S107中,采用基于未来偏移距离(FOD)的预警决策方法,判断车辆是否偏离当前车道;具体如下:
判断驾驶员在前n次行程中行驶至弯道处转向时是否存在跨越车道线的行为;
若跨越车道线,将实际车道线向外侧一定距离拓展,得到虚拟的车道边界线;
若没有跨越车道线,虚拟车道边界线和真实车道线重合;
计算预测汽车未来状态的时刻距当前时刻的时间,即前视时间Tlookahead;
前视时间Tlookahead的计算公式为:
式中,Lvirtual是车辆跨越虚拟车道边界线的纵向距离,Lwarning是偏离预警期望出发位置,vy是车辆当前侧向速度;
计算经过前视时间Tlookahead后车辆的侧向位置LT;
车辆侧向位置LT的计算公式为:
LT=Lcurrent+Tlookahead*vy
式中,Lcurrent是当前车辆与虚拟车道线的距离;
将车辆跨越虚拟车道边界线的纵向距离Lvirtual与车辆的侧向位置LT进行比较;
若LT>Lvirtual,车辆偏离当前车道,若LT≤Lvirtual,车辆没有偏离当前车道。
Claims (10)
1.一种多情景车道偏离预警方法,其特征在于:该方法包括以下步骤:
步骤1,实时采集车辆的当前车速、偏移距离和偏移角度、方向盘转向转角、当前道路车道线位置、车道宽度、道路曲率半径、转向灯和危险警报灯状态;
步骤2,根据步骤1中采集的数据,判断当前时刻是否满足抑制偏离预警条件;
若满足抑制条件,设定阻断时长,阻断后续操作,达到阻断时长后,继续判断下一时刻采集的数据;若不满足抑制条件,执行步骤3;
所述抑制偏离预警条件包括:当前车速、转向灯与危险警报灯状态、车辆偏离距离、方向盘转角速率、两次报警时间间隔;
步骤3,判断当前车速是否大于预先设定的车速阈值Vth2,如果小于阈值Vth2,执行步骤4;如果大于或等于阈值Vth2,执行步骤5;
步骤4,判断当前道路曲率半径是否大于设定的曲率半径阈值Rth;如果大于阈值Rth,判断当前车道为直道,执行步骤6;如果小于或等于阈值Rth,判断当前车道为弯道,执行步骤7;
步骤5,采用基于横向偏移速度的预警决策方法,判断车辆是否偏离当前车道,转入步骤8;
步骤6,采用基于车辆跨越车道线的剩余时间的预警决策方法,判断车辆是否偏离当前车道,转入步骤8;
步骤7,采用基于未来偏移距离的预警决策方法,判断车辆是否偏离当前车道,进入步骤8;
步骤8,若车辆没有偏离车道,则返回步骤1;若车辆偏离车道,发出偏离预警指令,阻止车辆的进一步偏离。
2.根据权利要求1所述的一种多情景车道偏离预警方法,其特征在于:所述步骤1中,采集当前道路车道线位置时,需要检测并识别两侧车道线和道路宽度;具体如下:
如果检测到车道线,获取道路线位置和道路宽度;
如果未检测到当前道路车道线,根据检测的路基宽度,分别在与车道两边路缘内侧一定距离处划分出虚拟车道线,以代替真实车道线;
车道宽度与路基宽度的计算方法为:
其中,D为车道宽度,Dsubgrade为路基宽度,Dsmax为路基宽度最大值。
3.根据权利要求1所述的一种多情景车道偏离预警方法,其特征在于:所述步骤2,根据采集的数据,判断当前时刻是否满足抑制偏离预警条件;具体如下:
2-1,当前车速V小于车速阈值Vth1时,表明车辆处于起步或者预备靠边停车状况,满足抑制偏离预警条件;
2-2,驾驶员开启危险警报灯或偏离侧的转向灯时,表明驾驶员有变换车道、掉头或者停车意图,满足抑制偏离预警条件;
2-3,直道行驶时,检测到车辆距离其偏离侧车道线的横向距离小于设定的距离阈值时,表明车辆处于预备变换车道或者掉头的状况,满足抑制偏离预警条件;
2-4,检测到驾驶员向偏离侧相反方向转动转向盘,且转角速率大于设定速率阈值时,表明驾驶员发现车辆偏离并有调整偏离方向的意图,满足抑制偏离预警条件;
2-5,在距离上一次偏离报警的t1时间段内,满足抑制偏离预警条件;
2-6,在满足以上任意一种抑制偏离预警条件时,阻断后续操作,阻断时长设为t2,达到阻断时长后,继续判断下一时刻数据。
4.根据权利要求1-3任一所述的一种多情景车道偏离预警方法,其特征在于:所述步骤5中,采用基于横向偏移速度的预警决策方法,判断车辆是否偏离当前车道,具体如下:
以车辆的当前侧向速度vy作为车辆是否偏离当前车道的决策指标;
所述侧向速度vy是与车辆当前纵向速度Vx垂直方向的速度;
将侧向速度vy与给定的速度阈值Vde进行比较,若vy>Vde,车辆偏离当前车道,若vy≤Vde,车辆没有偏离当前车道。
5.根据权利要求1-3任一所述的一种多情景车道偏离预警方法,其特征在于:所述步骤6中,采用基于车辆跨越车道线的剩余时间的预警决策方法,判断车辆是否偏离当前车道,具体如下:
车辆跨越车道线的剩余时间是指车辆从当前时刻位置到偏离侧车道线的剩余时间,其计算方法是:
首先计算当前时刻车辆前轮到偏离侧车道线的纵向距离;
然后根据该纵向距离,以及车辆当前的纵向速度,计算车辆跨越车道线的剩余时间;
计算公式为:
其中,TLC表示车辆跨越车道线的剩余时间,Vx表示车辆当前纵向速度,L表示从当前时刻车辆前轮到偏离侧车道线的纵向距离;
设车辆偏离过程中航向角,纵向和横向速度保持不变,转向盘转角保持恒定;
将车辆跨越车道线的剩余时间TLC与给定的时间阈值Tde进行比较,若TLC<Tde,车辆偏离当前车道,若TLC≥Tde,车辆没有偏离当前车道。
6.根据权利要求1-3任一所述的一种多情景车道偏离预警方法,其特征在于:所述步骤7中,采用基于未来偏移距离的预警决策方法,判断车辆是否偏离当前车道;具体如下:
判断驾驶员在前n次行程中行驶至弯道处转向时是否存在跨越车道线的行为;
若跨越车道线,将实际车道线向外侧拓展一定距离,得到虚拟的车道边界线;
若没有跨越车道线,虚拟车道边界线和真实车道线重合;
计算预测汽车未来状态的时刻距当前时刻的时间,即前视时间Tlookahead;
前视时间Tlookahea的计算公式为:
式中,Lvirtual是车辆跨越虚拟车道边界线的纵向距离,Lwarning是偏离预警期望出发位置,vy是车辆当前侧向速度;
计算经过前视时间Tlookahead后车辆的侧向位置LT;
车辆侧向位置LT的计算公式为:
LT=Lcurrent+Tlookahead*vy
式中,Lcurrent是当前车辆与虚拟车道线的距离;
将车辆跨越虚拟车道边界线的纵向距离Lvirtual与车辆的侧向位置LT进行比较;
若LT>Lvirtual,车辆偏离当前车道,若LT≤Lvirtual,车辆没有偏离当前车道。
7.根据权利要求1所述的一种多情景车道偏离预警方法,其特征在于:通过车速传感器获取当前车速;通过方向盘转角传感器获取方向盘转向转角;通过摄像头采集车辆的偏移距离和偏移角度、当前道路车道线位置、车道宽度、道路曲率半径;通过捕捉转向灯和危险警报灯信号线上的信号获取转向灯和危险警报灯状态。
8.一种多情景车道偏离预警***,其特征在于:该***包括数据采集单元、数据判断单元和偏离预警单元;
所述数据采集单元,安装于车辆内部,用于实时采集数据,并将采集到的数据传递至数据判断单元;
所述数据判断单元,用于接收采集到的数据,并进行偏离预警判断,将预警指令传递至偏离预警单元;
所述偏离预警单元,用于接收偏离预警指令,提醒驾驶员阻止车辆进一步偏离。
9.根据权利要求8所述的一种多情景车道偏离预警***,其特征在于:
所述数据采集单元包括摄像头、车速传感器、方向盘转角传感器、转向灯和危险警报灯;
通过车速传感器获取当前车速;
通过方向盘转角传感器获取方向盘转向转角;
通过摄像头采集车辆的偏移距离和偏移角度、当前道路车道线位置、车道宽度、道路曲率半径;
通过捕捉转向灯和危险警报灯信号线上的信号获取转向灯和危险警报灯状态。
10.根据权利要求8或9所述的一种多情景车道偏离预警***,其特征在于:
所述数据判断单元包括抑制偏离判断单元、车速判断单元、道路曲率半径判断单元、车道偏离判断单元;
所述抑制偏离判断单元,用于接收数据采集单元传递的数据,判断当前时刻是否满足抑制偏离预警条件,并将判断信号传递到车速判断单元;
所述车速判断单元,用于接收数据采集单元传递的数据,以及抑制偏离判断单元的判断信号,判断车辆是否大于预先设定的车速阈值,并将判断信号传递给车道偏离判断单元和道路曲率半径判断单元;
所述道路曲率半径判断单元,用于接收数据采集单元传递的数据,以及车速判断单元发送的判断信号,判断当前道路为直道或弯道,并将判断信号传递给车道偏离判断单元;
所述车道偏离判断单元,用于接收数据采集单元传递的数据,以及车速判断单元和道路曲率半径判断单元传递的判断信号,判断车辆是否偏离当前车道,并将判断信号传递给偏离预警单元。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201910909593.6A CN110667574B (zh) | 2019-09-25 | 2019-09-25 | 一种多情景车道偏离预警***及方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201910909593.6A CN110667574B (zh) | 2019-09-25 | 2019-09-25 | 一种多情景车道偏离预警***及方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN110667574A true CN110667574A (zh) | 2020-01-10 |
CN110667574B CN110667574B (zh) | 2021-01-05 |
Family
ID=69079214
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201910909593.6A Active CN110667574B (zh) | 2019-09-25 | 2019-09-25 | 一种多情景车道偏离预警***及方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN110667574B (zh) |
Cited By (7)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN112071061A (zh) * | 2020-09-11 | 2020-12-11 | 谢能丹 | 基于云计算和数据分析的车辆服务*** |
CN112622758A (zh) * | 2020-12-03 | 2021-04-09 | 武汉格罗夫氢能汽车有限公司 | 一种氢能汽车车道偏离预警装置 |
CN113436434A (zh) * | 2021-06-25 | 2021-09-24 | 中科路恒工程设计有限公司 | 山区干线公路高危路段预警***及方法 |
CN113682226A (zh) * | 2021-09-16 | 2021-11-23 | 岚图汽车科技有限公司 | 盲区监测和变道提醒方法、装置、设备以及可读存储介质 |
CN113954860A (zh) * | 2020-07-01 | 2022-01-21 | 丰田自动车株式会社 | 显示及声音输出控制*** |
CN114348014A (zh) * | 2022-01-28 | 2022-04-15 | 中国第一汽车股份有限公司 | 车道偏离预警方法、装置、车辆和介质 |
CN116080676A (zh) * | 2023-01-30 | 2023-05-09 | 北京京深深向科技有限公司 | 车道偏离预警方法、装置及电子设备、存储介质 |
Citations (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN104670229A (zh) * | 2013-11-28 | 2015-06-03 | 现代摩比斯株式会社 | 假想车道线生成装置与方法及车道线保持控制*** |
CN107031505A (zh) * | 2015-11-20 | 2017-08-11 | 株式会社万都 | 车道偏离警示装置和方法 |
US20180043870A1 (en) * | 2016-08-15 | 2018-02-15 | Toyota Jidosha Kabushiki Kaisha | Lane departure prevention apparatus |
CN108216024A (zh) * | 2017-12-14 | 2018-06-29 | 浙江鼎奕科技发展有限公司 | 一种车道偏离预警***及其方法 |
CN108583584A (zh) * | 2018-04-12 | 2018-09-28 | 安徽江淮汽车集团股份有限公司 | 一种车道偏离报警方法及*** |
CN109263660A (zh) * | 2018-11-12 | 2019-01-25 | 江铃汽车股份有限公司 | 一种基于360°环视影像***的车道偏移预警控制方法 |
-
2019
- 2019-09-25 CN CN201910909593.6A patent/CN110667574B/zh active Active
Patent Citations (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN104670229A (zh) * | 2013-11-28 | 2015-06-03 | 现代摩比斯株式会社 | 假想车道线生成装置与方法及车道线保持控制*** |
CN107031505A (zh) * | 2015-11-20 | 2017-08-11 | 株式会社万都 | 车道偏离警示装置和方法 |
US20180043870A1 (en) * | 2016-08-15 | 2018-02-15 | Toyota Jidosha Kabushiki Kaisha | Lane departure prevention apparatus |
CN108216024A (zh) * | 2017-12-14 | 2018-06-29 | 浙江鼎奕科技发展有限公司 | 一种车道偏离预警***及其方法 |
CN108583584A (zh) * | 2018-04-12 | 2018-09-28 | 安徽江淮汽车集团股份有限公司 | 一种车道偏离报警方法及*** |
CN109263660A (zh) * | 2018-11-12 | 2019-01-25 | 江铃汽车股份有限公司 | 一种基于360°环视影像***的车道偏移预警控制方法 |
Cited By (12)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN113954860A (zh) * | 2020-07-01 | 2022-01-21 | 丰田自动车株式会社 | 显示及声音输出控制*** |
US11981342B2 (en) | 2020-07-01 | 2024-05-14 | Toyota Jidosha Kabushiki Kaisha | Display and voice output control system of vehicle |
CN112071061A (zh) * | 2020-09-11 | 2020-12-11 | 谢能丹 | 基于云计算和数据分析的车辆服务*** |
CN112071061B (zh) * | 2020-09-11 | 2021-10-15 | 武汉云上融媒科技有限公司 | 基于云计算和数据分析的车辆服务*** |
CN112622758A (zh) * | 2020-12-03 | 2021-04-09 | 武汉格罗夫氢能汽车有限公司 | 一种氢能汽车车道偏离预警装置 |
CN113436434A (zh) * | 2021-06-25 | 2021-09-24 | 中科路恒工程设计有限公司 | 山区干线公路高危路段预警***及方法 |
CN113436434B (zh) * | 2021-06-25 | 2022-05-27 | 中科路恒工程设计有限公司 | 山区干线公路高危路段预警***及方法 |
CN113682226A (zh) * | 2021-09-16 | 2021-11-23 | 岚图汽车科技有限公司 | 盲区监测和变道提醒方法、装置、设备以及可读存储介质 |
CN113682226B (zh) * | 2021-09-16 | 2023-05-26 | 岚图汽车科技有限公司 | 盲区监测和变道提醒方法、装置、设备以及可读存储介质 |
CN114348014A (zh) * | 2022-01-28 | 2022-04-15 | 中国第一汽车股份有限公司 | 车道偏离预警方法、装置、车辆和介质 |
CN116080676A (zh) * | 2023-01-30 | 2023-05-09 | 北京京深深向科技有限公司 | 车道偏离预警方法、装置及电子设备、存储介质 |
CN116080676B (zh) * | 2023-01-30 | 2024-04-26 | 北京京深深向科技有限公司 | 车道偏离预警方法、装置及电子设备、存储介质 |
Also Published As
Publication number | Publication date |
---|---|
CN110667574B (zh) | 2021-01-05 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN110667574B (zh) | 一种多情景车道偏离预警***及方法 | |
US10864911B2 (en) | Automated detection of hazardous drifting vehicles by vehicle sensors | |
US9415776B2 (en) | Enhanced lane departure system | |
KR101996418B1 (ko) | 센서 융합 기반 보행자 탐지 및 보행자 충돌 방지 장치 및 방법 | |
KR101996419B1 (ko) | 센서 융합 기반 보행자 탐지 및 보행자 충돌 방지 장치 및 방법 | |
EP1726513B2 (en) | Driving assistance system for lane keeping support, for lane change assistance, and for driver status monitoring for a vehicle | |
EP2949548B1 (en) | Lane keeping suppressing system and method | |
KR102206689B1 (ko) | 추월지원시스템을 위한 방법 및 장치 | |
CN107264527B (zh) | 智能车防别车的控制方法及装置 | |
CN104276084B (zh) | 车辆驾驶辅助控制装置 | |
JP5163991B2 (ja) | 複雑な交通状況における車両の速度制御方法 | |
US9533685B2 (en) | Method and system for assisting overtaking | |
US20080186154A1 (en) | Method and Device for Driver Support | |
CN109733392B (zh) | 一种避障方法及装置 | |
CN104417561A (zh) | 情境感知威胁响应判定 | |
CN109278754A (zh) | 用于基于环境的驾驶员辅助功能的调整的方法和装置 | |
JP7279053B2 (ja) | 車線を変更するときに、自動車両と、車両の隣の走行車線にある2次物体との間の衝突リスクを検知するためのシステムおよび方法 | |
JP2011248855A (ja) | 車両用衝突警報装置 | |
EP3000104B1 (en) | Collision mitigation systems with adjustable trigger width | |
CN105584413B (zh) | 一种预防车辆碰撞的装置与方法 | |
JP6137979B2 (ja) | 車線逸脱防止支援装置 | |
CN112896157A (zh) | 一种防御性驾驶控制方法、装置、***、车载终端及存储介质 | |
CN105408181A (zh) | 用于运行汽车的驾驶员辅助***的方法和用于汽车的驾驶员辅助*** | |
CN112193246A (zh) | 车辆及用于执行车辆间距离控制的方法 | |
CN107139921A (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 |