CN105206090A - 一种车辆定位方法 - Google Patents

一种车辆定位方法 Download PDF

Info

Publication number
CN105206090A
CN105206090A CN201510657382.XA CN201510657382A CN105206090A CN 105206090 A CN105206090 A CN 105206090A CN 201510657382 A CN201510657382 A CN 201510657382A CN 105206090 A CN105206090 A CN 105206090A
Authority
CN
China
Prior art keywords
vehicle
lane
line
information
lane change
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.)
Granted
Application number
CN201510657382.XA
Other languages
English (en)
Other versions
CN105206090B (zh
Inventor
陈峥
曹立波
颜凌波
秦勤
Current Assignee (The listed assignees may be inaccurate. Google has not performed a legal analysis and makes no representation or warranty as to the accuracy of the list.)
WUHAN BUS MANUFACTURING Co.,Ltd.
Original Assignee
Xiamen Xingchen Tianyu Automotive Design Co Ltd
Priority date (The priority date 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 date listed.)
Filing date
Publication date
Application filed by Xiamen Xingchen Tianyu Automotive Design Co Ltd filed Critical Xiamen Xingchen Tianyu Automotive Design Co Ltd
Priority to CN201510657382.XA priority Critical patent/CN105206090B/zh
Publication of CN105206090A publication Critical patent/CN105206090A/zh
Application granted granted Critical
Publication of CN105206090B publication Critical patent/CN105206090B/zh
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Abstract

本发明公开了一种车辆定位方法,所述方法包括步骤如下:被定位车辆在进入道路时获取初始第一位置信息,在行驶过程中通过视觉系统获取变道状态;根据变道状态对第一位置信息进行更新;被定位车辆通过车-路协同通讯将第一位置信息发送给路侧单元,路侧单元通过信号分析得到第二位置信息;路侧单元将第一位置信息、第二位置信息和预先储存的道路数学信息进行信息融合,获取被定位车辆的车辆位置信息,路侧单元通过实时通讯将最终位置信息反馈给被定位车辆,得到自身在地图中的具体位置。本定位方法不受地形限制,可在GPS/DGPS精度不理想的城市环境中完成精确定位,以满足智能车辆的避撞、自主驾驶等应用的要求。

Description

一种车辆定位方法
技术领域
本发明涉及车辆定位技术领域,具体涉及一种基于射频识别、车载视觉和车-路协同进行联合定位的车辆定位方法。
背景技术
车联网系统是近年兴起的一种以提高交通效率和交通安全为主要目的的网络与应用系统,车辆定位技术是其中的关键技术,获取精确位置对于提高智能车辆的安全性和实现自主驾驶都具有重要意义。
全球定位系统(GPS)是目前使用最广泛的车辆定位方法,可通过差分法来提高性能,目前差分全球定位系统(DGPS)的定位精度最佳可达厘米级,但在复杂的城市环境中,卫星信号易被遮挡,导致定位精度不佳甚至无法工作,而且价格昂贵。
基于车路协同(V2I)的定位方法,通过分析车联网中车辆与路侧单元的实时通讯信号,测得路侧单元与车辆的距离,再通过一系列定位算法确定车辆位置坐标,虽然该方法不受地形限制,可弥补GPS的不足,但是定位过程中需要车辆与至少三个基站取得通讯,这样大大增加了所需基站数目和建设成本。
另一方面,车辆定位中沿道路横向的定位精度要求高于纵向定位精度要求,纵向的位置误差很容易通过预留纵向距离来补偿,而道路沿横向的距离较短,如果将车辆定位到错误的车道上会对行车安全造成严重威胁,而现有的定位方法无法确保将车辆定位在正确的车道上。
发明内容
本发明的目的在于克服上述现有车辆定位方法存在的不足,而提供一种能够保证车辆纵向定位精度,同时准确判别车辆所处车道的基于射频识别、车载视觉和车-路协同进行联合定位的车辆定位方法。
为实现上述目的,本发明采用以下技术方案:一种车辆定位方法,所述方法包括步骤如下:
被定位车辆在进入道路时获取初始第一位置信息,所述第一位置信息包括道路编号、行驶方向、车道编号;
在行驶过程中通过视觉系统获取变道状态;
根据变道状态对第一位置信息进行更新;
被定位车辆通过车-路协同通讯将第一位置信息发送给路侧单元,路侧单元通过信号分析得到第二位置信息,所述第二位置信息为该路侧单元与被定位车辆之间的距离信息;
路侧单元将第一位置信息、第二位置信息和预先储存的道路数学信息进行信息融合,获取被定位车辆的车辆位置信息,所述道路数学信息包括道路中每条车道的左、右车道线、中心线相对所述路侧单元的数学表达式,所述车辆位置信息包括被定位车辆的实时所处道路编号、行驶方向、车道编号和纵向位置,其中纵向位置是指车辆离所在车道起点的纵向路程;
路侧单元通过实时通讯将车辆位置信息反馈给被定位车辆,车辆根据自身行驶速度算得当前时刻的车辆位置信息,并与预先储存的电子地图进行匹配,得到自身在地图中的具体位置。
优选地,被定位车辆在进入道路时获取初始第一位置信息包括:在需要进行车辆定位的道路的每条车道入口路面上分别布置一枚射频识别标签,所述标签含有道路编号、行驶方向、车道编号,所述道路编号是指该道路在电子地图中的对应编号,所述行驶方向是指该射频标签所在侧道路所允许的车辆通行方向,所述车道编号指明车辆处于哪条车道,编号规则为从该侧道路最右车道向左或从最左侧车道向右编号,依次编为车道1、车道2……车道M,M为该侧道路总车道数;
被定位车辆的底部前端装有射频识别阅读器,当经过车道入口时读取标签中的初始第一位置信息。
优选地,在行驶过程中通过视觉系统获取变道状态包括:
在被定位车辆上装载视觉系统,利用置于汽车前方中间位置的摄像头以检测车辆前方车道线;
判断车道线与车辆的相对位置;
根据上一帧图像和本帧图像中车道线与宽度线的相对位置,判断车辆变道状态。
优选地,判断车道线与车辆的相对位置包括:
在已检测出车道线的图像底部中添加一条代表车辆宽度的横线,在每一帧图像中判断车道线(或其延长线)与宽度线的相对位置;
判断检测到的车道线与车辆的相对位置,相对位置分为“未相交”、“左相交”、“右相交”三种,判断规则包括:
若所有车道线与宽度线均不相交,则判定车道线与宽度线的相对位置为“未相交”;
若任一车道线与宽度线左半部分相交,则判定车道线与宽度线的相对位置为“左相交”;
若任一车道线与宽度线右半部分相交,则判定车道线与宽度线的相对位置为“右相交”。
优选地,根据上一帧图像和本帧图像中车道线与宽度线的相对位置,判断车辆变道状态包括:变道状态包括“开始向左变道”、“开始向右变道”、“完成向右变道”、“完成向左变道”、“正在变道”、“未变道”六种,判断规则包括:
若车道线与宽度线的相对位置在上一帧为“未相交”,在本帧为“左相交”,则判定变道状态为“开始向左变道”;
若车道线与宽度线的相对位置在上一帧为“未相交”,在本帧为“右相交”,则判定变道状态为“开始向右变道”;
若车道线与宽度线的相对位置在上一帧为“右相交”,在本帧为“未相交”,则判定变道状态为“完成向左变道”;
若车道线与宽度线的相对位置在上一帧为“左相交”,在本帧为“未相交”,则判定变道状态为“完成向右变道”;
若车道线与宽度线的相对位置在上一帧为“左相交”或“右相交”,在本帧为“左相交”或“右相交”,则判定变道状态为“正在变道”;
若车道线与宽度线的相对位置在上一帧和本帧均为“未相交”,则判定变道状态为“未变道”。
优选地,根据变道信息对第一位置信息进行更新包括:
若检测到变道状态为“开始向左、向右变道”,则第一位置信息中的车道编号+/-0.5,此时车道编号变为非整数,用以表示车辆处于两车道之间;
若检测到变道状态为“完成向左、向右变道”,则第一位置信息中的车道编号再+/-0.5,此时车道编号变为整数,用以表示车辆已处于另一车道或回到原车道;
若车辆未变道或仍在变道中则第一位置信息中的车道编号不变。
优选地,路侧单元与被定位车辆进行实时通讯获取第一位置信息,并通过信号分析得到第二位置信息包括:
路侧单元与被定位车辆之间使用超宽带脉冲技术或用于测距的无线通讯技术进行通讯,被定位车辆发出包含有第一位置信息的通讯信号,并记录下信号发出时间,路侧单元收到通讯信号后,提取其中的第一位置信息的同时,提取从信号发出到接收经过的时间或用于测距的特征,得到第二位置信息。
优选地,将第一位置信息、第二位置信息和预先储存的道路数学信息进行信息融合,获取被定位车辆的车辆位置信息包括:
预先以路侧单元为原点,以路面为坐标平面,建立局部平面直角坐标系,在该局部坐标系中测绘得到道路中每条车道的左、右车道线、中心线的数学表达式作为道路数学信息;
定位过程中路侧单元根据第一位置信息中的车道编号查询车辆近似行驶路径,若车道编号为整数,则从道路数学信息中查询该车道中心线相对本路侧单元局部坐标系的数学表达式作为车辆行驶路径;若获取的车道编号介于两个整数之间,则查询该两车道之间的车道线的数学表达式作为车辆行驶路径;
在路侧单元局部坐标系中,求出以路侧单元为原点,以第二位置信息为半径的圆与所述车辆行驶路径的两个交点的坐标;
选取距离上一次定位结果较近的交点坐标作为被定位车辆局部坐标,若是初次定位,选取靠近道路入口的交点坐标作为被定位车辆局部坐标;
通过下式将车辆局部坐标转化为纵向位置:
X = A + ∫ a x 1 1 + f ′ ( x ) 2 d x
其中X为车辆纵向位置,x1为车辆在局部坐标系中的横坐标,y=f’(x)为车辆行驶路径y=f(x)关于x的导数,a为车辆行驶路径在该路侧单元监控范围内的起点的局部坐标,A为为车辆行驶路径在该路侧单元监控范围内的起点的纵向位置;
优选地,路侧单元通过实时通讯将车辆位置信息反馈给被定位车辆,车辆根据行驶速度算得当前时刻的车辆位置信息,并与预先储存的电子地图进行匹配,得到自身在地图中的具体位置包括:
车辆接收到车辆位置信息后,利用自身速度计获取行驶速度,根据下式计算得当前时刻的车辆位置信息:
X ~ = X + v · ( t 2 - t 1 )
其中是车辆当前纵向位置,X为路侧单元反馈的车辆纵向位置,v为车辆当前速度,t2为当前时间,t1为车辆之前将第一位置信息发送给路侧单元的时间;
预先储存的电子地图精确到车道,即道路的每条车道都能够在地图上区分,根据车辆所在道路、行驶方向、所处车道和纵向位置匹配地图相应位置,并通过车内屏幕显示出来。
本发明所采用的技术方案具有以下有益效果:本发明通过射频识别技术和车载视觉判别车辆横向位置即所处车道,在此基础上通过车辆与路侧单元之间的通信、测距,计算出车辆纵向位置,完成定位。本定位方法不受地形限制,可在GPS/DGPS精度不理想的城市环境中完成精确定位,以满足智能车辆的避撞、自主驾驶等应用的要求。
附图说明
图1是本发明车辆定位方法流程图;
图2是本发明中路侧单元使用的局部坐标系示意图;
图3是本发明中判断车辆变道状态的流程图;
图4是本发明中车道线与车辆相对位置关系的示意图;
图5是本发明中实时更新车辆所处车道编号的流程图。
具体实施方式
下面结合附图并通过具体实施方式来进一步说明本发明的技术方案。
如图1所示,本发明提供的一种车辆定位方法,具体步骤如下:
101:被定位车辆在进入道路时获取初始第一位置信息,所述第一位置信息包括道路编号、行驶方向、车道编号;
预先在需要进行车辆定位的道路的每条车道入口路面上分别布置一枚射频识别标签,所述标签含有道路编号、行驶方向、车道编号,所述道路编号是指该道路在电子地图中的唯一编号,所述行驶方向是指该射频标签所在侧道路所允许的车辆通行方向。所述车道编号指明车辆处于哪条车道,编号规则为从该侧道路最右车道向左编号,依次编为车道1、车道2……车道M(M为该侧道路总车道数),被定位车辆的底部前端装有射频识别阅读器,当经过车道入口时读取标签中的初始第一位置信息。
该步骤主要是为了使车辆快速、可靠地获取其初始第一位置信息。同时由于射频标签成本极低,而且仅需布置在道路的入口处,故不会显著增加道路建设成本。
102:在行驶过程中通过视觉系统获取变道状态;
由于上一步101车辆通过车道入口只获得了初始第一位置信息,之后车辆有可能进行变道,造成所处车道的改变,故需要对车辆所处车道进行实时更新,该步骤主要是通过前方摄像头观察车辆相对车道线的相对位置,判断车辆所处车道是否发生变化,以及如何变化,获得的变道状态信息可用来更新车辆第一位置信息。
作为优选技术方案,采用下述方法实现上述步骤102,如图3所示,具体包括:
301:利用置于汽车前方中间位置的摄像头以检测车辆前方车道线;
在被定位车辆上装载有视觉系统,利用置于汽车前方中间位置的摄像头获取正前方图像,图像处理器通过车道线检测算法检测出车辆前方车道线。
302:判断检测到的车道线与车辆的相对位置;
具体地,视觉系统在已检测出车道线的图像底部中添加一条代表车辆宽度的横线,在每一帧图像中判断车道线(或其延长线)与宽度线的相对位置,车道线与车辆的相对位置可分为“未相交”、“左相交”、“右相交”三种,如图4所示,给出了“未相交401”、“左相交402”、“右相交403”三种相对位置关系的图例,具体判断规则包括:
若所有车道线与宽度线均不相交,则判定车道线与宽度线的相对位置为“未相交”;
若任一车道线与宽度线左半部分相交,则判定车道线与宽度线的相对位置为“左相交”;
若任一车道线与宽度线右半部分相交,则判定车道线与宽度线的相对位置为“右相交”。
303:根据上一帧图像和本帧图像中车道线与宽度线的相对位置,判断车辆变道状态。
变道状态包括“开始向左变道”、“开始向右变道”、“完成向左变道”、“完成向右变道”、“正在变道”、“未变道”六种,具体判断规则包括:
若车道线与宽度线的相对位置在上一帧为“未相交”,在本帧为“左相交”,则判定变道状态为“开始向左变道”;
若车道线与宽度线的相对位置在上一帧为“未相交”,在本帧为“右相交”,则判定变道状态为“开始向右变道”;
若车道线与宽度线的相对位置在上一帧为“右相交”,在本帧为“未相交”,则判定变道状态为“完成向左变道”;
若车道线与宽度线的相对位置在上一帧为“左相交”,在本帧为“未相交”,则判定变道状态为“完成向右变道”;
若车道线与宽度线的相对位置在上一帧为“左相交”或“右相交”,在本帧为“左相交”或“右相交”,则判定变道状态为“正在变道”;
若车道线与宽度线的相对位置在上一帧和本帧均为“未相交”,则判定变道状态为“未变道”。
103:根据变道状态对第一位置信息进行更新;
利用上一步102获取的车辆变道状态信息,在现有第一位置信息的基础上对车辆所处车道进行更新,若本次更新是车辆进入本道路后第一次更新,则所述现有第一位置信息是步骤101中获取的原始第一位置信息,否则所述现有第一位置信息是上一时刻进行更新之后的第一位置信息。
作为优选技术方案,采用下述方法实现上述步骤103,如图5所示,具体包括:
设定当前车道编号N0,N0来自现有第一位置信息,若本次第一位置信息更新是车辆进入本道路后第一次更新,则所述现有第一位置信息是步骤101中获取的原始第一位置信息;若本次第一位置信息更新不是车辆进入本道路后第一次更新,则所述现有第一位置信息是上一时刻进行更新之后的第一位置信息;
若检测到变道状态为“开始向左、向右变道”,则第一位置信息中的车道编号+/-0.5,此时车道编号变为非整数,用以表示车辆处于两车道之间;
若检测到变道状态为“完成向左、向右变道”,则第一位置信息中的车道编号再+/-0.5,此时车道编号变为整数,若“完成变道”与最近一次“开始变道”方向相同,则表明车辆进入另一车道,若方向相反则表明车辆放弃变道,回到原车道;
若车辆未变道或仍在变道中则第一位置信息中的车道编号不变;
104:被定位车辆通过车-路协同通讯将第一位置信息发送给路侧单元,并记录下发送信号时间,路侧单元通过信号分析得到第二位置信息,所述第二位置信息为该路侧单元与被定位车辆之间的距离信息;
车辆与路侧单元均装备有短程无线通信设备,可进行实时通信,记录下发送信号时间是为了在之后的步骤中纠正定位过程耗时所造成的位置误差;路侧单元收到短程通信信号后完成对车辆的测距,得到第二位置信息,现有的短程通信技术大多可在通信同时完成测距,如超宽带(UWB)通信技术、5.9GHzDSRC技术等,本发明包括但不仅限于以上短程通信技术。
105:路侧单元将第一位置信息、第二位置信息和预先储存的道路数学信息进行信息融合,获取被定位车辆的车辆位置信息,所述道路数学信息包括道路中每条车道的左、右车道线、中心线相对所述路侧单元的数学表达式,所述车辆位置信息包括被定位车辆的实时所处道路编号、行驶方向、车道编号和纵向位置,其中纵向位置是指车辆离所在车道起点的纵向路程;
如图2所示,路侧单元201以自身为原点建立一个局部的平面直角坐标系,并预先储存车道数学信息,包括该路侧单元所监控路段中每条车道的左、右车道线202和车道中心线203的拟合曲线相对该局部坐标系的表达式,其中获取道路拟合曲线的方法可以是借助道路设计图纸,也可以是使用全站仪或GPS等手段得到道路上离散点的坐标,然后通过最小二乘法或样条曲线拟合得到由直线、缓圆曲线、圆弧曲线等组成的道路表达式,本发明包括但不仅限于以上道路表达式的获取方式。
如图2所示,车辆204处于路侧单元201所预设的监控范围205内,定位过程中路侧单元根据收到的第一位置信息中的车道编号查询车辆近似行驶路径,若车道编号为整数,则从道路数学信息中查询该车道中心线相对本路侧单元局部坐标系的数学表达式作为车辆行驶路径;若获取的车道编号介于两个整数之间,则查询该两车道之间的车道线的数学表达式作为车辆行驶路径;
如图2所示,在路侧单元局部坐标系中,求出以路侧单元为原点,以第二位置信息为半径的圆206与所述车辆行驶路径的两个交点的坐标;选取距离上一次定位结果较近的交点坐标作为被定位车辆局部坐标,若是初次定位,选取靠近道路入口的交点坐标作为被定位车辆局部坐标;通过下式将车辆局部坐标转化为纵向位置:
X = A + ∫ a x 1 1 + f ′ ( x ) 2 d x
其中X为车辆纵向位置,x1为车辆在局部坐标系中的横坐标,y=f’(x)为车辆行驶路径y=f(x)关于x的导数,a为车辆行驶路径在该路侧单元监控范围内的起点的局部坐标,A为为车辆行驶路径在该路侧单元监控范围内的起点的纵向位置;
将算得的车辆纵向位置赋予车辆位置信息,车辆位置信息中的道路编号、行驶方向、车道编号继承自第一位置信息。
106:路侧单元通过实时通讯将车辆位置信息反馈给被定位车辆,车辆根据行驶速度算得当前时刻的车辆位置信息,并与预先储存的电子地图进行匹配,得到自身在地图中的具体位置;
具体地,车辆接收到车辆位置信息后,利用自身速度计获取行驶速度,根据下式计算得当前时刻的车辆位置信息:
X ~ = X + v · ( t 2 - t 1 )
其中是车辆当前纵向位置,X为路侧单元反馈的车辆纵向位置,v为车辆当前速度,t2为当前时间,t1为车辆之前将第一位置信息发送给路侧单元的时间,当前时刻的车辆位置信息中的道路编号、行驶方向、车道编号继承自车辆位置信息;
预先储存的电子地图应当精确到车道,即道路的每条车道都能够在地图上区分;车辆控制器根据当前车辆位置信息中的所在道路、行驶方向、所处车道和纵向位置匹配地图相应位置,并通过车内屏幕显示出来。
采用本发明所述的车辆定位方法,可有效保证车辆纵向定位精度,同时可准确判别车辆所处车道。本发明通过射频识别技术和车载视觉判别车辆横向位置即所处车道,在此基础上通过车辆与路侧单元之间的通信、测距,计算出车辆纵向位置,完成定位。本定位方法不受地形限制,可在GPS/DGPS精度不理想的城市环境中完成精确定位,以满足智能车辆的避撞、自主驾驶等应用的要求。
以上显示和描述了本发明的基本原理和主要特征。本行业的技术人员应该了解,本发明不受上述实施例的限制,上述实施例和说明书中描述的只是说明本发明的原理,在不脱离本发明精神和范围的前提下,本发明还会有各种变化和改进,这些变化和改进都落入要求保护的本发明范围内。本发明要求保护范围由所附的权利要求书及其等效物界定。

Claims (9)

1.一种车辆定位方法,所述方法包括步骤如下:
被定位车辆在进入道路时获取初始第一位置信息,所述第一位置信息包括道路编号、行驶方向、车道编号;
在行驶过程中通过视觉系统获取变道状态;
根据变道状态对第一位置信息进行更新;
被定位车辆通过车-路协同通讯将第一位置信息发送给路侧单元,路侧单元通过信号分析得到第二位置信息,所述第二位置信息为该路侧单元与被定位车辆之间的距离信息;
路侧单元将第一位置信息、第二位置信息和预先储存的道路数学信息进行信息融合,获取被定位车辆的车辆位置信息,所述道路数学信息包括道路中每条车道的左、右车道线、中心线相对所述路侧单元的数学表达式,所述车辆位置信息包括被定位车辆的实时所处道路编号、行驶方向、车道编号和纵向位置,其中纵向位置是指车辆离所在车道起点的纵向路程;
路侧单元通过实时通讯将车辆位置信息反馈给被定位车辆,车辆根据自身行驶速度算得当前时刻的车辆位置信息,并与预先储存的电子地图进行匹配,得到自身在地图中的具体位置。
2.根据权利要求1所述的车辆定位方法,其特征在于:被定位车辆在进入道路时获取初始第一位置信息包括:在需要进行车辆定位的道路的每条车道入口路面上分别布置一枚射频识别标签,所述标签含有道路编号、行驶方向、车道编号,所述道路编号是指该道路在电子地图中的对应编号,所述行驶方向是指该射频标签所在侧道路所允许的车辆通行方向,所述车道编号指明车辆处于哪条车道,编号规则为从该侧道路最右车道向左或从最左车道向右编号,依次编为车道1、车道2……车道M,M为该侧道路总车道数;
被定位车辆的底部前端装有射频识别阅读器,当经过车道入口时读取标签中的初始第一位置信息。
3.根据权利要求1所述的车辆定位方法,其特征在于:在行驶过程中通过视觉系统获取变道状态包括:
在被定位车辆上装载视觉系统,利用置于汽车前方中间位置的摄像头以检测车辆前方车道线;
判断车道线与车辆的相对位置;
根据上一帧图像和本帧图像中车道线与宽度线的相对位置,判断车辆变道状态。
4.根据权利要求3所述的方法,其特征在于,判断检测到的车道线与车辆的相对位置包括:
在已检测出车道线的图像底部中添加一条代表车辆宽度的横线,在每一帧图像中判断车道线(或其延长线)与宽度线的相对位置;
判断检测到的车道线与车辆的相对位置,将相对位置分为“未相交”、“左相交”、“右相交”三种,判断规则包括:
若所有车道线与宽度线均不相交,则判定车道线与宽度线的相对位置为“未相交”;
若任一车道线与宽度线左半部分相交,则判定车道线与宽度线的相对位置为“左相交”;
若任一车道线与宽度线右半部分相交,则判定车道线与宽度线的相对位置为“右相交”。
5.根据权利要求4所述方法,其特征在于:根据上一帧图像和本帧图像中车道线与宽度线的相对位置,判断车辆变道状态包括:变道状态包括“开始向左变道”、“开始向右变道”、“完成向右变道”、“完成向左变道”、“正在变道”、“未变道”六种,判断规则包括:
若车道线与宽度线的相对位置在上一帧为“未相交”,在本帧为“左相交”,则判定变道状态为“开始向左变道”;
若车道线与宽度线的相对位置在上一帧为“未相交”,在本帧为“右相交”,则判定变道状态为“开始向右变道”;
若车道线与宽度线的相对位置在上一帧为“右相交”,在本帧为“未相交”,则判定变道状态为“完成向左变道”;
若车道线与宽度线的相对位置在上一帧为“左相交”,在本帧为“未相交”,则判定变道状态为“完成向右变道”;
若车道线与宽度线的相对位置在上一帧为“左相交”或“右相交”,在本帧为“左相交”或“右相交”,则判定变道状态为“正在变道”;
若车道线与宽度线的相对位置在上一帧和本帧均为“未相交”,则判定变道状态为“未变道”。
6.根据权利要求1所述的车辆定位方法,其特征在于:根据变道信息对第一位置信息进行更新包括:
若检测到变道状态为“开始向左、向右变道”,则第一位置信息中的车道编号+/-0.5,此时车道编号变为非整数,用以表示车辆处于两车道之间;
若检测到变道状态为“完成向左、向右变道”,则第一位置信息中的车道编号再+/-0.5,此时车道编号变为整数,若“完成变道”与最近一次“开始变道”方向相同,则表明车辆进入另一车道,若方向相反则表明车辆放弃变道,回到原车道;
若车辆未变道或仍在变道中则第一位置信息中的车道编号不变。
7.根据权利要求1所述的车辆定位方法,其特征在于:路侧单元与被定位车辆进行实时通讯获取第一位置信息,并通过信号分析得到第二位置信息包括:
路侧单元与被定位车辆之间使用超宽带脉冲技术或用于测距的无线通讯技术进行通讯,被定位车辆发出包含有第一位置信息的通讯信号,并记录下信号发出时间,路侧单元收到通讯信号后,提取其中的第一位置信息的同时,提取从信号发出到接收经过的时间或用于测距的特征,得到第二位置信息。
8.根据权利要求1所述的车辆定位方法,其特征在于:将第一位置信息、第二位置信息和预先储存的道路数学信息进行信息融合,获取被定位车辆的车辆位置信息包括:
预先以路侧单元为原点,以路面为坐标平面,建立局部平面直角坐标系,在该局部坐标系中测绘得到道路中每条车道的左、右车道线、中心线的数学表达式作为道路数学信息;
定位过程中路侧单元根据第一位置信息中的车道编号查询车辆近似行驶路径,若车道编号为整数,则从道路数学信息中查询该车道中心线相对本路侧单元局部坐标系的数学表达式作为车辆行驶路径;若获取的车道编号介于两个整数之间,则查询该两车道之间的车道线的数学表达式作为车辆行驶路径;
在路侧单元局部坐标系中,求出以路侧单元为原点,以第二位置信息为半径的圆与所述车辆行驶路径的两个交点的坐标;
选取距离上一次定位结果较近的交点坐标作为被定位车辆局部坐标,若是初次定位,选取靠近道路入口的交点坐标作为被定位车辆局部坐标;
通过下式将车辆局部坐标转化为纵向位置:
X = A + ∫ a x 1 1 + f ′ ( x ) 2 d x
其中X为车辆纵向位置,x1为车辆在局部坐标系中的横坐标,y=f’(x)为车辆行驶路径y=f(x)关于x的导数,a为车辆行驶路径在该路侧单元监控范围内的起点的局部坐标,A为为车辆行驶路径在该路侧单元监控范围内的起点的纵向位置。
9.根据权利要求1所述的车辆定位方法,其特征在于:路侧单元通过实时通讯将车辆位置信息反馈给被定位车辆,车辆根据行驶速度算得当前时刻的车辆位置信息,并与预先储存的电子地图进行匹配,得到自身在地图中的具体位置包括:
车辆接收到车辆位置信息后,利用自身速度计获取行驶速度,根据下式计算得当前时刻的车辆位置信息:
X ~ = X + v · ( t 2 - t 1 )
其中是车辆当前纵向位置,X为路侧单元反馈的车辆纵向位置,v为车辆当前速度,t2为当前时间,t1为车辆之前将第一位置信息发送给路侧单元的时间;
预先储存的电子地图精确到车道,即道路的每条车道都能够在地图上区分,根据车辆所在道路、行驶方向、所处车道和纵向位置匹配地图相应位置,并通过车内屏幕显示出来。
CN201510657382.XA 2015-10-13 2015-10-13 一种车辆定位方法 Active CN105206090B (zh)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN201510657382.XA CN105206090B (zh) 2015-10-13 2015-10-13 一种车辆定位方法

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN201510657382.XA CN105206090B (zh) 2015-10-13 2015-10-13 一种车辆定位方法

Publications (2)

Publication Number Publication Date
CN105206090A true CN105206090A (zh) 2015-12-30
CN105206090B CN105206090B (zh) 2017-06-16

Family

ID=54953732

Family Applications (1)

Application Number Title Priority Date Filing Date
CN201510657382.XA Active CN105206090B (zh) 2015-10-13 2015-10-13 一种车辆定位方法

Country Status (1)

Country Link
CN (1) CN105206090B (zh)

Cited By (31)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN107085946A (zh) * 2017-06-13 2017-08-22 深圳市麦谷科技有限公司 一种基于图片识别技术的车辆定位方法及系统
CN107221193A (zh) * 2016-03-21 2017-09-29 中国移动通信集团广东有限公司 控制车辆终端变道的方法、道路分段设备、车辆终端
CN107238814A (zh) * 2016-03-29 2017-10-10 茹景阳 一种车辆定位的装置与方法
CN108033382A (zh) * 2017-12-15 2018-05-15 武汉华志机器人产业技术研究院有限公司 目标车辆基于地面站进行抬升的方法、装置及系统
CN108059107A (zh) * 2017-12-15 2018-05-22 武汉华志机器人产业技术研究院有限公司 基于地面站抬升目标车辆的方法、装置及系统
CN108415057A (zh) * 2018-01-25 2018-08-17 南京理工大学 一种无人车队与路侧单元协同工作的相对定位方法
CN108470142A (zh) * 2018-01-30 2018-08-31 西安电子科技大学 基于逆透视投影和车道距离约束的车道定位方法
CN108630002A (zh) * 2017-03-20 2018-10-09 罗伯特·博世有限公司 用于确定车辆的至少一个最可能路径的方法和装置
CN109147316A (zh) * 2018-07-23 2019-01-04 重庆邮电大学 一种基于v2x通信和高精度定位的城市车道车辆统计方法
CN109389864A (zh) * 2017-08-09 2019-02-26 湖南大学 一种车辆相对定位及碰撞预警方法
CN109387809A (zh) * 2017-08-02 2019-02-26 中国移动通信有限公司研究院 一种对定位终端进行定位的方法和定位终端
CN109697877A (zh) * 2019-02-18 2019-04-30 河北省交通规划设计院 基于北斗高精定位的车路协同方法及系统
CN109935098A (zh) * 2017-12-18 2019-06-25 上海交通大学 基于车路协同通信的高精度相对位置信息播发装置及方法
CN109946648A (zh) * 2019-03-06 2019-06-28 东南大学 一种车路协同下基于超宽带的车辆高精度定位方法
CN109974701A (zh) * 2017-12-28 2019-07-05 深圳市优必选科技有限公司 机器人的定位方法及装置
CN109996330A (zh) * 2019-04-11 2019-07-09 深圳成有科技有限公司 一种车路协同室内定位方法及系统
CN110379160A (zh) * 2019-07-09 2019-10-25 广州小鹏汽车科技有限公司 一种交通路口的车辆自动变道辅助方法、系统及车辆
CN110379155A (zh) * 2018-09-30 2019-10-25 长城汽车股份有限公司 用于确定道路目标坐标的方法及系统
CN110516652A (zh) * 2019-08-30 2019-11-29 北京百度网讯科技有限公司 车道检测的方法、装置、电子设备及存储介质
CN110530378A (zh) * 2019-08-28 2019-12-03 重庆长安汽车股份有限公司 一种基于v2x的map消息集的车辆定位方法
CN111065042A (zh) * 2018-10-16 2020-04-24 Aptiv技术有限公司 改善路侧单元位置确定的方法、路侧单元和提供位置信息的系统
CN111179581A (zh) * 2018-11-13 2020-05-19 千寻位置网络有限公司 一种基于视觉的共享单车id匹配的系统和方法
CN111212374A (zh) * 2018-11-02 2020-05-29 华为技术有限公司 车联网通信方法、定位方法以及车联网通信装置
WO2020108207A1 (zh) * 2018-11-29 2020-06-04 华为技术有限公司 一种高精度地图的构建方法及装置
CN112466142A (zh) * 2020-11-13 2021-03-09 浙江吉利控股集团有限公司 一种车辆调度方法、装置、系统及存储介质
CN112687101A (zh) * 2020-12-23 2021-04-20 的卢技术有限公司 一种基于电子标签的车道级定位方法及系统
CN112819711A (zh) * 2021-01-20 2021-05-18 电子科技大学 一种基于单目视觉的利用道路车道线的车辆反向定位方法
CN114898548A (zh) * 2022-03-07 2022-08-12 北京汽车研究总院有限公司 应急车道占用检测方法、设备、装置及存储介质
CN115362484A (zh) * 2020-04-13 2022-11-18 三菱电机株式会社 行驶路径识别装置和行驶路径识别方法
CN116238524A (zh) * 2023-03-27 2023-06-09 宁波斯年智驾科技有限公司 基于高精地图与车辆历史轨迹的驾驶行为判别方法及系统
US11926339B2 (en) 2018-09-30 2024-03-12 Great Wall Motor Company Limited Method for constructing driving coordinate system, and application thereof

Citations (8)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP2005301892A (ja) * 2004-04-15 2005-10-27 Mitsubishi Motors Corp 複数のカメラによるレーン認識装置
CN101545788A (zh) * 2009-05-14 2009-09-30 四川长虹电器股份有限公司 车辆定位的实现方法
US20100191461A1 (en) * 2009-01-26 2010-07-29 Gm Global Technology Operations, Inc. System and method of lane path estimation using sensor fusion
CN103063220A (zh) * 2012-12-26 2013-04-24 深圳市诺威达科技有限公司 一种汽车导航方法及汽车导航系统
CN103454660A (zh) * 2012-12-28 2013-12-18 北京握奇数据系统有限公司 一种车辆定位方法及装置
CN103448724A (zh) * 2013-08-23 2013-12-18 奇瑞汽车股份有限公司 车道偏离预警方法和装置
CN203535663U (zh) * 2013-10-11 2014-04-09 上海市保安服务总公司 基于rfid技术的车道识别装置
CN104537829A (zh) * 2014-12-09 2015-04-22 北京工业大学 一种用于智能交通物理仿真平台的智能小车及定位方法

Patent Citations (8)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP2005301892A (ja) * 2004-04-15 2005-10-27 Mitsubishi Motors Corp 複数のカメラによるレーン認識装置
US20100191461A1 (en) * 2009-01-26 2010-07-29 Gm Global Technology Operations, Inc. System and method of lane path estimation using sensor fusion
CN101545788A (zh) * 2009-05-14 2009-09-30 四川长虹电器股份有限公司 车辆定位的实现方法
CN103063220A (zh) * 2012-12-26 2013-04-24 深圳市诺威达科技有限公司 一种汽车导航方法及汽车导航系统
CN103454660A (zh) * 2012-12-28 2013-12-18 北京握奇数据系统有限公司 一种车辆定位方法及装置
CN103448724A (zh) * 2013-08-23 2013-12-18 奇瑞汽车股份有限公司 车道偏离预警方法和装置
CN203535663U (zh) * 2013-10-11 2014-04-09 上海市保安服务总公司 基于rfid技术的车道识别装置
CN104537829A (zh) * 2014-12-09 2015-04-22 北京工业大学 一种用于智能交通物理仿真平台的智能小车及定位方法

Non-Patent Citations (2)

* Cited by examiner, † Cited by third party
Title
原新等: "基于推算定位和超声波定位融合的机器人自主定位技术", 《海军工程大学学报》 *
袁鑫等: "线性最小二乘法的RSSI定位精确计算方法", 《传感技术学报》 *

Cited By (47)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN107221193A (zh) * 2016-03-21 2017-09-29 中国移动通信集团广东有限公司 控制车辆终端变道的方法、道路分段设备、车辆终端
CN107221193B (zh) * 2016-03-21 2020-08-04 中国移动通信集团广东有限公司 控制车辆终端变道的方法、道路分段设备、车辆终端
CN107238814A (zh) * 2016-03-29 2017-10-10 茹景阳 一种车辆定位的装置与方法
CN108630002A (zh) * 2017-03-20 2018-10-09 罗伯特·博世有限公司 用于确定车辆的至少一个最可能路径的方法和装置
CN107085946A (zh) * 2017-06-13 2017-08-22 深圳市麦谷科技有限公司 一种基于图片识别技术的车辆定位方法及系统
CN109387809A (zh) * 2017-08-02 2019-02-26 中国移动通信有限公司研究院 一种对定位终端进行定位的方法和定位终端
CN109387809B (zh) * 2017-08-02 2021-01-15 中国移动通信有限公司研究院 一种对定位终端进行定位的方法和定位终端
CN109389864A (zh) * 2017-08-09 2019-02-26 湖南大学 一种车辆相对定位及碰撞预警方法
CN108033382A (zh) * 2017-12-15 2018-05-15 武汉华志机器人产业技术研究院有限公司 目标车辆基于地面站进行抬升的方法、装置及系统
CN108059107A (zh) * 2017-12-15 2018-05-22 武汉华志机器人产业技术研究院有限公司 基于地面站抬升目标车辆的方法、装置及系统
CN109935098A (zh) * 2017-12-18 2019-06-25 上海交通大学 基于车路协同通信的高精度相对位置信息播发装置及方法
CN109974701A (zh) * 2017-12-28 2019-07-05 深圳市优必选科技有限公司 机器人的定位方法及装置
CN108415057B (zh) * 2018-01-25 2022-04-01 南京理工大学 一种无人车队与路侧单元协同工作的相对定位方法
CN108415057A (zh) * 2018-01-25 2018-08-17 南京理工大学 一种无人车队与路侧单元协同工作的相对定位方法
CN108470142A (zh) * 2018-01-30 2018-08-31 西安电子科技大学 基于逆透视投影和车道距离约束的车道定位方法
CN108470142B (zh) * 2018-01-30 2021-09-03 西安电子科技大学 基于逆透视投影和车道距离约束的车道定位方法
CN109147316A (zh) * 2018-07-23 2019-01-04 重庆邮电大学 一种基于v2x通信和高精度定位的城市车道车辆统计方法
CN109147316B (zh) * 2018-07-23 2022-05-03 重庆邮电大学 一种基于v2x通信和高精度定位的城市车道车辆统计方法
CN110379155A (zh) * 2018-09-30 2019-10-25 长城汽车股份有限公司 用于确定道路目标坐标的方法及系统
US11926339B2 (en) 2018-09-30 2024-03-12 Great Wall Motor Company Limited Method for constructing driving coordinate system, and application thereof
CN111065042A (zh) * 2018-10-16 2020-04-24 Aptiv技术有限公司 改善路侧单元位置确定的方法、路侧单元和提供位置信息的系统
US10924888B2 (en) 2018-10-16 2021-02-16 Aptiv Technologies Limited Method to improve the determination of a position of a roadside unit and a system to provide position information
CN111065042B (zh) * 2018-10-16 2022-02-11 Aptiv技术有限公司 改善路侧单元位置确定的方法、路侧单元和提供位置信息的系统
CN111212374B (zh) * 2018-11-02 2021-07-16 华为技术有限公司 车联网通信方法、定位方法以及车联网通信装置
CN111212374A (zh) * 2018-11-02 2020-05-29 华为技术有限公司 车联网通信方法、定位方法以及车联网通信装置
CN111179581B (zh) * 2018-11-13 2022-02-01 千寻位置网络有限公司 一种基于视觉的共享单车id匹配的系统和方法
CN111179581A (zh) * 2018-11-13 2020-05-19 千寻位置网络有限公司 一种基于视觉的共享单车id匹配的系统和方法
WO2020108207A1 (zh) * 2018-11-29 2020-06-04 华为技术有限公司 一种高精度地图的构建方法及装置
US11933627B2 (en) 2018-11-29 2024-03-19 Huawei Technologies Co., Ltd. High-definition map building method and apparatus
CN109697877A (zh) * 2019-02-18 2019-04-30 河北省交通规划设计院 基于北斗高精定位的车路协同方法及系统
CN109697877B (zh) * 2019-02-18 2020-09-15 河北省交通规划设计院 基于北斗高精定位的车路协同方法及系统
CN109946648B (zh) * 2019-03-06 2022-04-29 东南大学 一种车路协同下基于超宽带的车辆高精度定位方法
CN109946648A (zh) * 2019-03-06 2019-06-28 东南大学 一种车路协同下基于超宽带的车辆高精度定位方法
CN109996330A (zh) * 2019-04-11 2019-07-09 深圳成有科技有限公司 一种车路协同室内定位方法及系统
CN110379160A (zh) * 2019-07-09 2019-10-25 广州小鹏汽车科技有限公司 一种交通路口的车辆自动变道辅助方法、系统及车辆
CN110530378A (zh) * 2019-08-28 2019-12-03 重庆长安汽车股份有限公司 一种基于v2x的map消息集的车辆定位方法
CN110516652A (zh) * 2019-08-30 2019-11-29 北京百度网讯科技有限公司 车道检测的方法、装置、电子设备及存储介质
CN115362484A (zh) * 2020-04-13 2022-11-18 三菱电机株式会社 行驶路径识别装置和行驶路径识别方法
CN112466142B (zh) * 2020-11-13 2022-06-21 浙江吉利控股集团有限公司 一种车辆调度方法、装置、系统及存储介质
CN112466142A (zh) * 2020-11-13 2021-03-09 浙江吉利控股集团有限公司 一种车辆调度方法、装置、系统及存储介质
CN112687101A (zh) * 2020-12-23 2021-04-20 的卢技术有限公司 一种基于电子标签的车道级定位方法及系统
CN112819711A (zh) * 2021-01-20 2021-05-18 电子科技大学 一种基于单目视觉的利用道路车道线的车辆反向定位方法
CN112819711B (zh) * 2021-01-20 2022-11-22 电子科技大学 一种基于单目视觉的利用道路车道线的车辆反向定位方法
CN114898548A (zh) * 2022-03-07 2022-08-12 北京汽车研究总院有限公司 应急车道占用检测方法、设备、装置及存储介质
CN114898548B (zh) * 2022-03-07 2023-03-14 北京汽车研究总院有限公司 应急车道占用检测方法、设备、装置及存储介质
CN116238524A (zh) * 2023-03-27 2023-06-09 宁波斯年智驾科技有限公司 基于高精地图与车辆历史轨迹的驾驶行为判别方法及系统
CN116238524B (zh) * 2023-03-27 2024-02-09 宁波斯年智驾科技有限公司 基于高精地图与车辆历史轨迹的驾驶行为判别方法及系统

Also Published As

Publication number Publication date
CN105206090B (zh) 2017-06-16

Similar Documents

Publication Publication Date Title
CN105206090A (zh) 一种车辆定位方法
CN104217590B (zh) 用于使主车辆中的电子控制器确定交通密度的方法
CN102889892B (zh) 实景导航的方法及导航终端
US9024785B2 (en) Traffic information distribution system and traffic information system, traffic information distribution program, and traffic information distribution method
US10677597B2 (en) Method and system for creating a digital map
EP2491344B1 (en) System and method for vehicle navigation using lateral offsets
DE102016217645B4 (de) Verfahren zum Bereitstellen von Information über eine voraussichtliche Fahrintention eines Fahrzeugs
KR101446546B1 (ko) 위치기반 실시간 차량정보 표시시스템
CN106494393B (zh) 用于规划受支持的泊车过程的方法
CN103335853A (zh) 一种无人驾驶车辆认知能力测试系统及方法
US20200033153A1 (en) System for creating a vehicle surroundings model
CN102445702A (zh) 使用邻近实体信息的基于gps的相对定位增强方法
CN109389864A (zh) 一种车辆相对定位及碰撞预警方法
CN106710281A (zh) 车辆定位数据获取方法及装置
JP4617723B2 (ja) 中継装置
CN108139220A (zh) 用于评价地图内容的方法和设备
CN105469617A (zh) 一种行车安全辅助方法和装置
CN110296708B (zh) 运营路线规划方法、装置及存储介质
WO2013133752A1 (en) Method and system for determining vehicle position
CN109460025A (zh) 车辆的控制装置及系统
CN112884892B (zh) 基于路侧装置的无人矿车位置信息处理系统和方法
CN110345949A (zh) 一种车辆所在车道的定位方法及其系统
JP4255772B2 (ja) 車両管理装置、車両管理方法および車両管理プログラム
CN208422117U (zh) 一种基于车联网络的闯红灯预警系统
CN104554083A (zh) 一种智能行车辅助系统

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
TR01 Transfer of patent right

Effective date of registration: 20200623

Address after: 430000 No.16 Sunshine Avenue, Miaoshan office, Jiangxia Economic Development Zone, Wuhan, Hubei Province

Patentee after: WUHAN BUS MANUFACTURING Co.,Ltd.

Address before: 361000, Xiamen, Fujian Province, Xiangan District, new town, Strait modern city phase 1, A building

Patentee before: XIAMEN XINGCHEN TIANYU AUTOMOTIVE DESIGN Co.,Ltd.

TR01 Transfer of patent right
PE01 Entry into force of the registration of the contract for pledge of patent right

Denomination of invention: A method of vehicle location

Effective date of registration: 20220627

Granted publication date: 20170616

Pledgee: Guanggu Branch of Wuhan Rural Commercial Bank Co.,Ltd.

Pledgor: WUHAN BUS MANUFACTURING CO.,LTD.

Registration number: Y2022420000190

PE01 Entry into force of the registration of the contract for pledge of patent right
PC01 Cancellation of the registration of the contract for pledge of patent right

Date of cancellation: 20230621

Granted publication date: 20170616

Pledgee: Guanggu Branch of Wuhan Rural Commercial Bank Co.,Ltd.

Pledgor: WUHAN BUS MANUFACTURING CO.,LTD.

Registration number: Y2022420000190

PC01 Cancellation of the registration of the contract for pledge of patent right
PE01 Entry into force of the registration of the contract for pledge of patent right

Denomination of invention: A Vehicle Location Method

Effective date of registration: 20230629

Granted publication date: 20170616

Pledgee: Guanggu Branch of Wuhan Rural Commercial Bank Co.,Ltd.

Pledgor: WUHAN BUS MANUFACTURING CO.,LTD.

Registration number: Y2023420000275

PE01 Entry into force of the registration of the contract for pledge of patent right