CN114684147A - 一种邻车道目标切入本车道的概率计算方法 - Google Patents

一种邻车道目标切入本车道的概率计算方法 Download PDF

Info

Publication number
CN114684147A
CN114684147A CN202210304820.4A CN202210304820A CN114684147A CN 114684147 A CN114684147 A CN 114684147A CN 202210304820 A CN202210304820 A CN 202210304820A CN 114684147 A CN114684147 A CN 114684147A
Authority
CN
China
Prior art keywords
lane
vehicle
target
target vehicle
probability
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
Application number
CN202210304820.4A
Other languages
English (en)
Other versions
CN114684147B (zh
Inventor
汪哲文
邱利宏
徐榕
王晟
Current Assignee (The listed assignees may be inaccurate. Google has not performed a legal analysis and makes no representation or warranty as to the accuracy of the list.)
Chongqing Changan Automobile Co Ltd
Original Assignee
Chongqing Changan Automobile Co Ltd
Priority date (The priority date 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 date listed.)
Filing date
Publication date
Application filed by Chongqing Changan Automobile Co Ltd filed Critical Chongqing Changan Automobile Co Ltd
Priority to CN202210304820.4A priority Critical patent/CN114684147B/zh
Publication of CN114684147A publication Critical patent/CN114684147A/zh
Application granted granted Critical
Publication of CN114684147B publication Critical patent/CN114684147B/zh
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Images

Classifications

    • BPERFORMING OPERATIONS; TRANSPORTING
    • B60VEHICLES IN GENERAL
    • B60WCONJOINT 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/00Estimation 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
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B60VEHICLES IN GENERAL
    • B60WCONJOINT 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/00Estimation 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/10Estimation 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
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B60VEHICLES IN GENERAL
    • B60WCONJOINT 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
    • B60W2552/00Input parameters relating to infrastructure
    • B60W2552/30Road curve radius
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B60VEHICLES IN GENERAL
    • B60WCONJOINT 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
    • B60W2554/00Input parameters relating to objects
    • B60W2554/40Dynamic objects, e.g. animals, windblown objects
    • B60W2554/404Characteristics
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B60VEHICLES IN GENERAL
    • B60WCONJOINT 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
    • B60W2554/00Input parameters relating to objects
    • B60W2554/80Spatial relation or speed relative to objects
    • B60W2554/802Longitudinal distance
    • YGENERAL TAGGING OF NEW TECHNOLOGICAL DEVELOPMENTS; GENERAL TAGGING OF CROSS-SECTIONAL TECHNOLOGIES SPANNING OVER SEVERAL SECTIONS OF THE IPC; TECHNICAL SUBJECTS COVERED BY FORMER USPC CROSS-REFERENCE ART COLLECTIONS [XRACs] AND DIGESTS
    • Y02TECHNOLOGIES OR APPLICATIONS FOR MITIGATION OR ADAPTATION AGAINST CLIMATE CHANGE
    • Y02TCLIMATE CHANGE MITIGATION TECHNOLOGIES RELATED TO TRANSPORTATION
    • Y02T10/00Road transport of goods or passengers
    • Y02T10/10Internal combustion engine [ICE] based vehicles
    • Y02T10/40Engine management systems

Landscapes

  • Engineering & Computer Science (AREA)
  • Physics & Mathematics (AREA)
  • Automation & Control Theory (AREA)
  • Mathematical Physics (AREA)
  • Transportation (AREA)
  • Mechanical Engineering (AREA)
  • Traffic Control Systems (AREA)

Abstract

本发明涉及一种邻车道目标切入本车道的概率计算方法,步骤包括:计算邻车道的目标车辆与本车所在车道中心的横向距离;采用卡尔曼滤波的方式得到目标车辆相对于本车所在车道中心的横向速度;预测指定时间后目标车辆将要到达的横向位置;设置目标车辆切入本车所在车道的概率对应的横向位置区间;根据道路曲率、目标车辆的纵向位置、目标车辆类型对横向位置区间进行补偿;最后计算求得目标车辆切入本车所在车道的概率。本发明能够减少自车在车道内摆动对切入概率计算带来的影响,减少了传感器噪声对速度的影响,能够做到对切入行为的提前判断和响应,更为有效地量化了目标切入行为,能够避免制动过猛,提高制动的舒适性。

Description

一种邻车道目标切入本车道的概率计算方法
技术领域
本发明属于自动驾驶技术领域,具体涉及一种邻车道目标切入本车道的概率计算方法。
背景技术
自适应巡航系统(ACC)是根据驾驶员设置的跟车车距以及前方道路车辆情况来自动调整本车车速,从而得到稳定的跟车距离,实现舒适的跟车。目前现有的技术中,对于本车道内的前车控制方法较成熟,但是对于邻车道内的车辆切入行为判断较差,导致误识别为切入时会造成误刹车,严重影响了舒适度体验,而漏识别切入行为或识别太晚时,可能会导致严重的交通事故,因此准确判断邻车道内车辆的切入行为,对于提高自动驾驶功能的舒适性及安全性有非常重要的帮助。
当前自动驾驶系统对邻车道车辆切入行为判断效果主要受到以下条件的约束:
1)传感器对于目标车的横向速度判断不准,尤其是当自车在本车道内摆动,或者前方道路为弯道时,测量的横向速度与实际情况相差较大,可信度不高;
2)道路特征及目标类型对目标的切入行为判断影响较大,无法用单一方法去检查切入行为;
3)对于切入行为如果只用0或1来描述,则影响控制体验的连续性,造成制动过猛,控制效果不舒适,需要找到用概率来替代0或1来描述切入行为的方法。
发明内容
针对现有技术的上述不足,本发明要解决的技术问题是提供一种邻车道目标切入本车道的概率计算方法,避免因对邻车道内车辆的切入行为判断不够精准甚至出现失误而导致交通事故的问题。
为解决上述技术问题,本发明采用如下技术方案:
一种邻车道目标切入本车道的概率计算方法,具体包括以下步骤:
S1:计算邻车道的目标车辆与本车所在车道中心的横向距离;
S2:根据所述步骤S1中的横向距离,采用卡尔曼滤波的方式得到所述目标车辆相对于本车所在车道中心的横向速度;
S3:根据所述步骤S1中的横向距离和所述步骤S2中的横向速度来预测指定时间后所述目标车辆将要到达的横向位置;
S4:设置所述目标车辆切入本车所在车道的概率对应的横向位置区间;
S5:根据道路曲率、所述目标车辆的纵向距离、所述目标车辆类型对所述步骤S4中的横向位置区间进行补偿;
S6:根据所述步骤S3中的横向位置和修正补偿后的横向位置区间来计算求得所述目标车辆切入本车所在车道的概率。
进一步完善上述技术方案,所述步骤S1中计算邻车道的目标车辆与本车所在车道中心的横向距离包括:
求出所述目标车辆四个边界点到本车所在车道中心的距离,在四个边界点到本车所在车道中心的距离中求出最远距离Dmax和最近距离Dmin;
所述步骤S1中的横向距离
Figure BDA0003561428390000021
进一步地,所述步骤S3中的指定时间为T,所述步骤S2中横向速度为V,
那么所述步骤S3中的横向位置D’=D+V×T;
其中,指定时间T由传感器及执行器的延迟决定。
进一步地,所述步骤S4中,所述横向位置区间的两端为最远门槛和最近门槛,如果所述步骤S3中的横向位置超过所述最远门槛,那么所述目标车辆切入本车所在车道的概率为1;如果所述步骤S3中横向位置小于最近门槛,那么所述目标车辆切入本车所在车道的概率为0。
进一步地,根据所述目标车辆的纵向距离、道路曲率以及目标车辆类型对所述最远门槛和最近门槛进行修正补偿。
相比现有技术,本发明具有如下有益效果:
本发明的一种邻车道目标切入本车道的概率计算方法,将自车坐标系下的目标车辆的横向位置转化为目标车辆相对于自车所在车道中心的横向位置,能够减少自车在车道内摆动对切入概率计算带来的影响。利用卡尔曼滤波器计算目标车辆的横向速度,减少了传感器噪声对速度的影响。采用预测时间后的目标横向位置,能够做到对切入行为的提前判断和响应。采用切入概率的方式来描述切入行为,更为有效地量化了目标切入行为,能够避免制动过猛,提高制动的舒适性。
附图说明
图1为实施例的一种邻车道目标切入本车道的概率计算方法的场景示意图;
图2为实施例中目标车辆的纵向距离所对应门槛的示意图;
图3为实施例中道路曲率的对应门槛的示意图;
图4为实施例的一种邻车道目标切入本车道的概率与目标车辆与本车所在车道中心的横向距离的关系示意图;
图5为本发明实车测试邻车道目标切入本车道的概率与横向距离的对应图一;
图6为本发明实车测试邻车道目标切入本车道的概率与横向距离的对应图二。
具体实施方式
下面结合附图对本发明的具体实施方式作进一步的详细说明。
请参见图1-图6,具体实施例的一种邻车道目标切入本车道的概率计算方法,具体包括以下步骤:
S1:计算邻车道的目标车辆与本车所在车道中心的横向距离;
S2:根据所述步骤S1中的横向距离,采用卡尔曼滤波的方式得到所述目标车辆相对于本车所在车道中心的横向速度;
S3:根据所述步骤S1中的横向距离和所述步骤S2中的横向速度来预测指定时间后所述目标车辆将要到达的横向位置;
S4:设置所述目标车辆切入本车所在车道的概率对应的横向位置区间;
S5:根据道路曲率、所述目标车辆的纵向距离、所述目标车辆类型对所述步骤S4中的横向位置区间进行补偿;
S6:根据所述步骤S3中的横向位置和修正补偿后的横向位置区间来计算求得所述目标车辆切入本车所在车道的概率。
实施例的一种邻车道目标切入本车道的概率计算方法,将自车坐标系下的目标车辆的横向位置转化为目标车辆相对于自车所在车道中心的横向位置,能够减少自车在车道内摆动对切入概率计算带来的影响。利用卡尔曼滤波器计算目标车辆的横向速度,减少了传感器噪声对速度的影响。采用预测时间后的目标横向位置,能够做到对切入行为的提前判断和响应。采用切入概率的方式来描述切入行为,更为有效地量化了目标切入行为,能够避免制动过猛,提高制动的舒适性。
请继续参见图1-图6,其中,所述步骤S1中计算邻车道的目标车辆与本车所在车道中心的横向距离包括:
求出所述目标车辆四个边界点到本车所在车道中心的距离,在四个边界点到本车所在车道中心的距离中求出最远距离Dmax和最近距离Dmin;
所述步骤S1中的横向距离
Figure BDA0003561428390000031
实施时,请参见图1,目标车辆的四个边界点分别为A、B、C、D,通过下式可以计算得出最远距离Dmax和最近距离Dmin:
Figure BDA0003561428390000041
Figure BDA0003561428390000042
Figure BDA0003561428390000043
Figure BDA0003561428390000044
Figure BDA0003561428390000045
Figure BDA0003561428390000046
Figure BDA0003561428390000047
Figure BDA0003561428390000048
那么图1所示情况下的最远距离Dmax和最近距离Dmin应按照下式进行计算:
Figure BDA0003561428390000049
Figure BDA00035614283900000410
其中,X:自车到目标车辆的X坐标;Y:自车到目标车辆的Y坐标;XA:A点的X坐标;YA:A点的Y坐标;XB:B点的X坐标;YB:B点的Y坐标;XC:C点的X坐标;YC:C点的Y坐标;XD:D点的X坐标;YD:D点的Y坐标;L:目标车辆长;W:目标车辆宽;θ1:目标车辆倾角;Y0:自车所在车道中线横向位置;θ2:自车所在车道中线倾角;C0:自车所在车道中线曲率;C1:自车所在车道中线曲率变化率。这些坐标的来源可以是前视摄像头的感知结果,也可以是自车运动系数拟合的结果,或者是高精地图数据,均属于现有技术,故不对坐标获取方式多加赘述。
实施时,根据计算出的横向距离D,采用卡尔曼滤波的方式得到目标车辆相对于自车所在车道中心的横向速度:
预测过程:
xk=Fk×xk-1+Bk×uk
Figure BDA0003561428390000051
测量过程:
Figure BDA0003561428390000052
x′k=xk+K′×(zk-Hk×xk)
P′k=Pk-K′×Hk×Pk
其中,xk为目标车辆相对于自车车道中心横向位置D及横向速度V组成的二维数组;Fk:预测矩阵;Bk:控制矩阵;uk:控制向量;Pk:协方差矩阵;Qk:协方差噪声;Hk:传感器数据维度;Rk:传感器噪声;zk:传感器数据;K′:卡尔曼增益;
由此,可得出比较稳定的目标车辆相对于本车所在车道中心的横向速度。
其中,所述步骤S3中的指定时间为T,所述步骤S2中横向速度为V,
那么所述步骤S3中的横向位置D’=D+V×T;
其中,指定时间T由传感器及执行器的延迟决定。
其中,所述步骤S4中,所述横向位置区间的两端为最远门槛和最近门槛,如果所述步骤S3中的横向位置超过所述最远门槛,那么所述目标车辆切入本车所在车道的概率为1;如果所述步骤S3中横向位置小于最近门槛,那么所述目标车辆切入本车所在车道的概率为0;且如果横向位置的值处于最远门槛与最近门槛之间,从最远门槛到最近门槛,所述目标车辆切入本车所在车道的概率呈从大到小的线性变化。
其中,请参见图2和图3,根据所述目标车辆的纵向距离、道路曲率以及目标车辆类型对所述最远门槛和最近门槛进行修正补偿。
实施时,所述目标车辆的纵向距离以及道路曲率均为传感器测量得到,修正补偿的实施方式可以是根据纵向距离、道路曲率以及目标车辆类型等查表得到对应的补偿系数,其中纵向距离越远补偿系数越小,所有补偿系数的范围为0到1;图2中,横坐标为横向位置的值,纵坐标为所述纵向距离;图3中,横坐标为横向位置的值,纵坐标为所述道路曲率。
这样,优化切入概率在不同场景下的适用性。
实施时,如图4所示,根据所述步骤S3中的横向距离和修正补偿后的横向位置区间来计算求得所述目标车辆切入本车所在车道的概率P。
P=(W-Wmin)/(Wmax-Wmin)×P0×P1×P2
其中,W:目标车辆相对于自车车道中心横向位置(即所述步骤S3中的横向距离D’);Wmin:最近门槛;Wmax:最远门槛;P0:纵向距离补偿系数;P1:曲率补偿系数;P2:类型补偿系数。
从图5和图6可以看出,图5的横向距离(纵坐标)越小时,图6中所对应的切入概率(纵坐标)越大,应用本发明在实车测试过程中,对目标车辆切入本车道的概率有一个较好的计算结果,且对目标车辆的行为有准确的预测,大大提高了自动驾驶功能对切入工况的反应能力,舒适度得到提升。
最后说明的是,以上实施例仅用以说明本发明的技术方案而非限制,尽管参照较佳实施例对本发明进行了详细说明,本领域的普通技术人员应当理解,可以对本发明的技术方案进行修改或者等同替换,而不脱离本发明技术方案的宗旨和范围,其均应涵盖在本发明的权利要求范围当中。

Claims (5)

1.一种邻车道目标切入本车道的概率计算方法,其特征在于:具体包括以下步骤:
S1:计算邻车道的目标车辆与本车所在车道中心的横向距离;
S2:根据所述步骤S1中的横向距离,采用卡尔曼滤波的方式得到所述目标车辆相对于本车所在车道中心的横向速度;
S3:根据所述步骤S1中的横向距离和所述步骤S2中的横向速度来预测指定时间后所述目标车辆将要到达的横向位置;
S4:设置所述目标车辆切入本车所在车道的概率对应的横向位置区间;
S5:根据道路曲率、所述目标车辆的纵向距离、所述目标车辆类型对所述步骤S4中的横向位置区间进行补偿;
S6:根据所述步骤S3中的横向位置和修正补偿后的横向位置区间来计算求得所述目标车辆切入本车所在车道的概率。
2.根据权利要求1所述一种邻车道目标切入本车道的概率计算方法,其特征在于:所述步骤S1中计算邻车道的目标车辆与本车所在车道中心的横向距离包括:
求出所述目标车辆四个边界点到本车所在车道中心的距离,在四个边界点到本车所在车道中心的距离中求出最远距离Dmax和最近距离Dmin;
所述步骤S1中的横向距离
Figure FDA0003561428380000011
3.根据权利要求1所述一种邻车道目标切入本车道的概率计算方法,其特征在于:所述步骤S3中的指定时间为T,所述步骤S2中横向速度为V,
那么所述步骤S3中的横向位置D’=D+V×T;
其中,指定时间T由传感器及执行器的延迟决定。
4.根据权利要求1所述一种邻车道目标切入本车道的概率计算方法,其特征在于:所述步骤S4中,所述横向位置区间的两端为最远门槛和最近门槛,如果所述步骤S3中的横向位置超过所述最远门槛,那么所述目标车辆切入本车所在车道的概率为1;如果所述步骤S3中横向位置小于最近门槛,那么所述目标车辆切入本车所在车道的概率为0。
5.根据权利要求4所述一种邻车道目标切入本车道的概率计算方法,其特征在于:根据所述目标车辆的纵向距离、道路曲率以及目标车辆类型对所述最远门槛和最近门槛进行修正补偿。
CN202210304820.4A 2022-03-23 2022-03-23 一种邻车道目标切入本车道的概率计算方法 Active CN114684147B (zh)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN202210304820.4A CN114684147B (zh) 2022-03-23 2022-03-23 一种邻车道目标切入本车道的概率计算方法

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN202210304820.4A CN114684147B (zh) 2022-03-23 2022-03-23 一种邻车道目标切入本车道的概率计算方法

Publications (2)

Publication Number Publication Date
CN114684147A true CN114684147A (zh) 2022-07-01
CN114684147B CN114684147B (zh) 2024-06-25

Family

ID=82139203

Family Applications (1)

Application Number Title Priority Date Filing Date
CN202210304820.4A Active CN114684147B (zh) 2022-03-23 2022-03-23 一种邻车道目标切入本车道的概率计算方法

Country Status (1)

Country Link
CN (1) CN114684147B (zh)

Citations (5)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN101089917A (zh) * 2007-06-01 2007-12-19 清华大学 一种目标车换道工况下的快速识别方法
JP2009241870A (ja) * 2008-03-31 2009-10-22 Honda Motor Co Ltd 車両走行支援装置、車両、車両走行支援プログラム
US20180009438A1 (en) * 2015-01-21 2018-01-11 Denso Corporation Vehicle cruise control device and cruise control method
CN108202745A (zh) * 2016-12-19 2018-06-26 乐视汽车(北京)有限公司 预测障碍物车辆状态的方法及系统
CN111409639A (zh) * 2020-04-07 2020-07-14 北京理工大学 一种主车网联巡航控制方法及系统

Patent Citations (5)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN101089917A (zh) * 2007-06-01 2007-12-19 清华大学 一种目标车换道工况下的快速识别方法
JP2009241870A (ja) * 2008-03-31 2009-10-22 Honda Motor Co Ltd 車両走行支援装置、車両、車両走行支援プログラム
US20180009438A1 (en) * 2015-01-21 2018-01-11 Denso Corporation Vehicle cruise control device and cruise control method
CN108202745A (zh) * 2016-12-19 2018-06-26 乐视汽车(北京)有限公司 预测障碍物车辆状态的方法及系统
CN111409639A (zh) * 2020-04-07 2020-07-14 北京理工大学 一种主车网联巡航控制方法及系统

Also Published As

Publication number Publication date
CN114684147B (zh) 2024-06-25

Similar Documents

Publication Publication Date Title
US5986601A (en) Object detecting system for vehicle
JP4544987B2 (ja) 衝突予測方法及び衝突予測装置
JP2900737B2 (ja) 車間距離検出装置
US9507016B2 (en) Preceding vehicle selection apparatus
EP3859280A1 (en) Traffic lane line fitting method and system
US7103478B2 (en) Vehicular control object determination system
CN110320518B (zh) 一种车载bsd毫米波雷达安装位置自动标定方法
CN109655798B (zh) 一种车载雷达自适应调整方法及装置
US20130158830A1 (en) Leading Vehicle Detecting Apparatus And Inter-Vehicular Control Apparatus Using Leading Vehicle Detecting Apparatus
US20120065876A1 (en) Vehicular information processing device
CN109188382B (zh) 一种基于毫米波雷达的目标识别方法
US8102421B2 (en) Image processing device for vehicle, image processing method of detecting three-dimensional object, and image processing program
US11767055B2 (en) Lane separation line detection correcting device, lane separation line detection correcting method, and automatic driving system
US11753032B2 (en) Vehicle travel control device
US20060089802A1 (en) Vehicular control object determination system
CN114684147B (zh) 一种邻车道目标切入本车道的概率计算方法
US7966129B2 (en) Vehicular control object determination system
US20200062252A1 (en) Method and apparatus for diagonal lane detection
US20200369296A1 (en) Autonomous driving apparatus and method
CN116080646A (zh) 一种自适应巡航的目标车辆切出检测方法及系统
JP2006258545A (ja) 先行車認識装置
CN111231954B (zh) 自动驾驶的控制方法
CN115402349A (zh) 一种结合天气状态的高速辅助驾驶控制方法及系统
CN114740448A (zh) 用于车载雷达的目标状态估计方法、装置及存储介质
EP4201769A1 (en) Vehicle control device, vehicle control method, and non-transitory storage medium

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