CN113359779B - 一种考虑节能减排的自动驾驶车辆速度控制方法 - Google Patents
一种考虑节能减排的自动驾驶车辆速度控制方法 Download PDFInfo
- Publication number
- CN113359779B CN113359779B CN202110829894.5A CN202110829894A CN113359779B CN 113359779 B CN113359779 B CN 113359779B CN 202110829894 A CN202110829894 A CN 202110829894A CN 113359779 B CN113359779 B CN 113359779B
- Authority
- CN
- China
- Prior art keywords
- vehicle
- intersection
- speed
- time
- formula
- 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.)
- Active
Links
- 238000000034 method Methods 0.000 title claims abstract description 26
- 238000004134 energy conservation Methods 0.000 title claims abstract description 13
- 230000001133 acceleration Effects 0.000 claims description 35
- MWUXSHHQAYIFBG-UHFFFAOYSA-N nitrogen oxide Inorganic materials O=[N] MWUXSHHQAYIFBG-UHFFFAOYSA-N 0.000 claims description 24
- 239000000446 fuel Substances 0.000 claims description 14
- 229910002090 carbon oxide Inorganic materials 0.000 claims description 8
- 229930195733 hydrocarbon Natural products 0.000 claims description 8
- 150000002430 hydrocarbons Chemical class 0.000 claims description 8
- 239000004215 Carbon black (E152) Substances 0.000 claims description 5
- UGFAIRIUMAVXCW-UHFFFAOYSA-N Carbon monoxide Chemical class [O+]#[C-] UGFAIRIUMAVXCW-UHFFFAOYSA-N 0.000 claims description 5
- 229910052757 nitrogen Inorganic materials 0.000 claims description 4
- CURLTUGMZLYLDI-UHFFFAOYSA-N Carbon dioxide Chemical compound O=C=O CURLTUGMZLYLDI-UHFFFAOYSA-N 0.000 claims description 3
- 238000004364 calculation method Methods 0.000 abstract description 2
- 238000005265 energy consumption Methods 0.000 description 8
- 238000011160 research Methods 0.000 description 6
- OKTJSMMVPCPJKN-UHFFFAOYSA-N Carbon Chemical compound [C] OKTJSMMVPCPJKN-UHFFFAOYSA-N 0.000 description 5
- 229910052799 carbon Inorganic materials 0.000 description 5
- 238000005457 optimization Methods 0.000 description 5
- 238000005516 engineering process Methods 0.000 description 4
- 238000010586 diagram Methods 0.000 description 2
- 238000004458 analytical method Methods 0.000 description 1
- 230000009286 beneficial effect Effects 0.000 description 1
- 230000007175 bidirectional communication Effects 0.000 description 1
- 230000006854 communication Effects 0.000 description 1
- 238000004891 communication Methods 0.000 description 1
- 230000007547 defect Effects 0.000 description 1
- 238000011161 development Methods 0.000 description 1
- 230000000694 effects Effects 0.000 description 1
- 230000006855 networking Effects 0.000 description 1
- 230000035515 penetration Effects 0.000 description 1
- 230000001105 regulatory effect Effects 0.000 description 1
- 229920006395 saturated elastomer Polymers 0.000 description 1
- 238000012360 testing method Methods 0.000 description 1
Images
Classifications
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
- G05D1/00—Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
- G05D1/02—Control of position or course in two dimensions
- G05D1/021—Control of position or course in two dimensions specially adapted to land vehicles
- G05D1/0212—Control of position or course in two dimensions specially adapted to land vehicles with means for defining a desired trajectory
- G05D1/0223—Control of position or course in two dimensions specially adapted to land vehicles with means for defining a desired trajectory involving speed control of the vehicle
Landscapes
- Engineering & Computer Science (AREA)
- Aviation & Aerospace Engineering (AREA)
- Radar, Positioning & Navigation (AREA)
- Remote Sensing (AREA)
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Automation & Control Theory (AREA)
- Control Of Driving Devices And Active Controlling Of Vehicle (AREA)
Abstract
本发明公开了一种考虑节能减排的自动驾驶车辆速度控制方法,针对自动驾驶环境下的路段和交叉口,首先采集交叉口的信息、路段上车辆的信息,确定交叉口内部路径方程、计算路径上冲突点的坐标等信息;自动驾驶车辆以先到先服务的规则进入交叉口,车辆进入交叉口后计算经过路径上每个冲突点的时刻,在下一辆车进入交叉口之前,根据路径上冲突点的时刻计算下一辆车理论进入交叉口的时刻;根据理论进入时刻和车辆当前所在位置优化该车辆在路段上的行驶速度,以进入交叉口的速度最大及油耗、排放最小加权为目标函数,建立车速计算模型。本发明方法主要通过优化路段上车速以降低车辆油耗、排放,以达到节能减排的目的。
Description
技术领域
本发明属于智能交通控制领域,涉及自动驾驶车辆速度控制技术领域,更具体地说,涉及一种考虑节能减排的自动驾驶车辆速度控制方法。
背景技术
交通是能源消费和碳排放的大户,全球碳排放数据显示,2020年中国道路交通碳排放约占全球道路交通碳排放总量的四分之一,且随着经济发展水平提高,交通占能源消费的比例越来越大。交通领域节能减排的责任更加重大,任务也更加艰巨。但快速发展的智能网联汽车技术、自动驾驶等技术,为智能高效的交通创造条件,智能高效的交通有利于降低碳排放。
自动驾驶技术快速发展,如2021年4月,配备华为自动驾驶技术的汽车,在上海进行公开试乘,测试车辆的行驶情况较为平稳,在城区多种复杂场景下能实现无干预自动驾驶。相信在不远的将来,自动驾驶技术会得到普遍的应用。因此,在自动驾驶环境下,如何通过优化车辆的行驶轨迹、通过引导和调整车速,降低车辆能耗和排放,是当前需要考虑解决的问题。
现有针对车速引导的研究中,多集中在公交优先方面,如同济大学马万经等利用车路协同环境下公交车与信号机双向通信的特点,提出了公交车速与信号控制方案的协同优化方法,从而有效降低公交延误;在考虑普通车辆速度引导的研究中,大多通过车速和信号配时协同优化,以提高交叉口的通行效率,如吴伟等则从饱和交通流与非饱和交通流的运行特性出发,考虑实时流量与排队清空时间,建立车辆速度与相位差动态优化模型,实现了不停顿通过交叉口的流量最大化及延误最小化。
现有较多研究已经证明,全自动驾驶环境下无信号控制交叉口,车辆相互通信穿插通行比信号控制更高效,但在全自动驾驶环境下,针对提高交通安全和效率的研究较多,大多数研究以路段或交叉口的通行能力最大、延误最小等为目标,较少直接考虑车辆排放能源消耗等问题。因此本发明以能耗最小为目标,优化自动驾驶车辆在路段上的行驶速度,使得车辆在路段上尽可能不停车通过交叉口,车辆以先到先服务规则依次进入交叉口,根据前车的行驶轨迹和交叉口通行方案计算车辆最佳的行驶速度。
发明内容
技术问题:针对现有自动驾驶车辆控制中较少考虑节能减排研究的不足,本发明的目的是提供一种考虑节能减排的自动驾驶车辆速度控制方法,以能耗和延误加权最低为优化目标,对路段上的自动驾驶车辆车速进行优化,为每辆车计算最佳的行驶方案,尽可能实现节能减排效果。
技术方案:为解决上述技术问题,本发明的一种考虑节能减排的自动驾驶车辆速度控制方法,包括如下步骤:
步骤1:采集交叉口的信息、车辆信息,确定车辆在交叉口内部的通行路径方程,通过计算路径间冲突点坐标确定冲突点位置,计算冲突点间的距离;
步骤2:根据车辆进入交叉口的时间和速度,计算车辆经过路径上每个冲突点的时刻;
步骤3:根据所有前车经过路径上每个冲突点的时刻,计算后车理论进入交叉口的时刻;
步骤4:根据后车进入交叉口的理论时刻及理论到达交叉口的时刻,判断车辆在路段上是否必须停车,分两种情况,分别优化车辆在路段上的行驶轨迹;
步骤5:计算每辆车到达交叉口时刻、进入交叉口的速度和时刻,以车辆进入交叉口的速度最大和油耗、碳氧化物、氮氧化物、碳氢化物的总排放加权最小为目标,优化每辆车在路段和交叉口的行驶速度,其中目标函数由公式计算:
min(1-ω)·(VM-vn)+ω·∑AMOEA,n (1)
式中:ω为权重系数,取值范围为0≤ω≤1,A为中间变量,A∈{Fuel,CO,HC,NOX},其中Fuel表示油耗,CO表示碳氧化物,HC表示碳氢化物,NOX表示氮氧化物,MOEFuel,n表示车辆n的油耗,单位为mg,MOECO,n、MOEHC,n、MOENOX,n分别表示车辆n的碳氧化物、碳氢化物、氮氧化物的排放量,单位为ml,VM表示允许行驶的最大速度,vn表示车辆n进入交叉口的速度。
步骤1中,采集交叉口的信息、车辆信息,确定车辆在交叉口内部的通行路径方程,通过计算路径间冲突点坐标确定冲突点位置,计算冲突点间的距离,包括如下步骤:
步骤11:对交叉口各方向的进出口道分别编号,ldi表示交叉口d进口方向第i条车道 i∈{1,2,…,nd},d∈O,lkj表示交叉口k出口方向第j条车道j∈{nk+1,…,mk},k∈D,O、D分别表示进口方向和出口方向的集合,O,D={E,W,S,N},nd和mk分别表示d进口方向和k 出口方向的车道数,dr表示车道宽度,E,W,S,N分别表示交叉口东、西、南、北四个方向;在交叉口内部建立直角坐标系,计算自动驾驶车辆在交叉口内部的通行路径方程,对于直行路径,路径方程由点斜式公式计算,对于转弯路径方程用椭圆方程计算,路径用r表示,所有路径的集合用R表示;两条路径的交点为冲突点,通过联立两条路径方程,可求得冲突点的坐标,pi表示冲突点i,路径r上冲突点i的坐标用(xr,i,yr,i)表示,Φ表示所有冲突点的集合,pi∈Φ;路径r上冲突点pi和pi+1间的距离用Lr,pi,pi+1表示,用两点间距离公式计算;
步骤2中,根据车辆进入交叉口的时间和速度,计算车辆经过路径上每个冲突点的时刻,包括如下步骤:
步骤21:车辆实际进入交叉口的时刻用Tn′表示,进入交叉口的速度用vn表示,Φr表示路径r上冲突点的集合,车辆n经过路径r上冲突点pi的时刻用tn,r,pi表示,速度用vn,r,pi表示,Ω表示所有车辆的集合,经过路径r上第一个冲突点p1的时刻tn,r,p1和速度vn,r,p1分别由公式计算:
式中:VM表示允许行驶的最大速度,m/s,aU表示允许行驶的最大加速度,m/s2;
步骤3中,根据所有前车经过路径上每个冲突点的时刻,计算后车理论进入交叉口的时刻,包括如下步骤:
式中:Ln表示车辆n到达停车线的距离,m;Ωpi表示经过冲突点pi的车辆集合。
步骤4中,根据后车进入交叉口的理论时刻及理论到达交叉口的时刻,判断车辆在路段上是否必须停车,分两种情况,分别优化车辆在路段上的行驶轨迹,包括如下步骤:
式中:Ln表示车辆n到停车线的距离,vmin表示在路段上允许行驶的最小速度,aL表示在路段上允许行驶的最大减速度;
an,1·(Tn,2-Tn,1)=VM-vn,1 (12)
an,2·(Tn,4-Tn,3)=vn,2-vn,1 (13)
0≤an,1≤aL,0≤an,2≤aU (14)
vmin≤vn,1≤vn,2≤VM (15)
0≤Tn,1≤Tn,2≤Tn,3≤Tn,4≤Tn,5 (16)
式中:Tn,1表示车辆n以最大速度匀速行驶结束的时刻,Tn,2表示减速至vn,1的时刻,Tn,2-Tn,1阶段为以an,1减速度匀减速阶段、Tn,3表示以vn,1匀速行驶结束的时刻,Tn,3-Tn,2为以vn,1匀速行驶的阶段,Tn,4为以an,2匀加速结束的时刻,Tn,4-Tn,3阶段为以an,2加速度匀加速阶段,Tn,5表示以vn,2匀速结束的时刻,Tn,5-Tn,4为以vn,2匀速行驶的阶段;an,1表示匀减速的实际减速度,an,2表示匀加速的实际加速度,vn,1表示匀减速结束后的速度,vn,2表示不停车进入交叉口的速度;
步骤42:当车辆可以通过在路段上调节速度不停车进入交叉口时,速度由以下公式计算:
wn,1≤xn,1,wn,2≤xn,1+xn,2,wn,3≤xn,2+xn,3,wn,4≤xn,3+xn,4,wn,5≤xn,4+xn,5, wn,6≤xn,5 (19)
wn,1+wn,2+wn,3+wn,4+wn,5+wn,6=1 (20)
xn,1+xn,2+xn,3+xn,4+xn,5=1 (21)
xn,i=0 or 1(i=1,2,3,4,5) (22)
wn,i≥0(i=1,2,3,4,5,6) (23)
对于任意的t属于定义域,
t=wn,1·0+wn,2·Tn,1+wn,3·Tn,2+wn,4·Tn,3+wn,5·Tn,4+wn,6·Tn,5 (24)
可求得:
vn(t)=wn,1·VM+wn,2·VM+wn,3·vn,1+wn,4·vn,1+wn,5·vn,2+wn,6·vn,2 (25)
式中:xn,i(i=1,2,3,4,5)、wn,i(i=1,2,3,4,5,6)均为中间变量;
步骤43:当车辆可以通过在路段上调节速度不停车进入交叉口时,加速度由以下公式计算:
xn,i=0 or 1(i=6,7,8,9,10) (26)
xn,6+xn,7+xn,8+xn,9+xn,10=1 (27)
xn,6·0+xn,7·Tn,1+xn,8·Tn,2+xn,9·Tn,3+xn,10·Tn,4≤t≤xn,6·Tn,1+xn,7·Tn,2+yn,8·Tn,3+xn,9·Tn,4+xn,10·Tn,5 (28)
an(t)=xn,6·0+xn,7·an,1+xn,8·0+xn,9·an,2+xn,10·0 (29)
式中:xn,i(i=6,7,8,9,10)均为中间变量;
式中:ΩOi表示O进口方向车道i上的车辆集合,dc表示车辆长度和安全间隔之和,单位为m;
tn,1表示车辆停车后启动匀加速的时间;tn,2表示车辆停车后启动匀速行驶的时间;
an,3·(Tn,7-Tn,6)=VM-vn,3 (34)
an,4·(Tn,9-Tn,8)=vn,3 (35)
0≤an,3≤aL,0≤an,4≤aL (36)
0≤vn,3≤VM (37)
t n′=VM/aL+[Ln-jn·dc-VM 2/(2·aL)]/VM (40)
t n′表示车辆n到达队尾停车的最短行驶时间,表示车辆n到达队尾停车的最长行驶时间;vmin表示在路段上允许行驶的最小速度;Tn,6表示车辆n以最大速度VM匀速行驶结束的时刻,Tn,7表示减速至vn,3的时刻,Tn,7-Tn,6阶段为以an,3减速度匀减速阶段;Tn,8表示以vn,3匀速行驶结束的时刻,Tn,8-Tn,7为以vn,3匀速行驶的阶段,Tn,9为以an,4匀减速结束的时刻,为车辆停止的时刻,Tn,9-Tn,8阶段为以an,4加速度匀减速阶段;
步骤45:当车辆必须停车等待时,速度vn(t)由以下公式计算:
zn,1≤yn,1,zn,2≤yn,1+yn,2,zn,3≤yn,2+yn,3,zn,4≤yn,3+yn,4,zn,5≤yn,4+yn,5, zn,6≤yn,5+yn,6,zn,7≤yn,6+yn,7,zn,8≤yn,7 (42)
zn,1+zn,2+zn,3+zn,4+zn,5+zn,6+zn,7+zn,8=1 (43)
yn,1+yn,2+yn,3+yn,4+yn,5+yn,6+yn,7=1 (44)
yn,i=0 or 1(i=1,2,3,4,5,6,7) (45)
zn,i≥0(i=1,2,3,4,5,6,7,8) (46)
对于任意的t属于定义域,
可求得车辆n在t时刻的速度vn(t):
vn(t)=zn,1·VM+zn,2·VM+zn,3·vn,3+zn,4·vn,3+zn,5·0+zn,6·0+zn,7·tn,1·aU+zn,8·vn,4 (48)
式中:yn,i(i=1,2,3,4,5,6,7)、zn,i(i=1,2,3,4,5,6,7,8)均为中间变量,vn(t)表示任一t时刻车辆n的速度;vn,4表示停车后启动进入交叉口的速度;
步骤46:当车辆必须停车等待时,加速度an(t)由以下公式计算:
un,i=0 or 1(i=1,2,3,4,5,6,7) (49)
un,1+un,2+un,3+un,4+un,5+un,6+un,7=1 (50)
an(t)=un,1·0+un,2·an,3+un,3·0+un,4·an,4+un,5·0+un,6·aU+un,7·0 (52)
式中:un,i(i=1,2,3,4,5,6,7)均为中间变量,an(t)表示任一t时刻车辆n的加速度。
步骤5中,计算车辆n进入交叉口的速度、确定速度加速度和油耗关系,包括如下步骤:
步骤51:计算每辆车到达交叉口时刻、进入交叉口的速度和时刻;
进入交叉口的速度由公式计算:
vn=μn·vn,2+(1-μn)·vn,4 (53)
车辆实际进入交叉口的时刻由公式计算:
速度加速度和油耗关系由公式计算:
式中:A为中间变量,A∈{Fuel,CO,HC,NOX},MOEFuel,n表示车辆n的油耗,单位为mg,MOECO,n、MOEHC,n、MOENOX,n分别表示车辆n的碳氧化物、碳氢化物、氮氧化物排放量,单位为ml,表示加速时速度i次方和加速度j次方的回归系数;表示减速时速度i次方和加速度j次方的回归系数,vn(t)表示任一t时刻车辆n的速度,an(t)表示任一t时刻车辆n 的加速度。
有益效果:本发明与现有技术相比,具有以下优点:
本发明在自动驾驶环境下,主要以车辆能耗最小为目标优化车辆在路段上的行驶速度,尽可能保证车辆在路段上不停车通过交叉口,在降低能耗的同时也可以降低停车次数,车辆按先到先服务的通行次序依次进入交叉口,通过行驶路径确定冲突点,车辆经过每个冲突点后记录经过的时刻,对于同一个冲突点,后车经过时刻大于前车经过的时刻,以此可以确保车辆在交叉口内的行车安全。本发明能为自动驾驶车辆速度控制提供有效的技术支持。
附图说明
图1为本发明方法的流程图;
图2为本发明方法的研究对象示意图;
图3车辆不停车情况下在路段上行驶的s-t图;
图4车辆必须停车情况下在路段上行驶的v-t图;
图5为本发明方法的实施例示意图。
具体实施方式
结合附图和实施例,对本发明技术方案详细说明如下:
图1为本发明方法的流程图;
图2为本发明专利的研究对象交叉口示意图,表示了东、西、南、北四个方向的进、出口道车道编号;
图3为当时,可以通过调节车辆在路段上的行驶速度,不停车在时间后进入交叉口,Tn,1表示车辆n以最大速度匀速行驶结束的时刻,Tn,2表示减速至vn,1的时刻,即Tn,2-Tn,1阶段为以an,1减速度匀减速阶段、Tn,3表示以vn,1匀速行驶结束的时刻,即Tn,3-Tn,2为以vn,1匀速行驶的阶段,Tn,4为以an,2匀加速结束的时刻,即Tn,4-Tn,3阶段为以an,2加速度匀加速阶段,Tn,5表示以vn,2匀速结束的时刻,即Tn,5-Tn,4为以vn,2匀速行驶的阶段;
图4为当时,表示车辆以最小速度不停车行驶到关键冲突点仍然不能通过,此时车辆必须停车等待,Tn,6表示车辆n以最大速度VM匀速行驶结束的时刻,Tn,6-0阶段为以VM匀速行驶阶段,Tn,7表示减速至vn,3的时刻,即Tn,7-Tn,6阶段为以an,3减速度匀减速阶段;Tn,8表示以vn,3匀速行驶结束的时刻,即Tn,8-Tn,7为以vn,3匀速行驶的阶段,Tn,9为以an,4匀减速结束的时刻,为车辆停止的时刻,Tn,9-Tn,8阶段为以an,4加速度匀减速阶段,tn,1为车辆停车后启动匀加速的时间段;tn,2为车辆停车后启动匀速行驶的时间段,车辆在时刻进入交叉口;
图5为本发明方法的实施例示意图,图中描述了52个冲突点的位置。
根据说明书步骤1,采集交叉口的信息、车辆信息,确定车辆在交叉口内部的行驶轨迹方程,计算冲突点坐标,并计算冲突点间的距离,确定交叉口每条路径上冲突点的编号如表1所示:
表1路径对应编号及经过冲突点汇总表
路径 | 路径编号 | 路径经过冲突点编号 | 路径 | 路径编号 | 路径经过冲突点编号 |
E1S4 | 1 | 1,38,35,34,27,26,19 | W1N4 | 9 | 7,30,31,33,41,43,49 |
E2W5 | 2 | 2,45,44,42,41,40,39 | W2E5 | 10 | 8,23,24,25,27,28,29, |
E3W6 | 3 | 3,51,50,49,48,47,46,15 | W3E6 | 11 | 9,17,18,19,20,21,22,13 |
E3N6 | 4 | 3,14 | W3S6 | 12 | 9,16 |
N1E4 | 5 | 4,48,43,42,52,35,36 | S1W4 | 13 | 10,20,26,25,32,31,37 |
N2S5 | 6 | 5,47,40,33,32,24,18, | S2N5 | 14 | 11,21,28,34,52,44,50 |
N3S6 | 7 | 6,46,39,37,30,23,17,16 | S3N6 | 15 | 12,22,29,36,38,45,51,14 |
N3W6 | 8 | 6,15 | S3E6 | 16 | 12,13 |
以东方向左转为例,根据步骤1计算路径1经过冲突点的坐标和距离,如表2所示:
表2路径1上冲突点的坐标及到停车线的距离
冲突点编号 | 坐标 | 到停车线的距离(m) |
1 | (13,1.75) | 0 |
38 | (8.75,1.124446892) | 4.31 |
35 | (6.031320068,0) | 7.26 |
34 | (5.25,-0.450099602) | 8.16 |
27 | (0.450099602,-5.25) | 15.01 |
26 | (0,-6.031320068) | 15.91 |
19 | (-1.124446892,-8.75) | 18.86 |
选取某一时刻交叉口各方向进口道150m范围内的车辆,车辆信息如表3所示:
表3车辆位置信息表
根据论文《Nonlinear brake control for vehicle CW/CA systems》研究,驾驶员接受的最大加速度2.5m/s2,因此取最大加速度为2.5m/s2,即aU=2.5m/s2,最大减速度aL=3m/s2。车辆在路段和交叉口内行驶的最大速度VM=60km/h=16.7m/s,最小行驶速度vmin= 20km/h=2.78m/s,车辆长度和安全间隔之和dc=6m。
取权重ω=0.1,根据公式(2)-(60)约束条件和公式(1)的目标函数,求解得50辆车的最佳行驶方案如表5所示,在最佳行驶方案下每辆车的油耗、排放以及离开交叉口的时刻如表6所示:
表5计算结果表
由公式(54)可知vn,2为车辆进入交叉口的速度,由于车辆均不需要在交叉口处停车,由公式(55)可知,车辆实际进入交叉口的时刻Tn′=Tn,5。
以表5为例进行分析可知,1-15辆车vn,1=vn,2均为16.7m/s说明车辆没有调整车速就可以安全通过交叉口,第16辆车从当前时刻开始立即以2.07m/s2的减速度减速行驶,花费2s时间减速到12.57m/s,以12.57m/s的速度匀速行驶3s-2s=1s,再以2.07m/s2的加速度加速2s,速度恢复到最大速度16.7m/s,匀速行驶5.31s-5.0s=0.31s,进入交叉口。车辆16经过交叉口冲突点分别是12,22,29,36,38,45,51,14,经过每个冲突点的时刻tn,r,pi依次是,t16,15,12= 5.31s、t16,15,12=5.56s、t16,15,29=5.77s、t16,15,36=6.03s、t16,15,38=6.14s、t16,15,45=6.40s、 t16,15,51=6.61s、t16,15,14=6.87s。在本发明中对第一辆车开始优化的时刻为0时刻,所有时刻基于该0时刻计算。
表6油耗、排放及离开交叉口的时间
Claims (3)
1.一种考虑节能减排的自动驾驶车辆速度控制方法,其特征在于,该方法包括如下步骤:
步骤1:采集交叉口的信息、车辆信息,确定车辆在交叉口内部的通行路径方程,通过计算路径间冲突点坐标确定冲突点位置,计算冲突点间的距离;
步骤2:根据车辆进入交叉口的时间和速度,计算车辆经过路径上每个冲突点的时刻;
步骤3:根据所有前车经过路径上每个冲突点的时刻,计算后车理论进入交叉口的时刻;
步骤4:根据后车进入交叉口的理论时刻及理论到达交叉口的时刻,判断车辆在路段上是否必须停车,分两种情况,分别优化车辆在路段上的行驶轨迹;
步骤5:计算每辆车到达交叉口时刻、进入交叉口的速度和时刻,以车辆进入交叉口的速度最大和油耗、碳氧化物、氮氧化物、碳氢化物的总排放加权最小为目标,优化每辆车在路段和交叉口的行驶速度,其中目标函数由公式计算:
min(1-ω)·(VM-vn)+ω·∑AMOEA,n (1)
式中:ω为权重系数,取值范围为0≤ω≤1,A为中间变量,A∈{Fuel,CO,HC,NOX},其中Fuel表示油耗,CO表示碳氧化物,HC表示碳氢化物,NOX表示氮氧化物,MOEFuel,n表示车辆n的油耗,单位为mg,MOECO,n、MOEHC,n、MOENOX,n分别表示车辆n的碳氧化物、碳氢化物、氮氧化物的排放量,单位为ml,VM表示允许行驶的最大速度,vn表示车辆n进入交叉口的速度;
所述步骤4,根据后车进入交叉口的理论时刻及理论到达交叉口的时刻,判断车辆在路段上是否必须停车,分两种情况,分别优化车辆在路段上的行驶轨迹,包括如下步骤:
式中:Ω表示所有车辆的集合,Ln表示车辆n到停车线的距离,vmin表示在路段上允许行驶的最小速度,aL表示在路段上允许行驶的最大减速度;
an,1·(Tn,2-Tn,1)=VM-vn,1 (12)
an,2·(Tn,4-Tn,3)=vn,2-vn,1 (13)
0≤an,1≤aL,0≤an,2≤aU (14)
vmin≤vn,1≤vn,2≤VM (15)
0≤Tn,1≤Tn,2≤Tn,3≤Tn,4≤Tn,5 (16)
式中:aU表示允许行驶的最大加速度,m/s2,Tn,1表示车辆n以最大速度匀速行驶结束的时刻,Tn,2表示减速至vn,1的时刻,Tn,2-Tn,1阶段为以an,1减速度匀减速阶段、Tn,3表示以vn,1匀速行驶结束的时刻,Tn,3-Tn,2为以vn,1匀速行驶的阶段,Tn,4为以an,2匀加速结束的时刻,Tn,4-Tn,3阶段为以an,2加速度匀加速阶段,Tn,5表示以vn,2匀速结束的时刻,Tn,5-Tn,4为以vn,2匀速行驶的阶段;an,1表示匀减速的实际减速度,an,2表示匀加速的实际加速度,vn,1表示匀减速结束后的速度,vn,2表示不停车进入交叉口的速度;
步骤42:当车辆可以通过在路段上调节速度不停车进入交叉口时,速度由以下公式计算:
wn,1≤xn,1,wn,2≤xn,1+xn,2,wn,3≤xn,2+xn,3,wn,4≤xn,3+xn,4,wn,5≤xn,4+xn,5,wn,6≤xn,5
(19)
wn,1+wn,2+wn,3+wn,4+wn,5+wn,6=1 (20)
xn,1+xn,2+xn,3+xn,4+xn,5=1 (21)
xn,i=0 or 1;i=1,2,3,4,5 (22)
wn,i≥0;i=1,2,3,4,5,6 (23)
对于任意的t属于定义域,
t=wn,1·0+wn,2·Tn,1+wn,3·Tn,2+wn,4·Tn,3+wn,5·Tn,4+wn,6·Tn,5 (24)
可求得:
vn(t)=wn,1·VM+wn,2·VM+wn,3·vn,1+wn,4·vn,1+wn,5·vn,2+wn,6·vn,2 (25)
式中:xn,i,i=1,2,3,4,5;wn,i,i=1,2,3,4,5,6均为中间变量;
步骤43:当车辆可以通过在路段上调节速度不停车进入交叉口时,加速度由以下公式计算:
xn,i=0 or 1;i=6,7,8,9,10 (26)
xn,6+xn,7+xn,8+xn,9+xn,10=1 (27)
xn,6·0+xn,7·Tn,1+xn,8·Tn,2+xn,9·Tn,3+xn,10·Tn,4≤t≤xn,6·Tn,1+xn,7·Tn,2+yn,8·Tn,3+xn,9·Tn,4+xn,10·Tn,5 (28)
an(t)=xn,6·0+xn,7·an,1+xn,8·0+xn,9·an,2+xn,10·0 (29)
式中:xn,i,i=6,7,8,9,10均为中间变量;
式中:ΩOi表示O进口方向车道i上的车辆集合,dc表示车辆长度和安全间隔之和,单位为m;
tn,1表示车辆停车后启动匀加速的时间;tn,2表示车辆停车后启动匀速行驶的时间;
an,3·(Tn,7-Tn,6)=VM-vn,3 (34)
an,4·(Tn,9-Tn,8)=vn,3 (35)
0≤an,3≤aL,0≤an,4≤aL (36)
0≤vn,3≤VM (37)
t n′=VM/aL+[Ln-jn·dc-VM 2/(2·aL)]/VM (40)
t n′表示车辆n到达队尾停车的最短行驶时间,表示车辆n到达队尾停车的最长行驶时间;vmin表示在路段上允许行驶的最小速度;Tn,6表示车辆n以最大速度VM匀速行驶结束的时刻,Tn,7表示减速至vn,3的时刻,Tn,7-Tn,6阶段为以an,3减速度匀减速阶段;Tn,8表示以vn,3匀速行驶结束的时刻,Tn,8-Tn,7为以vn,3匀速行驶的阶段,Tn,9为以an,4匀减速结束的时刻,为车辆停止的时刻,Tn,9-Tn,8阶段为以an,4加速度匀减速阶段;
步骤45:当车辆必须停车等待时,速度vn(t)由以下公式计算:
zn,1≤yn,1,zn,2≤yn,1+yn,2,zn,3≤yn,2+yn,3,zn,4≤yn,3+yn,4,zn,5≤yn,4+yn,5,zn,6≤yn,5+yn,6,zn,7≤yn,6+yn,7,zn,8≤yn,7 (42)
zn,1+zn,2+zn,3+zn,4+zn,5+zn,6+zn,7+zn,8=1 (43)
yn,1+yn,2+yn,3+yn,4+yn,5+yn,6+yn,7=1 (44)
yn,i=0 or 1;i=1,2,3,4,5,6,7 (45)
zn,i≥0;i=1,2,3,4,5,6,7,8 (46)
对于任意的t属于定义域,
可求得车辆n在t时刻的速度vn(t):
vn(t)=zn,1·VM+zn,2·VM+zn,3·vn,3+zn,4·vn,3+zn,5·0+zn,6·0+zn,7·tn,1·aU+zn,8·vn,4(48)
式中:yn,i, i=1,2,3,4,5,6,7; zn,i, i=1,2,3,4,5,6,7,8均为中间变量,vn(t)表示任一t时刻车辆n的速度;vn,4表示停车后启动进入交叉口的速度;
步骤46:当车辆必须停车等待时,加速度an(t)由以下公式计算:
un,i=0 or 1;i=1,2,3,4,5,6,7 (49)
un,1+un,2+un,3+un,4+un,5+un,6+un,7=1 (50)
an(t)=un,1·0+un,2·an,3+un,3·0+un,4·an,4+un,5·0+un,6·aU+un,7·0 (52)
式中:un,i,i=1,2,3,4,5,6,7均为中间变量,an(t)表示任一t时刻车辆n的加速度。
2.根据权利要求1所述的一种考虑节能减排的自动驾驶车辆速度控制方法,其特征在于,所述步骤1中的采集交叉口的信息、车辆信息,确定车辆在交叉口内部的通行路径方程,通过计算路径间冲突点坐标确定冲突点位置,计算冲突点间的距离,包括如下步骤:
步骤11:对交叉口各方向的进出口道分别编号,ldi表示交叉口d进口方向第i条车道i∈{1,2,…,nd},d∈O,lkj表示交叉口k出口方向第j条车道j∈{nk+1,…,mk},k∈D,O、D分别表示进口方向和出口方向的集合,O,D={E,W,S,N},nd和mk分别表示d进口方向和k出口方向的车道数,dr表示车道宽度,E,W,S,N分别表示交叉口东、西、南、北四个方向;在交叉口内部建立直角坐标系,计算自动驾驶车辆在交叉口内部的通行路径方程,对于直行路径,路径方程由点斜式公式计算,对于转弯路径方程用椭圆方程计算,路径用r表示,所有路径的集合用R表示;两条路径的交点为冲突点,通过联立两条路径方程,可求得冲突点的坐标,pi表示冲突点i,路径r上冲突点i的坐标用(xr,i,yr,i)表示,Φ表示所有冲突点的集合,pi∈Φ;路径r上冲突点pi和pi+1间的距离用Lr,pi,pi+1表示,用两点间距离公式计算;
所述步骤2中,根据车辆进入交叉口的时间和速度,计算车辆经过路径上每个冲突点的时刻,包括如下步骤:
步骤21:车辆实际进入交叉口的时刻用Tn′表示,进入交叉口的速度用vn表示,Φr表示路径r上冲突点的集合,车辆n经过路径r上冲突点pi的时刻用tn,r,pi表示,速度用vn,r,pi表示,Ω表示所有车辆的集合,经过路径r上第一个冲突点p1的时刻tn,r,p1和速度vn,r,p1分别由公式计算:
式中:VM表示允许行驶的最大速度,m/s,aU表示允许行驶的最大加速度,m/s2;
所述步骤3中,根据所有前车经过路径上每个冲突点的时刻,计算后车理论进入交叉口的时刻,包括如下步骤:
式中:Ln表示车辆n到达停车线的距离,m;Ωpi表示经过冲突点pi的车辆集合。
3.根据权利要求1所述的一种考虑节能减排的自动驾驶车辆速度控制方法,其特征在于,所述步骤5中计算车辆n进入交叉口的速度、确定速度加速度和油耗关系,包括如下步骤:
步骤51:计算每辆车到达交叉口时刻、进入交叉口的速度和时刻;
进入交叉口的速度由公式计算:
vn=μn·vn,2+(1-μn)·vn,4 (53)
车辆实际进入交叉口的时刻由公式计算:
速度加速度和油耗关系由公式计算:
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202110829894.5A CN113359779B (zh) | 2021-07-22 | 2021-07-22 | 一种考虑节能减排的自动驾驶车辆速度控制方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202110829894.5A CN113359779B (zh) | 2021-07-22 | 2021-07-22 | 一种考虑节能减排的自动驾驶车辆速度控制方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN113359779A CN113359779A (zh) | 2021-09-07 |
CN113359779B true CN113359779B (zh) | 2022-06-28 |
Family
ID=77540105
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN202110829894.5A Active CN113359779B (zh) | 2021-07-22 | 2021-07-22 | 一种考虑节能减排的自动驾驶车辆速度控制方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN113359779B (zh) |
Families Citing this family (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN115620536A (zh) * | 2022-10-18 | 2023-01-17 | 北京航空航天大学 | 自动驾驶环境下基于危险度的交叉口通行效率提升方法 |
Citations (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP2008302849A (ja) * | 2007-06-08 | 2008-12-18 | Sumitomo Electric Ind Ltd | 車両運転支援システム、運転支援装置、車両及び車両運転支援方法 |
JP2009223353A (ja) * | 2008-03-13 | 2009-10-01 | Masahiro Watanabe | 交差点無停止走行制御システム |
CN108961784A (zh) * | 2018-06-11 | 2018-12-07 | 江苏济通智慧科技有限公司 | 一种自动驾驶下车速与交叉口信号双向控制方法 |
Family Cites Families (9)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP2000045818A (ja) * | 1998-07-29 | 2000-02-15 | Hitachi Eng Co Ltd | 道路車両の広域運転制御方法及び運転制御装置 |
US8255152B2 (en) * | 2008-09-24 | 2012-08-28 | The Regents Of The University Of California | Environmentally friendly driving navigation |
US9645577B1 (en) * | 2016-03-23 | 2017-05-09 | nuTonomy Inc. | Facilitating vehicle driving and self-driving |
WO2020036607A1 (en) * | 2018-08-17 | 2020-02-20 | Google Llc | Reducing vehicular congestion at an intersection |
CN110329258B (zh) * | 2019-07-23 | 2021-04-30 | 吉林大学 | 智能驾驶汽车节能减排协调控制方法 |
CN111710176B (zh) * | 2020-06-08 | 2021-11-09 | 同济大学 | 一种车路协同环境下交叉口信号-车辆轨迹协同控制方法 |
CN112837534B (zh) * | 2021-01-12 | 2022-07-22 | 同济大学 | 一种智能网联车环境下多车道环岛车辆协同控制方法 |
CN112356836B (zh) * | 2021-01-14 | 2021-03-30 | 长沙理工大学 | 一种保障自动驾驶交叉口通行安全的关键冲突点确定方法 |
CN112373472B (zh) * | 2021-01-14 | 2021-04-20 | 长沙理工大学 | 一种自动驾驶交叉口车辆进入时刻与行驶轨迹控制方法 |
-
2021
- 2021-07-22 CN CN202110829894.5A patent/CN113359779B/zh active Active
Patent Citations (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP2008302849A (ja) * | 2007-06-08 | 2008-12-18 | Sumitomo Electric Ind Ltd | 車両運転支援システム、運転支援装置、車両及び車両運転支援方法 |
JP2009223353A (ja) * | 2008-03-13 | 2009-10-01 | Masahiro Watanabe | 交差点無停止走行制御システム |
CN108961784A (zh) * | 2018-06-11 | 2018-12-07 | 江苏济通智慧科技有限公司 | 一种自动驾驶下车速与交叉口信号双向控制方法 |
Also Published As
Publication number | Publication date |
---|---|
CN113359779A (zh) | 2021-09-07 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN112373472B (zh) | 一种自动驾驶交叉口车辆进入时刻与行驶轨迹控制方法 | |
CN106997690B (zh) | 一种车联网环境下高速公路车辆非强制换道控制方法 | |
WO2021227502A1 (zh) | 一种信号交叉***通信号灯和车辆轨迹控制方法 | |
CN110450825B (zh) | 城市轨道交通列车运行控制方法 | |
CN111445692B (zh) | 一种无信号灯路口智能网联汽车的速度协同优化方法 | |
CN105035090B (zh) | 基于交通信号灯的自主驾驶车辆轨迹预测控制方法 | |
CN104794915B (zh) | 一种连续交叉路口车辆通行控制方法及装置 | |
CN108986488B (zh) | 一种车车通信环境下匝道汇入协同轨迹确定方法及设备 | |
CN110910646B (zh) | 用于交叉口的无人驾驶公交车辆的协同控制方法 | |
CN108986471A (zh) | 混合交通条件下交叉口车辆引导方法 | |
CN111341152B (zh) | 考虑待行队列与安全避撞的网联汽车绿色通行***与方法 | |
CN109493593B (zh) | 一种考虑舒适度的公交运行轨迹优化方法 | |
CN107016858A (zh) | 一种交叉口多流向候驶区和错位式停车线的预信号控制方法 | |
CN111325967A (zh) | 一种基于协同指派的智能网联汽车编队控制方法和装置 | |
CN112652179B (zh) | 车路协同环境下公交优先通行信号控制方法及*** | |
CN110838229A (zh) | 一种车辆队列编队方法 | |
CN113257007B (zh) | 交叉口共享自动驾驶车道的信号控制方法及*** | |
CN107215333B (zh) | 一种采用滑行模式的经济性协同自适应巡航策略 | |
CN112767715B (zh) | 一种交叉路***通信号灯与智能网联汽车的协同控制方法 | |
CN113359779B (zh) | 一种考虑节能减排的自动驾驶车辆速度控制方法 | |
CN106875700A (zh) | 一种消除起动损失时间的进口道设计与信号优化方法 | |
CN115565390B (zh) | 智能网联汽车多车道队列通行控制方法、***及计算机可读存储介质 | |
CN113312752A (zh) | 一种主路优先控制交叉***通仿真方法及装置 | |
CN111537236B (zh) | 一种交通拥堵辅助***测试方法 | |
CN113628459A (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 |