CN115830908A - Cooperative lane change method and system for unmanned vehicle platoon in mixed traffic flow - Google Patents
Cooperative lane change method and system for unmanned vehicle platoon in mixed traffic flow Download PDFInfo
- Publication number
- CN115830908A CN115830908A CN202211478251.1A CN202211478251A CN115830908A CN 115830908 A CN115830908 A CN 115830908A CN 202211478251 A CN202211478251 A CN 202211478251A CN 115830908 A CN115830908 A CN 115830908A
- Authority
- CN
- China
- Prior art keywords
- vehicle
- unmanned vehicle
- unmanned
- lane
- gap
- 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
- 230000008859 change Effects 0.000 title claims abstract description 77
- 238000000034 method Methods 0.000 title claims abstract description 48
- 238000005096 rolling process Methods 0.000 claims description 23
- 230000001133 acceleration Effects 0.000 claims description 13
- 238000004891 communication Methods 0.000 claims description 8
- 238000005457 optimization Methods 0.000 claims description 7
- 230000009133 cooperative interaction Effects 0.000 claims description 5
- 230000003993 interaction Effects 0.000 claims description 4
- 238000012545 processing Methods 0.000 claims description 4
- 238000012508 change request Methods 0.000 claims 1
- 230000008569 process Effects 0.000 abstract description 8
- 230000010391 action planning Effects 0.000 abstract description 2
- 238000010586 diagram Methods 0.000 description 5
- 230000006870 function Effects 0.000 description 5
- 230000006872 improvement Effects 0.000 description 3
- 230000009286 beneficial effect Effects 0.000 description 2
- 238000005516 engineering process Methods 0.000 description 2
- 238000012986 modification Methods 0.000 description 2
- 230000004048 modification Effects 0.000 description 2
- 230000035484 reaction time Effects 0.000 description 2
- 238000012360 testing method Methods 0.000 description 2
- 230000009471 action Effects 0.000 description 1
- 238000004364 calculation method Methods 0.000 description 1
- 230000000694 effects Effects 0.000 description 1
- 238000005265 energy consumption Methods 0.000 description 1
- 238000011160 research Methods 0.000 description 1
- 238000004088 simulation Methods 0.000 description 1
- 238000011144 upstream manufacturing Methods 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
- Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)
- Traffic Control Systems (AREA)
Abstract
Description
技术领域technical field
本发明属于道路交通控制领域,具体涉及一种无人驾驶车辆队列在混合交通流中协同变道方法及系统。The invention belongs to the field of road traffic control, and in particular relates to a method and system for cooperatively changing lanes of an unmanned vehicle queue in a mixed traffic flow.
背景技术Background technique
无人驾驶技术的进步有益于提高整个交通系统的效率的安全性。借助于车辆通信的能力,无人驾驶汽车被期望能够以车队的形式行驶,因为车队可以缩短车辆之间的间隙、提高交通能力。而且队列可以降低汽车的空气阻力,降低能耗。但由于技术的限制和相应政策法规的缺失,在未来很长一段时间内,无人驾驶车都将与有人车混合行驶。因为有人车的驾驶行为具有不确定性,因此无人驾驶车辆在混合流中的变道变得很困难。而且无人驾驶车辆为了保证在于有人驾驶车交互过程中的安全性,在换道时往往采用较为保守的动作。已有的研究多针对纯无人驾驶车辆的环境,不考虑附近有人驾驶车对无人驾驶车辆换道的影响,在实际应用中,这些方法则难以施行。还有些研究针对的是单车问题,这类的方法应用在车队变道时,效率比较低,难以保证车队换道的成功率。因此,无人驾驶车辆队列在混合流中的换道问题尚缺少有效的解决方法。Advances in driverless technology are beneficial to improve the efficiency and safety of the entire transportation system. With the ability of vehicles to communicate, driverless cars are expected to be able to travel in convoys, which can reduce gaps between vehicles and increase traffic capacity. And the queue can reduce the air resistance of the car and reduce energy consumption. However, due to technical limitations and the lack of corresponding policies and regulations, unmanned vehicles will be mixed with manned vehicles for a long time to come. Because of the uncertain driving behavior of manned vehicles, it becomes difficult for unmanned vehicles to change lanes in mixed traffic. Moreover, in order to ensure the safety of driverless vehicles during the interaction process, unmanned vehicles often adopt more conservative actions when changing lanes. Most of the existing research focuses on the environment of pure unmanned vehicles, without considering the influence of nearby manned vehicles on the lane change of unmanned vehicles. In practical applications, these methods are difficult to implement. There are also some studies that focus on the single-vehicle problem. This type of method is relatively inefficient when the team changes lanes, and it is difficult to guarantee the success rate of the team's lane change. Therefore, there is still a lack of effective solutions to the lane-changing problem of unmanned vehicle platoons in mixed flows.
发明内容Contents of the invention
本发明的目的在于提供一种无人驾驶车辆队列在混合交通流中协同变道方法及系统,以克服现有方法针对无人驾驶车辆换道成功率以及换道过程中效率低的问题。The purpose of the present invention is to provide a method and system for cooperatively changing lanes of unmanned vehicle platoons in mixed traffic flow, so as to overcome the problems of the success rate of unmanned vehicle lane changing and the low efficiency in the lane changing process of existing methods.
一种无人驾驶车辆队列在混合交通流中协同变道方法,包括以下步骤:A method for cooperatively changing lanes in a mixed traffic flow in a platoon of unmanned vehicles, comprising the following steps:
S1,获取无人驾驶车辆队列协同交互半径内的所有车辆信息,根据无人驾驶车辆队列以及获取的所有车辆信息建立无人驾驶车辆混合流换道模型;S1. Obtain all vehicle information within the cooperative interaction radius of the unmanned vehicle platoon, and establish a mixed traffic lane change model for unmanned vehicles based on the unmanned vehicle platoon and all the vehicle information obtained;
S2,根据建立的无人驾驶车辆混合流换道模型,确定无人驾驶车辆所在车道的纵向范围内的目标车道上的最大间隙,将该最大间隙作为首次换道的目标间隙;根据无人驾驶车辆的位置确定在目标间隙的纵向范围内的无人驾驶车辆,确认该无人驾驶车辆为首次换道无人驾驶车辆,当目标间隙满足首次换道无人驾驶车辆安全驶入条件时,首次换道无人驾驶车辆换道驶入该目标间隙;S2, according to the established unmanned vehicle mixed flow lane change model, determine the maximum gap on the target lane within the longitudinal range of the lane where the unmanned vehicle is located, and use the maximum gap as the target gap for the first lane change; according to the unmanned vehicle The position of the vehicle is determined as the unmanned vehicle within the longitudinal range of the target gap, and it is confirmed that the unmanned vehicle is the unmanned vehicle for the first lane change. When the target gap meets the safe entry conditions for the first lane change unmanned vehicle, Changing lanes The driverless vehicle changes lanes and enters the target gap;
S3,基于滚动优化的思想构建无人驾驶车辆纵向轨迹规划模型,无人驾驶车辆首次换道后,获取一个滚动时域内目前无人驾驶车辆队列中所有车辆的轨迹,基于无人驾驶车辆纵向轨迹规划模型,确定剩余无人驾驶车辆的目标间隙,依次将剩余无人驾驶车辆进行换道驶入目标间隙。S3. Construct the longitudinal trajectory planning model of unmanned vehicles based on the idea of rolling optimization. After the unmanned vehicle changes lanes for the first time, obtain the trajectories of all vehicles in the current unmanned vehicle queue in a rolling time domain, based on the longitudinal trajectory of unmanned vehicles The planning model determines the target gap of the remaining unmanned vehicles, and sequentially changes lanes of the remaining unmanned vehicles to enter the target gap.
优选的,采用路侧单元与车辆通信单元之间的交互,获取在无人驾驶车辆队列的通信半径范围内所有车辆的信息。Preferably, the interaction between the roadside unit and the vehicle communication unit is used to obtain the information of all vehicles within the communication radius of the unmanned vehicle platoon.
优选的,获取无人驾驶车辆与目标间隙前车的实时距离,如果无人驾驶车辆与目标间隙前车在当前时刻的距离大于等于无人驾驶车辆与目标间隙前车在当前时刻的最小换道安全间距,且无人驾驶车辆在当前换入目标间隙后目标间隙后车的反应加速度大于等于目标间隙后车的最大减速度,则满足无人驾驶车辆换到要求。Preferably, the real-time distance between the unmanned vehicle and the vehicle in front of the target gap is obtained, if the distance between the unmanned vehicle and the vehicle in front of the target gap at the current moment is greater than or equal to the minimum lane change between the unmanned vehicle and the vehicle in front of the target gap at the current moment The safe distance, and the reaction acceleration of the vehicle behind the target gap after the unmanned vehicle is currently switched into the target gap is greater than or equal to the maximum deceleration of the vehicle behind the target gap, then the unmanned vehicle’s switching requirements are met.
优选的,当无人驾驶车辆首次换道后,进入目标车辆队列,当首次换道的无人驾驶车辆为单车时,则调整单车与其前车之间的间隙,使该间隙满足剩余无人驾驶车辆安全驶入的目标间隙,将剩余无人驾驶车辆中的一辆无人驾驶车辆进行换道驶入该目标间隙。Preferably, after the unmanned vehicle changes lanes for the first time, it enters the target vehicle queue. When the unmanned vehicle that changes lanes for the first time is a single vehicle, the gap between the single vehicle and the vehicle in front is adjusted so that the gap meets the requirements of the remaining unmanned vehicles. The target gap that the vehicle safely enters, and one of the remaining unmanned vehicles is changed lanes and driven into the target gap.
优选的,当首次换道的无人驾驶车辆为多辆无人驾驶车辆组成的车队时,则调整无人驾驶车辆组成的车队中两辆无人驾驶车辆之间的间隙,使该间隙满足剩余无人驾驶车辆安全驶入的目标间隙,将剩余无人驾驶车辆中的一辆无人驾驶车辆进行换道驶入该目标间隙。Preferably, when the unmanned vehicle that changes lanes for the first time is a fleet of multiple unmanned vehicles, then adjust the gap between the two unmanned vehicles in the fleet of unmanned vehicles so that the gap meets the remaining The target gap that the unmanned vehicle safely enters, and one of the remaining unmanned vehicles changes lanes and drives into the target gap.
优选的,当首次换道的无人驾驶车辆为多辆无人驾驶车辆组成的车队时,扩大首次换道的多辆无人驾驶车辆组成的车队中相邻两辆无人驾驶车辆之间的间隙,使得剩余无人驾驶车辆能够安全换入该间隙。Preferably, when the unmanned vehicle that changes lanes for the first time is a fleet composed of multiple unmanned vehicles, expand the distance between two adjacent unmanned vehicles in the fleet composed of multiple unmanned vehicles that change lanes for the first time. gaps so that the remaining unmanned vehicles can safely swap into the gaps.
优选的,剩余无人驾驶车辆选择离它们最近的间隙作为目标间隙。Preferably, the remaining unmanned vehicles select the gap closest to them as the target gap.
优选的,依据当前时刻无人驾驶车辆混合流换道模型中各车辆的位置继续规划未来一个滚动时域内的轨迹,直至目标间隙拉大到了目标间隙长度。Preferably, according to the position of each vehicle in the unmanned vehicle mixed flow lane change model at the current moment, continue to plan the trajectory in a rolling time domain in the future until the target gap is enlarged to the target gap length.
一种无人驾驶车辆队列在混合交通流中协同变道系统,包括信息采集模块和处理模块;An unmanned vehicle platoon cooperatively changing lanes in a mixed traffic flow, including an information collection module and a processing module;
信息采集模块,获取无人驾驶车辆队列协同交互半径内的所有车辆信息,根据无人驾驶车辆队列以及获取的所有车辆信息建立无人驾驶车辆混合流换道模型;The information collection module acquires all vehicle information within the cooperative interaction radius of the unmanned vehicle platoon, and establishes a mixed traffic lane change model for unmanned vehicles based on the unmanned vehicle platoon and all the vehicle information obtained;
处理模块,根据建立的无人驾驶车辆混合流换道模型,确定无人驾驶车辆所在车道的纵向范围内的目标车道上的最大间隙,将该最大间隙作为首次换道的目标间隙;根据无人驾驶车辆的位置确定在目标间隙的纵向范围内的无人驾驶车辆,确认该无人驾驶车辆为首次换道无人驾驶车辆,当目标间隙满足首次换道无人驾驶车辆安全驶入条件时,首次换道无人驾驶车辆换道驶入该目标间隙;基于滚动优化的思想构建无人驾驶车辆纵向轨迹规划模型,无人驾驶车辆首次换道后,获取一个滚动时域内目前无人驾驶车辆队列中所有车辆的轨迹,基于无人驾驶车辆纵向轨迹规划模型,确定剩余无人驾驶车辆的目标间隙,依次将剩余无人驾驶车辆进行换道驶入目标间隙。The processing module determines the maximum gap on the target lane within the longitudinal range of the lane where the unmanned vehicle is located according to the established unmanned vehicle mixed flow lane change model, and takes the maximum gap as the target gap for the first lane change; The position of the driving vehicle determines the unmanned vehicle within the longitudinal range of the target gap, and confirms that the unmanned vehicle is the unmanned vehicle for the first lane change. When the target gap meets the safe entry conditions for the first lane change unmanned vehicle, The unmanned vehicle changes lanes for the first time and enters the target gap; the longitudinal trajectory planning model of unmanned vehicles is constructed based on the idea of rolling optimization. After the unmanned vehicles change lanes for the first time, the current unmanned vehicle queue in the rolling time domain Based on the trajectory planning model of the longitudinal trajectory of unmanned vehicles, determine the target gaps of the remaining unmanned vehicles, and then change lanes and drive the remaining unmanned vehicles into the target gaps.
优选的,获取无人驾驶车辆与目标间隙前车的实时距离,如果无人驾驶车辆与目标间隙前车在当前时刻的距离大于等于无人驾驶车辆与目标间隙前车在当前时刻的最小换道安全间距,且无人驾驶车辆在当前换入目标间隙后目标间隙后车的反应加速度大于等于目标间隙后车的最大减速度,则满足无人驾驶车辆换到要求。Preferably, the real-time distance between the unmanned vehicle and the vehicle in front of the target gap is obtained, if the distance between the unmanned vehicle and the vehicle in front of the target gap at the current moment is greater than or equal to the minimum lane change between the unmanned vehicle and the vehicle in front of the target gap at the current moment The safe distance, and the reaction acceleration of the vehicle behind the target gap after the unmanned vehicle is currently switched into the target gap is greater than or equal to the maximum deceleration of the vehicle behind the target gap, then the unmanned vehicle’s switching requirements are met.
与现有技术相比,本发明具有以下有益的技术效果:Compared with the prior art, the present invention has the following beneficial technical effects:
本发明一种无人驾驶车辆队列在混合交通流中协同变道方法,可以在目标间隙无法容纳整个车队同时换道时,通过将车队换道过程分步来完成换道,且考虑有人驾驶车驾驶行为不确定性和无人驾驶车辆动作规划过程中的安全性以及时间效率。该方法比现有的纯无人驾驶车辆环境下的车辆换道方法更贴近现实,比单车换道方法更高效。本发明提出的混合交通流中无人驾驶车队协同换道的方法,可以为自动驾驶车队在不同交通条件下推荐最迟的换道开始位置,提醒车队及时换道,防止车队错过最迟的滑到机会而错过下匝道的机会,为自动驾驶车队在混合流中的换道提供了技术保障。The present invention provides a method for cooperative lane change of unmanned vehicle platoons in mixed traffic flow. When the target gap cannot accommodate the entire fleet to change lanes at the same time, the lane change process of the fleet can be completed step by step, and manned vehicles can be considered. Uncertainty in driving behavior and safety and time efficiency during motion planning for unmanned vehicles. This method is closer to reality than the existing vehicle lane changing method in pure unmanned vehicle environment, and is more efficient than the single vehicle lane changing method. The method proposed by the present invention for the coordinated lane change of driverless fleets in mixed traffic flows can recommend the latest lane change start position for autonomous driving fleets under different traffic conditions, remind the fleet to change lanes in time, and prevent the fleet from missing the latest lane change. The opportunity to miss the off-ramp opportunity provides a technical guarantee for the autonomous vehicle fleet to change lanes in the mixed flow.
附图说明Description of drawings
图1为本发明实施例中车队在混合流中协同换道的流程图。Fig. 1 is a flow chart of coordinated lane changing of fleets in a mixed flow in an embodiment of the present invention.
图2为本发明实施例中无人驾驶车辆轨迹协同规划示意图。Fig. 2 is a schematic diagram of collaborative planning of unmanned vehicle trajectories in an embodiment of the present invention.
图3为本发明实施例中交通场景示意图。Fig. 3 is a schematic diagram of a traffic scene in an embodiment of the present invention.
图4为本发明实施例中车队协同换道轨迹图。Fig. 4 is a track diagram of team coordinated lane change in the embodiment of the present invention.
具体实施方式Detailed ways
为了使本技术领域的人员更好地理解本发明方案,下面将结合本发明实施例中的附图,对本发明实施例中的技术方案进行清楚、完整地描述,显然,所描述的实施例仅是本发明一部分的实施例,而不是全部的实施例。基于本发明中的实施例,本领域普通技术人员在没有做出创造性劳动前提下所获得的所有其他实施例,都应当属于本发明保护的范围。In order to enable those skilled in the art to better understand the solutions of the present invention, the technical solutions in the embodiments of the present invention will be clearly and completely described below in conjunction with the drawings in the embodiments of the present invention. Obviously, the described embodiments are only It is an embodiment of a part of the present invention, but not all embodiments. Based on the embodiments of the present invention, all other embodiments obtained by persons of ordinary skill in the art without making creative efforts shall fall within the protection scope of the present invention.
需要说明的是,本发明的说明书和权利要求书及上述附图中的术语“第一”、“第二”等是用于区别类似的对象,而不必用于描述特定的顺序或先后次序。应该理解这样使用的数据在适当情况下可以互换,以便这里描述的本发明的实施例能够以除了在这里图示或描述的那些以外的顺序实施。此外,术语“包括”和“具有”以及他们的任何变形,意图在于覆盖不排他的包含,例如,包含了一系列步骤或单元的过程、方法、系统、产品或设备不必限于清楚地列出的那些步骤或单元,而是可包括没有清楚地列出的或对于这些过程、方法、产品或设备固有的其它步骤或单元。It should be noted that the terms "first" and "second" in the description and claims of the present invention and the above drawings are used to distinguish similar objects, but not necessarily used to describe a specific sequence or sequence. It is to be understood that the data so used are interchangeable under appropriate circumstances such that the embodiments of the invention described herein can be practiced in sequences other than those illustrated or described herein. Furthermore, the terms "comprising" and "having", as well as any variations thereof, are intended to cover a non-exclusive inclusion, for example, a process, method, system, product or device comprising a sequence of steps or elements is not necessarily limited to the expressly listed instead, may include other steps or elements not explicitly listed or inherent to the process, method, product or apparatus.
本发明一种无人驾驶车辆队列在混合交通流中协同变道方法,包括以下步骤:The present invention relates to a method for cooperatively changing lanes of an unmanned vehicle platoon in a mixed traffic flow, comprising the following steps:
S1,获取无人驾驶车辆队列协同交互半径内的所有车辆信息,根据无人驾驶车辆队列以及获取的所有车辆信息建立无人驾驶车辆混合流换道模型;S1. Obtain all vehicle information within the cooperative interaction radius of the unmanned vehicle platoon, and establish a mixed traffic lane change model for unmanned vehicles based on the unmanned vehicle platoon and all the vehicle information obtained;
具体的,采用路侧单元与车辆通信单元之间的交互,获取在无人驾驶车辆队列的通信半径范围内所有车辆的信息,每个车辆均设置有车辆通信单元,路侧单元与车辆通信单元能够通信,获取车辆信息,包括车辆的位置信息、车辆速度和加速度信息。Specifically, the interaction between the roadside unit and the vehicle communication unit is used to obtain the information of all vehicles within the communication radius of the unmanned vehicle queue. Each vehicle is equipped with a vehicle communication unit, and the roadside unit and the vehicle communication unit It can communicate and obtain vehicle information, including vehicle location information, vehicle speed and acceleration information.
构建无人驾驶车辆混合流换道模型是为了判断某一个间隙是否可以允许无人驾驶车辆安全的换入;The purpose of constructing the mixed lane change model of unmanned vehicles is to judge whether a certain gap can allow unmanned vehicles to switch in safely;
无人驾驶车辆混合流换道模型用于计算无人驾驶车辆与目标间隙之间的距离,判断该距离是否大于设定的安全间距,设定的安全间距由Gipps模型计算出。需要确定无人驾驶车辆的反应时间和最大加减速度。The unmanned vehicle mixed flow lane change model is used to calculate the distance between the unmanned vehicle and the target gap, and judge whether the distance is greater than the set safety distance, which is calculated by the Gipps model. The reaction time and maximum acceleration and deceleration of the autonomous vehicle need to be determined.
Gipps计算与目标间隙前车的安全间距:Gipps calculates the safe distance from the vehicle in front of the target gap:
式中:——无人驾驶车辆(CAV)与目标间隙前车(pre)在时刻t的最小换道安全间距,单位:米;In the formula: ——The minimum lane-changing safety distance between the unmanned vehicle (CAV) and the vehicle in front of the target gap (pre) at time t, unit: meter;
vCAV(t)——无人驾驶车辆在时刻t的速度,单位:米/秒;v CAV (t)——the speed of the unmanned vehicle at time t, unit: m/s;
vpre(t)——前车在时刻t的速度,单位:米/秒;v pre (t)——the speed of the vehicle in front at time t, unit: m/s;
——无人驾驶车辆的最大减速度,单位:米/秒2; ——The maximum deceleration of the unmanned vehicle, unit: m/s2;
——目标间隙前车的最大减速度,单位:米/秒2; ——The maximum deceleration of the vehicle in front of the target gap, unit: m/s2;
τCAV——无人驾驶车辆的反应时间,单位:秒;τ CAV - reaction time of unmanned vehicle, unit: second;
xCAV(t)——无人驾驶车辆在时刻t的位置,单位:米;x CAV (t)——the position of the unmanned vehicle at time t, unit: meter;
xpre(t)——目标间隙前车在时刻t的位置,单位:米;x pre (t)——the position of the vehicle in front of the target gap at time t, unit: meter;
h——无人驾驶车辆的长度,单位:米。h——the length of the unmanned vehicle, unit: meter.
如果则满足无人驾驶车辆的安全换道标准,sCAV,pre(t)是无人驾驶车辆(CAV)与目标间隙前车(pre)在时刻t的实际距离,其计算公式如下:if Then meet the safe lane-changing standard of unmanned vehicles, s CAV,pre (t) is the actual distance between the unmanned vehicle (CAV) and the vehicle in front of the target gap (pre) at time t, and its calculation formula is as follows:
sCAV,pre(t)=xpre(t)-xCAV(t)-h (2)s CAV,pre (t)=x pre (t)-x CAV (t)-h (2)
准备换道的无人驾驶车辆换入目标间隙,目标间隙后的车辆(fol)产生的反应加速度不能超过车辆本身的加/减速度极限,目标间隙后的车辆(fol)的反应加速度由IDM模型计算得出,IDM模型需要确定最小跟驰间距(取3米)、加速度系数(取2),以及车辆的加减速度的极限范围。The unmanned vehicle that is about to change lanes changes into the target gap. The reaction acceleration generated by the vehicle (fol) after the target gap cannot exceed the acceleration/deceleration limit of the vehicle itself. The reaction acceleration of the vehicle (fol) after the target gap is determined by the IDM model It is calculated that the IDM model needs to determine the minimum car-following distance (take 3 meters), the acceleration coefficient (take 2), and the limit range of the acceleration and deceleration of the vehicle.
与目标间隙后车的安全判断计算公式如下:The formula for calculating the safety judgment of the vehicle behind the target gap is as follows:
—目标间隙后车的最大减速度,单位:米/秒2; —The maximum deceleration of the vehicle behind the target gap, unit: m/s 2 ;
afol,CAV(t)为无人驾驶车辆在时刻t换入目标间隙后,目标间隙后车的反应加速度,单位:米/秒2;a fol,CAV (t) is the reaction acceleration of the vehicle behind the target gap after the unmanned vehicle switches into the target gap at time t, unit: m/s2;
——目标间隙后车的最大加速度,单位:米/秒2; ——The maximum acceleration of the vehicle behind the target gap, unit: m/ s2 ;
s0——最小跟驰间距,取3米;s 0 —— the minimum car-following distance, take 3 meters;
S*——无人驾驶车辆和后车的期望间距,单位:米;S * ——the expected distance between the unmanned vehicle and the rear vehicle, unit: meter;
Δt——离散时间间隔,取0.1秒;Δt——discrete time interval, take 0.1 second;
δ——加速度系数,一般取2。δ——acceleration coefficient, generally 2.
同时满足则无人驾驶车辆进行换道进入目标间隙。satisfy at the same time Then the unmanned vehicle changes lanes and enters the target gap.
S2,根据建立的无人驾驶车辆混合流换道模型,确定无人驾驶车辆所在车道的纵向范围内的目标车道上的最大间隙,将该最大间隙作为首次换道的目标间隙;根据无人驾驶车辆的位置确定在目标间隙的纵向范围内的无人驾驶车辆,确认该无人驾驶车辆为首次换道无人驾驶车辆。S2, according to the established unmanned vehicle mixed flow lane change model, determine the maximum gap on the target lane within the longitudinal range of the lane where the unmanned vehicle is located, and use the maximum gap as the target gap for the first lane change; according to the unmanned vehicle The position of the vehicle is determined to be an unmanned vehicle within the longitudinal range of the target gap, and it is confirmed that the unmanned vehicle is the unmanned vehicle for the first lane change.
设无人驾驶车辆队一共有n辆车,依次将{k,m|k=1,...,n,m=1,...,n-k}中的k,m值带入下列不等式,找到使得下列不等式都满足的k,m值,确认首次换道的无人驾驶车辆或者无人驾驶车辆集合,即为{k,k+1,...,k+m-1}。Assuming that there are n vehicles in the unmanned vehicle team, the values of k and m in {k,m|k=1,...,n,m=1,...,n-k} are brought into the following inequality in turn, Find the values of k and m that satisfy the following inequalities, and confirm the unmanned vehicle or the set of unmanned vehicles that change lanes for the first time, which is {k, k+1,...,k+m-1}.
式中:m——首次换道的无人驾驶车辆数量;In the formula: m—the number of unmanned vehicles that change lanes for the first time;
k——车队中第k辆车。k——the kth car in the fleet.
t0——换道开始的时间。t 0 ——the time at which the lane change starts.
S3,基于滚动优化的思想构建无人驾驶车辆纵向轨迹规划模型,无人驾驶车辆首次换道后,获取一个滚动时域内目前无人驾驶车辆队列中所有车辆的轨迹,基于无人驾驶车辆纵向轨迹规划模型,确定剩余无人驾驶车辆的目标间隙,依次将剩余无人驾驶车辆进行换道驶入目标间隙。S3. Construct the longitudinal trajectory planning model of unmanned vehicles based on the idea of rolling optimization. After the unmanned vehicle changes lanes for the first time, obtain the trajectories of all vehicles in the current unmanned vehicle queue in a rolling time domain, based on the longitudinal trajectory of unmanned vehicles The planning model determines the target gap of the remaining unmanned vehicles, and sequentially changes lanes of the remaining unmanned vehicles to enter the target gap.
当无人驾驶车辆首次换道后,进入目标车辆队列,当首次换道的无人驾驶车辆为单车时,则调整单车与其前车之间的间隙,使该间隙满足剩余无人驾驶车辆安全驶入的目标间隙,将剩余无人驾驶车辆中的一辆无人驾驶车辆进行换道驶入该目标间隙。When the unmanned vehicle changes lanes for the first time, it enters the target vehicle queue. When the unmanned vehicle that changes lanes for the first time is a single vehicle, the gap between the single vehicle and the vehicle in front is adjusted so that the gap meets the requirements for safe driving of the remaining unmanned vehicles. Enter the target gap, and change lanes of one of the remaining unmanned vehicles to enter the target gap.
当首次换道的无人驾驶车辆为多辆无人驾驶车辆组成的车队时,则调整无人驾驶车辆组成的车队中两辆无人驾驶车辆之间的间隙,使该间隙满足剩余无人驾驶车辆安全驶入的目标间隙,将剩余无人驾驶车辆中的一辆无人驾驶车辆进行换道驶入该目标间隙。When the unmanned vehicle that changes lanes for the first time is a convoy of multiple unmanned vehicles, adjust the gap between two unmanned vehicles in the convoy of unmanned vehicles so that the gap meets the requirements of the remaining unmanned vehicles. The target gap that the vehicle safely enters, and one of the remaining unmanned vehicles is changed lanes and driven into the target gap.
如图1、图2所示,本申请以六辆车组成的无人驾驶车辆队列为例,将无人驾驶车辆队列拆分成三个小车队,其中一个小车队首次换道,剩余未换道的两个小车队按照前后位置,分为车队1和车队2,已经换道的小车队组成车队3。As shown in Figure 1 and Figure 2, this application takes an unmanned vehicle platoon composed of six vehicles as an example, and splits the unmanned vehicle platoon into three small fleets. One of the small fleets changed lanes for the first time, and the rest did not. The two small convoys on the road are divided into
协同轨迹规划阶段的协同方式为:扩大车队3中相邻两辆无人驾驶车辆之间的间隙,使得车队1和车队2中的车辆能够安全换入,同时车队1和车队2需根据车队3中其目标间隙的位置来实时调整其位置,具体细节如下:The coordination method in the collaborative trajectory planning stage is: to expand the gap between two adjacent unmanned vehicles in fleet 3, so that the vehicles in
车队3需要确定拉大车队3中哪些车辆之间的间隙,和被拉大间隙的目标大小。为此,先确定车队1和车队2的目标间隙,为减少车队1和车队2位置调整的时间,车队1和车队2分别在车队3中选择离它们最近的间隙作为目标间隙;接着,分别根据式(9)-(12)计算车队1和车队2所需的间距大小。Fleet 3 needs to determine which vehicles in Fleet 3 to widen the gap between, and the target size of the widened gap. To this end, first determine the target gaps of the
其中L1和L2分别为车队1和车队2所需的换道间距。Among them, L 1 and L 2 are the required lane-changing distances of
只规划接下来一个滚动时域(p)内的轨迹。在执行完一个时域内的轨迹后,依据当前时刻无人驾驶车辆混合流换道模型中各车辆的位置继续规划未来一个滚动时域内的轨迹,直至目标间隙拉大到了目标间隙长度。同时规划模型应考虑乘客的舒适性和轨迹调整的时间,因此为车队3建立如下的轨迹规划模型:Only trajectories within the next rolling horizon (p) are planned. After executing a trajectory in the time domain, continue to plan the trajectory in the future rolling time domain according to the position of each vehicle in the mixed flow lane change model of unmanned vehicles at the current moment, until the target gap is enlarged to the target gap length. At the same time, the planning model should consider the comfort of passengers and the time of trajectory adjustment, so the following trajectory planning model is established for fleet 3:
目标函数:Objective function:
约束: constraint:
vi(t)=vi(t-1)+ai(t-1)Δt,i∈I3 (15)v i (t)=v i (t-1)+a i (t-1)Δt,i∈I 3 (15)
xi(t)-xi+1(t)≥s0,i∈I3 (18)x i (t)-x i+1 (t)≥s 0 , i∈I 3 (18)
式中:ω1—舒适度的权重;In the formula: ω 1 —weight of comfort degree;
ω2—时间效率的权重;ω 2 —weight of time efficiency;
I3—为车队3内无人驾驶车辆的集合;I 3 —is the collection of unmanned vehicles in fleet 3;
—无人驾驶车辆k-1与后车k所需的最小安全换道间距,单位:米。 —The minimum safe lane-changing distance between unmanned vehicle k-1 and the following vehicle k, unit: meter.
n—无人车队内的车辆数;n—the number of vehicles in the unmanned fleet;
p—为滚动预测时域;p—is the rolling forecast time domain;
L1——车队1的最小换道所需间距,单位:米;L 1 ——the distance required for the minimum lane change of
L2——车队2的最小换道所需间距,单位:米;L 2 ——the distance required for the minimum lane change of
——无人车k-1与后车k所需的最小安全换道间距,单位:米。 ——The minimum safe lane-changing distance between unmanned vehicle k-1 and the following vehicle k, unit: meter.
车队1在轨迹协同阶段的目标是:在车队3调整好间隙时,车队1位于可以安全换入车队3中其目标间隙的位置。为此,车队1实时计算其与目标间隙前车之间的安全换道距离,并以此安全间距为实际间距的目标;除此之外还应考虑车队1乘客的舒适性,为此建立如式(19)所示的车队1轨迹规划模型目标函数。同样是基于滚动优化的思想,模型每次只规划一个滚动时域(p)内的车队1轨迹,在执行完一个滚动时域内的轨迹之后再在重新计算与目标间隙的前车之间的安全换道间隙,并重新规划未来一个滚动时域的轨迹。其模型具体如下:The goal of
目标函数:Objective function:
约束:式(14)-(18),且i=1。Constraints: Formulas (14)-(18), And i=1.
车队2在轨迹协同阶段的目标是:车队2在车队3调整好间隙时,车队2位于能够安全换入车队3中其目标间隙的位置。为此,车队2实时计算其与目标间隙前车之间的安全换道距离,并以此安全间距为实际间距的目标;除此之外还应考虑车队2乘客的舒适性,为此建立如式(20)所示的车队2轨迹规划模型目标函数。同样是基于滚动优化的思想,模型每次只规划一个滚动时域(p)内的车队2轨迹,在执行完一个滚动时域内的轨迹之后再在重新计算与目标间隙的前车之间的安全换道间隙,并重新规划未来一个滚动时域的轨迹。其模型具体如下:The goal of
目标函数:Objective function:
约束:constraint:
式(14)-(18)和式(21),且i=k+m。Formulas (14)-(18) and formula (21), And i=k+m.
上述所需要的以高速公路上一段两车道的路段为例,一个有10辆无人车车队需要在到达匝道口前变道至外侧车道。外侧车道的交通量为1500veh/h,目标车道上的有人车按照IDM模型行驶,初始位置按照泊松到达随机生成。初始速度为30m/s。车队在位于匝道口上游1500的位置收到变道开始信号。场景示意图如图3所示。模型参数如下表1所示The above requirements take a two-lane road section on the expressway as an example. A fleet of 10 unmanned vehicles needs to change lanes to the outer lane before reaching the ramp. The traffic volume of the outer lane is 1500veh/h, the manned vehicles on the target lane travel according to the IDM model, and the initial position is randomly generated according to Poisson arrival. The initial speed is 30m/s. The convoy receives a lane change start signal at a
表1模型参数设置Table 1 Model parameter settings
在该场景下的协同换道轨迹图如图4所示,从图4中可以看出,利用本发明提出的方法,一个由10辆无人车组成的车队在1500veh/h的交通环境下,可以再20秒内完成车队的全部换道。通过与两种经典的换道模型Gipps和MOBIL进行比较发现,本发明的方法在混合流中车队换道的问题上有明显的优势。在该场景下的多次测试结果也证实了本发明的优越性。测试结果如表2所示:The trajectory diagram of coordinated lane change in this scenario is shown in Figure 4. It can be seen from Figure 4 that using the method proposed in the present invention, a fleet of 10 unmanned vehicles can All lane changes of the convoy can be completed within 20 seconds. By comparing with two classic lane-changing models Gipps and MOBIL, it is found that the method of the present invention has obvious advantages in the problem of vehicle lane-changing in mixed flow. The multiple test results in this scenario also confirm the superiority of the present invention. The test results are shown in Table 2:
表2.方法性能对比结果Table 2. Method performance comparison results
从仿真结果可以看出,本发明提出的方法,对比目前经典的换道模型,在换道成功率上有明显提高,同时车队换道执行时间有大幅下降。It can be seen from the simulation results that the method proposed by the present invention, compared with the current classic lane-changing model, has a significant improvement in the success rate of lane-changing, and at the same time, the team's lane-changing execution time is greatly reduced.
本发明提出的混合交通流中无人驾驶车队协同换道的方法合理可靠,简单易行,本发明提出的车队换道方法可以在目标间隙无法容纳整个车队同时换道时,通过将车队换道过程分步来完成换道,且考虑有人驾驶车驾驶行为不确定性和无人驾驶车辆动作规划过程中的安全性以及时间效率。该方法比现有的纯无人驾驶车辆环境下的车辆换道方法更贴近现实,比单车换道方法更高效。本发明提出的混合交通流中无人驾驶车队协同换道的方法,可以为自动驾驶车队在不同交通条件下推荐最迟的换道开始位置,提醒车队及时换道,防止车队错过最迟的滑到机会而错过下匝道的机会,为自动驾驶车队在混合流中的换道提供了技术保障。The method for coordinated lane change of unmanned fleets in the mixed traffic flow proposed by the present invention is reasonable, reliable, simple and easy to implement. The lane change is completed step by step, and the uncertainty of the driving behavior of the manned vehicle and the safety and time efficiency of the action planning process of the unmanned vehicle are considered. This method is closer to reality than the existing vehicle lane changing method in pure unmanned vehicle environment, and is more efficient than the single vehicle lane changing method. The method proposed by the present invention for the coordinated lane change of driverless fleets in mixed traffic flows can recommend the latest lane change start position for autonomous driving fleets under different traffic conditions, remind the fleet to change lanes in time, and prevent the fleet from missing the latest lane change. The opportunity to miss the off-ramp opportunity provides a technical guarantee for the autonomous vehicle fleet to change lanes in the mixed flow.
应当指出,对于本技术领域的普通技术人员来说,在不脱离本发明原理的前提下,还可以做出若干改进和润饰,这些改进和润饰也应视为本发明的保护范围。本实施例中未明确的各组成部分均可用现有技术加以实现。It should be pointed out that those skilled in the art can make some improvements and modifications without departing from the principle of the present invention, and these improvements and modifications should also be regarded as the protection scope of the present invention. All components that are not specified in this embodiment can be realized by existing technologies.
Claims (10)
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202211478251.1A CN115830908B (en) | 2022-11-23 | 2022-11-23 | A method and system for collaborative lane changing of driverless vehicle queues in mixed traffic flow |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202211478251.1A CN115830908B (en) | 2022-11-23 | 2022-11-23 | A method and system for collaborative lane changing of driverless vehicle queues in mixed traffic flow |
Publications (2)
Publication Number | Publication Date |
---|---|
CN115830908A true CN115830908A (en) | 2023-03-21 |
CN115830908B CN115830908B (en) | 2023-10-27 |
Family
ID=85530879
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN202211478251.1A Active CN115830908B (en) | 2022-11-23 | 2022-11-23 | A method and system for collaborative lane changing of driverless vehicle queues in mixed traffic flow |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN115830908B (en) |
Cited By (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN118762544A (en) * | 2024-09-02 | 2024-10-11 | 武汉理工大学 | A lane-changing decision model for divergence under heterogeneous traffic flow conditions |
Citations (15)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP2003044524A (en) * | 2001-07-27 | 2003-02-14 | Fujitsu Ltd | Simulation equipment |
US20130041631A1 (en) * | 2011-08-08 | 2013-02-14 | Xerox Corporation | Systems and methods for enhanced cellular automata algorithm for traffic flow modeling |
CN107315411A (en) * | 2017-07-04 | 2017-11-03 | 合肥工业大学 | A kind of lane-change method for planning track based on automatic driving vehicle under collaborative truck |
CN108806252A (en) * | 2018-06-19 | 2018-11-13 | 西南交通大学 | A kind of Mixed Freeway Traffic Flows collaboration optimal control method |
US20190071096A1 (en) * | 2017-09-06 | 2019-03-07 | IFP Energies Nouvelles | Method for determining a speed to be reached for a first vehicle preceded by a second vehicle, in particular for an autonomous vehicle |
CN111081065A (en) * | 2019-12-13 | 2020-04-28 | 北京理工大学 | Intelligent vehicle cooperative lane change decision-making model under mixed traffic conditions |
CN111731296A (en) * | 2019-03-25 | 2020-10-02 | 本田技研工业株式会社 | Travel control device, travel control method, and storage medium storing program |
CN112735126A (en) * | 2020-12-24 | 2021-04-30 | 成都格林希尔德交通科技有限公司 | Mixed traffic flow cooperative optimization control method based on model predictive control |
CN113297721A (en) * | 2021-04-21 | 2021-08-24 | 东南大学 | Simulation method and device for selecting exit lane by vehicles at signalized intersection |
CN113313949A (en) * | 2021-05-31 | 2021-08-27 | 长安大学 | Method, device and equipment for cooperative control of passenger cars and trucks on expressways and ramp ways |
CN114023108A (en) * | 2021-11-02 | 2022-02-08 | 河北工业大学 | Mixed traffic flow lane change model and lane change simulation method |
CN114495527A (en) * | 2022-02-23 | 2022-05-13 | 长安大学 | A method and system for vehicle-road collaborative optimization at a networked intersection in a mixed traffic environment |
CN114613142A (en) * | 2022-03-24 | 2022-06-10 | 长沙理工大学 | A rule-based automatic driving method for vehicle lane change control at intersections |
CN114771522A (en) * | 2022-04-15 | 2022-07-22 | 河北工业大学 | Method for constructing man-machine hybrid driving traffic flow vehicle lane change model |
CN114842644A (en) * | 2022-04-26 | 2022-08-02 | 河北工业大学 | Traffic capacity calculation method for mixed traffic flow intersection area |
-
2022
- 2022-11-23 CN CN202211478251.1A patent/CN115830908B/en active Active
Patent Citations (15)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP2003044524A (en) * | 2001-07-27 | 2003-02-14 | Fujitsu Ltd | Simulation equipment |
US20130041631A1 (en) * | 2011-08-08 | 2013-02-14 | Xerox Corporation | Systems and methods for enhanced cellular automata algorithm for traffic flow modeling |
CN107315411A (en) * | 2017-07-04 | 2017-11-03 | 合肥工业大学 | A kind of lane-change method for planning track based on automatic driving vehicle under collaborative truck |
US20190071096A1 (en) * | 2017-09-06 | 2019-03-07 | IFP Energies Nouvelles | Method for determining a speed to be reached for a first vehicle preceded by a second vehicle, in particular for an autonomous vehicle |
CN108806252A (en) * | 2018-06-19 | 2018-11-13 | 西南交通大学 | A kind of Mixed Freeway Traffic Flows collaboration optimal control method |
CN111731296A (en) * | 2019-03-25 | 2020-10-02 | 本田技研工业株式会社 | Travel control device, travel control method, and storage medium storing program |
CN111081065A (en) * | 2019-12-13 | 2020-04-28 | 北京理工大学 | Intelligent vehicle cooperative lane change decision-making model under mixed traffic conditions |
CN112735126A (en) * | 2020-12-24 | 2021-04-30 | 成都格林希尔德交通科技有限公司 | Mixed traffic flow cooperative optimization control method based on model predictive control |
CN113297721A (en) * | 2021-04-21 | 2021-08-24 | 东南大学 | Simulation method and device for selecting exit lane by vehicles at signalized intersection |
CN113313949A (en) * | 2021-05-31 | 2021-08-27 | 长安大学 | Method, device and equipment for cooperative control of passenger cars and trucks on expressways and ramp ways |
CN114023108A (en) * | 2021-11-02 | 2022-02-08 | 河北工业大学 | Mixed traffic flow lane change model and lane change simulation method |
CN114495527A (en) * | 2022-02-23 | 2022-05-13 | 长安大学 | A method and system for vehicle-road collaborative optimization at a networked intersection in a mixed traffic environment |
CN114613142A (en) * | 2022-03-24 | 2022-06-10 | 长沙理工大学 | A rule-based automatic driving method for vehicle lane change control at intersections |
CN114771522A (en) * | 2022-04-15 | 2022-07-22 | 河北工业大学 | Method for constructing man-machine hybrid driving traffic flow vehicle lane change model |
CN114842644A (en) * | 2022-04-26 | 2022-08-02 | 河北工业大学 | Traffic capacity calculation method for mixed traffic flow intersection area |
Non-Patent Citations (1)
Title |
---|
杨达;苏刚;吴丹红;熊明强;蒲云;: "基于社会力的驾驶员换道决策行为建模", 西南交通大学学报, no. 04 * |
Cited By (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN118762544A (en) * | 2024-09-02 | 2024-10-11 | 武汉理工大学 | A lane-changing decision model for divergence under heterogeneous traffic flow conditions |
Also Published As
Publication number | Publication date |
---|---|
CN115830908B (en) | 2023-10-27 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
JP7194755B2 (en) | Trajectory plan | |
CN108447266B (en) | An intelligent networked vehicle collaborative lane change and queuing control method | |
CN106940933B (en) | A kind of intelligent vehicle decision lane-change method based on intelligent transportation system | |
US8352111B2 (en) | Platoon vehicle management | |
CN110775060B (en) | A single-lane double-column small vehicle formation intelligent control system and formation method | |
JP6183864B2 (en) | Method and system for adapting vehicle traffic flow | |
CN106601002A (en) | Urban expressway entrance ramp vehicle traffic guiding system and guiding method thereof in Internet of vehicles environment | |
CN112204350A (en) | Trajectory planning | |
EP3802259A1 (en) | Time-warping for autonomous driving simulation | |
CN109410561B (en) | Uniform and heterogeneous formation driving control method for vehicles on highway | |
CN107274684A (en) | A kind of single-point integrative design intersection policy selection method under bus or train route cooperative surroundings | |
Ashtiani et al. | Multi-intersection traffic management for autonomous vehicles via distributed mixed integer linear programming | |
CN115140094B (en) | Real-time lane change decision method based on longitudinal safety interval model | |
CN115565390B (en) | Intelligent network-connected automobile multi-lane queue traffic control method, system and computer readable storage medium | |
CN110363986A (en) | A centralized vehicle speed optimization method in the merge area based on vehicle-vehicle game and driving potential force | |
CN114999227B (en) | Non-signal control intersection mixed multi-vehicle model-free prediction cooperative control method | |
CN111634293A (en) | Automatic lane changing method of automatic driving vehicle based on traffic clearance | |
Younes et al. | A vehicular network based intelligent lane change assistance protocol for highways | |
CN115909783A (en) | A lane-level driving assistance method and system based on traffic flow | |
Li et al. | Enhancing cooperation of vehicle merging control in heavy traffic using communication-based soft actor-critic algorithm | |
CN115830908A (en) | Cooperative lane change method and system for unmanned vehicle platoon in mixed traffic flow | |
CN116740945A (en) | Method and system for multi-vehicle collaborative grouping intersection of expressway confluence region in mixed running environment | |
CN109656242A (en) | A kind of automatic Pilot planning driving path planning system | |
CN115273450A (en) | A lane-changing method for vehicles entering a formation in a networked autonomous driving environment | |
CN117681878A (en) | A collaborative lane changing method for intelligent connected vehicles with formation awareness |
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 |