CN114299755A - 一种智能网联队列换道方法 - Google Patents
一种智能网联队列换道方法 Download PDFInfo
- Publication number
- CN114299755A CN114299755A CN202111539448.7A CN202111539448A CN114299755A CN 114299755 A CN114299755 A CN 114299755A CN 202111539448 A CN202111539448 A CN 202111539448A CN 114299755 A CN114299755 A CN 114299755A
- Authority
- CN
- China
- Prior art keywords
- vehicle
- queue
- lane
- safety
- clearance
- 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 39
- 230000008859 change Effects 0.000 claims abstract description 88
- 230000001133 acceleration Effects 0.000 claims description 26
- 238000004364 calculation method Methods 0.000 claims description 20
- 238000012502 risk assessment Methods 0.000 claims description 16
- 230000008569 process Effects 0.000 claims description 15
- 238000005516 engineering process Methods 0.000 claims description 8
- 238000004891 communication Methods 0.000 claims description 6
- 238000011156 evaluation Methods 0.000 claims 1
- 230000006855 networking Effects 0.000 description 6
- 238000013461 design Methods 0.000 description 5
- 238000004458 analytical method Methods 0.000 description 3
- 238000010276 construction Methods 0.000 description 3
- 238000010586 diagram Methods 0.000 description 3
- 238000011160 research Methods 0.000 description 3
- 238000012795 verification Methods 0.000 description 2
- 206010039203 Road traffic accident Diseases 0.000 description 1
- 238000011161 development Methods 0.000 description 1
- 230000000694 effects Effects 0.000 description 1
- 238000005265 energy consumption Methods 0.000 description 1
- 238000012986 modification Methods 0.000 description 1
- 230000004048 modification Effects 0.000 description 1
- 230000009467 reduction Effects 0.000 description 1
- 230000000087 stabilizing effect Effects 0.000 description 1
Images
Classifications
-
- Y—GENERAL 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
- Y02—TECHNOLOGIES OR APPLICATIONS FOR MITIGATION OR ADAPTATION AGAINST CLIMATE CHANGE
- Y02T—CLIMATE CHANGE MITIGATION TECHNOLOGIES RELATED TO TRANSPORTATION
- Y02T10/00—Road transport of goods or passengers
- Y02T10/10—Internal combustion engine [ICE] based vehicles
- Y02T10/40—Engine management systems
Landscapes
- Traffic Control Systems (AREA)
- Control Of Driving Devices And Active Controlling Of Vehicle (AREA)
Abstract
本发明公开了一种智能网联队列换道方法,包括:产生队列换道意图;计算目标车道车辆动态间隙;计算队列换道所需间隙;判断目标车道车辆动态间隙是否大于队列换道所需间隙,若大于则选择此间隙作为换道目标间隙;若没有则判断是否属于强制换道,若是则目标车道车辆协助实现队列协同换道;若不是,则等待下一个间隙;队列内车辆逐个开始换道,获得换道车辆与各车辆的实际距离间隙,并计算换道车辆与各车辆的安全间隙,若各实际距离间隙全部满足了计算的安全间隙,则继续进行换道,否则调整换道车辆的运动状态;待所有队列内车辆逐个实现换道,则队列换道完成。本发明可有效实现队列整体换道,为智能网联队列实现安全、稳定地换道提供支撑。
Description
技术领域
本发明涉及一种智能网联队列换道方法,属于智能网联汽车的技术领域。
背景技术
随着运输需求的逐渐增加,汽车保有量和里程数不断攀升,随之而来的是交通事故的频发。然而智能网联技术的发展给交通安全和效率提供了新的机会,网智能网联车队由于其能有效提高驾驶安全性、减少车辆运行阻力、提高交通通信效率,并且可以减少能耗和尾气污染,因此逐渐成为研究热点。
队列换道是队列行驶中不可避免需要解决的问题,队列换道远远复杂于单车换道,因此对换道的流程和安全间隙计算具有较高的要求。目前,高速公路上队列进行换道的相关技术采用了不同的换道流程来实现换道,相似的是需要队列重新编组,队列内通过先超车然后变道的方式,流程复杂并且超车带来的碰撞风险大;同时现有技术中多重于流程的设计,缺少对队列换道安全间隙的深入研究,安全间隙在不同的主体间和不同的运动状态下不是一个定值,因此需要对安全间隙进行分主体和状态进行不同分析。
现有技术中,公开号为CN 111824147A的中国发明专利公开了一种队列换道的方法,该方法包括如下步骤:1)根据车队前进方向,依次对车辆进行编号V1、V2、V3、Vx……Vn,队列行驶车速为v;2)Vx判断与目标车道内后方车辆是否满足安全距离;3)车辆V,变道以后,其余的车辆V1、V2、V3……Vn形成新队列:4)新队列的尾车Vn,与车辆Vx,保持水平距离,避免在目标车道内被超车;5)V1判断与目标车道内前方车辆是否满足安全距离;6)确认目标车道内无其他车辆;7)条件同时满足时,新队列集体换道8)将完成换道的状态进行反馈操作。然而上述方法要求队列集体进行换道,在实际应用过程中要求苛刻,难以实现,通常以逐个换道的方式进行整体队列的换道;另外上述方法要求队列换道需要满足安全距离,然而队列内车辆间的安全距离和队列车辆与外部车辆间的安全距离存在差别,缺少对安全距离进行深入设计。
发明内容
本发明所要解决的技术问题在于克服现有方法在队列换道时无法对安全间隙进行分主体和状态进行不同分析,缺少对队列换道安全间隙的深入研究,而提供一种智能网联队列换道方法,为智能网联队列安全、稳定换道提供技术支持和保障。
本发明具体采用以下技术方案解决上述技术问题:
一种智能网联队列换道方法,包括如下步骤:
S1:队列在行驶过程中,产生队列换道意图;
S2:通过车路协同技术获得目标车道上队列前后范围内存在的车辆数量、车辆位置信息和各车辆的运动状态,计算并跟踪目标车道车辆之间的动态间隙;
S3:根据车路协同技术或者队列内部通信获得队列内车辆数量、车辆位置信息和各车辆的运动状态,计算队列换道所需间隙;
S4:在目标车道上队列前后范围内,判断目标车道车辆之间的动态间隙是否大于队列换道所需间隙,若大于则选择此间隙作为换道目标间隙,转S5;若没有满足此条件的目标车道车辆之间的动态间隙,则判断此时队列换道是否属于强制换道,若是则目标车道车辆协助实现队列协同换道;若不是,则队列等待下一个适合换道的间隙再进行换道,转S2;
S5:队列内车辆逐个开始换道:获得换道车辆与当前车道前方车辆、目标车道前方车辆和目标车道后方车辆之间的实际距离间隙,并计算换道车辆与当前车道前方车辆之间的安全间隙、换道车辆与目标车道前方车辆之间的安全间隙、换道车辆与目标车道后方车辆之间的安全间隙,若获得的各实际距离间隙全部满足了所述计算的三种安全间隙,则继续进行换道,否则调整换道车辆的运动状态以满足各安全间隙要求;
S6:在队列内换道车辆实现在目标车道上水平行驶后,换道车辆调整运动状态,实现小间隙队列跟驰行驶;
S7:待所有队列内车辆逐个实现以上步骤,则队列换道完成。
进一步地,作为本发明的一种优选方案,所述步骤S3计算队列换道所需间隙,具体为:
S3-1:计算跟驰时队列内车辆i与其前方车辆之间的动态间隙:
式中,Di为队列内第i辆车在跟驰过程中与前方车辆所需保持的安全间隙,n为队列内车辆的数量,IPF表示队列车辆关系下的安全距离评估,Ev为队列关系下距离风险评估的阈值;表示车辆i行驶方向前方的安全距离下界,表示车辆i的队列前方车辆i-1在行驶方向后方的安全距离下界,ai和ai-1分别表示车辆i和队列前方车辆i-1的行驶加速度,vi和vi-1分别表示车辆i和队列前方车辆i-1的行驶速度;α和τ是与速度和车道宽度相关的常数,λ和β分别是与虚拟质量和顺时针夹角相关的常数,γ表示队列车辆关系下车辆整体性相关的常数;Mi和Mi-1分别表示车辆i和队列前方车辆i-1的虚拟质量,其具体公式如下:
Mi=mi(1.566×10-14vi 6.687+0.3345)
式中,mi是车辆i的实际质量,vi是车辆i当前的行驶速度;
S3-2:计算跟驰时队列头车与目标车道前方车辆之间为行驶安全所需保持的安全间隙,若无前方车辆则所需间隙为0m;
式中,D1表示队列头车与目标车道前方车辆之间为行驶安全所需保持的安全间隙,RPF表示非队列车辆关系下的安全距离评估,Er为非队列关系下距离风险评估的阈值;表示队列头车行驶方向前方的安全距离,表示队列头车的目标车道前方车辆在行驶方向后方的安全距离,a1和af分别表示队列头车和目标车道前方车辆的行驶加速度,v1和vf分别表示队列头车和目标车道前方车辆的行驶速度,M1和Mf分别表示队列头车和目标车道前方车辆的虚拟质量;
S3-3:计算跟驰时队列尾车与目标车道后方车辆之间为行驶安全所需保持的安全间隙,若无后方车辆则所需间隙为0m;
式中,Dr表示队列尾车与目标车道后方车辆之间为行驶安全所需保持的安全间隙,表示队列目标车道后方车辆行驶方向前方的安全距离,表示队列尾车行驶方向后方的安全距离,ar和an分别表示目标车道后方车辆与队列尾车的行驶加速度,vr和vn分别表示目标车道后方车辆与队列尾车的行驶速度,Mr和Mn分别表示目标车道后方车辆与队列尾车的虚拟质量;
S3-4:计算队列换道所需间隙:
式中,Dlane为队列换道所需的安全间隙,D1表示队列头车与目标车道前方车辆之间所需保持的安全间隙,Di表示队列内车辆i与前方车辆之间所需保持的安全间隙,Dr表示队列尾车与目标车道后方车辆之间所需保持的安全间隙。
进一步地,作为本发明的一种优选方案,所述步骤S4中判断目标车道车辆动态间隙是否大于队列换道所需间隙,包括:若存在一个满足此条件的目标车道车辆动态间隙,则选择此间隙作为换道目标间隙,转S5;若存在多个满足此条件的目标车道车辆动态间隙,则选择纵向距离最近的间隙作为换道目标间隙,转S5。
进一步地,作为本发明的一种优选方案,所述步骤S5中计算换道车辆与目标车道前方车辆之间的安全间隙,包括:判断目标车道前方车辆是否为换道车辆所在队列内部车辆,并分别计算当目标车道前方车辆为非队列内部车辆或队列内部车辆时的安全间隙。
进一步地,作为本发明的一种优选方案,所述步骤S5中计算换道车辆的各安全间隙,具体为:
S5-1:计算换道时队列中第i辆车与当前车道前方车辆之间所需保持的安全间隙1;
式中,表示队列中第i辆车与当前车道前方车辆之间所需保持的安全间隙1,RPF表示非队列车辆关系下的安全距离评估,Er为非队列关系下距离风险评估的阈值;表示车辆i行驶方向前方的安全距离,表示车辆i的前方车辆在行驶方向后方的安全距离,θi表示车辆i在换道过程中的转向角,Li和Lf分别表示车辆i和前方车辆的车长,ai和af分别表示车辆i和前方车辆的行驶加速度,vi和vf分别表示车辆i和前方车辆的行驶速度,Mi和Mf分别表示车辆i和前方车辆的虚拟质量;α和τ是与速度和车道宽度相关的常数;λ和β分别是与虚拟质量和顺时针夹角相关的常数;
S5-2:计算换道时队列中第i辆车与目标车道前方车辆之间所需保持的安全间隙;
S5-2.1:当目标车道前方车辆为非队列车辆时,计算队列中第i辆车与当前车道前方车辆的安全间隙2:
式中,表示队列中第i辆车与作为非队列车辆的目标车道前方车辆之间所需保持的安全间隙2,表示车辆i行驶方向前方的安全距离,表示车辆i的目标车道前方车辆行驶方向后方的安全距离,θi表示车辆i在换道过程中的转向角,Li和Lf分别表示车辆i和目标车道前方车辆的车长,ai和af分别表示车辆i和目标车道前方车辆的行驶加速度,vi和vf分别表示车辆i和目标车道前方车辆的行驶速度,Mi和Mf分别表示车辆i和目标车道前方车辆的虚拟质量;
式中,表示队列中第i辆车与当前车道前方车辆之间的安全间隙3的安全下界,IPF表示队列车辆关系下的安全距离评估,Ev为队列关系下距离风险评估的阈值;表示车辆i行驶方向前方的安全距离下界,θi表示车辆i在换道过程中的转向角,表示车辆i的队列前方车辆i-1在行驶方向后方的安全距离下界,Li和Li-1分别表示车辆i和队列前方车辆i-1的车长,ai和ai-1分别表示车辆i和队列前方车辆i-1的行驶加速度,vi和vi-1分别表示车辆i和队列前方车辆i-1的行驶速度,Mi和Mi-1分别表示车辆i和队列前方车辆i-1的虚拟质量;
S5-3:计算换道时队列中第i辆车与目标车道后方车辆之间所需保持的安全间隙4:
式中,表示队列中第i辆车与目标车道后方车辆之间所需保持的安全间隙4,Di+1表示队列内各车辆i+1与前方同队列车辆i之间的动态安全间隙,RPF表示非队列车辆关系下的安全距离评估,Er为非队列关系下距离风险评估的阈值;表示车辆i的后方车辆在行驶方向前方的安全距离,表示车辆i行驶方向后方的安全距离,n为队列内车辆的数量,θi表示车辆i在换道过程中的转向角,Li和Lr分别表示车辆i和目标车道后方车辆的车长,ai和ar分别表示车辆i和目标车道后方车辆的行驶加速度,vi和vr分别表示车辆i和目标车道后方车辆的行驶速度,Ni和Nr分别表示车辆i和目标车道后方车辆的虚拟质量。
本发明采用上述技术方案,能产生如下技术效果:
本发明的方法,结合车路协同下队列自动驾驶的现实情况,在队列产生换道意图后,首先筛选目标车道是否存在的间隙,其次设计了队列和非队列车辆在跟驰下不同的安全间隙计算方式,得出队列整体换道所需的安全间隙供目标车道可行间隙的选择;在队列内车辆逐个换道过程中,对单个换道辆车与当前车道前方车辆、目标车道前方车辆和目标车道后方车辆之间的间隙进行分析得出不同车辆关系下的安全间隙计算方式,为车辆在换道时的间隙控制提供安全阈值;安全间隙满足后进行队列车辆逐个换道,计算换道场景下队列关系和非队列关系车辆间的安全间隙,在换道过程中以0.1s为步长间隙安全校验,并进行适当的运动状态调整,驶入目标车道后调整运动状态到小间隙跟驰;最终实现队列换道完成。
与现有技术相比,本发明的方法,设计了队列内车辆逐个换道实现队列整体换道的换道流程;并将队列车辆之间的安全间隙与非队列车辆之间的安全间隙进行了区分,同时在跟驰场景和换道场景下分别进行了分析,提供相应的安全间隙计算方式为队列车辆轨迹规划提供安全校验标准,为智能网联队列实现安全、稳定地换道提供支撑。同时,本发明方法计算流程清晰、计算简单,在保证换道安全性的前提下拥有较快的计算速度。
附图说明
图1为本发明实施例的方法流程图。
图2为本发明实施例中高速公路上某路段上队列换道意图生成的场景图。
图3本发明实施例中队列可换道场景图。
图4本发明实施例中队列在不同运动状态-换道安全间隙曲线图。
图5本发明实施例中队列内头车换道场景图。
图6本发明实施例中队列内中间车辆换道场景图。
具体实施方式
下面结合具体实施例,进一步阐明本发明,应理解这些实施例仅用于说明本发明而不用于限制本发明的范围,在阅读了本发明之后,本领域技术人员对本发明的各种等价形式的修改均落于本申请所附权利要求所限定的范围。
如图1所示,本发明涉及一种智能网联队列换道方法,主要包括如下步骤:
S1:队列在行驶过程中,由于追求更高的安全性或行驶速度,产生队列换道意图。
S2:通过车路协同技术获得目标车道上队列前后范围内存在的车辆数量、车辆位置信息和各车辆的运动状态,计算并跟踪目标车道各个车辆之间的动态间隙;其中,各车辆的运动状态包括车辆的速度、加速度信息。
S3:根据车路协同技术或者队列内部通信获得队列内车辆数量、车辆位置信息和各车辆的运动状态,其中各车辆的运动状态包括速度、加速度信息,计算队列换道所需间隙,具体如下:
S3-1:计算跟驰时队列内车辆i与其前方车辆之间的动态间隙:
式中,Di为队列内第i辆车在跟驰过程中与前方车辆所需保持的安全间隙,n为队列内车辆的数量,IPF表示队列车辆关系下的安全距离评估,Ev为队列关系下距离风险评估的阈值;表示车辆i行驶方向前方的安全距离下界,表示车辆i的队列前方车辆i-1在行驶方向后方的安全距离下界,ai和ai-1分别表示车辆i和队列前方车辆i-1的行驶加速度,vi和vi-1分别表示车辆i和队列前方车辆i-1的行驶速度;Mi和Mi-1分别表示车辆i和队列前方车辆i-1的虚拟质量,其具体公式如下:
Mi=mi(1.566×10-14vi 6.687+0.3345)
式中,mi是车辆i的实际质量,vi是车辆i当前的行驶速度。
另外,a和τ是与速度和车道宽度相关的常数,这里α取值0.074,τ取值2.699,λ和β分别是与虚拟质量和顺时针夹角相关的常数,这里λ取值0.061,β取值0.233,γ表示队列车辆关系下车辆整体性相关的常数,这里γ取值0.000401853。
S3-2:计算跟驰时队列头车与目标车道前方车辆之间为行驶安全所需保持的安全间隙,若无前方车辆则所需间隙为0m;
式中,D1表示队列头车与目标车道前方车辆之间为行驶安全所需保持的安全间隙,RPF表示非队列车辆关系下的安全距离评估,Er为非队列关系下距离风险评估的阈值;表示队列头车行驶方向前方的安全距离,表示队列头车的目标车道前方车辆Front Vehicle在行驶方向后方的安全距离,a1和af分别表示队列头车和目标车道前方车辆的行驶加速度,v1和vf分别表示队列头车和目标车道前方车辆的行驶速度,M1和Mf分别表示队列头车和目标车道前方车辆的虚拟质量;
S3-3:计算跟驰时队列尾车与目标车道后方车辆之间为行驶安全所需保持的安全间隙,若无后方车辆则所需间隙为0m;
式中,Dr表示队列尾车与目标车道后方车辆之间为行驶安全所需保持的安全间隙,表示队列目标车道后方车辆Rear Vehicle行驶方向前方的安全距离,表示队列尾车行驶方向后方的安全距离,ar和an分别表示目标车道后方车辆与队列尾车的行驶加速度,vr和vn分别表示目标车道后方车辆与队列尾车的行驶速度,Mr和Mn分别表示目标车道后方车辆与队列尾车的虚拟质量;
S3-4:计算队列换道所需间隙:
式中,Dlane为队列换道所需的安全间隙,D1表示队列头车与目标车道前方车辆之间所需保持的安全间隙,Di表示队列内车辆i与前方车辆之间所需保持的安全间隙,Dr表示队列尾车与目标车道后方车辆之间所需保持的安全间隙。
S4:在目标车道上队列前后范围内,判断目标车道车辆之间的动态间隙是否大于队列换道所需间隙,若大于则选择此间隙作为换道目标间隙,转S5;若没有满足此条件的目标车道车辆之间的动态间隙,则判断此时队列换道是否属于强制换道,所述强制换道包括前方事故、前方障碍物、前方进出匝道等场景下队列必须进行换道等,若是则目标车道车辆协助实现队列协同换道,即目标车道后方车辆进行减速,增加间隙致队列换道需求间隙的大小;若不是,则队列等待下一个适合换道的间隙再进行换道,转S2;
其中,所述步骤S4中判断目标车道车辆动态间隙是否大于队列换道所需间隙,包括:若存在一个满足此条件的目标车道车辆动态间隙,则选择此间隙作为换道目标间隙,转S5;若存在多个满足此条件的目标车道车辆动态间隙,则选择纵向距离最近的间隙作为换道目标间隙,转S5。
S5:队列内车辆逐个开始换道:队列中第i辆车t时刻换道,获得换道车辆i与当前车道前方车辆、目标车道前方车辆和目标车道后方车辆之间的实际距离间隙,并计算换道车辆i与当前车道前方车辆之间的安全间隙1、换道车辆与目标车道前方车辆之间的安全间隙2或安全间隙3、换道车辆与目标车道后方车辆之间的安全间隙4,若获得的各实际距离间隙全部满足了所述计算的三种安全间隙,则继续进行换道,否则调整换道车辆i的运动状态以满足各安全间隙要求;所述换道时安全间隙计算方式如下:
S5-1:计算换道时队列中第i辆车与当前车道前方车辆之间所需保持的安全间隙1;
式中,表示队列中第i辆车与当前车道前方车辆之间所需保持的安全间隙1,RPF表示非队列车辆关系下的安全距离评估,Er为非队列关系下距离风险评估的阈值,这里取值2;表示车辆i行驶方向前方的安全距离,表示车辆i的前方车辆FrontVehicle在行驶方向后方的安全距离,θi表示车辆i在换道过程中的转向角,Li和Lf分别表示车辆i和前方车辆的车长,ai和af分别表示车辆i和前方车辆的行驶加速度,vi和vf分别表示车辆i和前方车辆的行驶速度,Mi和Mf分别表示车辆i和前方车辆的虚拟质量。
另外,α和τ是与速度和车道宽度相关的常数,这里α取值0.074,τ取值2.699,λ和β分别是与虚拟质量和顺时针夹角相关的常数,这里λ取值0.061,β取值0.233。
S5-2:计算换道时队列中第i辆车与目标车道前方车辆之间所需保持的安全间隙;
S5-2.1:目标车道前方车辆为非队列车辆时,计算队列中第i辆车与当前车道前方车辆的安全间隙2。
式中,表示队列中第i辆车与作为非队列车辆的目标车道前方车辆之间所需保持的安全间隙2,表示车辆i行驶方向前方的安全距离,表示车辆i的目标车道前方车辆行驶方向后方的安全距离,θi表示车辆i在换道过程中的转向角,Li和Lf分别表示车辆i和目标车道前方车辆的车长,ai和af分别表示车辆i和目标车道前方车辆的行驶加速度,vi和vf分别表示车辆i和目标车道前方车辆的行驶速度,Mi和Mf分别表示车辆i和目标车道前方车辆的虚拟质量。
式中,表示队列中第i辆车与当前车道前方车辆之间的安全间隙3的安全下界,IPF表示队列车辆关系下的安全距离评估,Ev为队列关系下距离风险评估的阈值,这里取值2;表示车辆i行驶方向前方的安全距离下界,θi表示车辆i在换道过程中的转向角,表示车辆i的队列前方车辆i-1在行驶方向后方的安全距离下界,Li和Li-1分别表示车辆i和队列前方车辆i-1的车长,ai和ai-1分别表示车辆i和队列前方车辆i-1的行驶加速度,vi和vi-1分别表示车辆i和队列前方车辆i-1的行驶速度,Mi和Mi-1分别表示车辆i和队列前方车辆i-1的虚拟质量。
另外,a和τ是与速度和车道宽度相关的常数,这里α取值0.074,τ取值2.699,λ和β分别是与虚拟质量和顺时针夹角相关的常数,这里λ取值0.061,β取值0.233;γ表示队列车辆关系下车辆整体性相关的常数,这里γ取值0.000401853。
S5-3:计算换道时队列中第i辆车与目标车道后方车辆间须保持的安全间隙4;
式中,表示队列中第i辆车与目标车道后方车辆之间所需保持的安全间隙4,Di+1表示队列内各车辆i+1与前方同队列车辆i之间的动态安全间隙,RPF表示非队列车辆关系下的安全距离评估,Er为非队列关系下距离风险评估的阈值;表示车辆i的后方车辆在行驶方向前方的安全距离,表示车辆i行驶方向后方的安全距离,n为队列内车辆的数量,θi表示车辆i在换道过程中的转向角,Li和Lr分别表示车辆i和目标车道后方车辆的车长,ai和ar分别表示车辆i和目标车道后方车辆的行驶加速度,vi和vr分别表示车辆i和目标车道后方车辆的行驶速度,Mi和Mr分别表示车辆i和目标车道后方车辆的虚拟质量。
S6:判断车辆i是否已实现在目标车道上水平行驶,未完成则t=t+0.1s,转S5-1,完成,则车辆i稳定运动状态,进行小间隙队列跟驰行驶,由此在队列内换道车辆实现在目标车道上水平行驶后,换道车辆调整运动状态,实现小间隙队列跟驰行驶。
S7:判断是否队列内所有车辆完成了换道,未完成则i=i+1,转S5,均完成则队列换道结束,即待所有队列内车辆逐个实现以上步骤,则队列换道完成。
因此,本发明方法将队列车辆之间的安全间隙与非队列车辆之间的安全间隙进行了区分,设计了队列内车辆逐个换道的流程,可有效准确的实现队列的整体换道。
为了验证本发明方法可有效的实现队列的整体换道,下面用结合一个验证例进行说明本发明。
如图2所示,本验证例中高速公路上某路段有一队列和各社会车辆在行驶,白色车辆为队列车辆,灰色车辆为非队列车辆,队列正以20m/s的速度进行匀速行驶,在当前车道行驶前方存在施工路段,非队列车辆①、⑥、⑦、⑧均已20m/s的速度进行匀速行驶,队列进行换道的具体流程如下:
S1:为了避让前方施工区域,队列产生向左侧车道进行换道的意图。
S2:通过队列外部通信得到目标车道车辆数为3,皆以20m/s的速度匀速行驶,目标车道上的车辆①和车辆⑦两车之间间隙为61.36m,车辆⑦和车辆⑧两车之间间隙为25.97m。
S3:通过队列内部通信得到本队列由四辆车②、③、④、⑤组成,队列内车辆均以20m/s的速度进行匀速行驶,取距离风险评估阈值为2,根据公式得到队列内车辆间距为16.04m,队列头车与其目标车道前方车辆之间为行驶安全所需保持的间隙为40.0m,队列尾车与其目标车道后方车辆之间为行驶安全所需保持的间隙为39.85m,由此得到队列换道所需间隙为127.98m。
S4:判断跟踪的目标车道车辆动态间隙均小于队列换道所需间隙,两个间隙61.36m和25.97m均小于127.98m,说明没有可行间隙供以换道,但是此时队列换道是为了避让前方施工区域,属于强制换道,所以车辆⑦辅助队列协同换道,车辆⑦和后续车辆⑧进行减速,如图3所示,使得车辆①与车辆⑦之间的距离达到127.98m。
同时,给出了该队列与其目标车道前后非队列车辆即车辆①和⑦在不同速度和加速度下的队列换道安全间隙计算结果,如图4所示,随着车辆①和⑦与队列速度差的增加,即车辆①和⑦运动速度越比队列行驶速度快,则队列换道需要的换道间隙越大;车辆①和⑦运动速度越比队列行驶速度慢,则队列换道需要的换道间隙越小;并且在队列选用不同加速时,不论队列与周围车辆速度差为多少,在相同的速度差情况下,随着换道的加速度减小,换道所需要维持的间隙更小,该具体数值可为智能网联队列车辆的速度决策提供参考依据。
S5:队列头车进行换道,如图5所示,根据公式计算得到队列头车需要与当前车道前方车辆之间的安全间隙为40.0m,与目标车道前方车辆之间的安全间隙为40.0m,与目标车道后方车辆之间的安全间隙为87.98m,如果获取的队列头车的三个实际距离间隙均满足计算出的三个安全间隙,则继续进行换道,否则调整车辆的运动状态以致满足各安全间隙要求。
判断每0.1s判断车辆是不是完成了换道,即车辆已在目标车道上无转向角地行驶,未完成则继续步骤S5,完成了则车辆稳定运动状态,进行小间隙队列跟驰行驶,开始队列内下一个车辆进行换道,如图6场景,根据公式计算得到队列车辆需要与当前车道前方车辆保持的安全间隙为40.0m,与目标车道前方车辆安全间隙的区间为[16.044115,44.881565]m,与目标车道后方车辆的安全间隙为71.94m,如果实际间隙均满足相应的安全间隙,则继续进行换道,否则调整车辆的运动状态以致满足各安全间隙要求。
S6:在队列内换道车辆实现在目标车道上水平行驶后,换道车辆调整运动状态,实现小间隙队列跟驰行驶。
S7:判断是否队列内所有车辆完成了换道,若未完成则继续步骤S5,若队列内所有车辆均完成换道则队列换道结束。
综上,本发明方法设计了队列内车辆逐个换道实现队列整体换道的换道流程,并将队列车辆之间的安全间隙与非队列车辆之间的安全间隙进行了区分,同时在跟驰场景和换道场景下分别进行了分析,提供相应的安全间隙计算方式为队列车辆轨迹规划提供安全校验标准,为智能网联队列实现安全、稳定地换道提供支撑。同时,本发明方法计算流程清晰、计算简单,在保证换道安全性的前提下拥有较快的计算速度。
上面结合附图对本发明的实施方式作了详细说明,但是本发明并不限于上述实施方式,在本领域普通技术人员所具备的知识范围内,还可以在不脱离本发明宗旨的前提下做出各种变化。
Claims (5)
1.一种智能网联队列换道方法,其特征在于,包括如下步骤:
S1:队列在行驶过程中,产生队列换道意图;
S2:通过车路协同技术获得目标车道上队列前后范围内存在的车辆数量、车辆位置信息和各车辆的运动状态,计算并跟踪目标车道车辆之间的动态间隙;
S3:根据车路协同技术或者队列内部通信获得队列内车辆数量、车辆位置信息和各车辆的运动状态,计算队列换道所需间隙;
S4:在目标车道上队列前后范围内,判断目标车道车辆之间的动态间隙是否大于队列换道所需间隙,若大于则选择此间隙作为换道目标间隙,转S5;若没有满足此条件的目标车道车辆之间的动态间隙,则判断此时队列换道是否属于强制换道,若是则目标车道车辆协助实现队列协同换道;若不是,则队列等待下一个适合换道的间隙再进行换道,转S2;
S5:队列内车辆逐个开始换道:获得换道车辆与当前车道前方车辆、目标车道前方车辆和目标车道后方车辆之间的实际距离间隙,并计算换道车辆与当前车道前方车辆之间的安全间隙、换道车辆与目标车道前方车辆之间的安全间隙、换道车辆与目标车道后方车辆之间的安全间隙,若获得的各实际距离间隙全部满足了所述计算的三种安全间隙,则继续进行换道,否则调整换道车辆的运动状态以满足各安全间隙要求;
S6:在队列内换道车辆实现在目标车道上水平行驶后,换道车辆调整运动状态,实现小间隙队列跟驰行驶;
S7:待所有队列内车辆逐个实现以上步骤,则队列换道完成。
2.根据权利要求1所述的智能网联队列换道方法,其特征在于,所述步骤S3计算队列换道所需间隙,具体为:
S3-1:计算跟驰时队列内车辆i与其前方车辆之间的动态间隙:
式中,Di为队列内第i辆车在跟驰过程中与前方车辆所需保持的安全间隙,n为队列内车辆的数量;IPF表示队列车辆关系下的安全距离评估,Ev为队列关系下距离风险评估的阈值;表示车辆i行驶方向前方的安全距离下界,表示车辆i的队列前方车辆i-1在行驶方向后方的安全距离下界,ai和ai-1分别表示车辆i和队列前方车辆i-1的行驶加速度,vi和vi-1分别表示车辆i和队列前方车辆i-1的行驶速度;α和τ是与速度和车道宽度相关的常数,λ和β分别是与虚拟质量和顺时针夹角相关的常数,γ表示队列车辆关系下车辆整体性相关的常数;Mi和Mi-1分别表示车辆i和队列前方车辆i-1的虚拟质量,其具体公式如下:
Mi=mi(1.566×10-14vi 6.687+0.3345)
式中,mi是车辆i的实际质量,vi是车辆i当前的行驶速度;
S3-2:计算跟驰时队列头车与目标车道前方车辆之间为行驶安全所需保持的安全间隙,若无前方车辆则所需间隙为0m;
式中,D1表示队列头车与目标车道前方车辆之间为行驶安全所需保持的安全间隙,RPF表示非队列车辆关系下的安全距离评估,Er为非队列关系下距离风险评估的阈值;表示队列头车行驶方向前方的安全距离,表示队列头车的目标车道前方车辆在行驶方向后方的安全距离,a1和af分别表示队列头车和目标车道前方车辆的行驶加速度,v1和vf分别表示队列头车和目标车道前方车辆的行驶速度,M1和Mf分别表示队列头车和目标车道前方车辆的虚拟质量;
S3-3:计算跟驰时队列尾车与目标车道后方车辆之间为行驶安全所需保持的安全间隙,若无后方车辆则所需间隙为0m;
式中,Dr表示队列尾车与目标车道后方车辆之间为行驶安全所需保持的安全间隙,表示目标车道后方车辆行驶方向前方的安全距离,表示队列尾车行驶方向后方的安全距离,ar和an分别表示目标车道后方车辆与队列尾车的行驶加速度,vr和vn分别表示目标车道后方车辆与队列尾车的行驶速度,Mr和Mn分别表示目标车道后方车辆与队列尾车的虚拟质量;
S3-4:计算队列换道所需间隙:
式中,Dlane为队列换道所需的安全间隙,D1表示队列头车与目标车道前方车辆之间所需保持的安全间隙,Di表示队列内车辆i与前方车辆之间所需保持的安全间隙,Dr表示队列尾车与目标车道后方车辆之间所需保持的安全间隙。
3.根据权利要求1所述的智能网联队列换道方法,其特征在于,所述步骤S4中判断目标车道车辆动态间隙是否大于队列换道所需间隙,包括:若存在一个满足此条件的目标车道车辆动态间隙,则选择此间隙作为换道目标间隙,转S5;若存在多个满足此条件的目标车道车辆动态间隙,则选择纵向距离最近的间隙作为换道目标间隙,转S5。
4.根据权利要求1所述的智能网联队列换道方法,其特征在于,所述步骤S5中计算换道车辆与目标车道前方车辆之间的安全间隙,包括:判断目标车道前方车辆是否为换道车辆所在队列内部车辆,并分别计算当目标车道前方车辆为非队列内部车辆或队列内部车辆时的安全间隙。
5.根据权利要求1或4所述的智能网联队列换道方法,其特征在于,所述步骤S5中计算换道车辆的各安全间隙,具体为:
S5-1:计算换道时队列中第i辆车与当前车道前方车辆之间所需保持的安全间隙1;
式中,表示队列中第i辆车与当前车道前方车辆之间所需保持的安全间隙1,RPF表示非队列车辆关系下的安全距离评估,Er为非队列关系下距离风险评估的阈值;表示车辆i行驶方向前方的安全距离,表示车辆i的前方车辆在行驶方向后方的安全距离,θi表示车辆i在换道过程中的转向角,Li和Lf分别表示车辆i和前方车辆的车长,ai和af分别表示车辆i和前方车辆的行驶加速度,vi和vf分别表示车辆i和前方车辆的行驶速度,Mi和Mf分别表示车辆i和前方车辆的虚拟质量;α和τ是与速度和车道宽度相关的常数;λ和β分别是与虚拟质量和顺时针夹角相关的常数;
S5-2:计算换道时队列中第i辆车与目标车道前方车辆之间所需保持的安全间隙;
S5-2.1:当目标车道前方车辆为非队列车辆时,计算队列中第i辆车与当前车道前方车辆的安全间隙2:
式中,表示队列中第i辆车与作为非队列车辆的目标车道前方车辆之间所需保持的安全间隙2,表示车辆i行驶方向前方的安全距离,表示车辆i的目标车道前方车辆行驶方向后方的安全距离,θi表示车辆i在换道过程中的转向角,Li和Lf分别表示车辆i和目标车道前方车辆的车长,ai和af分别表示车辆i和目标车道前方车辆的行驶加速度,vi和vf分别表示车辆i和目标车道前方车辆的行驶速度,Mi和Mf分别表示车辆i和目标车道前方车辆的虚拟质量;
式中,表示队列中第i辆车与当前车道前方车辆之间的安全间隙3的安全下界,IPF表示队列车辆关系下的安全距离评估,Ev为队列关系下距离风险评估的阈值;表示车辆i行驶方向前方的安全距离下界,θi表示车辆i在换道过程中的转向角,表示车辆i的队列前方车辆i-1在行驶方向后方的安全距离下界,Li和Li-1分别表示车辆i和队列前方车辆i-1的车长,ai和ai-1分别表示车辆i和队列前方车辆i-1的行驶加速度,vi和vi-1分别表示车辆i和队列前方车辆i-1的行驶速度,Mi和Mi-1分别表示车辆i和队列前方车辆i-1的虚拟质量;
S5-3:计算换道时队列中第i辆车与目标车道后方车辆之间所需保持的安全间隙4:
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202111539448.7A CN114299755B (zh) | 2021-12-14 | 2021-12-14 | 一种智能网联队列换道方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202111539448.7A CN114299755B (zh) | 2021-12-14 | 2021-12-14 | 一种智能网联队列换道方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN114299755A true CN114299755A (zh) | 2022-04-08 |
CN114299755B CN114299755B (zh) | 2023-08-29 |
Family
ID=80966754
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN202111539448.7A Active CN114299755B (zh) | 2021-12-14 | 2021-12-14 | 一种智能网联队列换道方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN114299755B (zh) |
Cited By (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN115662188A (zh) * | 2022-10-25 | 2023-01-31 | 吉林大学 | 一种队列行驶车辆的避障*** |
CN116311867A (zh) * | 2023-01-18 | 2023-06-23 | 东南大学 | 一种基于智能网联车队列控制的多车协同换道方法 |
CN117681878A (zh) * | 2024-02-04 | 2024-03-12 | 西南交通大学 | 一种编队感知的智能网联汽车协同变道方法 |
Citations (10)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN106997690A (zh) * | 2017-05-15 | 2017-08-01 | 东南大学 | 一种车联网环境下高速公路车辆非强制换道控制方法 |
CN108765982A (zh) * | 2018-05-04 | 2018-11-06 | 东南大学 | 车路协同环境下信号控制交叉口车速引导***及引导方法 |
CN109410561A (zh) * | 2018-10-24 | 2019-03-01 | 清华大学 | 一种高速路车辆匀异质编队行驶控制方法 |
US20190147745A1 (en) * | 2017-11-13 | 2019-05-16 | Hyundai Motor Company | Apparatus and method for controlling platooning of vehicles |
CN110884493A (zh) * | 2019-11-21 | 2020-03-17 | 东风商用车有限公司 | 一种高速场景队列换道的行为决策方法及其*** |
CN111445697A (zh) * | 2020-03-22 | 2020-07-24 | 华南理工大学 | 一种智能网联条件下的高速公路协同车辆换道控制方法 |
CN111824147A (zh) * | 2020-06-19 | 2020-10-27 | 东风商用车有限公司 | 一种队列换道的方法 |
CN112242071A (zh) * | 2020-10-16 | 2021-01-19 | 山东摩西网络科技有限公司 | 基于动态编组重构的道路自动驾驶车辆协同避障方法 |
CN112530201A (zh) * | 2020-11-17 | 2021-03-19 | 东南大学 | 一种智能车交叉口右转换道间隙选择方法及装置 |
WO2021233005A1 (zh) * | 2020-05-21 | 2021-11-25 | 东南大学 | 一种智能车辆编队变道性能测评方法 |
-
2021
- 2021-12-14 CN CN202111539448.7A patent/CN114299755B/zh active Active
Patent Citations (10)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN106997690A (zh) * | 2017-05-15 | 2017-08-01 | 东南大学 | 一种车联网环境下高速公路车辆非强制换道控制方法 |
US20190147745A1 (en) * | 2017-11-13 | 2019-05-16 | Hyundai Motor Company | Apparatus and method for controlling platooning of vehicles |
CN108765982A (zh) * | 2018-05-04 | 2018-11-06 | 东南大学 | 车路协同环境下信号控制交叉口车速引导***及引导方法 |
CN109410561A (zh) * | 2018-10-24 | 2019-03-01 | 清华大学 | 一种高速路车辆匀异质编队行驶控制方法 |
CN110884493A (zh) * | 2019-11-21 | 2020-03-17 | 东风商用车有限公司 | 一种高速场景队列换道的行为决策方法及其*** |
CN111445697A (zh) * | 2020-03-22 | 2020-07-24 | 华南理工大学 | 一种智能网联条件下的高速公路协同车辆换道控制方法 |
WO2021233005A1 (zh) * | 2020-05-21 | 2021-11-25 | 东南大学 | 一种智能车辆编队变道性能测评方法 |
CN111824147A (zh) * | 2020-06-19 | 2020-10-27 | 东风商用车有限公司 | 一种队列换道的方法 |
CN112242071A (zh) * | 2020-10-16 | 2021-01-19 | 山东摩西网络科技有限公司 | 基于动态编组重构的道路自动驾驶车辆协同避障方法 |
CN112530201A (zh) * | 2020-11-17 | 2021-03-19 | 东南大学 | 一种智能车交叉口右转换道间隙选择方法及装置 |
Non-Patent Citations (1)
Title |
---|
张荣辉;游峰;初鑫男;郭烈;何兆成;王荣本;: "车-车协同下无人驾驶车辆的换道汇入控制方法", 中国公路学报, no. 04 * |
Cited By (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN115662188A (zh) * | 2022-10-25 | 2023-01-31 | 吉林大学 | 一种队列行驶车辆的避障*** |
CN115662188B (zh) * | 2022-10-25 | 2024-04-19 | 吉林大学 | 一种队列行驶车辆的避障*** |
CN116311867A (zh) * | 2023-01-18 | 2023-06-23 | 东南大学 | 一种基于智能网联车队列控制的多车协同换道方法 |
CN116311867B (zh) * | 2023-01-18 | 2024-03-19 | 东南大学 | 一种基于智能网联车队列控制的多车协同换道方法 |
CN117681878A (zh) * | 2024-02-04 | 2024-03-12 | 西南交通大学 | 一种编队感知的智能网联汽车协同变道方法 |
CN117681878B (zh) * | 2024-02-04 | 2024-04-16 | 西南交通大学 | 一种编队感知的智能网联汽车协同变道方法 |
Also Published As
Publication number | Publication date |
---|---|
CN114299755B (zh) | 2023-08-29 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN114299755B (zh) | 一种智能网联队列换道方法 | |
CN109035862B (zh) | 一种基于车车通信的多车协同换道控制方法 | |
CN109410561B (zh) | 一种高速路车辆匀异质编队行驶控制方法 | |
CN109501799B (zh) | 一种车联网条件下的动态路径规划方法 | |
CN108447266B (zh) | 一种智能网联汽车协同换道入队控制方法 | |
CN112258875B (zh) | 基于车路协同与自动驾驶的交叉口智能管控方法 | |
CN108986488B (zh) | 一种车车通信环境下匝道汇入协同轨迹确定方法及设备 | |
CN107016858B (zh) | 一种交叉口多流向候驶区和错位式停车线的预信号控制方法 | |
CN113313949B (zh) | 一种高速公路出口匝道客货车协同控制方法、装置和设备 | |
CN113327441B (zh) | 基于高速公路合流区的网联自动车辆速度控制及轨迹优化方法 | |
CN111325975B (zh) | 一种智能网联车辆在汇入口区域的集中优化协调方法 | |
CN106781435A (zh) | 一种基于无线通信的非信控交叉路口车辆编队通行方法 | |
CN111081069B (zh) | 一种高速公路瓶颈区域的车辆轨迹控制方法 | |
CN113920762A (zh) | 一种基于智能网联环境下应急车辆优先通行的控制方法 | |
CN114842644A (zh) | 一种混合交通流交织区通行能力计算方法 | |
CN115273450B (zh) | 一种网联自动驾驶环境下车辆进入编队的换道方法 | |
CN111710191A (zh) | 一种面向城市快速路的匝道合流控制方法及*** | |
CN1719354A (zh) | 车辆跟驰运动的加速度控制方法 | |
CN112216148A (zh) | 一种车路协同下双车道车辆换道指引方法 | |
CN113823076B (zh) | 一种基于联网车辆协调控制的即停即走路段缓堵方法 | |
CN117315955A (zh) | 一种基于深度强化学习的智能网联车辆入匝道协同控制方法 | |
CN116129627A (zh) | 一种智能网联车队下匝道前的协同换道策略 | |
CN112711796A (zh) | 一种引入虚拟车道的城市快速路车辆换道仿真实验方法 | |
CN109131349B (zh) | 一种用于抑制道路交通幽灵堵塞的方法 | |
CN116363905B (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 |