用于车路协同环境下交叉路口表达及车路目标匹配的方法技术

本发明专利技术公开了一种用于车路协同环境下交叉路口表达及车路目标匹配的方法，包括：交叉口的简易表达方法：选定交叉路口并预先采集其中心点处和各分支路口停车线中点处的经纬度信息；在交叉路口所在平面基建立极坐标系，计算确定各分支路口停车线中点的极角；根据各个分支路口极角范围赋予其编号；车路目标匹配方法：计算目标车辆所在点的极径，明确其是否处于交叉路口区域；观测极径的变化趋势，判定目标车辆的行驶方向；将目标车辆所在点的极角与各个分支路口极角范围进行匹配，确定目标车辆所处分支路口。本发明专利技术能非常灵活、简易地定义任意交叉口，并能稳定、高效地判断目标车辆是否处于交叉路口区域，确定其行驶方向和所处分支路口。

Intersection Expression and Vehicle-Road Object Matching Method in Vehicle-Road Cooperative Environment

【技术实现步骤摘要】
用于车路协同环境下交叉路口表达及车路目标匹配的方法
本专利技术涉及车路协同条件下车辆定位
，尤其涉及一种用于车路协同环境下交叉路口表达及车路目标匹配的方法。
技术介绍
道路平面交叉口是交通系统的重要构成部分，是道路交通网络的关键节点和枢纽，更是行人和车辆转向、汇合、分流的地方。在联通路网和承担大量交通流的同时，道路交叉路口范围内车与行人、车与车，尤其是机动车与非机动车的冲突已成为诱发道路交通事故的重要因素。为了保证道路交叉口行人及车辆的安全通行，车路协同(CooperativeVehicleInfrastructureSystem，CVIS)等技术已被研究或应用于道路交叉口，利用车路协同技术在提前获知目标车辆所处路口及行驶方向等信息的基础上，对目标车辆可能发生的冲突进行预判，并根据风险分析结果采取应变措施以实现安全通行。然而，道路平面交叉口类型多样，包括三枝分叉、四枝分叉以及多枝分叉等，并且存在几何形状不规则或者非对称的交叉路口，如何在通用类型的交叉路口下完成对目标车辆当前所处路口和当前行驶方向的准确判断、并进行冲突的识别，已成为一个难点问题。通过总结现有的关于车路协同环境下交叉路口的车路目标匹配的实现途径，发现主要通过以下两种方法解决：方法一、通将道路特殊固定点处的经纬度及目标车辆的经纬度信息转化为WGS-84坐标或者高斯投影坐标，在同一绝对坐标系中根据平面几何关系对目标车辆的所处路口位置和行驶方向进行判断；方法二、利用高精度电子地图匹配，并结合相关改进的定位算法，分析得到目标车辆所处路口和行驶方向。其中，方法一测量数据大，数据计算较为繁琐，并且经纬度的误差极易导致车路目标匹配失败；方法二对电子地图精度要求极高，从地图存储量较大，并且受算法准确性的影响，所以该方法极不稳定。尽管上述两种方法对车路协同环境下的交叉路口车路目标匹配具有实际应用价值，但均存在精度要求高、不稳定、受交叉口类型限制的缺点。因此，提出一种适用于通用类型交叉口的、准确的、稳定性高的交叉口表达方式、并实现车路目标匹配方法是有必要的。
技术实现思路
本专利技术要解决的技术问题在于针对现有技术中的缺陷，提供一种用于车路协同环境下交叉路口表达及车路目标匹配的方法。本专利技术解决其技术问题所采用的技术方案是：本专利技术提供一种用于车路协同环境下交叉路口表达及车路目标匹配的方法，该方法包括：交叉口的简易表达方法和车路目标匹配方法；其具体步骤为：交叉口的简易表达方法：S1、选定交叉路口并预先采集其中心点处的经纬度信息，同时采集各分支路口停车线中点处的经纬度信息；S2、在交叉路口所在平面基于交叉路口中心点和正东方向建立极坐标系，通过经纬度信息计算确定各分支路口停车线中点的极角，从而进一步获得分支路口的极角范围；S3、根据各个分支路口独特无重复的极角范围，依次赋予其特定编号；车路目标匹配方法：S4、计算目标车辆所在点与交叉口中心点的距离即极径，明确目标车辆是否处于交叉路口区域；S5、观测目标车辆所在点的极径的变化趋势，判定目标车辆的行驶方向；获得目标车辆所在点的极角，并将其与各个分支路口极角范围进行匹配，确定目标车辆所处分支路口。进一步地，本专利技术的步骤S1的具体方法为：选定具有N个分支的交叉路口，测量采集路口中心点O处的经纬度信息LO、BO，同时采集各分支路口停车线中点处的经纬度信息Li、Bi，1≤i≤N，路口中心点是指交叉路口的各分支汇合的交点，包括：任意选定一普通类型的交叉路口，确定其分支路口数为N、中心点O以及分支路口停车线中点；利用地理信息采集设备预先测量交叉路口中心点O处的经纬度信息和各个分支路口停车线中点的经纬度信息Li、Bi。进一步地，本专利技术的步骤S2中建立极坐标系的具体方法为：建立与交叉路口同一平面的极坐标系，测定各个分支路口停车线中点处的极角θi，通过分支路口与其停车线中点的空间位置关系得到各分支路口的极角变化范围θi1～θi2，1≤i≤N。进一步地，本专利技术的步骤S2中获得分支路口的极角范围的具体方法为：计算获得各分支路口停车线中点在极坐标系中的极角，取逆时针方向为正；根据停车线中点的极角及其与分支路口的空间位置关系，得到分支路口的极角范围，各分支路口极角范围无重叠部分。进一步地，本专利技术的步骤S3中进行编号的具体方法为：结合各分支路口的极角变化范围，给各个分支路口进行特定编码，其编码信息记为Si，1≤i≤N；包括：按照递增规则，分别给各分支路口极角范围进行排序；按照分支路口极角范围差异，依次序给各个分支路口标定独特的编码信息S1～SN。进一步地，本专利技术的步骤S4中计算目标车辆所在点与交叉口中心点的距离即极径，明确目标车辆是否处于交叉路口区域的具体方法为：目标车辆P通过GPS、北斗或惯性导航系统获取其位置信息，位置信息包括经纬度信息和航向角信息，包括：目标车辆P通过车载定位系统获取自身位置信息；根据目标车辆实时经纬度信息LP、BP和交叉口中心点经纬度信息LO、BO，计算目标车辆P与交叉路口中心点O的距离dPO，即极径；比较距离dPO与阈值D的大小关系，判定目标车辆P是否在交叉路口区域范围内。进一步地，本专利技术的步骤S5中观测目标车辆所在点的极径的变化趋势，判定目标车辆的行驶方向的具体方法为：判断目标车辆所在点与交叉口中心点距离即极径的增减规律；目标车辆所在点极径增大，表明目标车辆驶离交叉路口；目标车辆所在点极径减小，表明目标车辆驶入交叉路口。进一步地，本专利技术的步骤S5中确定目标车辆所处分支路口的具体方法为：根据目标车辆的位置信息，计算获取目标车辆所在点的极角；目标车辆驶入交叉路口，将目标车辆所在点的极角与各分支路口极角范围进行一一匹配，则得到目标车辆所处分支路口；目标车辆驶离交叉路口，通过目标车辆所在点极角与分支路口极角范围±180°后进行匹配，确定目标车辆所处分支路口。本专利技术产生的有益效果是：本专利技术的用于车路协同环境下交叉路口表达及车路目标匹配的方法，(1)信息处理量小，操作简单，易于实现。本专利技术仅需要通过极坐标系下的目标车辆所在点的极径变化趋势和极角范围筛选即可实现车路目匹配。(2)稳定、高效、准确。本专利技术中实现车路目标表匹配的方法，步骤简单、流程固定、受设备精度影响小。(3)容错性好。本专利技术中，各分支路口的极角范围可以在一定的角度范围内变动而不影响车路目标匹配结果。(4)普遍适用性。本专利技术提供的方法可以适用绝大多数类型的平面交叉口车路目标匹配问题。故而，本专利技术所提供的方法可以准确、稳定地、快速地完成对交叉路口目标车辆所处分支路口和行驶方向的判断，并且操作简单、实用性强，有效解决坐标转换、高精电子地图匹配等实现车路目标匹配的方法误差大、不稳定的缺陷。附图说明下面将结合附图及实施例对本专利技术作进一步说明，附图中：图1是一种用于车路协同环境下交叉路口表达及车路目标匹配的方法的流程图；图2是一种用于车路协同环境下交叉路口表达及车路目标匹配的方法的分支路口极角范围和车辆位置示意图；图3是一种用于车路协同环境下交叉路口表达及车路目标匹配的方法的行驶方向和所处路口判断流程图；图4是一种用于车路协同环境下交叉路口表达及车路目标匹配的方法的设计实施例一；图5是一种用于车路协同环境下交叉路口表达及车路目标匹配的方法的设计实施例二。具体实施方式为了使本本文档来自技高网...

【技术保护点】
1.一种用于车路协同环境下交叉路口表达及车路目标匹配的方法，其特征在于，该方法包括：交叉口的简易表达方法和车路目标匹配方法；其具体步骤为：交叉口的简易表达方法：S1、选定交叉路口并预先采集其中心点处的经纬度信息，同时采集各分支路口停车线中点处的经纬度信息；S2、在交叉路口所在平面基于交叉路口中心点和正东方向建立极坐标系，通过经纬度信息计算确定各分支路口停车线中点的极角，从而进一步获得分支路口的极角范围；S3、根据各个分支路口独特无重复的极角范围，依次赋予其特定编号；车路目标匹配方法：S4、计算目标车辆所在点与交叉口中心点的距离即极径，明确目标车辆是否处于交叉路口区域；S5、观测目标车辆所在点的极径的变化趋势，判定目标车辆的行驶方向；获得目标车辆所在点的极角，并将其与各个分支路口极角范围进行匹配，确定目标车辆所处分支路口。

【技术特征摘要】
1.一种用于车路协同环境下交叉路口表达及车路目标匹配的方法，其特征在于，该方法包括：交叉口的简易表达方法和车路目标匹配方法；其具体步骤为：交叉口的简易表达方法：S1、选定交叉路口并预先采集其中心点处的经纬度信息，同时采集各分支路口停车线中点处的经纬度信息；S2、在交叉路口所在平面基于交叉路口中心点和正东方向建立极坐标系，通过经纬度信息计算确定各分支路口停车线中点的极角，从而进一步获得分支路口的极角范围；S3、根据各个分支路口独特无重复的极角范围，依次赋予其特定编号；车路目标匹配方法：S4、计算目标车辆所在点与交叉口中心点的距离即极径，明确目标车辆是否处于交叉路口区域；S5、观测目标车辆所在点的极径的变化趋势，判定目标车辆的行驶方向；获得目标车辆所在点的极角，并将其与各个分支路口极角范围进行匹配，确定目标车辆所处分支路口。2.根据权利要求1所述的用于车路协同环境下交叉路口表达及车路目标匹配的方法，其特征在于，步骤S1的具体方法为：选定具有N个分支的交叉路口，测量采集路口中心点O处的经纬度信息LO、BO，同时采集各分支路口停车线中点处的经纬度信息Li、Bi，1≤i≤N，路口中心点是指交叉路口的各分支汇合的交点，包括：任意选定一普通类型的交叉路口，确定其分支路口数为N、中心点O以及分支路口停车线中点；利用地理信息采集设备预先测量交叉路口中心点O处的经纬度信息和各个分支路口停车线中点的经纬度信息Li、Bi。3.根据权利要求1所述的用于车路协同环境下交叉路口表达及车路目标匹配的方法，其特征在于，步骤S2中建立极坐标系的具体方法为：建立与交叉路口同一平面的极坐标系，测定各个分支路口停车线中点处的极角θi，通过分支路口与其停车线中点的空间位置关系得到各分支路口的极角变化范围θi1～θi2，1≤i≤N。4.根据权利要求1所述的用于车路协同环境下交叉路口表达及车路目标匹配的方法，其特征在于，步骤S2中获得分支路口的极角范围的具体方法为：计算获得各分支路口停车线中点在极坐标系中的极角，取逆时针方向为...

【专利技术属性】
技术研发人员：吕能超，文家强，吴超仲，褚端峰，高策，
申请(专利权)人：武汉理工大学，
类型：发明
国别省市：湖北,42