一种基于V2X的车辆路口引导方法及装置与流程

一种基于v2x的车辆路口引导方法及装置
技术领域
1.本发明属于道路与交通技术领域，更具体地，涉及一种基于v2x的车辆路口引导方法及装置。


背景技术：

2.车与外界信息交换(vehicle to everything，v2x)，主要包括车与车(vehicle to vehicle，v2v)，车与基础设施(vehicle to infrastructure，v2i)，车与人(vehicle to people，v2p)，车与云(vehicle to network，v2n)。即车辆通过传感器，网络通讯技术与其它周边车、人、物进行通讯交流，并根据收集的信息进行分析、决策的一项技术。
3.在社会进步和经济发展的推动下，汽车在人们日常生活中正扮演着越来越重要的角色。由于汽车数量的急剧增长，汽车安全驾驶成为了世界性的问题，汽车通过v2x网络通信感知行驶环境中其他交通参与者的状态信息，进而计算出是否对本车的行驶状态存在影响，然后对驾驶员进行相应的提醒。
4.随着车联网技术的不断发展和成熟，消费者对汽车的安全性和出行效率也逐渐的提高。特别是驾驶员在参与城市出行交通时，最怕遇到红绿灯路口，车联网技术可以对车辆即将通过红绿灯路口的车辆进行宏观规划，给出建议驾驶速度，尽最大程度的保证车辆不停车顺利通过。
5.参考公开号为cn110874939a的专利申请，提供了一种绿波车速引导方法及系统，该方法包括：自车接收其他车辆的发出的车辆数据信号以及第一交叉路口和第二交叉路口的交通灯发出的交通灯信号；禁止灯为交通灯指示禁止车辆通行的状态，通行灯为交通灯指示允许车辆通行的状态；根据自车的车辆数据信号、前行车辆的车辆数据信号、设定的同一车道的两辆车辆之间的安全距离，以及第一交叉路口和第二交叉路口的交通灯信号，计算得到行驶车速，使得自车以行驶车速行驶至第二交叉路口时，位于自车前方的第二交叉路口的交通灯处于允许通行状态。从而节省自车通过交叉路口的通行时间，提高车辆通过交叉路口的通行效率。然而该方案没有给出如何筛选出与本车同车道的前行车辆中最后一辆车辆的方法，以及如何给出速度建议，实用性降低。


技术实现要素：

6.针对现有技术的以上缺陷或改进需求，本发明提出了一种基于v2x的车辆路口引导方法及装置，通过筛选本车所在车道上前行车辆中的离本车最近的一辆车，从而给出速度建议，提高实用性。
7.为实现上述目的，按照本发明的一个方面，提供了一种基于v2x的车辆路口引导方法，包括：
8.(1)获取主车hv与周边车辆rv的位置以及路口信号灯信息，确定周边车辆rv在主车坐标系下的相对于主车hv的相对方位角和相对航向角；
9.(2)由相对航向角确定周边车辆rv与主车hv航向是否相同，在周边车辆rv与主车
hv航向相同时，确定周边车辆rv与主车hv为同向车辆；
10.(3)由相对方位角确定周边车辆rv与主车hv之间的位置关系，基于周边车辆rv与主车hv之间的位置关系确定周边车辆rv与主车hv在垂直于车道方向或者在平行于车道方向的距离，进而确定周边车辆rv与主车hv所处的车道；
11.(4)在主车hv前方不存在其他车辆时，由主车hv与交叉口停止线的距离及路侧设备发送的主车hv当前所处车道的信号灯信息确定行驶速度；
12.(5)在主车hv前方存在其他车辆时，根据周边车辆rv与主车hv在垂直于车道方向或者在平行于车道方向的距离筛选出与主车hv同车道且与主车hv最近的前方车辆，根据与主车hv同车道且与主车hv最近的前方车辆的行驶状态信息进行碰撞预警。
13.在一些可选的实施方案中，步骤(1)包括：
14.(1.1)由确定周边车辆rv在主车坐标系下的相对于主车hv的相对方位角β，其中，(x
r
,y
r
)表示在主车坐标系下周边车辆rv的位置坐标；
15.(1.2)由确定周边车辆rv在主车坐标系下的相对于主车hv的相对航向角γ，其中，表示主车hv车头方向与正北方向的顺时针夹角，表示周边车辆rv车头方向与正北方向的顺时针夹角。
16.在一些可选的实施方案中，步骤(3)包括：
17.(3.1)若0
°
＜β＜90
°
，则判定rv在hv右前方，由确定hv和rv在垂直于车道方向的距离d
parallel
；若0<d
parallel
<第一距离值，1.9，则判定rv在hv同车道，且rv在hv前方；若第一距离值1.9<d
parallel
<第二距离值3.75，则判定rv在hv右侧相临车道，且rv在hv前方；
18.(3.2)若270
°
＜β＜360
°
，则判定rv在hv左前方，由确定hv和rv在垂直于车道方向的距离d
parallel
；若0<d
parallel
<第一距离值1.9，则判定rv在hv同车道，且rv在hv前方；若第一距离值1.9<d
parallel
<第二距离值3.75，则判定rv在hv左侧相临车道，且rv在hv前方；
19.(3.3)若90
°
＜β＜180
°
，则判定rv在hv右后方，由确定hv和rv在垂直于车道方向的距离d
parallel
；若0<d
parallel
<第一距离值1.9，则判定rv在hv同车道，且rv在hv后方；若第一距离值1.9<d
parallel
<第二距离值3.75，则判定rv在hv右侧相
临车道，且rv在hv后方，并由临车道，且rv在hv后方，并由确定hv和rv在平行于车道方向的距离d
verticall
；
20.(3.4)若180
°
＜β＜270
°
，则判定rv在hv左后方，由确定hv和rv在垂直于车道方向的距离d
parallel
；若0<d
parallel
<第一距离值1.9，则判定rv在hv同车道，且rv在hv后方；若第一距离值1.9<d
parallel
<第二距离值3.75，则判定rv在hv左侧相临车道，且rv在hv后方，并由临车道，且rv在hv后方，并由确定hv和rv在平行于车道方向的距离d
verticall
。
21.在一些可选的实施方案中，步骤(4)包括：
22.(4.1)在主车hv前方不存在其他车辆时，从路侧设备接收主车hv当前处于的车道的信号灯信息，若当前相位为红灯或者当前相位为黄灯，则结合主车hv与交叉口停止线的距离确定行驶速度；
23.(4.2)在主车hv前方不存在其他车辆时，从路侧设备接收主车hv当前处于的车道的信号灯信息，若当前相位为绿灯，则结合主车hv与交叉口停止线的距离确定行驶速度。
24.在一些可选的实施方案中，步骤(4.1)包括：
25.(4.1.1)在主车hv前方不存在其他车辆时，从路侧设备接收主车hv当前处于的车道的信号灯信息，若当前相位为红灯且剩余时间t
f
秒，后面绿灯t
g
秒；若当前相位为黄灯且剩余时间t
y
秒，后面红灯t
r
秒，此时需要等待的时间t
f
＝t
y
t
r
；
26.(4.1.2)若s≤d
h
≤s0，主车hv可匀速通过，并做出提示，其中，s＝v
h
*t
f
，s0＝v
h
*(t
f
t
g
)，d
h
为主车hv与交叉口停止线的距离，v
h
表示主车车速；
27.(4.1.3)若s＜s0≤d
h
，考虑加速通过，其中，，考虑加速通过，其中，t
b
为驾驶员反应时间，a
h
驾驶员感受到的舒适加速度，v
f
为当前道路允许的最大速度，若s1≥d
h
，则输出提示信息，用于提醒加速至最高限速v
f
，可以不停车通过；若s1＜d
h
，则输出提示信息，提醒前方需要停车；
28.(4.1.4)若s＞d
h
，考虑减速通过，其中，，考虑减速通过，其中，若s2＜d
h
，则输出提示信息，提醒减速可以不停车通过，若d
h
≤s2，则输出提示信息，提醒前方停车，等待。
29.在一些可选的实施方案中，步骤(4.2)包括：
30.(4.2.1)在主车hv前方不存在其他车辆时，从路侧设备接收主车hv当前处于的车道的信号灯信息，若当前相位为绿灯，且剩余时间t
g
秒，且后面黄灯t
y
秒，红灯t
r
秒，则计算s
′
＝v
h
*(t
g
t
y
)；
31.(4.2.2)若s
′
≥d
h
，可匀速通过；若s
′
＜d
h
，可考虑加速通过，计算
其中，d
h
为主车hv与交叉口停止线的距离，t
b
为驾驶员反应时间，a
h
驾驶员感受到的舒适加速度，v
f
为当前道路允许的最大速度，若s3≥d
h
，则输出提示信息，提醒加速可以不停车通过，若s3＜d
h
，则输出提示信息，提醒考虑减速，下一次绿灯时间通过。
32.在一些可选的实施方案中，步骤(5)包括：
33.(5.1)在主车hv前方存在其他车辆时，根据d
parallel
和d
verticall
筛选出与主车hv同车道且与主车hv最近的目标前方车辆rv
′
，通过v2x无线通讯方式获取到rv
′
的行驶状态信息和rv
′
相对于主车hv的d
parallel
和d
verticall
；
34.(5.2)若a1‑
a2≠0，则其中，v
n
表示rv
′
的速度，a
n
表示rv
′
的加速度，d
r
表示主车同车道最近的前方车辆与交叉口停止线的距离；若a1‑
a2＝0，则a1为主车hv当前时刻的加速度，a2为rv
′
当前时刻的加速度；
35.(5.3)若t≤预设时间值，则输出前向碰撞预警；
36.(5.4)若t＞预设时间值，表示暂时没有碰撞危险，由路侧设备发送的主车hv当前所处车道的信号灯信息确定行驶速度。
37.在一些可选的实施方案中，步骤(5.4)包括：
38.(5.4.1)若当前相位为红灯且剩余时间t
f
秒，后面绿灯t
g
秒；若当前相位为黄灯，剩余时间t
y
秒，后面红灯t
r
秒，此时需要等待的时间t
f
＝t
y
t
r
，计算v
r
表示距离主车最近的远车当前时刻的速度；
39.(5.4.2)若d
r
≤s或s0≤d
r
，则rv
′
在当前红绿灯周期内不能通过路口，则输出提示信息，提醒主车hv前方需要停车，等待；若s＜s0≤d
r
，则rv
′
在当前红绿灯周期内能通过路口，则rv
′
通过路口所需要的时间为：若t
r
′
3≥t
f
t
g
，则输出提示信息，提醒主车hv前方停车，等待；若t
r
′
3＜t
f
t
g
，则输出提示信息，提醒主车hv保持安全距离，可以通过；
40.(5.4.3)若当前相位为绿灯，且剩余时间t
g
秒，且后面黄灯t
y
秒，红灯t
r
秒，计算s
′
＝v
h
*(t
g
t
y
)，若s
′
≤d
r
，则输出提示信息，提醒主车hv前方停车，等待；若s
′
≥d
h
，rv
′
在当前红绿灯周期内能通过路口，则rv
′
通过路口所需要的时间为：若t
r
″
3≥t
y
t
g
，则输出提示信息，提醒主车hv前方停车，等待；若t
r
″
3＜t
y
t
g
，则输出提示信息，提醒主车hv保持安全距离，可以通过。
41.在一些可选的实施方案中，所述方法还包括：主车hv接收路侧设备更新后的红绿灯相位信息，其中，路侧设备红绿灯相位信息更新方式为：路侧设备根据路口各方向向路口行驶的车辆到达路口行驶时间进行记录，并计算出同一方向相邻两辆车抵达路口的时间间
隔，相对的两个方向为一组，当某个时间段相邻两辆车通过路口的时间间隔超过预设时间间隔，则表示可以直接从绿灯变为红灯，为另一个方向行驶的车辆节约时间，更新红绿灯相位信息。
42.按照本发明的另一方面，提供了一种基于v2x的车辆路口引导装置，包括：
43.定位模块，用于获取主车hv与周边车辆rv的位置以及路口信号灯信息，确定周边车辆rv在主车坐标系下的相对于主车hv的相对方位角和相对航向角；
44.方向确定模块，用于由相对航向角确定周边车辆rv与主车hv航向是否相同，在周边车辆rv与主车hv航向相同时，确定周边车辆rv与主车hv为同向车辆；
45.车道确定模块，用于由相对方位角确定周边车辆rv与主车hv之间的位置关系，基于周边车辆rv与主车hv之间的位置关系确定周边车辆rv与主车hv在垂直于车道方向或者在平行于车道方向的距离，进而确定周边车辆rv与主车hv所处的车道；
46.第一行驶决策模块，用于在主车hv前方不存在其他车辆时，由主车hv与交叉口停止线的距离及路侧设备发送的主车hv当前所处车道的信号灯信息确定行驶速度；
47.第二行驶决策模块，用于在主车hv前方存在其他车辆时，根据周边车辆rv与主车hv在垂直于车道方向或者在平行于车道方向的距离筛选出与主车hv同车道且与主车hv最近的前方车辆，根据与主车hv同车道且与主车hv最近的前方车辆的行驶状态信息进行碰撞预警。
48.总体而言，通过本发明所构思的以上技术方案与现有技术相比，能够取得下列有益效果：
49.(1)通过筛选本车所在车道上前行车辆中的离本车最近的一辆车，从而给出速度建议，并在行驶决策中，加入了防碰撞机制，避免单一追求通行效率而造成碰撞危险而降低了驾驶安全性。
50.(2)具体参数的选取结合实际情况提高了本发明的实用性；根据交通运输流运行状态，动态更新红绿灯相位信息，整个引导过程中与智能路侧设备动态更新红绿灯相位信息相结合，尽最大程度上提高交通效率。
附图说明
51.图1是本发明实施例提供的一种基于v2x的车辆路口引导方法的流程示意图；
52.图2是本发明实施例提供的一种相对方位角与相对航向角示意图；
53.图3是本发明实施例提供的一种路口引导区示意图；
54.图4是本发明实施例提供的一种基于v2x的车辆路口引导方法的流程示意图；
55.图5是本发明实施例提供的一种路口示意图；
56.图6是本发明实施例提供的一种某一路口车辆示意图；
57.图7是本发明实施例提供的一种基于v2x的车辆路口引导装置的结构示意图。
具体实施方式
58.为了使本发明的目的、技术方案及优点更加清楚明白，以下结合附图及实施例，对本发明进行进一步详细说明。应当理解，此处所描述的具体实施例仅仅用以解释本发明，并不用于限定本发明。此外，下面所描述的本发明各个实施方式中所涉及到的技术特征只要
彼此之间未构成冲突就可以相互组合。
59.在本发明实例中，“第一”、“第二”等是用于区别不同的对象，而不是用于描述特定的顺序或先后次序。
60.实施例一
61.如图1所示是本发明实施例提供的一种基于v2x的车辆路口引导方法的流程示意图，在图1所示的方法中包括以下步骤：
62.s1：获取主车hv与周边车辆rv的位置以及路口信号灯信息，确定周边车辆rv在主车坐标系下的相对于主车hv的相对方位角和相对航向角；
63.如图2所示，车辆通过惯导、gps等定位装置定位车辆的位置信息，然后通过v2x无线通信技术进行车辆速度、加速度、转向灯状态以及方向盘转角等各种基本数据的实时交换，假设车辆a为本车，以本车为原点建立坐标系，然后再计算出其他车辆在本车坐标系内的位置和行驶方向，假设车辆b在车辆a为原点建立的坐标系方位角为β，取值范围为[0,2π]，指在本车坐标系中，从坐标轴纵轴正方向起，顺时针量到本车质心与远车质心的直线间的夹角，即为相对于与本车的方位角。如图2中(a)所示，根据图2中(a)所示的两车方位角在本车坐标系中的相对关系，此时远车与本车的相对方位角即为315
°
。在本车坐标系下车辆a的坐标为原点(0,0)，车辆b坐标为(x
r
,y
r
)，车辆b在本车坐标下的方位角β计算公式为：
[0064][0065]
相对航向角γ，取值范围为[0,2π]，是指在本车坐标系中，从坐标轴纵轴正方向起，顺时针量到本车坐标系原点与远车航向的矢量所决定的直线间的夹角，即为远车与本车的相对航向角。如图2中(b)所示，根据图2中(b)所示的两车航向角在本车坐标系中的相对关系，此时远车与本车的相对航向角即为45
°
。计算公式如下：
[0066][0067]
式中，表示本车车头方向与正北方向的顺时针夹角，表示远车车头方向与正北方向的顺时针夹角。
[0068]
本实施例中，在步骤s1中，如图3所示，主车hv进入引导区后，需确定与周边车辆的位置关系以及路口信号灯信息，重点判断主车同车道的前方是否有其他车辆。假设根据车辆搭载的定位装置得到主车hv位置坐标为(x
h
,y
h
)，周边车辆rv位置坐标为(x
r
,y
r
)，主车hv的航向角为周边车辆rv航向角为然后转换到本车坐标系下主车hv的坐标为原点(0,0)，周边车辆rv坐标为(x
r
,y
r
)。在本车坐标系中，周边车辆rv相对本车hv的相对方位角和相对航向角分别为β和γ。
[0069]
s2：由相对航向角确定周边车辆rv与主车hv航向是否相同，在周边车辆rv与主车hv航向相同时，确定周边车辆rv与主车hv为同向车辆；
[0070]
在本实施例中，根据相对方位角和相对航向角分别为β和γ，得出两车之间的位置关系，若γ<预设角度，则认为航向相同，因此可视为同向车辆。
[0071]
在本实施例中，预设角度可以根据汽车经验设计，如图4中的2
°
，本实施例不做唯一性限定。
[0072]
s3：由相对方位角确定周边车辆rv与主车hv之间的位置关系，基于周边车辆rv与主车hv之间的位置关系确定周边车辆rv与主车hv在垂直于车道方向或者在平行于车道方向的距离，进而确定周边车辆rv与主车hv所处的车道；
[0073]
在本实施例中，智能路侧基础设备可以收集路口各个方向的车辆信息，如图5所示的各个方向即将通过本路口的车辆位置信息、车辆行驶状态信息。假设从方向c向路口行驶的车辆根据距离由近到远依次编号为车辆c1、c2，
……
，c
n
，从方向c向路口行驶的车辆的位置关系如图6所示。
[0074]
假设车辆c1、c2…
c
n
到路口的距离分别为s1、s2…
s
n
,到达路口的时间为t1、t2…
t
n
,当前时刻速度分别为v1、v2…
v
n
,当前时刻加速度分别为a1、a2…
a
n
,车辆之间的距离为δs1、δs2…
δs
n
‑1。
[0075][0076]
进一步地，在本实施例中，步骤s3可以通过以下方式实现：
[0077]
s3.1：若0
°
＜β＜90
°
，则判定rv在hv右前方，由确定hv和rv在垂直于车道方向的距离d
parallel
；若0<d
parallel
<第一距离值，则判定rv在hv同车道，且rv在hv前方；若第一距离值<d
parallel
<第二距离值，则判定rv在hv右侧相临车道，且rv在hv前方；
[0078]
s3.2：若270
°
＜β＜360
°
，则判定rv在hv左前方，由确定hv和rv在垂直于车道方向的距离d
parallel
；若0<d
parallel
<第一距离值，则判定rv在hv同车道，且rv在hv前方；若第一距离值<d
parallel
<第二距离值，则判定rv在hv左侧相临车道，且rv在hv前方；
[0079]
s3.3：若90
°
＜β＜180
°
，则判定rv在hv右后方，由确定hv和rv在垂直于车道方向的距离d
parallel
；若0<d
parallel
<第一距离值，则判定rv在hv同车道，且rv在hv后方；若第一距离值<d
parallel
<第二距离值，则判定rv在hv右侧相临车道，且rv在hv后方，并由rv在hv后方，并由确定hv和rv在平行于车道方向的距离d
verticall
；
[0080]
s3.4：若180
°
＜β＜270
°
，则判定rv在hv左后方，由确定hv和rv在垂直于车道方向的距离d
parallel
；若0<d
parallel
<第一距离值，则判定rv在hv同车道，且rv在hv后方；若第一距离值<d
parallel
<第二距离值，则判定rv在hv左侧相临车道，且rv在hv后方，并由确定hv和rv在平行于车道方向的距离d
verticall
。
[0081]
其中，第一距离值和第二距离值可以根据国家标准确定，如国家标准车道宽度为3.75m，第一距离值可以为1.9m，第二距离值可以是3.75m。
[0082]
s4：在主车hv前方不存在其他车辆时，由主车hv与交叉口停止线的距离及路侧设备发送的主车hv当前所处车道的信号灯信息确定行驶速度；
[0083]
在本实施例中，步骤s4可以通过以下方式实现：计算主车hv与交叉口停止线的距离d
h
，将位于主车左侧相临车道、主车同车道、主车右侧相临车道前方车辆列入表1，分别计算与红绿灯的距离l
j
、d
i
、r
k
，把与交叉口停止线的距离按由近到远的顺序，重新排序(j＝1、i＝1、k＝1为主车所处车道距离交叉口停止线最近的车辆代号)，m，n，p表示数量；
[0084]
表1
[0085][0086]
若d
h
＝d1，表示主车前方无其他车辆，
[0087]
主车hv将自身的位置信息通过v2x无线通信方式传到路侧设备，路侧设备结合储存的当前路段的高精度地图计算出主车hv当前处于的车道，然后将相应车道的信号灯信息发送给主车。
[0088]
(1)若收到相位此时为红灯且剩余时间t
f
秒，后面绿灯t
g
秒；若当前相位为黄灯，剩余时间t
y
秒，后面红灯t
r
秒，此时t
f
＝t
y
t
r
，计算s＝v
h
*t
f
，s0＝v
h
*(t
f
t
g
)，v
h
表示主车车速；
[0089]
a)当s≤d
h
≤s0，可匀速通过，提醒“保持车速前进”；
[0090]
b)当s＜s0≤d
h
，考虑加速通过，计算得：
[0091]
t
b
为驾驶员反应时间，a
h
驾驶员感受到的舒适加速度，v
f
为当前道路允许的最大速度。比如t
b
＝1s，a
h
＝2m/s2,v
f
＝v
max
；s1≥d
h
，提醒“加速至最高限速v
max
，可以不停车通过”；s1＜d
h
，提醒“前方需要停车”。
[0092]
c)当s＞d
h
，考虑减速通过，计算得：
[0093]
t
b
＝1s，a
h
＝2m/s2,v
f
＝v
min
；若s2＜d
h
，提醒“减速可以不停车通过”；若d
h
≤s2，提醒“前方停车，等待”。
[0094]
(2)若收到相位此时为绿灯，且剩余时间t
g
秒，且后面黄灯t
y
秒，红灯t
r
秒；计算s
′
＝v
h
*(t
f
t
y
)，若s
′
≥d
h
，可匀速通过；若s
′
＜d
h
，可考虑加速通过，计算得：t
b
＝1s，a
h
＝2m/s2,v
f
＝v
max
，若s3≥d
h
，提醒“加速可以不停车通过”，
[0095]
若s3＜d
h
，考虑减速,下一次绿灯时间通过。
[0096]
s5：在主车hv前方存在其他车辆时，根据周边车辆rv与主车hv在垂直于车道方向或者在平行于车道方向的距离筛选出与主车hv同车道且与主车hv最近的前方车辆，根据与主车hv同车道且与主车hv最近的前方车辆的行驶状态信息进行碰撞预警。
[0097]
在本实施例中，步骤s5可以通过以下方式实现：
[0098]
若d
h
≠d1，表示主车前方存在其他车辆，
[0099]
根据步骤s3计算出的d
parallel
和d
verticall
筛选出与主车hv同车道且与主车hv最近的前方车辆，假设筛选出的前方车辆为远车rv
′
，通过v2x无线通讯方式获取到远车rv
′
的行驶状态信息、rv
′
相对于主车hv的d
parallel
和d
verticall
。
[0100]
当a1‑
a2≠0时，
[0101]
当a1‑
a2＝0时，
[0102]
其中，v
n
表示rv
′
的速度，a
n
表示rv
′
的加速度，d
r
表示主车同车道最近的前方车辆与交叉口停止线的距离，a1为主车hv当前时刻的加速度，a2为远车rv
′
当前时刻的加速度。
[0103]
当t
ttc
＝t≤预设时间值，则输出前向碰撞预警。车辆制动的过程分为以下四个阶段，分别是驾驶员反应阶段、消除制动间隙阶段、制动压力升高阶段、制动器持续制动阶段。
[0104]
其中，预设时间值为系统设定值，可以根据实际需要确定，本实施例不做唯一性限定。
[0105]
第一阶段：这一阶段是指从驾驶员接收到预警系统的预警提示信号到驾驶员在意识到碰撞危险后将脚移动到制动踏板上的总时间，称这段时间为驾驶员反应时间t1，取值一般为0.3s～1.6s；
[0106]
第二阶段：汽车的制动器在设计时为避免驾驶员误触会预留一些间隙，所以在驾驶员踩下制动踏板时，需一定时间后，制动系统才开始起作用。此时间的长度即为制动间隙消除时间t2，取值0.1s；
[0107]
第三阶段：当制动器开始起作用时，制动系统制动压力升高并开始输出减速度，车辆由当前的加速度到达根据不同工况所需的制动减速度，加速度的变化可被近似的视为线性变化。这段加速度变化的时间即为制动压力升高时间t3。因为当车辆中的制动系统起作用时，绝大部分情况可瞬间输出车辆所需要的制动减速度，所以t3一般为一个极小的固定值0.4s。
[0108]
由于时间阈值设置过大时，报警的频率则会增加影响驾驶舒适性和系统的准确性，因此本系统设置系统设定值为3s。
[0109]
当t
ttc
＝t＞系统设定值时，暂时没有碰撞危险，考虑车速引导。
[0110]
若收到相位此时为红灯且剩余时间t
f
秒,后面绿灯t
g
秒；若当前相位为黄灯，剩余时间t
y
秒，后面红灯t
r
秒，此时t
f
＝t
y
t
r
；
[0111]
计算v
r
表示距离主车最近的远车当前时刻的速度，当d
r
≤s或s0≤d
r
时，远车rv
′
在当前红绿灯周期内不能通过路口，提醒主车hv“前方需要停车，等待”。当s＜s0≤d
r
时，远车rv
′
在当前红绿灯周期内能通过路口，则远车rv
′
通过路口所需要的时间为：若t
r
′
3≥t
f
t
g
，提醒“前方停车，等待”；若t
r
′
3＜t
f
t
g
，提醒“保持安全距离，可以通过”。
[0112]
若收到相位此时为绿灯，且剩余时间t
g
秒，且后面黄灯t
y
秒，红灯t
r
秒；计算s
′
＝v
h
*(t
g
t
y
)，若s
′
≤d
r
，提醒“前方停车，等待”；若s
′
≥d
h
，远车rv
′
在当前红绿灯周期内能通过路口，则远车rv
′
通过路口所需要的时间为：若t
r
″
3≥t
y
t
g
，提醒“前方停车，等待”；若t
r
″
3＜t
y
t
g
，提醒“保持安全距离，可以通过”。
[0113]
在本实施例中，所述方法还包括：动态更新红绿灯相位信息的步骤，具体为：将车方向a、b、c、d等四个方向向路口行驶的车辆到达路口行驶时间进行记录，并计算出同一方向相邻两辆车抵达路口的时间间隔。
[0114][0115]
将四个方向分为两组，方向a和方向c为一组，方向b和方向d为一组，当某个时间段相邻两辆通过路口的时间间隔比较大，超过预设时间间隔，可以直接从绿灯变为红灯，为另一个方向行驶的车辆节约时间，提升整个交通运输体系的效率，整个过程中所有数据动态更新。
[0116]
在本实施例中，预设时间间隔的大小可以根据实际需要确定，本实施例不做唯一性限定。
[0117]
实施例二
[0118]
如图7所示是本发明实施例提供的一种基于v2x的车辆路口引导装置的结构示意图，包括：
[0119]
定位模块201，用于获取主车hv与周边车辆rv的位置以及路口信号灯信息，确定周边车辆rv在主车坐标系下的相对于主车hv的相对方位角和相对航向角；
[0120]
方向确定模块202，用于由相对航向角确定周边车辆rv与主车hv航向是否相同，在周边车辆rv与主车hv航向相同时，确定周边车辆rv与主车hv为同向车辆；
[0121]
车道确定模块203，用于由相对方位角确定周边车辆rv与主车hv之间的位置关系，基于周边车辆rv与主车hv之间的位置关系确定周边车辆rv与主车hv在垂直于车道方向或者在平行于车道方向的距离，进而确定周边车辆rv与主车hv所处的车道；
[0122]
第一行驶决策模块204，用于在主车hv前方不存在其他车辆时，由主车hv与交叉口
停止线的距离及路侧设备发送的主车hv当前所处车道的信号灯信息确定行驶速度；
[0123]
第二行驶决策模块205，用于在主车hv前方存在其他车辆时，根据周边车辆rv与主车hv在垂直于车道方向或者在平行于车道方向的距离筛选出与主车hv同车道且与主车hv最近的前方车辆，根据与主车hv同车道且与主车hv最近的前方车辆的行驶状态信息进行碰撞预警。
[0124]
其中，各模块的具体实施方式可以参考上述方法实施例的描述，本实施例将不再复述。
[0125]
需要指出，根据实施的需要，可将本技术中描述的各个步骤/部件拆分为更多步骤/部件，也可将两个或多个步骤/部件或者步骤/部件的部分操作组合成新的步骤/部件，以实现本发明的目的。
[0126]
本领域的技术人员容易理解，以上所述仅为本发明的较佳实施例而已，并不用以限制本发明，凡在本发明的精神和原则之内所作的任何修改、等同替换和改进等，均应包含在本发明的保护范围之内。