CN109859528B - 一种基于v2x车联网的弯道处车辆位置分类方法 - Google Patents
一种基于v2x车联网的弯道处车辆位置分类方法 Download PDFInfo
- Publication number
- CN109859528B CN109859528B CN201910146111.6A CN201910146111A CN109859528B CN 109859528 B CN109859528 B CN 109859528B CN 201910146111 A CN201910146111 A CN 201910146111A CN 109859528 B CN109859528 B CN 109859528B
- Authority
- CN
- China
- Prior art keywords
- vehicle
- lane
- curvature
- track
- adjacent
- 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.)
- Active
Links
Images
Landscapes
- Traffic Control Systems (AREA)
Abstract
本发明公开了一种基于V2X车联网的弯道处车辆位置分类方法利用主车的V2X基础数据,并结合历史路径信息,进行路径预测,再与远车的位置信息比对,从而为碰撞预警类场景提供有效输入,可以极大地提升预警判断的准确性。
Description
技术领域
本发明涉及V2X(Vehicle to everything)车联网领域,尤其涉及一种基于V2X车联网的弯道处车辆位置分类方法。
背景技术
现有的适用于弯道上的碰撞避免方法,均是依靠毫米波雷达检测或是单纯依赖GNSS(Global Navigation Satellite System)提供的车辆位置、速度和行驶方向等定位信息,进行车辆位置信息识别,进而对车辆的碰撞进行预警。例如公开号为CN206441349U的中国实用新型专利,公开了“一种弯道防碰撞预警系统”,其通过路侧毫米波雷达检测入弯方向车辆,并将车辆信息通过电子屏进行显示,此种系统存在误报的风险,监测的准确率依赖于毫米波雷达的准确率,因此误报会导致预警失效,产生安全隐患。
公告号为CN106004873A的中国发明专利,公开了“一种基于V2X车联网的汽车弯道避撞与稳定性系统协调控制方法”,利用V2X车联网技术中的基础数据建立汽车弯道避撞安全距离方程和汽车期望横摆角速度方程,进而设计汽车弯道避撞与稳定性系统协调控制的方法,此种方法缺少历史路径的支撑,仅依靠基础数据无法在弯道处准确判断车辆下一时刻的动作,因此预测不够准确。
因此亟需一种安全准确的弯道上判断车辆位置分类方法。
发明内容
本发明目的是提供一种基于V2X车联网的弯道处车辆位置分类方法,从而为碰撞预警类场景提供有效输入,并可以极大地提高预警判断的准确性。
本发明解决技术问题采用如下技术方案:
一种基于V2X车联网的弯道处车辆位置分类方法,包括以下步骤:
S10、获取车辆A和车辆B的车辆信息;
S20、比较VA、VB和速度阈值Vmin,若车辆A和车辆B的车速均大于等于速度阈值Vmin,则执行步骤S30;否则,执行步骤S10;
S30、分别计算获取车辆A的曲率KA和车辆B的曲率KB;
S40、比较KA、KB和曲率阈值Kmin;若车辆A和车辆B的曲率均大于等于曲率阈值Kmin,则执行步骤S50;否则,执行步骤S10;
S50、分别计算获取车辆A的曲率半径RA和车辆B的曲率半径RB;
S60、计算车辆A的轨迹圆点和车辆B的轨迹圆点之间的距离;
S70、判断车辆A和车辆B是否处于同一道路;若是,则执行S80;否则执行S10;
S80、根据车辆A和车辆B的曲率半径与车辆A的转向,确定车辆A和车辆B的位置。
进一步,步骤S10中,车辆A和车辆B的车辆信息包括经纬度、速度、行驶方向和横向角速度。
进一步,步骤S30中,车辆在弯道上行驶的曲率计算公式为:
K=ω/V
其中,ω为车辆横向角速度,V为车辆的速度;
曲率的二阶低通滤波公式为:
n≥3
初始化:y1=u1 y2=u2
其中,ω0=2πf0,f0为截至频率,ζ为阻尼因子,TS为采样时间。
进一步,步骤S50中,曲率半径的计算公式为:
R=1/K
其中K为车辆的曲率。
进一步,步骤S80中,若|RA-RB|≤(Dlane*0.5),则车辆A和车辆B处于同一车道;
若(Dlane*0.5)<|RA-RB|≤(Dlane*1.5),如果RA>RB,车辆A左转,则车辆B位于车辆A左相邻车道;如果RA>RB,车辆A右转,则车辆B位于车辆A右相邻车道;如果RA<RB,车辆A左转,则车辆B位于车辆A右相邻车道;如果RA<RB,车辆A右转,则车辆B位于车辆A左相邻车道;
若(Dlane*1.5)<|RA-RB|,如果RA>RB,车辆A左转,则车辆B位于车辆A左端非相邻车道;如果RA>RB,车辆A右转,则车辆B位于车辆A右端非相邻车道;如果RA<RB,车辆A左转,则车辆B位于车辆A右端非相邻车道;如果RA<RB,车辆A右转,则车辆B位于车辆A左端非相邻车道;
其中,RA为车辆A的曲率半径,RB为车辆B的曲率半径,Dlane为车道宽度。
本发明具有如下有益效果:本发明的基于V2X车联网的弯道处车辆位置分类方法利用主车的V2X基础数据,并结合历史路径信息,进行路径预测,再与远车的位置信息比对,从而为碰撞预警类场景提供有效输入,可以极大地提升预警判断的准确性。
附图说明
图1为本发明的基于V2X车联网的弯道处车辆位置分类方法应用于安全应用场景的示意图;
图2为V2X系统目标分类方法的系统框图;
图3为本发明的基于V2X车联网的弯道处车辆位置分类方法的流程图。
具体实施方式
下面结合实施例及附图对本发明的技术方案作进一步阐述。
实施例1
本实施例提供了一种基于V2X车联网的弯道处车辆位置分类方法,解决弯道处车辆位置的分类问题,为V2X碰撞预警类场景提供其要求的位置数据。
如图1所示,本发明处理的实际场景为本车和远车均处于弯道的行驶状态,且车辆之间使用V2X车联网技术进行通信,共享信息。当本车和远车均行驶于直道上时,可以通过两车间距、行驶方向角计算出两车的横向距离,从而容易判定出两车的相对位置关系;但当两车均处于弯道时,由于道路曲率的影响,横向距离不能再作为判定两车相对位置的依据。假定本车为车辆A,则本发明提供的基于V2X车联网技术的弯道处车辆位置分类方法可以仅通过传感器模块输入的数据,确定远车B相对本车A的位置为反向相邻左前方车道。
如图2所示为V2X系统目标分类方法的系统框图。具体地,本车的目标分类模块从传感器数据处理模块获取本车的经纬度,速度、行驶方向和横向角速度等信息,从无线消息处理模块获取远车的经纬度,速度、行驶方向和横向角速度等信息,并根据本车和远车信息判断两车的行驶状态,然后根据不同的行驶状态按照不同的车辆位置分类方法对弯道上的本车和远车的相对位置进行判定,进而输出给上层的碰撞类应用场景,能够使应用场景提升在弯道上的判定性能。
本发明的基于V2X车联网的弯道处车辆位置分类方法为V2X系统目标分类方法中目标分类模块的子系统,用于提供对主车和远车均行驶于弯道情况下的目标分类功能。此外,目标分类模块还包括非弯道车辆位置分类方法,用于提供为主车和远车行驶在非弯道情况下的目标分类功能。
具体地,一种基于V2X车联网的弯道处车辆位置分类方法,包括以下步骤:
S10、获取车辆A和车辆B的车辆信息;
在本发明中,车辆A的目标分类模块从传感器数据处理模块获取车辆A的经纬度、速度(VA)、行驶方向(HA)和横向角速度(ωA),并从无线处理模块获取车辆B的经纬度、速度(VB)、行驶方向(HB)和横向角速度(ωB)。
S20、比较VA、VB和速度阈值Vmin,若车辆A和车辆B的车速均大于等于速度阈值Vmin,则执行步骤S30;否则,执行步骤S10;
具体地,当车速速度很小时,其角速度也会很小,这样计算的曲率半径就会很大,就相当于在一个半径很大的圆的弯道上,近似于直线了。
因此,如果本发明中车辆的速度小于速度阈值Vmin,则该车当前行驶于直道上;若车辆A和车辆B任一车辆车速小于速度阈值,或者车辆A和车辆B的车速都小于速度阈值,则执行步骤S10。
S30、分别计算获取车辆A的曲率KA和车辆B的曲率KB;
S40、比较KA、KB和曲率阈值Kmin;若车辆A和车辆B的曲率均大于等于曲率阈值Kmin,则执行步骤S50;否则,执行步骤S10;
在本发明中,为了过滤掉由于车身晃动或正常变道带来的曲率瞬时变化的干扰,让两车的曲率通过二阶低通滤波计算。
具体地,车辆在弯道上行驶的瞬时曲率计算公式为:
K=ω/V
其中,ω为车辆横向角速度,V为车辆的速度。
曲率的二阶低通滤波公式为:
n≥3
初始化:y1=u1 y2=u2
其中,ω0=2πf0,f0为截至频率,ζ为阻尼因子,TS为采样时间。
S50、分别计算获取车辆A的曲率半径RA和车辆B的曲率半径RB;
在本发明中,曲率半径的计算公式为:
R=1/K
S60、计算车辆A的轨迹圆点和车辆B的轨迹圆点之间的距离;
在本发明中,选择车辆A的位置作为坐标原点,定正北(0度)为Y轴正向,正东(90度)为X轴正向,则车辆A的坐标为(0,0),通过车辆A的经纬度和车辆B的经纬度,获取原点到车辆B的方向角AB和距离DB,则车辆B的横坐标xB=DB*sin(AB*π/180),纵坐标yB=DB*cos(AB*π/180)。
在本发明中,依据车辆A的横向角速度(ωA),判断车辆处于转向状态;若左转,则车辆A的轨迹圆点坐标:
xA0=xA+RA*sin((HA-90)*π/180)
yA0=yA+RA*cos((HA-90)*π/180)
若右转,则车辆A的轨迹圆点坐标:
xA0=xA+RA*sin((HA+90)*π/180)
yA0=yA+RA*cos((HA+90)*π/180)
同样的计算方式,获取车辆B的轨迹圆点坐标xB0和yB0;
因此,车辆A的轨迹圆点和车辆B的轨迹圆点之间距离:
S70、判断车辆A和车辆B是否处于同一道路;若是,则执行S80;否则执行S10;
在本发明中,若车辆A的轨迹圆点和车辆B的轨迹圆点之间距离大于圆点距离阈值Dmax时,则车辆A和车辆B不处于同一道路;当车辆A的轨迹圆点和车辆B的轨迹圆点之间距离小于等于圆点距离阈值Dmax时,车辆A和车辆B处于同一道路。
S80、根据车辆A和车辆B的曲率半径与车辆A的转向,确定车辆A和车辆B的位置。
在本发明中,设定车道宽度Dlane,若|RA-RB|≤(Dlane*0.5),则车辆A和车辆B处于同一车道;
若(Dlane*0.5)<|RA-RB|≤(Dlane*1.5),如果RA>RB,车辆A左转,则车辆B位于车辆A左相邻车道;如果RA>RB,车辆A右转,则车辆B位于车辆A右相邻车道;如果RA<RB,车辆A左转,则车辆B位于车辆A右相邻车道;如果RA<RB,车辆A右转,则车辆B位于车辆A左相邻车道;
若(Dlane*1.5)<|RA-RB|,如果RA>RB,车辆A左转,则车辆B位于车辆A左端非相邻车道;如果RA>RB,车辆A右转,则车辆B位于车辆A右端非相邻车道;如果RA<RB,车辆A左转,则车辆B位于车辆A右端非相邻车道;如果RA<RB,车辆A右转,则车辆B位于车辆A左端非相邻车道。
以上实施例的先后顺序仅为便于描述,不代表实施例的优劣。
最后应说明的是:以上实施例仅用以说明本发明的技术方案,而非对其限制;尽管参照前述实施例对本发明进行了详细的说明,本领域的普通技术人员应当理解:其依然可以对前述各实施例所记载的技术方案进行修改,或者对其中部分技术特征进行等同替换;而这些修改或者替换,并不使相应技术方案的本质脱离本发明各实施例技术方案的精神和范围。
Claims (4)
1.一种基于V2X车联网的弯道处车辆位置分类方法,其特征在于,包括以下步骤:
S10、获取车辆A和车辆B的车辆信息;
S20、比较VA、VB和速度阈值Vmin,若车辆A和车辆B的车速均大于等于速度阈值Vmin,则执行步骤S30;否则,执行步骤S10;
S30、分别计算获取车辆A的曲率KA和车辆B的曲率KB;
S40、比较KA、KB和曲率阈值Kmin;若车辆A和车辆B的曲率均大于等于曲率阈值Kmin,则执行步骤S50;否则,执行步骤S10;
S50、分别计算获取车辆A的曲率半径RA和车辆B的曲率半径RB;
S60、计算车辆A的轨迹圆点和车辆B的轨迹圆点之间的距离;
S70、判断车辆A和车辆B是否处于同一道路;若是,则执行S80;否则执行S10;
S80、根据车辆A和车辆B的曲率半径与车辆A的转向,确定车辆A和车辆B的位置;
其中,步骤S60中,车辆A的轨迹圆点和车辆B的轨迹圆点之间距离:
式中,χA0和yA0为车辆A的轨迹原点坐标;χB0和yB0和为车辆B的轨迹原点坐标;步骤S70中,若车辆A的轨迹圆点和车辆B的轨迹圆点之间距离大于圆点距离阈值时,则车辆A和车辆B不处于同一道路;当车辆A的轨迹圆点和车辆B的轨迹圆点之间距离小于等于圆点距离阈值时,车辆A和车辆B处于同一道路;
步骤S80中,若|RA-RB|≤(Dlane*0.5),则车辆A和车辆B处于同一车道;
若(Dlane*0.5)<|RA-RB|≤(Dlane*1.5),如果RA>RB,车辆A左转,则车辆B位于车辆A左相邻车道;如果RA>RB,车辆A右转,则车辆B位于车辆A右相邻车道;如果RA<RB,车辆A左转,则车辆B位于车辆A右相邻车道;如果RA<RB,车辆A右转,则车辆B位于车辆A左相邻车道;
若(Dlane*1.5)<|RA-RB|,如果RA>RB,车辆A左转,则车辆B位于车辆A左端非相邻车道;如果RA>RB,车辆A右转,则车辆B位于车辆A右端非相邻车道;如果RA<RB,车辆A左转,则车辆B位于车辆A右端非相邻车道;如果RA<RB,车辆A右转,则车辆B位于车辆A左端非相邻车道;
其中,RA为车辆A的曲率半径,RB为车辆B的曲率半径,Dlane为车道宽度。
2.根据权利要求1中的基于V2X车联网的弯道处车辆位置分类方法,其特征在于,步骤S10中,车辆A和车辆B的车辆信息包括经纬度、速度、行驶方向和横向角速度。
4.根据权利要求1中的基于V2X车联网的弯道处车辆位置分类方法,其特征在于,步骤S50中,曲率半径的计算公式为:
R=1/K
其中K为车辆的曲率。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201910146111.6A CN109859528B (zh) | 2019-02-27 | 2019-02-27 | 一种基于v2x车联网的弯道处车辆位置分类方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201910146111.6A CN109859528B (zh) | 2019-02-27 | 2019-02-27 | 一种基于v2x车联网的弯道处车辆位置分类方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN109859528A CN109859528A (zh) | 2019-06-07 |
CN109859528B true CN109859528B (zh) | 2021-12-10 |
Family
ID=66899193
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201910146111.6A Active CN109859528B (zh) | 2019-02-27 | 2019-02-27 | 一种基于v2x车联网的弯道处车辆位置分类方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN109859528B (zh) |
Families Citing this family (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN112109703A (zh) * | 2020-06-17 | 2020-12-22 | 上汽通用五菱汽车股份有限公司 | 车辆控制方法、车辆控制系统、车及存储介质 |
CN115567875A (zh) * | 2021-06-30 | 2023-01-03 | 中兴通讯股份有限公司 | 同车道的判断方法、电子设备和计算机可读存储介质 |
CN113674551A (zh) * | 2021-08-05 | 2021-11-19 | 东风汽车集团股份有限公司 | 一种基于车路协同的车辆前向碰撞预警方法与系统 |
CN114187760B (zh) * | 2021-11-29 | 2023-06-09 | 中汽研(天津)汽车工程研究院有限公司 | 一种基于车路协同系统的弯道车辆相对位置分类方法 |
Citations (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN102951151A (zh) * | 2011-08-24 | 2013-03-06 | 现代摩比斯株式会社 | 车辆的车道保持辅助系统及其方法 |
CN106601029A (zh) * | 2017-02-17 | 2017-04-26 | 重庆长安汽车股份有限公司 | 基于弯道自适应的前撞预警方法及系统 |
JP2017078972A (ja) * | 2015-10-20 | 2017-04-27 | トヨタ自動車株式会社 | 運転支援装置 |
CN107830865A (zh) * | 2017-10-16 | 2018-03-23 | 东软集团股份有限公司 | 一种车辆目标分类方法、装置、系统及计算机程序产品 |
CN107945574A (zh) * | 2017-10-25 | 2018-04-20 | 东软集团股份有限公司 | 一种车辆碰撞预警方法、装置及设备 |
CN108053690A (zh) * | 2017-12-29 | 2018-05-18 | 东软集团股份有限公司 | 识别行驶车道的方法、弯道预警方法、装置、介质及设备 |
-
2019
- 2019-02-27 CN CN201910146111.6A patent/CN109859528B/zh active Active
Patent Citations (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN102951151A (zh) * | 2011-08-24 | 2013-03-06 | 现代摩比斯株式会社 | 车辆的车道保持辅助系统及其方法 |
JP2017078972A (ja) * | 2015-10-20 | 2017-04-27 | トヨタ自動車株式会社 | 運転支援装置 |
CN106601029A (zh) * | 2017-02-17 | 2017-04-26 | 重庆长安汽车股份有限公司 | 基于弯道自适应的前撞预警方法及系统 |
CN107830865A (zh) * | 2017-10-16 | 2018-03-23 | 东软集团股份有限公司 | 一种车辆目标分类方法、装置、系统及计算机程序产品 |
CN107945574A (zh) * | 2017-10-25 | 2018-04-20 | 东软集团股份有限公司 | 一种车辆碰撞预警方法、装置及设备 |
CN108053690A (zh) * | 2017-12-29 | 2018-05-18 | 东软集团股份有限公司 | 识别行驶车道的方法、弯道预警方法、装置、介质及设备 |
Also Published As
Publication number | Publication date |
---|---|
CN109859528A (zh) | 2019-06-07 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN109859528B (zh) | 一种基于v2x车联网的弯道处车辆位置分类方法 | |
CN109669451B (zh) | 自主驾驶支持设备及方法 | |
CN107646114B (zh) | 用于估计车道的方法 | |
EP2926330B1 (en) | Vehicle location estimation apparatus and vehicle location estimation method | |
US9645250B2 (en) | Fail operational vehicle speed estimation through data fusion of 6-DOF IMU, GPS, and radar | |
JP4604103B2 (ja) | 交差点見通し検出装置 | |
US11155257B2 (en) | Automatic parking control device | |
CN110271539B (zh) | 一种自动垂直泊车控制系统 | |
CN110969059A (zh) | 车道线识别方法及系统 | |
JP6638531B2 (ja) | 周辺物体検出装置 | |
CN107830865A (zh) | 一种车辆目标分类方法、装置、系统及计算机程序产品 | |
US11042759B2 (en) | Roadside object recognition apparatus | |
CN109693669B (zh) | 一种确定最近在径前车的方法及系统 | |
US10032379B1 (en) | Traffic circle warning system and method | |
JP2008041058A (ja) | 死角移動体を報知するための報知システム、画像処理装置、車載装置及び報知方法 | |
CN114735018A (zh) | 一种基于单雷达的前方最危险目标车辆的筛选判断方法 | |
CN113602265A (zh) | 基于车车通信的处理协同换道方法及系统 | |
CN114559941A (zh) | 车辆弯道行驶预警方法、系统、装置和计算机可读介质 | |
WO2020158598A1 (ja) | 道路認識装置 | |
CN110834626B (zh) | 行车障碍预警方法、装置、车辆和存储介质 | |
CN112258895A (zh) | 一种基于v2x的丁字路口碰撞判断方法 | |
CN114084133B (zh) | 一种跟车目标的确定方法及相关装置 | |
CN112026774B (zh) | 基于自车摄像头、雷达感知信息的周围车辆侧滑识别方法 | |
US20220319324A1 (en) | Collision warning system and method for a vehicle | |
JP7346722B2 (ja) | 運転支援方法及び運転支援装置 |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
PB01 | Publication | ||
PB01 | Publication | ||
SE01 | Entry into force of request for substantive examination | ||
SE01 | Entry into force of request for substantive examination | ||
GR01 | Patent grant | ||
GR01 | Patent grant |