CN113327448A - 一种自动驾驶专用相位下的车辆轨迹优化方法 - Google Patents
一种自动驾驶专用相位下的车辆轨迹优化方法 Download PDFInfo
- Publication number
- CN113327448A CN113327448A CN202110877881.5A CN202110877881A CN113327448A CN 113327448 A CN113327448 A CN 113327448A CN 202110877881 A CN202110877881 A CN 202110877881A CN 113327448 A CN113327448 A CN 113327448A
- Authority
- CN
- China
- Prior art keywords
- vehicle
- intersection
- vehicles
- automatic driving
- lane
- 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 27
- 238000005457 optimization Methods 0.000 title claims abstract description 24
- 230000001133 acceleration Effects 0.000 claims abstract description 37
- 238000000926 separation method Methods 0.000 claims abstract description 24
- 238000013459 approach Methods 0.000 claims description 5
- 238000005516 engineering process Methods 0.000 description 3
- 230000008676 import Effects 0.000 description 3
- 230000007547 defect Effects 0.000 description 2
- 238000010586 diagram Methods 0.000 description 2
- 238000011160 research Methods 0.000 description 2
- 230000009286 beneficial effect Effects 0.000 description 1
- 230000004927 fusion Effects 0.000 description 1
- 238000007726 management method Methods 0.000 description 1
- 238000012986 modification Methods 0.000 description 1
- 230000004048 modification Effects 0.000 description 1
- 238000012545 processing Methods 0.000 description 1
- 238000006467 substitution reaction Methods 0.000 description 1
Images
Classifications
-
- G—PHYSICS
- G08—SIGNALLING
- G08G—TRAFFIC CONTROL SYSTEMS
- G08G1/00—Traffic control systems for road vehicles
- G08G1/09—Arrangements for giving variable traffic instructions
- G08G1/0962—Arrangements for giving variable traffic instructions having an indicator mounted inside the vehicle, e.g. giving voice messages
- G08G1/0968—Systems involving transmission of navigation instructions to the vehicle
- G08G1/096833—Systems involving transmission of navigation instructions to the vehicle where different aspects are considered when computing the route
-
- G—PHYSICS
- G06—COMPUTING; CALCULATING OR COUNTING
- G06F—ELECTRIC DIGITAL DATA PROCESSING
- G06F17/00—Digital computing or data processing equipment or methods, specially adapted for specific functions
- G06F17/10—Complex mathematical operations
- G06F17/11—Complex mathematical operations for solving equations, e.g. nonlinear equations, general mathematical optimization problems
-
- G—PHYSICS
- G08—SIGNALLING
- G08G—TRAFFIC CONTROL SYSTEMS
- G08G1/00—Traffic control systems for road vehicles
- G08G1/01—Detecting movement of traffic to be counted or controlled
- G08G1/0104—Measuring and analyzing of parameters relative to traffic conditions
- G08G1/0125—Traffic data processing
-
- G—PHYSICS
- G08—SIGNALLING
- G08G—TRAFFIC CONTROL SYSTEMS
- G08G1/00—Traffic control systems for road vehicles
- G08G1/01—Detecting movement of traffic to be counted or controlled
- G08G1/052—Detecting movement of traffic to be counted or controlled with provision for determining speed or overspeed
-
- G—PHYSICS
- G08—SIGNALLING
- G08G—TRAFFIC CONTROL SYSTEMS
- G08G1/00—Traffic control systems for road vehicles
- G08G1/09—Arrangements for giving variable traffic instructions
- G08G1/0962—Arrangements for giving variable traffic instructions having an indicator mounted inside the vehicle, e.g. giving voice messages
- G08G1/0967—Systems involving transmission of highway information, e.g. weather, speed limits
- G08G1/096708—Systems involving transmission of highway information, e.g. weather, speed limits where the received information might be used to generate an automatic action on the vehicle control
- G08G1/096716—Systems involving transmission of highway information, e.g. weather, speed limits where the received information might be used to generate an automatic action on the vehicle control where the received information does not generate an automatic action on the vehicle control
Landscapes
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Engineering & Computer Science (AREA)
- Mathematical Physics (AREA)
- Computational Mathematics (AREA)
- Theoretical Computer Science (AREA)
- Data Mining & Analysis (AREA)
- Pure & Applied Mathematics (AREA)
- Mathematical Optimization (AREA)
- Mathematical Analysis (AREA)
- Atmospheric Sciences (AREA)
- Remote Sensing (AREA)
- Radar, Positioning & Navigation (AREA)
- Operations Research (AREA)
- Chemical & Material Sciences (AREA)
- Algebra (AREA)
- Life Sciences & Earth Sciences (AREA)
- Databases & Information Systems (AREA)
- Software Systems (AREA)
- General Engineering & Computer Science (AREA)
- Analytical Chemistry (AREA)
- Traffic Control Systems (AREA)
- Control Of Driving Devices And Active Controlling Of Vehicle (AREA)
Abstract
本发明面向自动驾驶车辆与人工驾驶车辆混合行驶的交通环境,设计了一种自动驾驶专用相位下的车辆轨迹优化方法,属于智能交通领域。首先,采集交叉口的物理参数、车辆的基本信息及各进口车道的信号状态;其次,将交叉口划分为轨迹控制区和协调刹车区,建立车辆行驶轨迹模型和自动驾驶车辆冲突分离的协调控制模型;最后,以交叉口所有进口车道上的车辆安全、迅速地通过交叉口为优化目标,优化获得车辆的位置、速度及加速度。本发明考虑自动驾驶车辆与人工驾驶车辆行驶的差异性,优化不同车辆类型的轨迹,并在自动驾驶专用相位下,对自动驾驶专用车道上的车辆进行冲突分离的协调控制,实现车辆的分类而治。
Description
技术领域
本发明属于智能交通控制领域,涉及城市交叉口车辆通行的运动轨迹的交通控制技术领域,更具体地说,涉及一种自动驾驶专用相位下的车辆轨迹优化方法。
背景技术
自动驾驶车辆的技术结构主要包括环境感知和定位、决策规划和执行控制三大模块,具体实现过程是传感器技术和摄像头、GPS等技术获取汽车行驶过程中的环境指标,然后经由汽车智能处理器或远程控制中心进行信息融合与处理,规划车辆安全行驶路径与决策车辆跟车、换道、转弯、停车等指令,最后将决策传递给车辆的功能部件,把油门、制动、转向、换挡等指令落实,实现车辆运动。自动驾驶技术从理论与技术层面上已经相当成熟,基本实现在道路上的安全行驶。
目前,针对自动驾驶车辆的国内外研究大多存在以下不足:第一,简化车辆的运动轨迹,假设车辆在交叉口路段上匀速行驶,只优化获得车辆进入交叉口的时刻;第二,理想化人工驾驶车辆的运动过程,忽略了自动驾驶车辆可以依靠系统的稳定性,大大缩减了跟驰过程中最小的安全跟车间距,并严格遵守交通规则行驶。在信号灯控制仍然是交叉口交通控制与管理的主流选择的情况下,新增自动驾驶专用相位,限定自动驾驶专用进口车道上只允许自动驾驶车辆行驶,从而实现交叉口所有自动驾驶专用进口车道上车辆自由通行。因此,面向自动驾驶车辆与人工驾驶车辆的混合交通流,基于“绿灯行-红灯停”的车辆通行策略,并充分考虑自动驾驶车辆与人工驾驶车辆的行驶特征的差异性,提出一种自动驾驶专用相位下的车辆轨迹优化方法具有深刻的研究意义。
发明内容
本发明目的是为了克服上述技术存在的不足,建立一种自动驾驶专用相位下的车辆轨迹优化方法。该方法充分考虑自动驾驶车辆与人工驾驶车辆行驶特征的区别,建立车辆行驶轨迹模型,在自动驾驶专用相位,对自动驾驶专用进口车道上车辆进行协调控制,实现车辆的分类而治,从而有效保障了车辆安全、高效地通过交叉口。
技术方案:为解决上述技术问题,本发明的一种自动驾驶专用相位下的车辆轨迹优化方法,包括如下步骤:
步骤1:采集交叉口的物理参数,包括交叉口人工驾驶进口车道及自动驾驶专用进口车道、进出口车道数及车道宽度;采集车辆的基本信息,包括车辆当前所在进口车道、位置、速度以及预计转向;采集交叉口各进口车道的信号状态;
步骤2:将交叉口划分为轨迹控制区和协调刹车区,建立车辆行驶轨迹模型和自动驾驶车辆冲突分离的协调控制模型;
步骤3:以交叉口所有进口车道上的车辆安全、迅速地通过交叉口为优化目标,优化获得车辆行驶轨迹。
本发明中,步骤1的采集交叉口环境的物理参数、车辆的基本信息及交叉口信号配时方案,包括如下步骤:
步骤1-1:采集交叉口的物理参数,包括自动驾驶专用进口车道及人工驾驶进口车道、进口车道数及出口车道数、各进口车道的车道宽度与各出口车道的车道宽度,用表示交叉口进口方向的进口车道集合,,用表示交叉口出口方向的出口车道集合,,并对进口车道进行编号;
步骤1-2:采集车辆的基本信息,包括车辆当前所在进口车道、位置、速度、加速度及预计转向,,其中分别表示左转、直行、右转,用表示交叉口进口车道上车辆的集合,,用表示交叉口人工驾驶进口车道上车辆的集合,,用表示交叉口自动驾驶专用进口车道上车辆的集合,;
本发明中,步骤2的将交叉口划分为轨迹控制区和协调刹车区,建立车辆行驶轨迹模型和自动驾驶车辆冲突分离的协调控制模型,包括如下步骤:
步骤2-2:基于车辆加速度的优化,确定车辆行驶轨迹的位置-速度-加速度的关系,由公式计算(1)-(2):
步骤2-3:自动驾驶专用进口车道上的车辆的加速度不小于最大减速度,且不大于最大加速度,由公式计算(3):
步骤2-4:交叉口所有进口车道上的车辆的速度不大于最大速度,由公式计算(4):
步骤2-6:人工驾驶进口车道上车辆行驶的跟车过程,受同一车道上相邻前车、后车的位置和速度的影响,车辆跟车的加速度由公式计算(9):
其中,表示表示时刻车辆的跟车加速度, 、 、 、 表示人工驾驶进口车道上车辆的跟车模型的参数,表示车辆的车身长度,表示同一车道上相邻两台人工驾驶车辆的最小安全跟车距离,表示人工驾驶车辆的紧急反应时间;
步骤2-7:在交叉口各进口车道上虚拟一台车辆,表示进口车道上的第一台车辆,其初始时刻的位置及速度由公式计算(10)-(11);当进口车道信号切换至红灯,车辆的位置及速度由公式计算(12)-(15);当进口车道信号切换至绿灯,车辆的位置及速度由公式计算(16)-(19):
步骤2-8:人工驾驶进口车道上车辆的加速度不小于最大减速度,且不大于最大加速度及车辆跟车速度,由公式计算(20):
步骤2-9:同一车道上相邻的两台车辆之间的间距不小于最小安全跟车间距与紧急反应时间内车辆行驶的路程之和,人工驾驶车辆由公式(21)计算,自动驾驶车辆由公式(22)计算;
步骤2-10:自动驾驶相位下,已驶入交叉口轨迹控制区、未驶离交叉口的自动驾驶专用进口车道上的车辆,任意时刻,须进行不同自动驾驶专用进口车道上的任意两台车辆的冲突分离的协调控制,即不同自动驾驶专用进口车道上的任意两台车辆到冲突点距离差的绝对值不小于自动驾驶车辆冲突分离的最小安全间距,由公式计算(23)-(25):
其中,和是0-1变量,表示时刻车辆已驶离交叉口,表示时刻车辆未驶离交叉口,表示时刻车辆允许驶入交叉口,表示时刻车辆禁止驶入交叉口,表示时刻车辆已驶入车辆轨迹控制区,表示时刻车辆未驶入车辆轨迹控制区,表示车辆与车辆在交叉口内行驶轨迹的冲突点位置,表示自动驾驶车辆冲突分离的最小安全间距,表示车辆在交叉口内的行驶轨迹,表示车辆与车辆在交叉口内的行驶轨迹存在冲突点,表示车辆驶离交叉口的目标位置,表示车辆所在进口车道上轨迹控制区边界线的位置;
步骤2-11:自动驾驶相位下,已驶入交叉口协调刹车区、未驶离交叉口的自动驾驶专用进口车道上的车辆,任意时刻,须进行不同进口车道上的任意两台车辆的冲突分离的协调刹车控制,即不同自动驾驶专用进口车道上的任意两台车辆到冲突点的距离差的绝对值不小于自动驾驶车辆冲突分离的最小安全间距,由公式(26)-(27)计算:
步骤2-12:自动驾驶专用相位下,已驶入交叉口协调刹车区、未驶离交叉口的自动驾驶专用进口车道上的车辆,当车辆需要刹车,则该车辆以最大减速度紧急刹车,且当前时刻无法驶入交叉口,由公式(28)-(29)计算:
步骤2-13:同一车道上,按照车辆距离停车线的远近依次驶入交叉口,由公式计算(30)-(31):
步骤2-14:当自动驾驶专用车道上的车辆已驶入交叉口,则该车辆当前时刻允许驶入交叉口,当车辆已禁止驶入交叉口,则该车辆当前时刻未驶入交叉口,由公式(32)-(33)计算:
步骤2-15:基于“绿灯行-红灯停”的通行规则,当交叉口信号灯切换至红灯时,已驶入交叉口的车辆,继续在交叉口内通行,未驶入交叉口的车辆,则无法驶入交叉口,由公式计算(34)-(35):
本发明中,步骤3的以交叉口所有进口车道上的车辆安全、迅速地通过交叉口为优化目标,优化获得车辆行驶轨迹,包括如下步骤:
步骤3-1:交叉口所有进口车道上的车辆安全、迅速地驶离交叉口,即在优化时间内,车辆位置与驶离交叉口的目标位置的距离差之和最小,优化获得车辆行驶轨迹的位置、速度及加速度,由公式计算(36):
与现有技术相比,本发明的有益效果是:面向自动驾驶车辆与人工驾驶车辆混合行驶的交通环境,对交叉口所有进口车道上的车辆进行行驶轨迹的优化,并在自动驾驶专用相位下,对自动驾驶专用车道上的车辆进行冲突分离的协调控制,实现自动驾驶车辆与人工驾驶车辆的混合交通流下交叉口交通控制。
附图说明
图1为本发明的总体流程图;
图2为本发明实施例的应用示意图;
图中标号说明:201表示交叉口轨迹控制区,202表示交叉口协调刹车区
具体实施方法
下面结合示例对本发明作进一步详细的描述,但本发明的实施方式不限于此。本发明的实施方式并不受所述示例的限制,其他的任何未背离本发明的精神实质与原理下所作的改变、修饰、替代、组合、简化,均应为等效的置换方式,都包含在本发明的保护范围之内。
实施例1:
本发明的一种自动驾驶专用相位下的车辆轨迹优化方法,包括如下步骤:
步骤1:采集交叉口的物理参数,包括交叉口人工驾驶进口车道及自动驾驶专用进口车道、进出口车道数及车道宽度;采集车辆的基本信息,包括车辆当前所在进口车道、位置、速度、加速度及预计转向;采集交叉口各进口车道的信号状态;
步骤2:将交叉口划分为轨迹控制区和协调刹车区,建立车辆行驶轨迹模型和自动驾驶车辆冲突分离的协调控制模型;
步骤3:满足交叉口所有进口车道上的车辆安全、迅速地通过交叉口,优化获得车辆行驶轨迹。
实施例2:
在实施例1的基础上,步骤1中采集交叉口的物理参数、车辆的基本信息及各进口车道的信号状态,包括如下步骤:
步骤1-1:采集交叉口的物理参数,包括自动驾驶专用进口车道及人工驾驶进口车道、进口车道数及出口车道数、各进口车道的车道宽度与各出口车道的车道宽度,用表示交叉口进口方向的进口车道集合,,用表示交叉口出口方向的出口车道集合,,并对进口车道进行编号;
步骤1-2:采集车辆的基本信息,包括车辆当前所在进口车道、位置、速度、加速度及预计转向,,其中分别表示左转、直行、右转,用表示交叉口进口车道上车辆的集合,,用表示交叉口人工驾驶进口车道上车辆的集合,,用表示交叉口自动驾驶专用进口车道上车辆的集合,;
本实施例步骤1中所述采集交叉口的物理参数,交叉口进口车道数、,对各进口车道编号,,其中自动驾驶专用进口车道和人工驾驶进口车道,对各出口车道编号,,获取各进口车道宽度均为米、各出口车道宽度均为米,车辆尺寸为;采集交叉口所有进口车道上车辆的基本信息,如表1所示;确定优化更新步长,优化周期为;
表1:交叉口所有进口车道上车辆的所在进口车道、位置、速度、加速度及预计转向的基本信息表
车辆编号<i>i</i> | 车辆所在进口车道<i>l</i><sub><i>i</i></sub> | 位置xi(t0) | 速度v<sub>i</sub>(t<sub>0</sub>)(m/s) | 加速度<i>a</i><sub>i</sub>(t<sub>0</sub>) (m/s<sup>2</sup>) | 预计转向β<sub>i</sub> |
1 | 8 | 579 | 1.87 | 1.1 | L' |
2 | 6 | 570 | 3.48 | 0.34 | L' |
3 | 4 | 566 | 2.24 | 1.59 | S' |
4 | 1 | 557 | 3.37 | 1.26 | S' |
5 | 3 | 550 | 1.5 | -0.96 | S' |
6 | 12 | 543 | 0.24 | -0.41 | S' |
7 | 9 | 532 | 2.84 | 0.84 | S' |
8 | 15 | 523 | 2.33 | -0.55 | R' |
9 | 16 | 509 | 0.75 | 1.17 | R' |
10 | 5 | 500 | 3.58 | -0.84 | R' |
11 | 1 | 500 | 2.15 | 1.48 | L' |
12 | 10 | 478 | 0.03 | 1.15 | S' |
13 | 5 | 460 | 3.43 | 1.41 | L' |
14 | 14 | 456 | 3.31 | 0.11 | R' |
15 | 8 | 450 | 2.96 | 1.16 | L' |
16 | 4 | 431 | 0.9 | 0.96 | R' |
17 | 13 | 409 | 1.39 | 0.89 | R' |
18 | 3 | 400 | 3.78 | 1.39 | R' |
19 | 14 | 345 | 2.56 | 1.52 | R' |
20 | 11 | 340 | 1.64 | 0.69 | S' |
21 | 7 | 325 | 1.27 | -0.67 | L' |
22 | 13 | 321 | 1.43 | 1.58 | R' |
23 | 6 | 300 | 0.43 | 1.38 | L' |
24 | 9 | 300 | 1.5 | -0.57 | S' |
25 | 10 | 287 | 3.21 | 0.21 | S' |
26 | 12 | 269 | 3.27 | -0.16 | S' |
27 | 7 | 231 | 1.18 | -0.79 | L' |
28 | 2 | 200 | 0.54 | 1.03 | L' |
29 | 16 | 178 | 3.78 | -0.58 | R' |
30 | 11 | 129 | 0.36 | -0.76 | S' |
31 | 2 | 100 | 2.04 | 1.38 | S' |
32 | 15 | 98 | 2.63 | 1.22 | R' |
实施例3:
在实施例1的基础上,步骤2中将交叉口划分为轨迹控制区和协调刹车区,建立车辆行驶轨迹模型和自动驾驶车辆冲突分离的协调控制模型,包括如下步骤:
步骤2-2:基于车辆加速度的优化,确定车辆行驶轨迹的位置-速度-加速度的关系,由公式计算(1)-(2):
步骤2-3:自动驾驶专用进口车道上的车辆的加速度不小于最大减速度,且不大于最大加速度,由公式计算(3):
步骤2-4:交叉口所有进口车道上的车辆的速度不大于最大速度,由公式计算(4):
步骤2-6:人工驾驶进口车道上车辆行驶的跟车过程,受同一车道上相邻前车、后车的位置和速度的影响,车辆跟车的加速度由公式计算(9):
其中,表示表示时刻车辆的跟车加速度, 、 、 、 表示人工驾驶进口车道上车辆的跟车模型的参数,表示车辆的车身长度,表示同一车道上相邻两台人工驾驶车辆的最小安全跟车距离,表示人工驾驶车辆的紧急反应时间;
步骤2-7:在交叉口各进口车道上虚拟一台车辆,表示进口车道上的第一台车辆,其初始时刻的位置及速度由公式计算(10)-(11);当进口车道信号切换至红灯,车辆的位置及速度由公式计算(12)-(15);当进口车道信号切换至绿灯,车辆的位置及速度由公式计算(16)-(19):
步骤2-8:人工驾驶进口车道上车辆的加速度不小于最大减速度,且不大于最大加速度及车辆跟车速度,由公式计算(20):
步骤2-9:同一车道上相邻的两台车辆之间的间距不小于最小安全跟车间距与紧急反应时间内车辆行驶的路程之和,人工驾驶车辆由公式(21)计算,自动驾驶车辆由公式(22)计算;
步骤2-10:自动驾驶相位下,已驶入交叉口轨迹控制区、未驶离交叉口的自动驾驶专用进口车道上的车辆,任意时刻,须进行不同自动驾驶专用进口车道上的任意两台车辆的冲突分离的协调控制,即不同自动驾驶专用进口车道上的任意两台车辆到冲突点距离差的绝对值不小于自动驾驶车辆冲突分离的最小安全间距,由公式计算(23)-(25):
其中,和是0-1变量,表示时刻车辆已驶离交叉口,表示时刻车辆未驶离交叉口,表示时刻车辆允许驶入交叉口,表示时刻车辆禁止驶入交叉口,表示时刻车辆已驶入车辆轨迹控制区,表示时刻车辆未驶入车辆轨迹控制区,表示车辆与车辆在交叉口内行驶轨迹的冲突点位置,表示自动驾驶车辆冲突分离的最小安全间距,表示车辆在交叉口内的行驶轨迹,表示车辆与车辆在交叉口内的行驶轨迹存在冲突点,表示车辆驶离交叉口的目标位置,表示车辆所在进口车道上轨迹控制区边界线的位置;
步骤2-11:自动驾驶相位下,已驶入交叉口协调刹车区、未驶离交叉口的自动驾驶专用进口车道上的车辆,任意时刻,须进行不同进口车道上的任意两台车辆的冲突分离的协调刹车控制,即不同自动驾驶专用进口车道上的任意两台车辆到冲突点的距离差的绝对值不小于自动驾驶车辆冲突分离的最小安全间距,由公式(26)-(27)计算:
步骤2-12:自动驾驶专用相位下,已驶入交叉口协调刹车区、未驶离交叉口的自动驾驶专用进口车道上的车辆,当车辆需要刹车,则该车辆以最大减速度紧急刹车,且当前时刻无法驶入交叉口,由公式(28)-(29)计算:
步骤2-13:同一车道上,按照车辆距离停车线的远近依次驶入交叉口,由公式计算(30)-(31):
步骤2-14:当自动驾驶专用车道上的车辆已驶入交叉口,则该车辆当前时刻允许驶入交叉口,当车辆已禁止驶入交叉口,则该车辆当前时刻未驶入交叉口,由公式(32)-(33)计算:
步骤2-15:基于“绿灯行-红灯停”的通行规则,当交叉口信号灯切换至红灯时,已驶入交叉口的车辆,继续在交叉口内通行,未驶入交叉口的车辆,则无法驶入交叉口,由公式计算(34)-(35):
实施例4:
在实施例1的基础上,所述步骤3中以交叉口所有进口车道上的车辆安全、迅速地通过交叉口为优化目标,优化获得车辆行驶轨迹,包括如下步骤:
步骤31:交叉口所有进口车道上的车辆安全、迅速地驶离交叉口,即在优化时间内,车辆位置与驶离交叉口的目标位置的距离差之和最小,优化获得车辆行驶轨迹的位置、速度及加速度,由公式计算(1):
Claims (3)
1.一种自动驾驶专用相位下的车辆轨迹优化方法,其特征在于,所述步骤如下:
步骤1:采集交叉口的物理参数,包括交叉口人工驾驶进口车道及自动驾驶专用进口车道、进出口车道数及车道宽度;采集车辆的基本信息,包括车辆当前所在进口车道、位置、速度、加速度及预计转向;采集交叉口各进口车道的信号状态;
步骤2:将交叉口划分为轨迹控制区和协调刹车区,建立车辆行驶轨迹模型和自动驾驶车辆冲突分离的协调控制模型;
步骤3:以交叉口所有进口车道上的车辆安全、迅速地通过交叉口为优化目标,优化获得车辆的行驶轨迹。
2.根据权利要求1所述的一种自动驾驶专用相位下的车辆轨迹优化方法,其特征在于,所述步骤2中包括如下步骤:
步骤2-2:基于车辆加速度的优化,确定车辆行驶轨迹的位置-速度-加速度的关系,由公式计算(1)-(2):
步骤2-3:自动驾驶专用进口车道上的车辆的加速度不小于最大减速度,且不大于最大加速度,由公式计算(3):
步骤2-4:交叉口所有进口车道上的车辆的速度不大于最大速度,由公式计算(4):
步骤2-6:人工驾驶进口车道上车辆行驶的跟车过程,受同一车道上相邻前车、后车的位置和速度的影响,车辆跟车的加速度由公式计算(9):
其中,表示表示时刻车辆的跟车加速度, 、 、 、 表示人工驾驶进口车道上车辆的跟车模型的参数,表示车辆的车身长度,表示同一车道上相邻两台人工驾驶车辆的最小安全跟车距离,表示人工驾驶车辆的紧急反应时间;
步骤2-7:在交叉口各进口车道上虚拟一台车辆,表示进口车道上的第一台车辆,其初始时刻的位置及速度由公式计算(10)-(11);当进口车道信号切换至红灯,车辆的位置及速度由公式计算(12)-(15);当进口车道信号切换至绿灯,车辆的位置及速度由公式计算(16)-(19):
步骤2-8:人工驾驶进口车道上车辆的加速度不小于最大减速度,且不大于最大加速度及车辆跟车速度,由公式计算(20):
步骤2-9:同一车道上相邻的两台车辆之间的间距不小于最小安全跟车间距与紧急反应时间内车辆行驶的路程之和,人工驾驶车辆由公式(21)计算,自动驾驶车辆由公式(22)计算;
步骤2-10:自动驾驶相位下,已驶入交叉口轨迹控制区、未驶离交叉口的自动驾驶专用进口车道上的车辆,任意时刻,须进行不同自动驾驶专用进口车道上的任意两台车辆的冲突分离的协调控制,即不同自动驾驶专用进口车道上的任意两台车辆到冲突点距离差的绝对值不小于自动驾驶车辆冲突分离的最小安全间距,由公式计算(23)-(25):
其中,和是0-1变量,表示时刻车辆已驶离交叉口,表示时刻车辆未驶离交叉口,表示时刻车辆允许驶入交叉口,表示时刻车辆禁止驶入交叉口,表示时刻车辆已驶入车辆轨迹控制区,表示时刻车辆未驶入车辆轨迹控制区,表示车辆与车辆在交叉口内行驶轨迹的冲突点位置,表示自动驾驶车辆冲突分离的最小安全间距,表示车辆在交叉口内的行驶轨迹,表示车辆与车辆在交叉口内的行驶轨迹存在冲突点,表示车辆驶离交叉口的目标位置,表示车辆所在进口车道上轨迹控制区边界线的位置;
步骤2-11:自动驾驶相位下,已驶入交叉口协调刹车区、未驶离交叉口的自动驾驶专用进口车道上的车辆,任意时刻,须进行不同进口车道上的任意两台车辆的冲突分离的协调刹车控制,即不同自动驾驶专用进口车道上的任意两台车辆到冲突点的距离差的绝对值不小于自动驾驶车辆冲突分离的最小安全间距,由公式(26)-(27)计算:
步骤2-12:自动驾驶专用相位下,已驶入交叉口协调刹车区、未驶离交叉口的自动驾驶专用进口车道上的车辆,当车辆需要刹车,则该车辆以最大减速度紧急刹车,且当前时刻无法驶入交叉口,由公式(28)-(29)计算:
步骤2-13:同一车道上,按照车辆距离停车线的远近依次驶入交叉口,由公式计算(30)-(31):
步骤2-14:当自动驾驶专用车道上的车辆已驶入交叉口,则该车辆当前时刻允许驶入交叉口,当车辆已禁止驶入交叉口,则该车辆当前时刻未驶入交叉口,由公式(32)-(33)计算:
步骤2-15:基于“绿灯行-红灯停”的通行规则,当交叉口信号灯切换至红灯时,已驶入交叉口的车辆,继续在交叉口内通行,未驶入交叉口的车辆,则无法驶入交叉口,由公式计算(34)-(35):
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202110877881.5A CN113327448B (zh) | 2021-08-02 | 2021-08-02 | 一种自动驾驶专用相位下的车辆轨迹优化方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202110877881.5A CN113327448B (zh) | 2021-08-02 | 2021-08-02 | 一种自动驾驶专用相位下的车辆轨迹优化方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN113327448A true CN113327448A (zh) | 2021-08-31 |
CN113327448B CN113327448B (zh) | 2021-10-29 |
Family
ID=77426719
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN202110877881.5A Active CN113327448B (zh) | 2021-08-02 | 2021-08-02 | 一种自动驾驶专用相位下的车辆轨迹优化方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN113327448B (zh) |
Cited By (7)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN114030355A (zh) * | 2021-11-15 | 2022-02-11 | 智己汽车科技有限公司 | 一种车辆控制方法、装置、车辆及介质 |
CN114093166A (zh) * | 2021-11-17 | 2022-02-25 | 上海交通大学 | 一种面向无信号灯岔口的集中式混合车辆协调优化方法 |
CN114495547A (zh) * | 2022-02-22 | 2022-05-13 | 北京航空航天大学 | 一种面向自动驾驶汽车的信号交叉口协同通行策略 |
CN114973733A (zh) * | 2022-04-29 | 2022-08-30 | 北京交通大学 | 一种信号交叉口处混合流下网联自动车轨迹优化控制方法 |
CN115482677A (zh) * | 2022-09-19 | 2022-12-16 | 长沙理工大学 | 一种自动驾驶交叉口的公交优先控制方法 |
CN115482663A (zh) * | 2022-09-09 | 2022-12-16 | 长沙理工大学 | 一种考虑自动驾驶专用相位的交叉口交通控制方法 |
CN115953903A (zh) * | 2023-03-14 | 2023-04-11 | 武汉理工大学 | 一种基于物联网的交叉口直行车辆连续通行方法 |
Citations (8)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP2017041038A (ja) * | 2015-08-19 | 2017-02-23 | アイシン・エィ・ダブリュ株式会社 | 経路探索システム、経路探索方法及びコンピュータプログラム |
CN107248297A (zh) * | 2017-08-01 | 2017-10-13 | 东南大学 | 一种车路协同环境下交叉口栅格化信号相位时长计算方法 |
CN108399762A (zh) * | 2018-05-08 | 2018-08-14 | 北京航空航天大学 | 一种自动驾驶和人工驾驶车辆混行条件下的交叉口通行控制方法 |
CN111710176A (zh) * | 2020-06-08 | 2020-09-25 | 同济大学 | 一种车路协同环境下交叉口信号-车辆轨迹协同控制方法 |
CN112071074A (zh) * | 2020-11-12 | 2020-12-11 | 长沙理工大学 | 一种交叉口自动驾驶车辆专用相位的设置方法 |
CN112309120A (zh) * | 2020-11-04 | 2021-02-02 | 长沙理工大学 | 一种最佳进口车道选择的自动驾驶交叉口交通控制方法 |
CN112373472A (zh) * | 2021-01-14 | 2021-02-19 | 长沙理工大学 | 一种自动驾驶交叉口车辆进入时刻与行驶轨迹控制方法 |
CN113096416A (zh) * | 2021-03-29 | 2021-07-09 | 长沙理工大学 | 用于高速公路上合流区的自动驾驶专用车道与通用车道可变限速的动态协同管控方法 |
-
2021
- 2021-08-02 CN CN202110877881.5A patent/CN113327448B/zh active Active
Patent Citations (8)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP2017041038A (ja) * | 2015-08-19 | 2017-02-23 | アイシン・エィ・ダブリュ株式会社 | 経路探索システム、経路探索方法及びコンピュータプログラム |
CN107248297A (zh) * | 2017-08-01 | 2017-10-13 | 东南大学 | 一种车路协同环境下交叉口栅格化信号相位时长计算方法 |
CN108399762A (zh) * | 2018-05-08 | 2018-08-14 | 北京航空航天大学 | 一种自动驾驶和人工驾驶车辆混行条件下的交叉口通行控制方法 |
CN111710176A (zh) * | 2020-06-08 | 2020-09-25 | 同济大学 | 一种车路协同环境下交叉口信号-车辆轨迹协同控制方法 |
CN112309120A (zh) * | 2020-11-04 | 2021-02-02 | 长沙理工大学 | 一种最佳进口车道选择的自动驾驶交叉口交通控制方法 |
CN112071074A (zh) * | 2020-11-12 | 2020-12-11 | 长沙理工大学 | 一种交叉口自动驾驶车辆专用相位的设置方法 |
CN112373472A (zh) * | 2021-01-14 | 2021-02-19 | 长沙理工大学 | 一种自动驾驶交叉口车辆进入时刻与行驶轨迹控制方法 |
CN113096416A (zh) * | 2021-03-29 | 2021-07-09 | 长沙理工大学 | 用于高速公路上合流区的自动驾驶专用车道与通用车道可变限速的动态协同管控方法 |
Non-Patent Citations (5)
Title |
---|
KEJUN LONG ET AL.: ""Predicting Freeway Travel Time Using Multiple-Source Heterogeneous Data Integration"", 《MDPI APPLIED SCIENCE》 * |
MOHSEN ET AL.: ""Capacity and Delay Analysis of Arterials with Mixed Autonomous and Human-Driven Vehicles"", 《2017 5TH IEEE INTERNATIONAL CONFERENCE ON MODELS AND TECHNOLOGIES FOR INTELLIGENT TRANSPORTATION SYSTEMS(MT-ITS)》 * |
吴伟 等: ""自动驾驶环境下面向交叉口自由转向车道的交通控制模型"", 《中国公路学报》 * |
梁猛: ""基于车路协同的交叉口控制系统设计"", 《交通科技》 * |
龙科军 等: ""城市道路干线信号协调控制与车速引导集成优化"", 《长安大学学报(自然科学版)》 * |
Cited By (11)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN114030355A (zh) * | 2021-11-15 | 2022-02-11 | 智己汽车科技有限公司 | 一种车辆控制方法、装置、车辆及介质 |
CN114093166A (zh) * | 2021-11-17 | 2022-02-25 | 上海交通大学 | 一种面向无信号灯岔口的集中式混合车辆协调优化方法 |
CN114495547A (zh) * | 2022-02-22 | 2022-05-13 | 北京航空航天大学 | 一种面向自动驾驶汽车的信号交叉口协同通行策略 |
CN114495547B (zh) * | 2022-02-22 | 2023-02-24 | 北京航空航天大学 | 一种面向自动驾驶汽车的信号交叉口协同通行方法 |
CN114973733A (zh) * | 2022-04-29 | 2022-08-30 | 北京交通大学 | 一种信号交叉口处混合流下网联自动车轨迹优化控制方法 |
CN114973733B (zh) * | 2022-04-29 | 2023-09-29 | 北京交通大学 | 一种信号交叉口处混合流下网联自动车轨迹优化控制方法 |
CN115482663A (zh) * | 2022-09-09 | 2022-12-16 | 长沙理工大学 | 一种考虑自动驾驶专用相位的交叉口交通控制方法 |
CN115482663B (zh) * | 2022-09-09 | 2023-12-19 | 长沙理工大学 | 一种考虑自动驾驶专用相位的交叉口交通控制方法 |
CN115482677A (zh) * | 2022-09-19 | 2022-12-16 | 长沙理工大学 | 一种自动驾驶交叉口的公交优先控制方法 |
CN115482677B (zh) * | 2022-09-19 | 2023-12-08 | 长沙理工大学 | 一种自动驾驶交叉口的公交优先控制方法 |
CN115953903A (zh) * | 2023-03-14 | 2023-04-11 | 武汉理工大学 | 一种基于物联网的交叉口直行车辆连续通行方法 |
Also Published As
Publication number | Publication date |
---|---|
CN113327448B (zh) | 2021-10-29 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN113327448B (zh) | 一种自动驾驶专用相位下的车辆轨迹优化方法 | |
CN112373472B (zh) | 一种自动驾驶交叉口车辆进入时刻与行驶轨迹控制方法 | |
CN112071104B (zh) | 一种考虑驾驶风格的多信号灯路口车辆通行辅助优化方法 | |
CN111325981A (zh) | 一种智能网联条件下的交叉口交通流微观控制方法 | |
CN108615387B (zh) | 一种自动驾驶下交叉口自由转向车道设置方法 | |
CN104494598B (zh) | 一种用于智能车辆的路口行驶控制方法 | |
CN108922177A (zh) | 一种无人驾驶车辆通过交叉路口时速度控制系统及方法 | |
CN107622675B (zh) | 信号交叉口可变进出口车道交通流控制方法 | |
CN106875709A (zh) | 一种基于红绿灯的车速诱导方法、系统及车辆 | |
CN111951571B (zh) | 一种交通事故下路段拥堵车辆疏导系统及方法 | |
CN113554886B (zh) | 一种车路协同交叉口车流冲突消解方法 | |
CN112309120A (zh) | 一种最佳进口车道选择的自动驾驶交叉口交通控制方法 | |
CN110910646A (zh) | 用于交叉口的无人驾驶公交车辆的协同控制方法 | |
CN111091722A (zh) | 人机混合驾驶环境下交叉口信号控制参数的优化方法 | |
CN112017439A (zh) | 一种自动驾驶交叉口行人过街摆渡车控制方法 | |
CN113140112A (zh) | 一种自动驾驶交叉口车辆冲突分离的控制方法 | |
CN111143956A (zh) | 一种基于慢行优先的彩色非机动车待行区的设计方法 | |
CN109267438A (zh) | 一种潮汐式自动驾驶brt的控制方法 | |
CN115713863A (zh) | 一种面向自动驾驶专用相位的轨迹规划与信号优化方法 | |
CN115909768A (zh) | 一种智能网联混合交通流交叉口信号协同优化方法及系统 | |
CN111833618A (zh) | 一种行人被动优先的智能信号控制方法 | |
CN108898856A (zh) | 智能城市交通优化方法与系统 | |
CN115489548A (zh) | 智能汽车园区道路路径规划方法 | |
CN114005290B (zh) | 一种交叉口左转公交车借道通行方法及其装置 | |
CN100334301C (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 |