CN105206108B - 一种基于电子地图的车辆碰撞预警方法 - Google Patents
一种基于电子地图的车辆碰撞预警方法 Download PDFInfo
- Publication number
- CN105206108B CN105206108B CN201510475551.8A CN201510475551A CN105206108B CN 105206108 B CN105206108 B CN 105206108B CN 201510475551 A CN201510475551 A CN 201510475551A CN 105206108 B CN105206108 B CN 105206108B
- Authority
- CN
- China
- Prior art keywords
- vehicle
- road
- current
- car
- electronic map
- Prior art date
- Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
- Expired - Fee Related
Links
- 238000000034 method Methods 0.000 title claims abstract description 34
- 238000001914 filtration Methods 0.000 claims abstract description 8
- 238000006243 chemical reaction Methods 0.000 claims abstract description 6
- 230000004927 fusion Effects 0.000 claims abstract description 4
- 239000011159 matrix material Substances 0.000 claims description 19
- 230000009897 systematic effect Effects 0.000 claims description 9
- 238000004891 communication Methods 0.000 claims description 8
- 230000001133 acceleration Effects 0.000 claims description 6
- 238000002955 isolation Methods 0.000 claims description 3
- 238000005259 measurement Methods 0.000 claims description 3
- 238000005457 optimization Methods 0.000 claims 1
- 230000006855 networking Effects 0.000 description 8
- 238000005516 engineering process Methods 0.000 description 6
- 238000010586 diagram Methods 0.000 description 3
- 230000005611 electricity Effects 0.000 description 3
- 230000000694 effects Effects 0.000 description 2
- 238000012360 testing method Methods 0.000 description 2
- 206010057315 Daydreaming Diseases 0.000 description 1
- 230000008859 change Effects 0.000 description 1
- 238000007405 data analysis Methods 0.000 description 1
- 230000007423 decrease Effects 0.000 description 1
- 230000007547 defect Effects 0.000 description 1
- 230000007246 mechanism Effects 0.000 description 1
- 238000012986 modification Methods 0.000 description 1
- 230000004048 modification Effects 0.000 description 1
- 230000008520 organization Effects 0.000 description 1
- 230000008569 process Effects 0.000 description 1
- 230000004224 protection Effects 0.000 description 1
- 230000009467 reduction Effects 0.000 description 1
- 238000011160 research Methods 0.000 description 1
- 238000010561 standard procedure Methods 0.000 description 1
- 230000009466 transformation Effects 0.000 description 1
Landscapes
- Traffic Control Systems (AREA)
- Position Fixing By Use Of Radio Waves (AREA)
- Navigation (AREA)
Abstract
本发明涉及一种基于电子地图的车辆碰撞预警方法,包括:1)获取车辆的GPS数据,GPS数据包括运动状态信息和位置信息,采用坐标系转化将车辆位置信息映射至二维直角坐标系中;2)根据车辆历史GPS数据,采用卡尔曼滤波算法对车辆当前位置信息进行优化预测得到第一车辆当前位置;3)根据车辆历史GPS数据,结合电子地图信息预测得到第二车辆当前位置;4)融合第一车辆当前位置和第二车辆当前位置得到预测的车辆最优位置,5)结合预测的车辆最优位置与TCC算法,进行碰撞预警。与现有技术相比,本发明实时预估出车辆是否与周围车辆有碰撞可能性,并实时地给驾驶员预警提示,有效地提升驾驶的安全性、车辆定位精度,实用高效。
Description
技术领域
本发明涉及车联网中的智能交通技术,尤其是涉及一种基于电子地图的车辆碰撞预警方法。
背景技术
车联网是物联网在智能交通领域的重要应用,通过信息交互,把车、路及行人连接成一个整体网络,从而实现交通的智能化。在行车安全和智能交通方面,车联网主要基于车车通信、车路通信,实时可靠地共享信息,从而提升交通流的效率和驾驶安全。基于车车通信或车路通信,结合车载GPS和电子地图信息,车载主动安全***可以提前通知驾驶员可能发生的危险状况,辅助安全驾驶,提高车辆危险预警精确度,从而极大地避免了安全事故的发生。
车联网主动安全应用是智能交通领域重要的基础技术,具有高度的实际应用价值,因而受到很多汽车厂商的重点关注。欧洲电信标准化协会(EuropeanTelecommunications Standards Institute,ETSI)在标准技术文档TS102638(Basic setof application definitions)中对各种车联网主动安全应用场景作出了规范,并定义了安全消息的基本格式和传递机制。目前这方面的研究主要集中在欧美,国内的主要汽车厂商也联合高校做出了较深入的研究。在实际应用中,驾驶员视野盲区、注意力不集中或者天气原因等问题都有可能造成车辆相撞危险,车载主动安全***基于车车通信分析出本车与周围车辆相撞的可能性,给驾驶员实时地预警提示,甚至在紧急情况下采取一些安全防护措施。
目前很多的车辆主动安全应用并没有将电子地图考虑在内,绝大部分基于车载传感器。其主要方法为,利用超声波、雷达等传感器探测周围车辆与本车的距离,若小于安全距离则对驾驶员报警提示。超声波传感器车载传感器的稳定性很容易收到环境、天气等因素的影响,从而基于传感器的车载主动安全应用的性能就会因为传感器稳定性降低而大幅下降。
发明内容
本发明的目的就是为了克服上述现有技术存在的缺陷而提供一种基于电子地图的车辆碰撞预警方法,基于车与车共享运动状态信息和位置信息,结合电子地图精确车辆定位,实时预估出车辆是否与周围车辆有碰撞可能性,并实时地给驾驶员预警提示,有效地提升了驾驶的安全性,车辆定位精度,实用高效。
本发明的目的可以通过以下技术方案来实现:
一种基于电子地图的车辆碰撞预警方法包括以下步骤:
1)获取车辆的GPS数据,所述GPS数据包括运动状态信息和位置信息,采用坐标系转化将车辆位置信息映射至二维直角坐标系中;
2)根据车辆历史GPS数据,采用卡尔曼滤波算法对车辆当前位置信息进行优化预测得到第一车辆当前位置;
3)根据车辆历史GPS数据,结合电子地图信息预测得到第二车辆当前位置;
4)融合第一车辆当前位置和第二车辆当前位置得到预测的车辆最优位置;
5)结合预测的车辆最优位置与TCC算法,进行车辆碰撞预警。
所述步骤1)具体为:
11)行驶车辆获取本车的GPS数据,同时与本车通信范围内的邻居车辆进行通信,获取邻居车辆的GPS数据;
12)建立以本车为原点的二维直角坐标系,并将接收到的邻居车辆的位置信息映射至该二维直角坐标系中。
所述步骤12)具体为:
121)由位置信息获得本车的GPS经纬度(lonA,latA)和邻居车辆的GPS经纬度(lonB,latB),按照零度经线的基准,东经取经度的正值,西经取经度的负值,北纬取90-纬度值,南纬取90+纬度值,变换后获得本车的GPS经纬度(mlonA,mlatA)和邻居车辆的GPS经纬度(mlonB,mlatB);
122)获取本车与邻居车辆的距离Distance,满足以下公式:
C=sin(mlatA)·sin(mlatB)·cos(mlonA-mlonB)+cos(mlatA)·cos(mlatB)
Distance=R·arccos(C)·π/180
式中,C为中间量,R为地球半径;
123)以本车为原点建立二维直角坐标系,则本车坐标为(0,0),当lonA>lonB,邻居车辆坐标为(-Distance·cos(|mlatA-mlatB|),Distance·sin(mlatA-mlatB)),当lonA≤lonB,邻居车辆坐标为(Distance·cos(|mlatA-mlatB|),Distance·sin(mlatA-mlatB))。
所述步骤2)具体为:
21)建立状态变量X和***误差协方差矩阵P的递归方程,满足以下公式:
Xt/t-1=At-1Xt-1/t-1+wt-1
式中,下标t表示当前时刻,下标t-1表示上一时刻,Xt/t-1为利用上一时刻的车辆状态信息来预测车辆在当前时刻的状态信息结果,Xt-1/t-1为上一时刻的最优状态信息结果,Pt/t-1为对应Xt/t-1的***误差协方差矩阵,Pt-1/t-1为对应Xt-1/t-1的***误差协方差矩阵,(x,y)为车辆在二维直角坐标系中的坐标,v为车辆速度,为车辆的航向角,wt-1为***过程噪声的协方差,A为卡尔曼滤波***参数,Q为***过程的协方差,Δt为上一时刻和当前时刻的时间间隔;
22)建立车辆当前GPS数据Z和状态变量的估计方程,满足以下公式:
Xt/t=Xt/t-1+Kgt(Zt-Xt/t-1)
Kgt=Pt/t-1(Pt/t-1+r)-1
式中,Xt/t为当前时刻的最优状态信息结果,为当前车辆GPS数据Z中的坐标、速度和航向角,Kg为最佳卡尔曼增益,r为测量噪声的误差协方差;
23)将根据车辆历史GPS数据和当前GPS数据带入步骤21)和步骤22)的公式,获得对车辆当前位置信息优化预测的第一车辆当前位置(x1,y1),并更新误差协方差矩阵P,满足以下公式:
Pt/t=(I-Kgt)Pt/t-1
式中,I为单位矩阵,Pt/t为对应Xt/t的***误差协方差矩阵。
所述步骤3)具体为:
31)每条道路Ri被划分为若干个路段Sn,且每条道路所包含的信息有道路上各点的坐标、道路宽度路段长度道路中心线与正北夹角每个路段距离下一个交叉口距离其中,i为道路的序号,n为路段的序号;
32)将车辆当前GPS数据中的位置信息标定在电子地图上,判断当前车辆的坐标是否在道路上,若是,执行步骤34),若否,执行步骤33);
33)根据车辆历史GPS数据并结合电子地图信息预测得到第二车辆当前位置(x2,y2),执行步骤4);
34)即为第二车辆当前位置(x2,y2),执行步骤4)。
所述步骤33)具体为:
331)根据车辆上一时刻的GPS数据获取车辆在道路上行驶的估计距离Dis,满足以下公式:
式中,vt-1、at-1、分别为车辆在上一时刻的速度、加速度、航向角,为车辆上一时刻所在路段的道路中心线与正北的夹角,下标t表示当前时刻,下标t-1表示上一时刻,Δt为上一时刻和当前时刻的时间间隔;
332)判断Dis是否大于为车辆上一时刻所在的路段距下一交叉口的距离,若是,以车辆上一时刻的航向角为依据确定车辆当前所在道路,为该车辆当前所在道路的中心线与正北的夹角,ε为设定值,若否,车辆仍在上一时刻所在道路;
333)结合车辆当前所在道路信息预测得到第二车辆当前位置(x2,y2),执行步骤4)。
所述步骤4)具体为:
41)根据第一车辆当前位置(x1,y1)得到误差协方差P1,根据第二车辆当前位置(x2,y2)得到误差协方差P2;
42)利用P1、P2融合(x1,y1)和(x2,y2)得到车辆最优位置(xf,yf),满足以下公式:
所述步骤5)具体为:
51)将车辆最优位置标记在同一坐标系中,利用电子地图的道路拓扑结构,针对有轨迹相交的车辆,采用TCC算法得到两辆车到达相交点时间差tTCC;
52)设定与车辆速度大小有关的报警阈值,当tTCC小于报警阈值,则表明车辆之间有碰撞危险,并发出报警。
所述步骤51)中利用电子地图的道路拓扑结构剔除不可能碰撞的情况来获取有轨迹相交的车辆情况,所述不可能碰撞的情况包括:
a、两辆车在相邻道路,但道路中间有隔离带,则两辆车不会相撞;
b、两辆车在两条不同的道路,且两条道路并无交叉口,即使两辆车轨迹相交也不会相撞;
c、两辆车在方向不同的道路上行驶,且两辆车之间距离随时间而增大,则两辆车不会相撞。
所述步骤52)中与车辆速度大小有关的报警阈值包括:
当车辆速度小于等于30km/h,对应的报警阈值为5s;
当车辆速度大于30km/h且小于等于60km/h,对应的报警阈值为7s;
当车辆速度大于60km/h且小于等于90km/h,对应的报警阈值为10s;
当车辆速度大于90km/h且小于等于120km/h,对应的报警阈值为12s。
与现有技术相比,本发明具有以下优点:
1、高可靠性:本方法利用车车通信技术,能够不断获取邻居车辆的实时GPS信息,并且从CAN总线获取本车的运动状态信息。在通信设备可靠性得到保证的情况下,本车总是能够利用本发明方案判断车辆间是否有碰撞危险,从而得到不同等级的预警信息,误差较小。
2、高准确率:本方法采用电子地图信息来辅助车辆定位,使车辆定位精度大大提升,从而提升碰撞预警准确率。
3、实时性:本方法所使用的无线通信技术传输时延很小,能够保证获取的邻居车辆的运动状态信息和位置信息总是实时的,并且算法复杂度较低,时间消耗小,从而能够最快时间给出预警信息。
4、适应性:本方法适用于不同车辆行驶场景(交叉路口、同车道行驶、邻车道行驶等),安全预警等级可以根据实际的道路交通情况调整,以适应不同的道路情形。
5、实用性:本方法中车辆共享信息量并不高,占用无线信道带宽小;使用的预警算法与模型的参数结合了理论与大量测试得出的结果,实用性较强。
附图说明
图1为本发明方法应用于***的架构图。
图2为本发明方法逻辑流程图。
图3为本发明中道路信息图。
图4为本发明中结合电子地图的车辆位置推算图。
图5为电子地图中两车碰撞说明示意图;
图6为简化的两车碰撞说明示意图;
图7为加入电子地图与不加入电子地图时车辆碰撞预警准确率示意图。
具体实施方式
下面结合附图和具体实施例对本发明进行详细说明。
一种基于电子地图的车辆碰撞预警方法以本车与邻居车辆共享交换车辆运动状态信息和位置信息为基础,并结合电子地图信息辅助碰撞预警,最终由人机界面HMI告知驾驶员的报警信息。如图1、图2所示,本发明方法具体包括以下步骤:
1)获取车辆的GPS数据,GPS数据包括运动状态信息和位置信息,采用坐标系转化将车辆位置信息(即本车车辆GPS坐标以及接收到的其他车辆GPS坐标)映射至二维直角坐标系中,其中运动状态信息包括速度、加速度、航向角等,位置信息包括经度、纬度等,从而实时的预测车辆运动轨迹。具体为:
11)行驶车辆获取本车的GPS数据,同时与本车通信范围内的邻居车辆进行通信,获取邻居车辆的运动状态信息和位置信息。
12)建立以本车为原点的二维直角坐标系,并将接收到的邻居车辆的位置信息映射至该二维直角坐标系中。其中,步骤12)包括:
121)由位置信息获得本车的GPS经纬度(lonA,latA)和邻居车辆的GPS经纬度(lonB,latB),按照零度经线的基准,东经取经度的正值,西经取经度的负值,北纬取90-纬度值,南纬取90+纬度值,变换后获得本车的GPS经纬度(mlonA,mlatA)和邻居车辆的GPS经纬度(mlonB,mlatB);
122)获取本车与邻居车辆的距离Distance,满足以下公式:
C=sin(mlatA)·sin(mlatB)·cos(mlonA-mlonB)+cos(mlatA)·cos(mlatB)
Distance=R·arccos(C)·π/180
式中,C为中间量,R为地球半径并取值为6371004m;
123)以本车为原点建立二维直角坐标系,则本车坐标为(0,0),当lonA>lonB,邻居车辆坐标为(-Distance·cos(|mlatA-mlatB|),Distance·sin(mlatA-mlatB)),当lonA≤lonB,邻居车辆坐标为(Distance·cos(|mlatA-mlatB|),Distance·sin(mlatA-mlatB))。
2)根据反应历史行车轨迹的行驶速度、加速度、航向角、GPS坐标位置信息,采用卡尔曼滤波算法对车辆当前位置信息进行优化预测得到第一车辆当前位置。具体为:
21)利用车辆历史行驶轨迹及车辆状态来对其轨迹进行预测主要是采用Kalman滤波理论对***状态进行观测,利用状态空间的概念将信号看作是白噪声作用下的一个线性***的输出,并把这种输入输出关系用一个状态方程来进行描述。具体如下:建立状态变量X和***误差协方差矩阵P的递归方程,满足以下公式:
Xt/t-1=At-1Xt-1/t-1+wt-1
其中:
因此:
式中,下标t表示当前时刻,下标t-1表示上一时刻,Xt/t-1为利用上一时刻的车辆状态信息来预测车辆在当前时刻的状态信息结果,Xt-1/t-1为上一时刻的最优状态信息结果,Pt/t-1为对应Xt/t-1的***误差协方差矩阵,Pt-1/t-1为对应Xt-1/t-1的***误差协方差矩阵,(x,y)为车辆在二维直角坐标系中的坐标,v为车辆速度,为车辆的航向角,wt-1为***过程噪声的协方差,一般认为过程噪声满足正态分布所以其值为0,A为卡尔曼滤波***参数,Q为***过程的协方差,Δt为上一时刻和当前时刻的时间间隔,因为在该***中并没有控制量输入,所以不需要变换矩阵B。
22)假设观察变量:
Z为从GPS接收到的数据,建立车辆当前GPS数据Z和状态变量的估计方程,满足以下公式:
Xt/t=Xt/t-1+Kgt(Zt-Xt/t-1)
Kgt=Pt/t-1(Pt/t-1+r)-1
式中,Xt/t为当前时刻的最优状态信息结果,为当前车辆GPS数据Z中的坐标、速度和航向角,Kg为最佳卡尔曼增益,r为测量噪声的误差协方差。
23)将根据车辆历史GPS数据和当前GPS数据带入步骤21)和步骤22)的公式,获得对车辆当前位置信息优化预测的第一车辆当前位置(x1,y1),并更新误差协方差矩阵P,满足以下公式:
Pt/t=(I-Kgt)Pt/t-1
式中,I为单位矩阵,Pt/t为对应Xt/t的***误差协方差矩阵。
3)根据车辆历史行驶速度、加速度、航向角、GPS坐标位置信息,结合电子地图信息预测得到第二车辆当前位置。具体为:
31)如图3所示,每条道路Ri被划分为若干个路段Sn,且每条道路所包含的信息有道路上各点的坐标、道路宽度路段长度道路中心线与正北夹角每个路段距离下一个交叉口距离其中,i为道路的序号,n为路段的序号,图3中Intersection为交叉点。
32)将车辆当前GPS数据中的位置信息标定在电子地图上,以车辆均行驶在车道上为前提,判断当前车辆的坐标是否在道路上,若是,执行步骤34),若否,则认为该GPS坐标位置信息为错误信息,执行步骤33)。
33)根据反应行车状态的车辆历史GPS数据并结合电子地图信息预测得到第二车辆当前位置(x2,y2),执行步骤4)。其中,步骤33)包括:
331)如图4所示,根据车辆上一时刻的GPS数据获取车辆在道路上行驶的估计距离Dis,满足以下公式:
式中,vt-1、at-1、分别为车辆在上一时刻的速度、加速度、航向角,为车辆上一时刻所在路段的道路中心线与正北的夹角,下标t表示当前时刻,下标t-1表示上一时刻,Δt为上一时刻和当前时刻的时间间隔;
332)判断Dis是否大于为车辆上一时刻所在的路段距下一交叉口的距离,若是,因为GPS更新频率大于1HZ,Δt=Tt-Tt-1≤1s,即两个时刻之间间隔小于1s,所以可以利用车辆上一时刻的航向角来推断车辆当前所在车道,即以车辆上一时刻的航向角为依据确定车辆当前所在道路,当车道的中心线与正北的夹角约等于车辆上一时刻的航向角判断该车道为车辆当前所在车道,用判断式表示为:为该车辆当前所在道路的中心线与正北的夹角,ε为设定值并取值为[0°,20°],若否,车辆仍在上一时刻所在道路;
333)结合车辆当前所在道路信息预测得到第二车辆当前位置(x2,y2),执行步骤4),图4中,为当前时刻错误的GPS点,(xt-1,yt-1)为上一时刻的位置,则当前时刻估计位置(xt,yt)作为(x2,y2)。
34)即为第二车辆当前位置(x2,y2),执行步骤4)。
4)融合第一车辆当前位置和第二车辆当前位置得到预测的车辆最优位置。具体为:
41)根据第一车辆当前位置(x1,y1)得到误差协方差P1,根据第二车辆当前位置(x2,y2)得到误差协方差P2,此P1、P2的解算运用同步骤21)中的公式;
42)利用P1、P2融合(x1,y1)和(x2,y2)得到车辆最优位置(xf,yf),满足以下公式:
5)结合预测的车辆最优位置与TCC算法,进行车辆碰撞预警。具体为:
51)将车辆最优位置标记在同一坐标系中,利用电子地图的道路拓扑结构,针对有轨迹相交的车辆,采用TCC算法得到两辆车到达相交点时间差tTCC。其中,利用电子地图的道路拓扑结构剔除不可能碰撞的情况来获取有轨迹相交的车辆情况,不可能碰撞的情况包括:
a、两辆车在相邻道路,但道路中间有隔离带,则两辆车不会相撞;
b、两辆车在两条不同的道路,且两条道路并无交叉口,即使两辆车轨迹相交也不会相撞;
c、两辆车在方向不同的道路上行驶,且两辆车之间距离随时间而增大,则两辆车不会相撞。
52)设定与车辆速度大小有关的报警阈值,当tTCC小于报警阈值,则表明车辆之间有碰撞危险,并发出报警。其中,与车辆速度大小有关的报警阈值包括:
当车辆速度小于等于30km/h,对应的报警阈值为5s;
当车辆速度大于30km/h且小于等于60km/h,对应的报警阈值为7s;
当车辆速度大于60km/h且小于等于90km/h,对应的报警阈值为10s;
当车辆速度大于90km/h且小于等于120km/h,对应的报警阈值为12s。
因此,本发明基于局部地理范围内的车辆共享运动状态信息和位置信息,采用电子地图信息来优化车辆位置信息进而提升车辆定位精度,使用“两车最近距离及到达最近距离所需时间”指标来判断车辆是否有碰撞可能性及安全等级,可以保证安全预警的高可靠性,为车联网中的辅助驾驶安全提供了一种实用性强、可靠性高的实现方法。
如图5所示,以道路上两辆车A、B为例,进行详细说明:
1、假如道路上只有两辆车A、B。且行驶在交叉口,当前时刻接收到GPS数据显示两车坐标分别为A(121.223893E,31.291575N)、B(121.224172E,31.290233N),如图6所示,其中B车车速为15m/s,A车车速为20m/s。
2、将A、B车坐标在电子地图上定位,发现B车坐标在车道外,但是当前车辆行驶在车道中心线上,则判定B(121.224172E,31.290233N)为错误坐标。
3、上一时刻B车坐标为(121.224176E,31.29014N),车速为18m/s,航向角为32°。结合车辆历史轨迹,利用卡尔曼滤波算法来进行当前车辆坐标估计,得到车辆当前位置估计值为(121.224347E,31.290313N)。
4、同时利用电子地图信息判断车辆B当前坐标信息。首先,获取B车上一时刻准确的GPS坐标(121.224176E,31.29014N),利用公式求出Dis。其中B车上一时刻的数据为(18m/s,2.3m/s2,32°),且B车辆当前行驶道路的方向角H=31.6°,Δt=1s。则通过计算得出Dis≈17.64。
5、因为B车上时刻距离下一路口距离D=90m>Dis,说明当前时刻B车仍行驶在当前道路上(图5中同丁路)根据车道信息,可通过电子地图来对应找到当前车辆的坐标位置为(121.224316E,31.290294N)。
6、根据历史数据分析得到P1=1.3,P2=2.5,根据公式得到B车坐标最优解(121.224336E,31.2903065N)。
7、判断两车在两条不同车道上,且两条车道交叉有交叉路口,因此两车有碰撞可能。再求出tTCC进一步判断两车碰撞可能。
8、由两车航向角及坐标可判断两车轨迹在路口相交,路口坐标为(121.22494E,31.290938N)。
9、根据求得B车坐标及A车坐标,计算A、B车到达路***叉点所需时间为分别为4.5s、3.536s,tTCC=4.5-3.536=0.964s<5s,则发出警报。
图7为实际测试过程中加入电子地图(CCWS)与不加入电子地图(CWS)时车辆碰撞预警准确率(Hit Rate),从图中可看出加入电子地图的碰撞预警准确率明显高于未加入电子地图。
与传统的基于超声波、雷达、激光等车载传感器的车载主动安全应用相比,基于电子地图的车联网主动安全应用在稳定性、有效距离、成本控制等方面具有明显优势。由于车与车、车与路边单元能够共享信息,所以车联网主动安全应用不受距离的限制。另外,它对传感器的精密性要求并不高,极大地降低了成本且提升了稳定性,具有很高的实际推广价值。将电子地图信息纳入安全碰撞预警体系中,充分利用道路信息及道路拓扑结构来辅助车辆准确定位,进一步提升碰撞预警精度,本发明因此而来。
综上,本发明区别于同类技术,在车载GPS和车车通信的基础上,主要结合了电子地图信息,利用具体道路拓扑结构及道路信息,来优化GPS定位坐标,可以提前通知驾驶员可能发生的碰撞危险状况,辅助安全驾驶,增加车辆定位精度及报警准确率,从而极大地避免了安全事故的发生。且本发明无需额外设置任何传感器设备。
上述实施例仅用于说明本发明的原理及其功效,而非用于限制本发明。任何熟悉此技术的人士皆可在不违背本发明的精神及范畴下,对上述实施例进行修饰或调整。因此,举凡所属技术领域中具有通常知识者在未脱离本发明所揭示的精神与技术思想的条件下所完成的一切等效修饰或改变,仍应由本发明的权利要求所涵盖。
Claims (8)
1.一种基于电子地图的车辆碰撞预警方法,其特征在于,包括以下步骤:
1)获取车辆的GPS数据,所述GPS数据包括运动状态信息和位置信息,采用坐标系转化将车辆位置信息映射至二维直角坐标系中;
2)根据车辆历史GPS数据,采用卡尔曼滤波算法对车辆当前位置信息进行优化预测得到第一车辆当前位置;
3)根据车辆历史GPS数据,结合电子地图信息预测得到第二车辆当前位置;
4)融合第一车辆当前位置和第二车辆当前位置得到预测的车辆最优位置;
5)结合预测的车辆最优位置与TCC算法,进行车辆碰撞预警;
所述步骤1)具体为:
11)行驶车辆获取本车的GPS数据,同时与本车通信范围内的邻居车辆进行通信,获取邻居车辆的GPS数据;
12)建立以本车为原点的二维直角坐标系,并将接收到的邻居车辆的位置信息映射至该二维直角坐标系中;
所述步骤12)具体为:
121)由位置信息获得本车的GPS经纬度(lonA,latA)和邻居车辆的GPS经纬度(lonB,latB),按照零度经线的基准,东经取经度的正值,西经取经度的负值,北纬取90-纬度值,南纬取90+纬度值,变换后获得本车的GPS经纬度(mlonA,mlatA)和邻居车辆的GPS经纬度(mlonB,mlatB);
122)获取本车与邻居车辆的距离Distance,满足以下公式:
C=sin(mlatA)·sin(mlatB)·cos(mlonA-mlonB)+cos(mlatA)·cos(mlatB)
Distance=R·arccos(C)·π/180
式中,C为中间量,R为地球半径;
123)以本车为原点建立二维直角坐标系,则本车坐标为(0,0),当lonA>lonB,邻居车辆坐标为(-Distance·cos(|mlatA-mlatB|),Distance·sin(mlatA-mlatB)),当lonA≤lonB,邻居车辆坐标为(Distance·cos(|mlatA-mlatB|),Distance·sin(mlatA-mlatB))。
2.根据权利要求1所述的一种基于电子地图的车辆碰撞预警方法,其特征在于,所述步骤2)具体为:
21)建立状态变量X和***误差协方差矩阵P的递归方程,满足以下公式:
Xt/t-1=At-1Xt-1/t-1+wt-1
式中,下标t表示当前时刻,下标t-1表示上一时刻,Xt/t-1为利用上一时刻的车辆状态信息来预测车辆在当前时刻的状态信息结果,Xt-1/t-1为上一时刻的最优状态信息结果,Pt/t-1为对应Xt/t-1的***误差协方差矩阵,Pt-1/t-1为对应Xt-1/t-1的***误差协方差矩阵,(x,y)为车辆在二维直角坐标系中的坐标,v为车辆速度,为车辆的航向角,wt-1为***过程噪声的协方差,A为卡尔曼滤波***参数,Q为***过程的协方差,Δt为上一时刻和当前时刻的时间间隔;
22)建立车辆当前GPS数据Z和状态变量的估计方程,满足以下公式:
Xt/t=Xt/t-1+Kgt(Zt-Xt/t-1)
Kgt=Pt/t-1(Pt/t-1+r)-1
式中,Xt/t为当前时刻的最优状态信息结果,为当前车辆GPS数据Z中的坐标、速度和航向角,Kg为最佳卡尔曼增益,r为测量噪声的误差协方差;
23)将根据车辆历史GPS数据和当前GPS数据带入步骤21)和步骤22)的公式,获得对车辆当前位置信息优化预测的第一车辆当前位置(x1,y1),并更新误差协方差矩阵P,满足以下公式:
Pt/t=(I-Kgt)Pt/t-1
式中,I为单位矩阵,Pt/t为对应Xt/t的***误差协方差矩阵。
3.根据权利要求1所述的一种基于电子地图的车辆碰撞预警方法,其特征在于,所述步骤3)具体为:
31)每条道路Ri被划分为若干个路段Sn,且每条道路所包含的信息有道路上各点的坐标、道路宽度路段长度道路中心线与正北夹角每个路段距离下一个交叉口距离其中,i为道路的序号,n为路段的序号;
32)将车辆当前GPS数据中的位置信息标定在电子地图上,判断当前车辆的坐标是否在道路上,若是,执行步骤34),若否,执行步骤33);
33)根据车辆历史GPS数据并结合电子地图信息预测得到第二车辆当前位置(x2,y2),执行步骤4);
34)即为第二车辆当前位置(x2,y2),执行步骤4)。
4.根据权利要求3所述的一种基于电子地图的车辆碰撞预警方法,其特征在于,所述步骤33)具体为:
331)根据车辆上一时刻的GPS数据获取车辆在道路上行驶的估计距离Dis,满足以下公式:
式中,vt-1、at-1、分别为车辆在上一时刻的速度、加速度、航向角,为车辆上一时刻所在路段的道路中心线与正北的夹角,下标t表示当前时刻,下标t-1表示上一时刻,Δt为上一时刻和当前时刻的时间间隔;
332)判断Dis是否大于 为车辆上一时刻所在的路段距下一交叉口的距离,若是,以车辆上一时刻的航向角为依据确定车辆当前所在道路, 为该车辆当前所在道路的中心线与正北的夹角,ε为设定值,若否,车辆仍在上一时刻所在道路;
333)结合车辆当前所在道路信息预测得到第二车辆当前位置(x2,y2),执行步骤4)。
5.根据权利要求1所述的一种基于电子地图的车辆碰撞预警方法,其特征在于,所述步骤4)具体为:
41)根据第一车辆当前位置(x1,y1)得到误差协方差P1,根据第二车辆当前位置(x2,y2)得到误差协方差P2;
42)利用P1、P2融合(x1,y1)和(x2,y2)得到车辆最优位置(xf,yf),满足以下公式:
6.根据权利要求1所述的一种基于电子地图的车辆碰撞预警方法,其特征在于,所述步骤5)具体为:
51)将车辆最优位置标记在同一坐标系中,利用电子地图的道路拓扑结构,针对有轨迹相交的车辆,采用TCC算法得到两辆车到达相交点时间差tTCC;
52)设定与车辆速度大小有关的报警阈值,当tTCC小于报警阈值,则表明车辆之间有碰撞危险,并发出报警。
7.根据权利要求6所述的一种基于电子地图的车辆碰撞预警方法,其特征在于,所述步骤51)中利用电子地图的道路拓扑结构剔除不可能碰撞的情况来获取有轨迹相交的车辆情况,所述不可能碰撞的情况包括:
a、两辆车在相邻道路,但道路中间有隔离带,则两辆车不会相撞;
b、两辆车在两条不同的道路,且两条道路并无交叉口,即使两辆车轨迹相交也不会相撞;
c、两辆车在方向不同的道路上行驶,且两辆车之间距离随时间而增大,则两辆车不会相撞。
8.根据权利要求6所述的一种基于电子地图的车辆碰撞预警方法,其特征在于,所述步骤52)中与车辆速度大小有关的报警阈值包括:
当车辆速度小于等于30km/h,对应的报警阈值为5s;
当车辆速度大于30km/h且小于等于60km/h,对应的报警阈值为7s;
当车辆速度大于60km/h且小于等于90km/h,对应的报警阈值为10s;
当车辆速度大于90km/h且小于等于120km/h,对应的报警阈值为12s。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201510475551.8A CN105206108B (zh) | 2015-08-06 | 2015-08-06 | 一种基于电子地图的车辆碰撞预警方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201510475551.8A CN105206108B (zh) | 2015-08-06 | 2015-08-06 | 一种基于电子地图的车辆碰撞预警方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN105206108A CN105206108A (zh) | 2015-12-30 |
CN105206108B true CN105206108B (zh) | 2017-06-13 |
Family
ID=54953747
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201510475551.8A Expired - Fee Related CN105206108B (zh) | 2015-08-06 | 2015-08-06 | 一种基于电子地图的车辆碰撞预警方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN105206108B (zh) |
Families Citing this family (40)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN105691391B (zh) * | 2016-03-02 | 2017-11-28 | 同济大学 | 一种考虑驾驶员反应差异性特征的前向避撞预警算法 |
CN105702093B (zh) * | 2016-04-21 | 2018-01-02 | 江苏联盟信息工程有限公司 | 一种基于经纬度采集点的车道判定方法及定位装置 |
CN106080593A (zh) * | 2016-07-01 | 2016-11-09 | 苏州科技大学 | 一种车辆智能防碰撞***及防碰撞方法 |
FR3054684B1 (fr) * | 2016-07-29 | 2018-08-24 | Institut Vedecom | Systeme de pilotage d’un vehicule autonome |
US10139244B2 (en) * | 2016-08-17 | 2018-11-27 | Veoneer Us Inc. | ADAS horizon and vision supplemental V2X |
CN106525033A (zh) * | 2016-09-22 | 2017-03-22 | 深圳市元征科技股份有限公司 | 一种行车轨迹的确定方法及其装置 |
CN106355890B (zh) * | 2016-09-27 | 2019-03-05 | 东软集团股份有限公司 | 一种对目标车辆分类的判断方法及装置 |
CN108257418A (zh) * | 2016-12-28 | 2018-07-06 | 上海汽车集团股份有限公司 | 车辆碰撞预警方法及装置 |
CN108257417A (zh) * | 2016-12-28 | 2018-07-06 | 上海汽车集团股份有限公司 | 用于路侧单元的车辆碰撞预警方法及装置 |
CN107121980B (zh) * | 2017-03-17 | 2019-07-09 | 北京理工大学 | 一种基于虚拟约束的自动驾驶车辆路径规划方法 |
CN107133359B (zh) * | 2017-05-31 | 2020-11-20 | 北京三驰惯性科技股份有限公司 | 一种车辆侧翻预警特征点与电子地图匹配方法及装置 |
CN109389864A (zh) * | 2017-08-09 | 2019-02-26 | 湖南大学 | 一种车辆相对定位及碰撞预警方法 |
CN107945574B (zh) * | 2017-10-25 | 2020-04-10 | 东软集团股份有限公司 | 一种车辆碰撞预警方法、装置及设备 |
CN109703456B (zh) * | 2017-10-25 | 2022-04-05 | 上海汽车集团股份有限公司 | 一种防止汽车碰撞的警示方法、装置及汽车控制器 |
CN111819419B (zh) * | 2017-12-27 | 2024-03-08 | 宝马股份公司 | 用于车辆的数字地图的变形校正 |
CN110031876A (zh) * | 2018-01-11 | 2019-07-19 | 中南大学 | 一种基于卡尔曼滤波的车载导航轨迹点偏移矫正方法 |
CN108519738A (zh) * | 2018-04-13 | 2018-09-11 | 中国科学院微电子研究所 | 一种车辆运动状态信息延时补偿方法和装置 |
WO2019202626A1 (ja) * | 2018-04-16 | 2019-10-24 | 三菱電機株式会社 | 車両用通信装置 |
CN110617815B (zh) * | 2018-06-19 | 2023-10-10 | 上海汽车集团股份有限公司 | 一种自动驾驶监控告警的方法和装置 |
CN110728875B (zh) * | 2018-07-16 | 2022-03-18 | 西安合众思壮导航技术有限公司 | 一种模拟车辆驾驶的方法及装置 |
CN109523830B (zh) * | 2018-11-08 | 2021-08-03 | 中交第一公路勘察设计研究院有限公司 | 基于高频高精度定位信息的车辆轨迹预测及碰撞预警方法 |
CN111179624A (zh) * | 2018-11-13 | 2020-05-19 | 奥迪股份公司 | 碰撞预警方法、装置、计算机设备和存储介质 |
US11862012B2 (en) * | 2018-11-29 | 2024-01-02 | Hitachi Astemo, Ltd. | Vehicle control system and server |
CN111275609B (zh) * | 2018-12-05 | 2023-03-24 | 杭州海康威视数字技术股份有限公司 | 一种pt坐标与gps坐标的转换方法、装置及球机 |
CN109658700A (zh) * | 2019-03-05 | 2019-04-19 | 上汽大众汽车有限公司 | 交叉路口防撞预警装置及预警方法 |
CN111665372A (zh) * | 2019-03-07 | 2020-09-15 | 北京奇虎科技有限公司 | 一种碰撞检测方法及装置 |
CN111665011A (zh) * | 2019-03-07 | 2020-09-15 | 北京奇虎科技有限公司 | 一种碰撞检测方法及装置 |
CN110006422B (zh) * | 2019-03-28 | 2021-03-09 | 浙江吉利汽车研究院有限公司 | 一种设备安全运行参数的确定方法、装置、设备和存储介质 |
CN110148312B (zh) * | 2019-04-30 | 2021-04-16 | 惠州市德赛西威智能交通技术研究院有限公司 | 一种基于v2x***的碰撞预警方法、装置和存储介质 |
CN110097783A (zh) * | 2019-05-15 | 2019-08-06 | 芜湖汽车前瞻技术研究院有限公司 | 车辆预警方法及*** |
CN110310481A (zh) * | 2019-06-28 | 2019-10-08 | 浙江吉利控股集团有限公司 | 一种车辆碰撞预警方法、装置及设备 |
CN111105644A (zh) * | 2019-11-22 | 2020-05-05 | 京东数字科技控股有限公司 | 一种车辆盲区监测、行驶控制方法、装置及车路协同*** |
CN111243274A (zh) * | 2020-01-20 | 2020-06-05 | 陈俊言 | 面向非网联交通个体的道路碰撞预警***及方法 |
CN111739289B (zh) * | 2020-06-02 | 2024-02-20 | 腾讯科技(深圳)有限公司 | 车辆预警信息的处理方法及装置 |
CN111862633A (zh) * | 2020-06-23 | 2020-10-30 | 东风汽车集团有限公司 | 一种基于v2x的交通信号灯控制方法、路侧单元及*** |
CN113096441B (zh) * | 2021-03-25 | 2022-08-05 | 北京星云互联科技有限公司 | 一种车辆预警方法、装置、车辆及存储介质 |
CN113706927B (zh) * | 2021-08-16 | 2023-02-28 | 中汽创智科技有限公司 | 一种车辆预警方法、装置、电子设备、存储介质及程序产品 |
CN114387786B (zh) * | 2022-01-26 | 2023-03-21 | 青岛海信网络科技股份有限公司 | 一种路口车辆运行状态预测方法及装置 |
CN115331461B (zh) * | 2022-07-28 | 2023-12-29 | 武汉理工大学 | 一种无信号交叉口混合交通通行控制方法、装置及车辆 |
CN117115759B (zh) * | 2023-04-12 | 2024-04-09 | 盐城工学院 | 一种基于类别引导的路侧交通目标检测***及方法 |
Family Cites Families (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP4650899B2 (ja) * | 2006-10-13 | 2011-03-16 | 三菱電機株式会社 | 安全支援情報提供車載システム |
US8935086B2 (en) * | 2007-02-06 | 2015-01-13 | GM Global Technology Operations LLC | Collision avoidance system and method of detecting overpass locations using data fusion |
CN101488290B (zh) * | 2009-02-27 | 2011-01-05 | 清华大学 | 一种防后车追尾预警方法及其预警*** |
CN103578294B (zh) * | 2013-10-28 | 2015-12-30 | 北京航空航天大学 | 一种基于专用短程通信的弯道协同避撞预警方法 |
CN104157167B (zh) * | 2014-08-28 | 2016-09-28 | 银江股份有限公司 | 一种基于协同相对定位技术的车辆防碰撞方法 |
-
2015
- 2015-08-06 CN CN201510475551.8A patent/CN105206108B/zh not_active Expired - Fee Related
Also Published As
Publication number | Publication date |
---|---|
CN105206108A (zh) | 2015-12-30 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN105206108B (zh) | 一种基于电子地图的车辆碰撞预警方法 | |
CN103760904B (zh) | 一种语音播报式智能车辆路径规划装置与实施方法 | |
US9725037B2 (en) | Message occlusion detection system and method in a vehicle-to-vehicle communication network | |
CN105109491B (zh) | 一种基于弯道纵向曲率的车辆行驶航向预测装置及预测方法 | |
CN103177596B (zh) | 一种交叉路口自主管控*** | |
CN205334746U (zh) | 一种基于车路协同技术的车载虚拟道路状态显示*** | |
CN103996293B (zh) | 基于车友协同的实时路况采集查询***及采集查询方法 | |
CN104269073A (zh) | 一种基于车车通信的逆向车道超车预警方法 | |
CN108011947A (zh) | 一种车辆协作式编队行驶*** | |
CN202193050U (zh) | 一种新型的防碰撞*** | |
CN104867356A (zh) | 一种基于DSRC和Telematics的车辆威胁评估*** | |
CN105513391A (zh) | 一种基于车路协同技术的车载虚拟道路状态显示*** | |
CN105427669A (zh) | 一种基于dsrc车车通信技术的防撞预警方法 | |
CN104554105A (zh) | 一种汽车防碰撞网络预警方法及装置与验证实验平台 | |
CN102928816A (zh) | 一种面向隧道环境的车辆高可靠组合定位方法 | |
CN103871273A (zh) | 车载通信装置、车辆及车辆通信方法 | |
CN207264194U (zh) | 集装箱卡车自动驾驶*** | |
CN106114357A (zh) | 一种车辆转弯时防剐蹭装置及方法 | |
CN105792135A (zh) | 一种定位车辆所在车道的方法及装置 | |
CN107221195A (zh) | 汽车车道预测方法及车道级地图 | |
AU2021106247A4 (en) | Vehicle fusion positioning method based on V2X and laser point cloud registration for advanced automatic driving | |
US20210031780A1 (en) | Driving data used to improve infrastructure | |
CN109460025A (zh) | 车辆的控制装置及*** | |
CN107200016A (zh) | 道路自适应预测方法及采用该方法的车辆*** | |
CN113009912A (zh) | 一种基于混合a星的低速商用无人车路径规划算法 |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
C06 | Publication | ||
PB01 | Publication | ||
C10 | Entry into substantive examination | ||
SE01 | Entry into force of request for substantive examination | ||
GR01 | Patent grant | ||
GR01 | Patent grant | ||
CF01 | Termination of patent right due to non-payment of annual fee | ||
CF01 | Termination of patent right due to non-payment of annual fee |
Granted publication date: 20170613 |