一种基于车路协同系统的弯道车辆相对位置分类方法与流程

1.本发明属于车路协同技术领域，尤其是涉及一种基于车路协同系统的弯道车辆相对位置分类方法。


背景技术：

2.车路协同系统通过车联网技术实现车辆、道路和行人之间进行实时动态信息交互，从而提高出行安全。车联网技术主要依靠安装在路端的路侧单元(road side unit，rsu)和车载单元(on board unit,obu)进行通信。现有对弯道中车辆与车辆之间的碰撞判断主要依赖于雷达或摄像头等传感器，但是雷达只对其正前方的一段区域内进行检测，对于弯道内的检测具有一定的局限性，而摄像头的检测容易受到天气影响。
3.因此，结合当前需求，提出一种基于车路协同系统的弯道车辆相对位置分类方法，车路协同技术具有感知范围广，不受遮挡物及天气影响的优势，使最终实现提高弯道行车安全的目的。


技术实现要素：

4.有鉴于此，本发明旨在提出一种基于车路协同系统的弯道车辆相对位置分类方法，以解决车辆在弯道行驶过程中因受遮挡物或天气影响导致判断周围周围车辆相对位置不准确的问题。
5.为达到上述目的，本发明的技术方案是这样实现的：
6.一种基于车路协同系统的弯道车辆相对位置分类方法，包括以下步骤：
7.s1、获取自身车辆的基本安全状态信息，以及接收路侧单元的地图信息及周围车辆的基本安全状态信息；
8.s2、计算自身车辆所在位置点距离地图信息中多个位置点中最短距离的位置点pm以及第二短距离的位置点pn；
9.s3、以自身车辆所在位置点为原点，自身车辆行驶方向为y轴建立坐标系，以及结合最短距离的位置点pm、第二距离的位置点pn，判断自身车辆在行驶道路上的行驶方向；
10.s4、计算周围车辆位置点距离地图信息中多个位置点中最短距离的位置点p
p
以及第二短距离的位置点pq；
11.s5、以周围车辆所在位置点为原点，车辆行驶方向为y轴建立坐标系，以及结合最短距离的位置点p
p
、第二距离的位置点pq，判断周围车辆在行驶道路上的行驶方向；
12.s6、判断自身车辆以及周围车辆的行驶方向是否一致，若方向一致，执行步骤s7，否则执行步骤s8；
13.s7、判断自身车辆与周围车辆是否都在y轴同一侧，若是，则两辆车在同一车道，否则处于相邻车道；
14.s8、判断自身车辆与周围车辆是否都在y轴同一侧，若是，则两辆车在相邻车道，否则处于同一车道且车辆和周围车辆对向行驶。
15.进一步的，步骤s1中的基本安全状态信息包括：当前时刻的经度、纬度、航向角、速度、加速度。
16.进一步的，步骤s1中地图消息包括路口信息、路段信息和车道信息，具体包含路段中的若干个参考位置点的经纬度，路段起点和终点经纬度，车道宽度信息。
17.进一步的，步骤s3中判断自身车辆在行驶道路上的行驶方向详细过程包括以下内容：
18.自身车辆的位置点为ph(p
hx
,p
hy
)，最短距离位置点pm(p
mx
,p
my
)，第二距离的位置点pn(p
nx
,p
ny
)，以自身车辆的位置为原点，以自身车辆的行驶方向为y轴方向建立坐标系，经过以下坐标转换过程进行坐标转换：
[0019][0020][0021]
其中，p
mx*
为pm位置点坐标系转换后的横坐标；p
my*
为pm位置点坐标系转换后的纵坐标；p
mx
为pm位置点的横坐标；p
my
为pm位置点的纵坐标；h
θ
为自身车辆的航向角；p
hx
为周围车辆所在位置点的横坐标；p
hy
为自身车辆所在位置点的纵坐标；p
nx*
为pn位置点坐标系转换后的横坐标；p
ny*
为pn位置点坐标系转换后的纵坐标；p
nx
为pn位置点的横坐标；p
ny
为pn位置点的纵坐标；
[0022]
则若(p
nx*-p
mx*
)(p
ny*-p
my*
)＞0，则自身车辆行驶方向为否则，自身车辆行驶方向为
[0023]
进一步的，步骤s5中判断周围车辆在行驶道路上的行驶方向详细过程包括以下内容：
[0024]
周围车辆的位置点为pr(p
rx
,p
ry
)，最短距离位置点p
p
(p
px
,p
py
)，第二距离的位置点pq(p
qx
,p
qy
)，以周围车辆的位置为原点，以周围车辆的行驶方向为y轴方向建立坐标系，经过以下坐标转换过程进行坐标转换：
[0025][0026][0027]
其中，p
px*
为p
p
位置点坐标系转换后的横坐标；p
py*
为p
p
位置点坐标系转换后的纵坐标；p
px
为p
p
位置点的横坐标；p
py
为p
p
位置点的纵坐标；r
θ
为周围车辆的航向角；p
rx
为周围车辆所在位置点的横坐标；p
ry
为周围车辆所在位置点的纵坐标；p
qx*
为pq位置点坐标系转换后的横坐标；p
qy*
为pq位置点坐标系转换后的纵坐标；p
qx
为pq位置点的横坐标；p
qy
为pq位置点的纵坐标；
[0028]
则若(p
qx*-p
px*
)(p
qy*-p
py*
)＞0，则周围车辆行驶方向为否则，周围车辆行驶方向为
[0029]
进一步的，步骤s6中判断自身车辆以及周围车辆的方向是否一致包括以下方法：
[0030]
自身车辆的行驶方向为：pmpn，周围车辆的行驶方向为：p
p
pq，若n》m且p》q，或n《m且p《q则自身车辆与周围车辆行驶方向一致，否则自身车辆与周围车辆行驶方向相反。
[0031]
进一步的，步骤s7中，根据步骤s3建立的坐标系，即以自身车辆为原点，其行驶方向为y轴建立坐标系，判断距离自身车辆最短距离的位置点pm在其左侧还是右侧，同时，以同样的方法判断第二最短距离的位置点p
p
在其左侧或右侧，则：
[0032]
当p
mx*
*p
px*
＞＝0；自身车辆和周围车辆处于同一车道；
[0033]
当p
mx*
*p
px*
＜0；自身车辆和周围车辆处于相邻车道。
[0034]
进一步的，步骤s8中，根据步骤s5建立的坐标系，即以自身车辆为原点，其行驶方向为y轴建立坐标系，判断距离自身车辆最短距离的位置点pm在其左侧还是右侧，同时，以同样的方法判断第二最短距离的位置点p
p
在其左侧或右侧，则：
[0035]
当p
mx*
*p
px*
＞＝0；自身车辆和周围车辆处于对向相邻车道上；
[0036]
当p
mx*
*p
px*
＜0；自身车辆和周围车辆处于同一车道，对向行驶。
[0037]
相对于现有技术，本发明所述的一种基于车路协同系统的弯道车辆相对位置分类方法具有以下有益效果：
[0038]
(1)本发明所述的一种基于车路协同系统的弯道车辆相对位置分类方法，基于车路协同系统进行弯道中车辆相对位置的判断，解决现有技术中遮挡物及天气情况对车辆相对位置判断的问题；
[0039]
(2)本发明所述的一种基于车路协同系统的弯道车辆相对位置分类方法，可在进入全新道路即可进行相对位置的判断，解决了现有技术中利用车辆行驶轨迹点对弯道中车辆相对位置的判断。
附图说明
[0040]
构成本发明的一部分的附图用来提供对本发明的进一步理解，本发明的示意性实施例及其说明用于解释本发明，并不构成对本发明的不当限定。在附图中：
[0041]
图1为本发明实施例所述的道路安全应用场景示意；
[0042]
图2为本发明实施例所述的一种基于车路协同系统的弯道车辆相对位置分类方法流程图。
具体实施方式
[0043]
需要说明的是，在不冲突的情况下，本发明中的实施例及实施例中的特征可以相互组合。
[0044]
在本发明的描述中，需要理解的是，术语“中心”、“纵向”、“横向”、“上”、“下”、“前”、“后”、“左”、“右”、“竖直”、“水平”、“顶”、“底”、“内”、“外”等指示的方位或位置关系为基于附图所示的方位或位置关系，仅是为了便于描述本发明和简化描述，而不是指示或暗示所指的装置或元件必须具有特定的方位、以特定的方位构造和操作，因此不能理解为对
本发明的限制。此外，术语“第一”、“第二”等仅用于描述目的，而不能理解为指示或暗示相对重要性或者隐含指明所指示的技术特征的数量。由此，限定有“第一”、“第二”等的特征可以明示或者隐含地包括一个或者更多个该特征。在本发明的描述中，除非另有说明，“多个”的含义是两个或两个以上。
[0045]
在本发明的描述中，需要说明的是，除非另有明确的规定和限定，术语“安装”、“相连”、“连接”应做广义理解，例如，可以是固定连接，也可以是可拆卸连接，或一体地连接；可以是机械连接，也可以是电连接；可以是直接相连，也可以通过中间媒介间接相连，可以是两个元件内部的连通。对于本领域的普通技术人员而言，可以通过具体情况理解上述术语在本发明中的具体含义。
[0046]
下面将参考附图并结合实施例来详细说明本发明。
[0047]
如图1至图2所示，一种基于车路协同系统的弯道车辆相对位置分类方法流程图，包括以下步骤：
[0048]
步骤s1：获取自身车辆hv的状态信息；
[0049]
步骤s2：接收路侧单元rsu的地图消息(map消息)及周围车辆rv的基本安全消息(bsm消息)；
[0050]
其中自身车辆hv内安装有用于与路侧单元及周围车辆相互通信的终端，其通信终端采用c-v2x obu和c-v2x rsu。
[0051]
步骤s3：根据以上信息，计算map消息中的位置点距离hv所在位置点最短的位置点pm；
[0052]
步骤s4：分别计算距离pm点前后相邻的两个点距离hv较短的点pn；
[0053]
(由于道路是弯道，所以道路方向时刻在变，分别计算距离hv最近点及次近点，为了确认当前hv所在道路的方向，以便和车辆行驶方向做匹配)；
[0054]
步骤s5：以hv所在位置点为原点，以车辆行驶方向为y轴建立坐标系，判断hv的行驶方向；
[0055]
步骤s6：重复步骤s2-步骤s5，计算出距离rv较近的两个位置点p
p
和pq及rv的行驶方向；
[0056]
步骤s7：判断hv和rv的行驶方向是否一致，若一致，执行步骤s8；否则，执行步骤s9；
[0057]
步骤s8：判断hv和rv是否都在y轴同一侧，若是，则说明两车在同一车道，否则处于相邻车道；
[0058]
步骤s9：判断hv和rv是否都在y轴同一侧，若是，则说明两车在对向相邻车道，否则处于同一车道且hv和rv对向行驶；
[0059]
进一步地，步骤s1中，hv的状态信息包含当前时刻的经度、纬度、航向角、速度、加速度等数据；
[0060]
进一步地，步骤s2中，map消息包含路口信息、路段信息和车道信息，具体包含路段中的若干个参考位置点的经纬度，路段起点和终点经纬度，车道宽度等信息。
[0061]
进一步地，步骤s2中，rv的bsm状态信息包含当前时刻的经度、纬度、航向角、速度、加速度等数据；
[0062]
进一步地，步骤s5中，hv的位置点为ph(p
hx
,p
hy
)，pm(p
mx
,p
my
)，pn(p
nx
,p
ny
)以hv的位
置为原点，以hv的行驶方向为y轴方向建立坐标系，则p
m*
，p
n*
坐标为:
[0063][0064][0065]
其中：p
mx*
为pm位置点坐标系转换后的横坐标；p
my*
为pm位置点坐标系转换后的纵坐标；p
mx
为pm位置点的横坐标；p
my
为pm位置点的纵坐标；h
θ
为hv的航向角；p
hx
为hv所在位置点的横坐标；p
hy
为hv所在位置点的纵坐标；p
nx*
为pn位置点坐标系转换后的横坐标；p
ny*
为pn位置点坐标系转换后的纵坐标；p
nx
为pn位置点的横坐标；p
ny
为pn位置点的纵坐标；
[0066]
则若(p
nx*-p
mx*
)(p
ny*-p
my*
)＞0，则hv行驶方向为否则，hv行驶方向为hv行驶方向为
[0067]
进一步地，步骤s7中，若hv的行驶方向为hv行驶方向为rv的行驶方向为判断hv和rv行驶方向一致的依据为n》m且p》q，或n《m且p《q；否则，hv的rv的行驶方向相反；
[0068]
周围车辆rv在行驶道路上的行驶方向详细过程包括以下内容：
[0069]
周围车辆的位置点为pr(p
rx
,p
ry
)，最短距离位置点p
p
(p
px
,p
py
)，第二距离的位置点pq(p
qx
,p
qy
)，以周围车辆的位置为原点，以周围车辆的行驶方向为y轴方向建立坐标系，经过以下坐标转换过程进行坐标转换：
[0070][0071][0072]
其中：p
px*
为p
p
位置点坐标系转换后的横坐标；p
py*
为p
p
位置点坐标系转换后的纵坐标；p
px
为p
p
位置点的横坐标；p
py
为p
p
位置点的纵坐标；r
θ
为rv的航向角；p
rx
为rv所在位置点的横坐标；p
ry
为rv所在位置点的纵坐标；p
qx*
为pq位置点坐标系转换后的横坐标；p
qy*
为pq位置点坐标系转换后的纵坐标；p
qx
为pq位置点的横坐标；p
qy
为pq位置点的纵坐标；
[0073]
则若(p
qx*-p
px*
)(p
qy*-p
py*
)＞0，则周围车辆行驶方向为否则，周围车辆行驶方向为
[0074]
进一步地，步骤s8中，根据步骤s5建立的坐标系，即以hv为原点，其行驶方向为y轴建立坐标系，判断距离hv最近的点pm在其左侧还是右侧，同时，以同样的方法判断p
p
在其左侧或右侧，则：
[0075][0076]
进一步地，步骤s9中，根据步骤s5建立的坐标系，即以hv为原点，其行驶方向为y轴建立坐标系，判断距离hv最近的点pm在其左侧还是右侧，同时，以同样的方法判断p
p
在其左侧或右侧，则：
[0077][0078]
实施例如下：
[0079]
本实施例中的一种基于车路协同系统的弯道车辆相对位置分类方法基于图1所示的道路中。hv和rv行驶的道路中包含一条路段ab，其中由于路段为由一定曲率的道路，因此由9个参考位置点：p1(x1,y1)，p2(x2,y2)......p9(x9,y9)进行表示，路段ab细分为三条车道，从左向右依次定义为lane1、lane2和lane3，每条车道宽度为3m。hv的当前的行驶位置点为ph(xh，yh)，行驶速度为vh，航向角为θh，rv的当前的行驶位置点为pr(xr，yr)，行驶速度为vr，航向角为θr。
[0080]
如图2所示，一种基于车路协同系统的弯道车辆相对位置分类方法流程图，具体步骤如下：
[0081]
步骤s1：获取自身车辆hv的状态信息，包含行驶位置点、速度、航向角等；
[0082]
步骤s2：接收路侧单元rsu的map消息及周围车辆rv的bsm消息，包含当权行驶位置点、速度、航向角等及路段中的9个参考位置点的位置坐标，路段起点a和终点b的位置坐标，车道宽度等信息。
[0083]
步骤s3：根据以上信息，计算map消息中的位置点距离hv最短的位置点pm；
[0084]
进一步地，使用以下公式计算出每个道路参考位置点距离hv的距离：
[0085][0086]
步骤s4：分别计算距离pm点前后相邻的两个点距离hv较短的点pn；
[0087]
步骤s5：以hv行驶方向起点为原点，以车辆行驶方向为y轴建立坐标系，判断hv的行驶方向；
[0088]
步骤s6：重复步骤s2-步骤s5，计算出距离rv较近的两个位置点p
p
和pq及rv的行驶方向；
[0089]
步骤s7：判断hv和rv的行驶方向是否一致，若一致，执行步骤s8；否则，执行步骤s9；
[0090]
步骤s8：判断hv和rv是否都在y轴同一侧，若是，则说明两车在同一车道，执行步骤s10；否则处于相邻车道；
[0091]
步骤s9：判断hv和rv是否都在y轴同一侧，若是，则说明两车在对向相邻车道；否则，处于同一车道且hv和rv对向行驶；
[0092]
进一步地，步骤s5中，hv的位置点为ph(p
hx
,p
hy
)，pm(p
mx
,p
my
)，pn(p
nx
,p
ny
)以hv的位置为原点，以hv的行驶方向为y轴方向建立坐标系，则p
m*
，p
n*
坐标为:
[0093][0094][0095]
则若(p
nx*-p
mx*
)(p
ny*-p
my*
)＞0，则hv行驶方向为否则，hv行驶方向为hv行驶方向为
[0096]
进一步地，步骤s7中，若hv的行驶方向为hv行驶方向为rv的行驶方向为判断hv和rv行驶方向一致的依据为n》m且p》q，或n《m且p《q；否则，hv的rv的行驶方向相反；
[0097]
进一步地，步骤s8中，根据步骤s5建立的坐标系，即以hv为原点，其行驶方向为y轴建立坐标系，判断距离hv最近的点pm在其左侧还是右侧，同时，以同样的方法判断pp在其左侧或右侧，则：
[0098][0099]
进一步地，步骤s9中，根据步骤s5建立的坐标系，即以hv为原点，其行驶方向为y轴建立坐标系，判断距离hv最近的点pm在其左侧还是右侧，同时，以同样的方法判断pp在其左侧或右侧，则：
[0100][0101]
以上所述仅为本发明的较佳实施例而已，并不用以限制本发明，凡在本发明的精神和原则之内，所作的任何修改、等同替换、改进等，均应包含在本发明的保护范围之内。