欢迎来到知嘟嘟! 联系电话:13336804447 卖家免费入驻,海量在线求购! 卖家免费入驻,海量在线求购!
知嘟嘟
我要发布
联系电话:13336804447
知嘟嘟经纪人
收藏
专利号: 202110532902X
申请人: 山东科技大学
专利类型:发明专利
专利状态:已下证
专利领域: 测量;测试
更新日期:2023-12-11
缴费截止日期: 暂无
价格&联系人
年费信息
委托购买

摘要:

权利要求书:

1.一种车道级地图匹配方法,其特征在于,所述方法包括:获取车辆的定位数据和道路基础数据;所述定位数据包括实时位置信息和运行工况数据;

对所述车辆的定位数据进行数据预处理,得到预处理后车辆定位数据;

根据所述道路基础数据绘制高精度地图,所述高精度地图的地图位置误差应在厘米级以内,能够有效区分行车道;

根据所述预处理后车辆定位数据和所述高精度地图匹配车辆所在车道;

将所述车辆的定位位置在所述车辆所在车道的中心线的垂直投影确定为车辆在车道的匹配位置。

2.根据权利要求1所述的车道级地图匹配方法,其特征在于,所述获取车辆的定位数据和道路基础数据,具体包括:

获取北斗亚米级高精度定位设备采集的车辆行驶过程中的实时位置信息,所述实时位置信息包括UTC时间、经度、经度半球、纬度、纬度半球、车辆运行速度和方向角;其中,UTC时间为实时位置信息的采样时间;经度、纬度、经度半球、纬度半球为车辆的位置信息,精确到亚米级误差;车辆运行速度为利用北斗定位信息估算的车辆实时运行速度;方向角为车辆行驶方向与正北向的夹角;

获取车载自动诊断系统采集的车辆CAN总线的运行工况数据,所述运行工况数据包括车速、发动机转速和方向盘转向角;其中,车速为车辆车载电脑系统采集的行驶速度;方向盘转向角为车辆自身方向转向角度,当方向盘正向时角度为0,方向盘左转角度为负值,方向盘右转角度为正值;

获取RTK设备采集的道路基础数据,所述道路基础数据精确到厘米级误差。

3.根据权利要求1所述的车道级地图匹配方法,其特征在于,所述对车辆的定位数据进行数据预处理,得到预处理后车辆定位数据,具体包括:剔除所述实时位置信息中多条重复的所述实时位置信息,仅保留一条所述实时位置信息;

剔除所述运行工况数据中大于最大速度阈值的速度错误数据,利用历史速度数据采用平滑方法进行对剔除速度错误数据对应时间段进行速度补偿;所述最大速度阈值根据道路限速和所述运行工况数据设定;

当采样时间内未接收到所述实时位置信息时,确定该采样时间的定位数据缺失;当连续所述定位数据缺失不超过预设次数时,利用临近的前两段采样时间获得的实时位置信息对缺失的定位数据进行补偿,补偿的定位数据中速度和位置坐标计算如下所示:vi=2vi‑1‑vi‑2              (1)其中,(xi,yi,vi)为补偿点的经度、纬度和速度,(xi‑1,yi‑1,vi‑1)、(xi‑2,yi‑2,vi‑2)分别为前两个采样点的经度、纬度和速度;

计算当前采样时刻至前一采样时刻的车辆平均速度;剔除所述车辆平均速度大于设定最大行驶速度的定位数据,并对剔除定位数据对应时间内容的定位数据中的位置坐标进行补偿,补偿的定位数据中位置坐标的计算公式为式(2)和(3)。

4.根据权利要求3所述的车道级地图匹配方法,其特征在于,当连续所述定位数据缺失超过预设次数时,判定为设备故障或通信故障,不进行补偿,发出数据异常或故障提示信息。

5.根据权利要求1所述的车道级地图匹配方法,其特征在于,所述根据预处理后车辆定位数据和所述高精度地图匹配车辆所在车道,具体包括:将所述实时位置信息在所述高精度地图中进行二维坐标投影,得到车辆投影位置;

根据所述车辆投影位置和车道线位置信息确定所述车辆所在车道;

计算所述车辆的定位点到所述所在车道的中心线的距离;

判断所述距离是否小于第一距离阈值,得到第一判断结果;所述第一距离阈值小于车道宽度的一半;

当所述第一判断结果表示是时,确定所述所在车道为匹配后车辆所在车道;

当所述第一判断结果表示否时,获取所述车辆当前采样时刻之前连续N个采样时刻的所述定位数据,实时N个连续采样时刻的定位数据序列中,第一个采样时刻距离车道中心线的距离小于第二距离阈值;其中,所述第二距离阈值为离车道中心线足够小的距离,且所述第二距离阈值远小于所述第一距离阈值;

利用公式 计算历史轨迹平均方向角,利用公式 计算平均径向速度,利用公式 计算平均切向速度;其中,β为道路车道前进方向与正北向的夹角, 表示车辆行进方向与车道线的夹角;

利用公式 计算车辆横向运动距离L;

判断车辆横向运动距离是否大于车道宽度的一半,若是,确定所述车辆跨越车道线,存在变道行为,确定相邻车道为匹配后车辆所在车道;若否确定车辆未跨越车道线,则确定当前车道为匹配后车辆所在车道。

6.一种车道级地图匹配系统,其特征在于,所述系统包括:数据采集模块,用于获取车辆的定位数据和道路基础数据;所述定位数据包括实时位置信息和运行工况数据;

数据预处理模块,用于对所述车辆的定位数据进行数据预处理,得到预处理后车辆定位数据;还用于根据所述道路基础数据绘制高精度地图,所述高精度地图的地图位置误差应在厘米级以内,能够有效区分行车道;

车道匹配模块,用于根据所述预处理后车辆定位数据和所述高精度地图匹配车辆所在车道;

车辆投影匹配模块,用于将所述车辆的定位位置在所述车辆所在车道的中心线的垂直投影确定为车辆在车道的匹配位置。

7.根据权利要求6所述的车道级地图匹配系统,其特征在于,所述数据采集模块具体包括:

北斗亚米级高精度定位设备,用于采集的车辆行驶过程中的实时位置信息,所述实时位置信息包括UTC时间、经度、经度半球、纬度、纬度半球、车辆运行速度和方向角;其中,UTC时间为实时位置信息的采样时间;经度、纬度、经度半球、纬度半球为车辆的位置信息,精确到亚米级误差;车辆运行速度为利用北斗定位信息估算的车辆实时运行速度;方向角为车辆行驶方向与正北向的夹角;

车载自动诊断系统,用于采集的车辆CAN总线的运行工况数据,所述运行工况数据包括车速、发动机转速和方向盘转向角;其中,车速为车辆车载电脑系统采集的行驶速度;方向盘转向角为车辆自身方向转向角度,当方向盘正向时角度为0,方向盘左转角度为负值,方向盘右转角度为正值;

RTK设备,用于采集的道路基础数据,所述道路基础数据精确到厘米级误差。

8.根据权利要求6所述的车道级地图匹配系统,其特征在于,所述数据预处理模块具体包括:

冗余数据剔除单元,用于剔除所述实时位置信息中多条重复的所述实时位置信息,仅保留一条所述实时位置信息;

速度错误数据剔除与补偿单元,用于剔除所述运行工况数据中大于最大速度阈值的速度错误数据,利用历史速度数据采用平滑方法进行对剔除速度错误数据对应时间段进行速度补偿;所述最大速度阈值根据道路限速和所述运行工况数据设定;

数据缺失补偿单元,用于当采样时间内未接收到所述实时位置信息时,确定该采样时间的定位数据缺失;当连续所述定位数据缺失不超过预设次数时,利用临近的前两段采样时间获得的实时位置信息对缺失的定位数据进行补偿,补偿的定位数据中速度和位置坐标计算如下所示:

vi=2vi‑1‑vi‑2                  (1)其中,(xi,yi,vi)为补偿点的经度、纬度和速度,(xi‑1,yi‑1,vi‑1)、(xi‑2,yi‑2,vi‑2)分别为前两个采样点的经度、纬度和速度;

定位错误数据剔除与补偿单元,用于计算当前采样时刻至前一采样时刻的车辆平均速度;剔除所述车辆平均速度大于设定最大行驶速度的定位数据,并对剔除定位数据对应时间内容的定位数据中的位置坐标进行补偿,补偿的定位数据中位置坐标的计算公式为式(2)和(3)。

9.根据权利要求6所述的车道级地图匹配系统,其特征在于,所述车道匹配模块具体包括:

坐标投影单元,用于将所述实时位置信息在所述高精度地图中进行二维坐标投影,得到车辆投影位置;

定位车道单元,用于根据所述车辆投影位置和车道线位置信息确定所述车辆所在车道;

距离计算单元,用于计算所述车辆的定位点到所述所在车道的中心线的距离;

第一车道判别单元,用于判断所述距离是否小于第一距离阈值,得到第一判断结果;所述第一距离阈值小于车道宽度的一半;

当所述第一判断结果表示是时,确定所述所在车道为匹配后车辆所在车道;

当所述第一判断结果表示否时,获取所述车辆当前采样时刻之前连续N个采样时刻的所述定位数据,实时N个连续采样时刻的定位数据序列中,第一个采样时刻距离车道中心线的距离小于第二距离阈值;其中,所述第二距离阈值为离车道中心线足够小的距离,且所述第二距离阈值远小于所述第一距离阈值;

第二车道判别单元,用于利用公式 计算历史轨迹平均方向角,利用公式计算平均径向速度,利用公式 计算平均切向速度;其中,β为道路车道前进方向与正北向的夹角, 表示车辆行进方向与车道线的夹角;

利用公式 计算车辆横向运动距离L;

判断车辆横向运动距离是否大于车道宽度的一半,若是,确定所述车辆跨越车道线,存在变道行为,确定相邻车道为匹配后车辆所在车道;若否确定车辆未跨越车道线,则确定当前车道为匹配后车辆所在车道。