一种自动驾驶环境下交叉口行人过街摆渡车行驶通道的设置方法转让专利
申请号 : CN202011129793.9
文献号 : CN112258861B
文献日 : 2021-09-28
发明人 : 吴伟 , 刘洋 , 龙科军 , 郝威
申请人 : 长沙理工大学
摘要 :
权利要求 :
1.一种自动驾驶环境下交叉口行人过街摆渡车行驶通道的设置方法,其特征在于,该方法包括如下步骤:
步骤1:确定交叉口的基本信息,包括交叉口的大小、车道数及车道宽度,确定行人过街摆渡车的信息、包括:车辆大小、车辆的容量、车辆的运行参数,确定行人过街摆渡车的停靠位置的数量和大小,并规定行驶区域,设置行人过街摆渡车在交叉口区域的行驶通道;
步骤2:在交叉口内部建立直角坐标系,在步骤1确定的行驶通道下,通过确定路径的边界方程来确定停靠节点之间行人过街摆渡车的行驶路径方程;
步骤3:根据交叉口和行人摆渡车基本信息,计算行人过街摆渡车在各行驶路径上的行驶时间;
步骤4:根据行人过街需求量、行人过街摆渡车在各行驶路径上的行驶时间,确定每辆行人过街摆渡车在交叉口的具体控制方案;
所述步骤1中,包含如下步骤:
步骤11:对交叉口进口车道、出口车道进行编号,表示O方向第i条进口车道,其中O表示交叉口的进口方向,O={E、W、S、N},其中E、W、S、N分别表示东、西、南、北四个方向,i∈m,表示D方向第j条出口车道,其中D表示交叉口的出口方向,D={E、W、S、N},j∈m,m表示O、D方向的车道总数,用 分别表示车道 和 的宽度,单位为米;
行人过街摆渡车的容量,用C表示,单位为人/辆;行人过街摆渡车开关门的时间用F表示,单位为秒,单位人数上车、下车时间分别用δt和δt′表示,单位为秒,行人摆渡车停靠点的长和宽分别用a和b表示,车辆的长和宽分别用a′和b′表示,单位均为米,行人摆渡车的理论+ ‑
最大行驶速度用v表示,单位为米每秒,摆渡车运行的加速度和减速度分别用a 和a 表示,单位为米每二次方秒;
步骤12:行人过街摆渡车在交叉口的东北、东南、西北、西南四个角落停靠,分别用E‑N、E‑S、W‑N、W‑S表示,其中每个位置包含3个停靠点,行人过街摆渡车在停靠点出发或到达,每个停靠点最多可停靠1辆行人过街摆渡车;出发节点的集合用Op表示,其中Op={1,2,3,4,5,
6,7,8,9,10,11,12},终止节点集合的用Dp表示,其中Dp={13,14,15,16,17,18,19,20,21,
22,23,24},为避免行人过街摆渡车相互之间不必要的冲突,当行人过街摆渡车从1、4、7、10停靠点出发时,行人过街摆渡车只在1、4、7、10、13、14、15、16节点组成的白色区域运行;从
2、5、8、11停靠点出发时,只在2、5、8、11、17、18、19、20节点组成的灰色区域运行;从3、6、9、
12停靠点出发时,只在3、6、9、12、21、22、23、24节点组成的灰色区域运行,此外,行人过街摆渡车可以在同一个角落的三个停靠点之间相互运行;节点1、2、3、16、19、22位于交叉口的西北角落,其中节点1、节点2、节点3依次是由北向西的第一、第二、第三个停靠点,节点1和节点16、节点2和节点19、节点3和节点22在同一个位置,分别表示出发节点和到达节点;节点
4、5、6、13、20、23位于交叉口的东北角落,其中节点4、节点5、节点6依次是由北向东的第一、第二、第三个停靠点,节点4和节点13、节点5和节点20、节点6和节点23在同一个位置,分别表示出发节点和到达节点;节点7、8、9、14、17、24位于交叉口的东南角落,其中节点7、节点
8、节点9依次是由南向东的第一、第二、第三个停靠点,节点7和节点14、节点8和节点17、节点9和节点24在同一个位置,分别表示出发节点和到达节点;节点10、11、12、15、18、21位于交叉口的西南角落,其中节点10、节点11、节点12依次是由南向西的第一、第二、第三个停靠点,节点10和节点15、节点11和节点18、节点12和节点21在同一个位置,分别表示出发节点和到达节点;
所述步骤2中,包含如下步骤:
步骤21:以交叉口中心点为原点,在交叉口内部建立直角坐标系,根据各方向车道宽度确定坐标轴的刻度,规定行人摆渡车向x、y轴正方向行驶时,路径的左边边界为外边界,右边边界为内边界,ε为二元变量,当边界为外边界时,ε=1,当边界为内边界时,ε=0;在东西方向上,节点1→节点13表示节点1到节点13的路径;节点1→节点13、节点4→节点16的路径,在交叉口区域运行路径的边界方程如公式(1)所示:ξp,q表示节点p到节点q路径上,节点p与最外侧车道的距离,其中p∈Op,q∈Dq,单位为米,
节点2→节点20、节点5→节点19的路径,在交叉口区域运行路径的边界方程如公式(2)所示:
节点3→节点23、节点6→节点22的路径,在交叉口区域运行路径的下边界方程如公式(3)所示:
节点7→节点15、节点10→节点14的路径,在交叉口区域运行路径的边界方程如公式(4)所示:
节点8→节点18、节点11→节点17的路径,在交叉口区域运行路径的边界方程如公式(5)所示:
节点9→节点21、节点12→节点24的路径,在交叉口区域运行路径的边界方程如公式(6)所示:
步骤22:在南北方向上,节点1→节点15、10→节点16的路径,在交叉口区域运行路径的边界方程如公式(7)所示:
节点2→节点18、节点11→节点19的路径,在交叉口区域运行路径的边界方程如公式(8)所示:
节点3→节点21、节点12→节点22的路径,在交叉口区域运行路径的边界方程如公式(9)所示:
节点4→节点14、节点7→节点13的路径,在交叉口区域运行路径的边界方程如公式(10)所示:
节点5→节点17、节点8→节点20的路径,在交叉口区域运行路径的边界方程如公式(11)所示:
节点6→节点24、节点9→节点23的路径,在交叉口区域运行路径的边界方程如公式(12)所示:
步骤23:行人过街摆渡车可以在交叉口对角线行驶,节点1→节点14、节点7→节点16的路径,驶入点和驶出点的坐标分别如公式(13)、(14)所示:节点2→节点17、节点8→节点19的路径,驶入点和驶出点的坐标分别如公式(15)、(16)所示:
节点3→节点24、节点9→节点22的路径,驶入点和驶出点的坐标分别如公式(17)、(18)所示:
节点4→节点15、节点10→节点13的路径,驶入点和驶出点的坐标分别如公式(19)、(20)所示:
节点5→节点18、节点11→节点20的路径,驶入点和驶出点的坐标分别如公式(21)、(22)所示:
节点6→节点21、节点12→节点23的路径,驶入点和驶出点的坐标分别如公式(23)、(24)所示:
通过点斜式方程确定路径边界方程,分别相应的中间变量x1、y1、x2、y2代入公式(25),可求得对应的路径边界方程:
式中,x1、y1、x2、y2均为中间变量;
包含如下步骤:
步骤31:从出发节点p到终止节点q的距离用Lp,q表示,当行驶路径与坐标轴平行时,用公式(26)计算节点之间的距离:当p∈{1,2,3},q∈{13,20,23}或p∈{4,5,6},q∈{16,19,22}时,式(26)中O和D取N方向;当p∈{1,2,3},q∈{15,18,21}或p∈{10,11,12},q∈{16,19,22}时,公式(26)中O和D取W方向;当p∈{4,5,6},q∈{14,17,24}或p∈{7,8,9},q∈{13,20,23}时,公式(26)中O和D取E方向;当p∈{10,11,12},q∈{14,17,24}或p∈{7,8,9},q∈{15,18,21}时,公式(26)中O和D取S方向;
行人过街摆渡车可以在交叉口对角线行驶,当路径为 时,即p∈{1,2,
3},q∈{14,17,24}或p∈{7,8,9},q∈{16,19,22}时,通过公式(27)计算斜线距离:当路径为斜线 时,即p∈{4,5,6},q∈{15,18,21}或p∈{10,11,12},q∈{13,20,23}时,通过公式(28)计算斜线的距离:步骤32:当行人过街摆渡车出发节点p到终止节点q的距离Lp,q较小时,行人过街摆渡车实际行驶的最大速度达不到预定的匀速行驶速度,这种情况下没有匀速行驶阶段,行人过街摆渡车在节点i和节点j之间的行驶距离Lij由两部分组成,如公式(29)所示;
公式(29)中,l1表示匀加速行驶的距离,由公式(30)计算;l2表示匀减速行驶的距离,由公式(31)计算;
+ ‑
公式(30)和(31)中,a、a 分别表示行人过街摆渡车匀加速阶段、减速阶段的加速度大小,单位为米每二次方秒,t1表示匀加速阶段花费的时间,t2表示匀减速阶段花费的时间,单‑
位为米每秒;v表示行人摆渡车实际行驶的最大速度,单位为米每秒,由公式(32)计算;
‑ +
v=a·t1 (32)在没有匀速行驶的情况下,行人过街摆渡车在节点p和q之间行驶的时间用tp,q表示,由公式(33)计算;
步骤33:当有匀速行驶阶段时,行人过街摆渡车在节点p和q之间的行驶距离Lp,q由三阶段组成,即匀加速阶段、匀速阶段和匀减速阶段,如公式(34)所示;
公式中l3、l4和l5分别表示匀加速阶段、匀速阶段和匀减速阶段行驶的距离,分别由公式(35)‑(37)计算;
l4=v·t4 (36)公式(35)‑(37)中,t3、t4和t5分别表示行驶l3、l4和l5距离所用的时间,单位为秒;v表示规定的最大匀速,由公式(38)和(39)表示;
+
v=a·t3 (38)
‑
v=a·t5 (39)
在有匀速行驶阶段的情况下,行人过街摆渡车在节点p和q之间行驶的时间用tp,q表示,由公式(40)计算;
所述步骤4:根据行人过街需求量、行人过街摆渡车在各行驶路径上的行驶时间,确定每辆行人过街摆渡车在交叉口的具体行驶路径的方法,包括如下步骤:步骤41:行人过街摆渡车从节点p到q的路径用rp,q表示,rp,q为二元决策变量,rp,q∈{0,
1},当rp,q=1表示在该路径通行,否则未在该路径上通行,rp,q满足公式(41)约束:行人过街摆渡车到达节点p的时刻用Tp表示,离开节点p的时刻用tp表示,当行人过街摆渡车从到达节点p到离开节点p的时刻,由公式(42)计算:tp=Tp+F+dq·δt+d′q·δ′t (42)公式(42)中F表示行人过街摆渡车开关门的时间,dq、d′q分别表示在节点p处上客、下客人数,δt、δ′t分别表示单位人数上、下摆渡车的时间,单位为秒;
当行人过街摆渡车从节点p出发到达节点q,到达节点q的时刻由公式(43)计算:行人过街摆渡车离开节点p时的载客人数用Lp表示,当行人过街摆渡车从节点p出发到达节点q时,载客量Lq由公式(44)计算:考虑到行人过街摆渡车的容量大小,Lp的上下限由公式(45)确定;
C表示行人过街摆渡车的容量,单位为人/辆;
步骤42:以所有过街行人的总延误最小为目标建立目标函数,如公式(46)所示,公式中TD表示过街行人的总延误;
式中T0表示行人过街摆渡车运营前开始上客的时刻,取值为0s。
说明书 :
一种自动驾驶环境下交叉口行人过街摆渡车行驶通道的设置
方法
技术领域
的设置方法。
背景技术
面交叉口的管理方法会随之发生改变。如IEEE Trans.Intelligent Vehicles(第3卷第2
期,2018年1月)、Transportation Research Part C‑Emerging Technologies(第103卷,
2019年6月)、中国公路学报(第32卷第12期,2019年12月)等许多研究均表明,自动驾驶交叉
口可无需信号灯控制,交通控制的对象将直接面向车辆,每辆车可以通过制定专属的通行
方案,避免在交叉口发生冲突,相互穿插地通过交叉口,能较大程度降低车辆在交叉口的延
误,极大程度上改变了现有的交叉口管理模式。
多,且冲突点较为随机,很难实现安全、有效地交叉口管理。为了规范交叉口过街行人的通
行秩序,减少冲突点,保障通行安全,本发明通过在交叉口各角落设置行人过街摆渡车停靠
点,在交叉口各角落放置行人过街摆渡车,在行人过街之前,将每个角落的行人先集中在行
人过街摆渡车上,通过行人过街摆渡车统一运送到目的地,实现行人的安全过街。如何控制
行人过街摆渡车在交叉口内部的通行,是本发明需要解决的问题。
度计算在路径上的运行时间,严格控制摆渡车按照此行驶方案在交叉口区域行驶,能最大
限度的减少运行时的相互干扰,本发明的核心内容是制定行人过街摆渡车的行驶通道,并
且控制行人过街摆渡车交叉口内部,在该通道内通行。
口通过行人过街相位等的优化,挖崛交叉口的通行能力。目前针对自动驾驶环境下交叉口
行人过街摆渡车的设置方法的相关研究很少,没有在交叉口安排行人过街摆渡车、设置摆
渡车行驶规则,并通过严格的数学方程,确定行驶方案的研究。
发明内容
在交叉口各角落设置行人过街摆渡车,并确定行驶通道及行驶方案,确保行人过街安全。
停靠位置的数量和大小,并规定行驶区域,设置行人过街摆渡车在交叉口区域的行驶通道。
∈m, 表示D方向第j条出口车道,其中D表示交叉口的出口方向,D={E、W、S、N},j∈m,m表
示O、D方向的车道总数,用 分别表示车道 和 的宽度,单位为米;
点的长和宽分别用a和b表示,车辆的长和宽分别用a′和b′表示,单位均为米,行人摆渡车的
+ ‑
理论最大行驶速度用v表示,单位为米每秒,摆渡车运行的加速度和减速度分别用a和a 表
示,单位为米每二次方秒;
达,每个停靠点最多可停靠1辆行人过街摆渡车。出发节点的集合用Op表示,其中Op={1,2,
3,4,5,6,7,8,9,10,11,12},终止节点集合的用Dp表示,其中Dp={13,14,15,16,17,18,19,
20,21,22,23,24},为避免行人过街摆渡车相互之间不必要的冲突,当行人过街摆渡车从1、
4、7、10停靠点出发时,行人过街摆渡车只在1、4、7、10、13、14、15、16节点组成的白色区域运
行;从2、5、8、11停靠点出发时,只在2、5、8、11、17、18、19、20节点组成的灰色区域运行;从3、
6、9、12停靠点出发时,只在3、6、9、12、21、22、23、24节点组成的灰色区域运行,此外,行人过
街摆渡车可以在同一个角落的三个停靠点之间相互运行;节点1、2、3、16、19、22位于交叉口
的西北角落,其中节点1、节点2、节点3依次是由北向西的第一、第二、第三个停靠点,节点1
和节点16、节点2和节点19、节点3和节点22在同一个位置,分别表示出发节点和到达节点;
节点4、5、6、13、20、23位于交叉口的东北角落,其中节点4、节点5、节点6依次是由北向东的
第一、第二、第三个停靠点,节点4和节点13、节点5和节点20、节点6和节点23在同一个位置,
分别表示出发节点和到达节点;节点7、8、9、14、17、24位于交叉口的东南角落,其中节点7、
节点8、节点9依次是由南向东的第一、第二、第三个停靠点,节点7和节点14、节点8和节点
17、节点9和节点24在同一个位置,分别表示出发节点和到达节点;节点10、11、12、15、18、21
位于交叉口的西南角落,其中节点10、节点11、节点12依次是由南向西的第一、第二、第三个
停靠点,节点10和节点15、节点11和节点18、节点12和节点21在同一个位置,分别表示出发
节点和到达节点;
界,右边边界为内边界。ε为二元变量,当边界为外边界时,ε=1,当边界为内边界时,ε=0。
在东西方向上,1→13表示节点1到节点13的路径;节点1→节点13、节点4→节点16的路径,
在交叉口区域运行路径的边界方程如公式(1)所示:
D取W方向;当p∈{4,5,6},q∈{14,17,24}或p∈{7,8,9},q∈{13,20,23}时,公式(26)中O和
D取E方向;当p∈{10,11,12},q∈{14,17,24}或p∈{7,8,9},q∈{15,18,21}时,公式(26)中
O和D取S方向。
人过街摆渡车在节点i和节点j之间的行驶距离Lij由两部分组成,如公式(29)所示;
‑
间,单位为米每秒;v 表示行人摆渡车实际行驶的最大速度,单位为米每秒,由公式(32)计
算;
车的控制方案。
道,根据停靠点的大小确定行人过街摆渡车路径的宽度,通过确定路径的上边界和下边界
确定路径方程,能有效模拟行人过街摆渡车在实地交叉口的通行情况。本发明方法具有很
好的普适性,能面向不同大小、不同车道数的交叉口,确定任意两节点之间的路径方程,能
有效保障自动驾驶环境下交叉口行人过街的安全。
附图说明
具体实施方式
停靠位置的数量和大小,并规定行驶区域,设置行人过街摆渡车在交叉口区域的行驶通道;
步骤2在该通道下确定每辆车的行驶轨迹方程,再通过步骤3计算行人过街摆渡车在通道内
各行驶轨迹上的行驶时间,最后步骤4,根据行人过街的需求确定行人过街摆渡车具体的行
驶方案;
并规定行驶区域,本发明实施例选取双向两车道的正交十字交叉口,交叉口的基本信息为,
交叉口的进出口车道的车道数均为2,即步骤1中m=2,车道宽度均设置为3m,
行人过街摆渡车的信息为,行人过街摆渡车的长和宽分别为a′=b′=
1.25m,单位人数上车、下车时间δt和δt′均为0.5s,开关门的时间F=4s,停靠点的长和宽分
别是a=b=1.5m,每辆摆渡车的容量C=20人,考虑到行人乘坐摆渡车的舒适性,设置行人
2 + ‑ 2
过街摆渡车的加速度和减速度大小均为1m/s ,即a=a =1m/s ,设定理论最大行驶速度为
v=4m/s;
域运行;从2、5、8、11停靠点出发时,只在2、5、8、11、17、18、19、20节点组成的灰色区域运行;
从3、6、9、12停靠点出发时,只在3、6、9、12、21、22、23、24节点组成的灰色区域运行,此外,行
人过街摆渡车可以在同一个位置的三个停靠点之间运行;
4.75m、ξ2,5=ξ5,8=ξ8,11=ξ11,2=2.25m、ξ1,4=ξ3,12=ξ6,9=ξ7,10=0.75m,
节点2→节点20、节点5→节点19 y=9.75,‑8.25≤x≤8.25
节点3→节点23、节点6→节点22 y=8.25,‑10.75≤x≤10.75
节点7→节点15、节点10→节点14 y=‑12.25,‑6.75≤x≤6.75
节点8→节点18、节点11→节点17 y=‑9.75,‑8.25≤x≤8.25
节点9→节点21、节点12→节点24 y=‑8.25,‑10.75≤x≤10.75
节点1→节点15、节点10→节点16 x=‑6.75,‑10.75≤y≤10.75
节点2→节点18、节点11→节点19 x=‑8.25,‑8.25≤y≤8.25
节点3→节点21、节点12→节点22 x=‑10.75,‑6.75≤y≤6.75
节点4→节点14、节点7→节点13 x=6.75,‑10.75≤y≤10.75
节点5→节点17、节点8→节点20 x=8.25,‑8.25≤y≤8.25
节点6→节点24、节点9→节点23 x=10.75,‑6.75≤y≤6.75
行人过街摆渡车以规定的加速度和最大行驶速度行驶时,速度以1m/s的加速度从0增加到
4m/s时,根据匀加速运动速度与时间公式vt=v0+a·t,计算得所需时间为4s,根据匀加速运
2
时间与位移公式 计算得运行距离为8m;当速度以1m/s的减速度从4m/s降
低到0时,运行距离为8m,当L1,13=13.5m<16m时,行人过街摆渡车的最大行驶速度达不到
‑
4m/s,根据步骤32计算得最大行驶速度v =3.674m/s,t1=t2=3.675s,t1,13=t1+t2=
7.348s。L1,15=21.5m>16m,说明在L1,15上行驶时,能达到4m/s,且以4m/s的速度匀速行驶
21.5m‑16m=5.5m,匀速行驶的时间为5.5/4=1.375s,在L1,15总行驶时间为9.375s。
t9,24=0s;
西北角、东北角、西南角各有5、2、5位行人;从西南角出发到西北角、东北角、东南角分别有
8、9、2位行人时。计算得该辆行人过街摆渡车的在交叉口各角落停靠点间的行驶路径及在
每个节点的上下客人数,行人过街摆渡车具体的控制方案如表4所示。
的保护范围之内。