雾天高速公路车辆换道行驶车道定位方法技术

本发明专利技术公开了一种雾天高速公路车辆换道行驶车道定位方法，具体包括：车道判定模块利用转向开关获取车辆转向状态信息，通过高精度BDS模块获取车辆中心的当前行驶信息，调取高精度地图模块中存储的车辆行驶所在高速公路信息，然后将车辆中心BDS数据投影到高精度地图模块上，获得车辆中心在高精度地图上的实时位置和航向角，运用垂直迭代法测量出高精度地图上车辆中心与左右两侧最接近车道的车道中心线的距离，与设定阈值对比，判定行驶车辆所处车道号或车辆换道行驶状态。该方法集成应用高精度BDS与高精度电子地图等先进技术，不依赖于相机等环境感知技术，实现车辆在雾天高速公路车道上换道行驶的实时准确定位。公路车道上换道行驶的实时准确定位。公路车道上换道行驶的实时准确定位。

【技术实现步骤摘要】
雾天高速公路车辆换道行驶车道定位方法


[0001]本专利技术涉及汽车安全驾驶领域，尤其涉及一种雾天高速公路高级驾驶辅助系统(ADAS)换道行驶车道定位方法。

技术介绍

[0002]为了解决雾天高速公路通行效率低的问题，应用车联网技术，雾天高速公路车辆高级辅助驾驶系统正从单车道ADAS向多车道ADAS发展，车道定位技术是多车道ADAS研究和开发的核心技术之一，特别是在高速公路车道数变化、行驶车辆突发故障、车辆驶离高速公路等情况发生，车辆必须进行换道行驶时，车道定位的准确性将直接影响自身车辆向周围车辆发送行驶车道信息的准确性，从而影响雾天高速公路车辆行驶的安全性。中国专利CN109870689A中提出了一种毫米波雷达与高精矢量地图匹配的车道级定位方法与系统，基于毫米波雷达测量数据，识别道路边界；将所述道路边界在高精矢量地图上进行地图匹配，得到车辆在地图上的横纵向位置；将所述车辆在地图上的横纵向位置作为当前车道的定位结果。但是，该方案需要根据普通GPS数据初步确定车辆的位置，为提升车辆的定位精度，还需要基于ADAS相机识别道路交通标示，在雾天环境下，由于ADAS相机对周围环境的辨识度不高，难以保证高精度定位，特别是在弯道行驶时，可能导致定位车道误判，并且毫米波雷达在具体实施过程中成本较高。

技术实现思路

[0003]为了克服现有车辆车道定位技术在雾天环境高速公路上定位精度不高，不能满足车辆换道安全行驶要求的不足，本专利技术提供一种基于高精度北斗定位系统(BDS，误差小于20cm)与高精度电子地图(误差小于10cm)匹配技术，采用垂直迭代法测量车辆前后轴中心连线中点(以下简称车辆中心)与车道中心线距离的雾天高速公路车辆换道行驶车道定位方法，它不依赖相机等视觉传感器，可以解决车辆在雾天高速公路环境下车辆换道行驶时的车道实时准确定位问题。
[0004]本专利技术解决其技术问题所采用的技术方案是：一种雾天高速公路车辆换道行驶车道定位方法，该方法是利用由转向开关、高精度BDS模块、高精度地图模块和车道判定模块构成系统，车道判定模块通过转向开关获取车辆转向状态信息，判断车辆是否处于换道行驶状态；车道判定模块通过高精度BDS模块获取车辆中心的当前行驶信息，包括车辆中心在平面坐标系中的位置坐标、航向角(车辆中心航向与平面坐标系中Y轴的夹角，以正北方向为零基准，顺时针方向为正方向)等数据；高精度地图模块存储有车辆行驶所在高速公路车道边界、车道中心线、车道号和航向角(车道中心线航向与平面坐标系中Y轴的夹角，以正北方向为零基准，顺时针方向为正方向)等信息，供车道判定模块调取使用；车道判定模块将车辆中心实时BDS数据投影到车辆当前行驶路段的高精度地图上，获得换道行驶过程中车辆中心在高精度地图上的实时位置和航向角；然后采用垂直迭代法测量出高精度地图上车辆中心与左右两侧最接近车道的车道中心线的横向距离，与设定阈值比较，判定行驶车辆
所处车道号或车辆换道行驶状态。
[0005]其中，在所述判定行驶车辆所处的车道号之前，还包括：对车辆进行初始标定，以确定车辆坐标系及BDS信号接收模块在车辆坐标系中的位置坐标；将车辆中心作为车辆坐标系原点，车头方向为Y
V
轴、车右方向为X
V
轴、正上方为Z
V
轴的右手坐标系。BDS标定，主要包括测量高精度BDS模块中心与车辆中心的位置偏差，得到车辆坐标系下高精度BDS模块中心的坐标(X
VBP
，Y
VBP
)。
[0006]在车辆从ID
i
号车道向ID
i+1
号车道换道行驶过程中，如果在高精度地图上能够测得车辆中心与左右两侧最接近车道ID
i
号和ID
i+1
号车道的车道中心线的横向距离分别为D
L
、D
R
，若D
L
小于等于设定阈值D
T
，则判定车道号为ID
i
，若D
R
小于等于设定阈值D
T
，则判定车道号为ID
i+1
，否则，判定车辆处于换道行驶状态。
[0007]本专利技术中高精度地图上车辆中心与左右两侧最接近车道的车道中心线的横向距离可用垂直迭代法求得，具体方法如图4所示：
[0008]设定误差阈值ε，假设车辆中心在高精度地图上的位置点为A(X
A
，Y
A
)、航向为航向角为α；
[0009]第一步：过A点作一条垂直于的直线，得到该直线与车道中心线的交点B0(X
B0
，Y
B0
)，查询高精度地图得到车道中心线上B0点的航向角θ
B0
，过B0点沿航向角θ
B0
作直线得到车道中心线上B0点的切线B0C0；过A点作一条垂直于B0C0的直线，在切线B0C0上的垂足为D1(X
D1
，Y
D1
)点，交车道中心线于B1(X
B1
，Y
B1
)点，若D1与B1的距离则横向距离为A点与B1点的距离横向距离求解结束；
[0010]第二步：若则查询高精度地图得到车道中心线上B1点的航向角θ
B1
，过B1点沿航向角θ
B1
作直线得到车道中心线上B1点的切线B1C1；
[0011]第三步：过A点作一条垂直于B1C1的直线，在切线B1C1上的垂足为D2(X
D2
，Y
D2
)点，交车道中心线于B2(X
B2
，Y
B2
)点；
[0012]第四步：若D2与B2的距离则横向距离为A点与B2点的距离横向距离求解结束；
[0013]第五步：若D2与B2的距离则按照第二步和第三步所述的方法继续循环迭代，直至找到的交点B
K
，横向距离为A点与B
K
点的距离横向距离求解结束。
[0014]本专利技术的有益效果为：集成应用高精度北斗定位系统与高精度电子地图等先进技术，不依赖于ADAS相机和毫米波雷达等环境感知技术，实现车辆在雾天高速公路车道上换道行驶的准确定位，提高车辆换道行驶安全性，为解决雾天高速公路通行效率低的问题提供了新的途径。
附图说明
[0015]图1是本专利技术中车辆换道行驶车道定位系统图；
[0016]图2是本专利技术中车辆换道行驶车道定位方法流程图；
[0017]图3是本专利技术中车辆换道过程示意图；
[0018]图4是本专利技术中横向距离迭代法求解示意图。
具体实施方式
[0019]以下结合附图说明和具体实施方式对本专利技术作进一步详细的说明。
[0020]参见图1至图4，一种雾天高速公路车辆换道行驶车道定位方法，该方法是利用由转向开关1、高精度BDS模块2、高精度地图模块3和车道判定模块4构成的图1所示系统，按图2所示流程，车道判定本文档来自技高网...

【技术保护点】

【技术特征摘要】
1.一种雾天高速公路车辆换道行驶车道定位方法，其特征在于：利用由转向开关、高精度BDS模块、高精度地图模块和车道判定模块构成的系统，车道判定模块通过转向开关获取车辆转向状态信息，判断车辆是否处于换道行驶状态，通过高精度BDS模块获取车辆中心在平面坐标系中的位置坐标和航向角等数据，调取高精度地图模块中存储的车辆当前行驶路段所在高速公路车道...

【专利技术属性】
技术研发人员：孙文进，闵永军，林宇凡，
申请(专利权)人：南京林业大学，
类型：发明
国别省市：