CN102460535B - 车辆行驶位置判定方法及车辆行驶位置判定装置 - Google Patents
车辆行驶位置判定方法及车辆行驶位置判定装置 Download PDFInfo
- Publication number
- CN102460535B CN102460535B CN200980159798.1A CN200980159798A CN102460535B CN 102460535 B CN102460535 B CN 102460535B CN 200980159798 A CN200980159798 A CN 200980159798A CN 102460535 B CN102460535 B CN 102460535B
- Authority
- CN
- China
- Prior art keywords
- information
- car
- front truck
- vehicle
- track
- 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
- 238000000034 method Methods 0.000 title claims abstract description 36
- 238000001514 detection method Methods 0.000 description 16
- 238000004891 communication Methods 0.000 description 15
- 238000012545 processing Methods 0.000 description 8
- 238000010586 diagram Methods 0.000 description 4
- RKTYLMNFRDHKIL-UHFFFAOYSA-N copper;5,10,15,20-tetraphenylporphyrin-22,24-diide Chemical compound [Cu+2].C1=CC(C(=C2C=CC([N-]2)=C(C=2C=CC=CC=2)C=2C=CC(N=2)=C(C=2C=CC=CC=2)C2=CC=C3[N-]2)C=2C=CC=CC=2)=NC1=C3C1=CC=CC=C1 RKTYLMNFRDHKIL-UHFFFAOYSA-N 0.000 description 2
- 238000005516 engineering process Methods 0.000 description 2
- 230000001133 acceleration Effects 0.000 description 1
- 238000013459 approach Methods 0.000 description 1
- 230000003190 augmentative effect Effects 0.000 description 1
- 230000000694 effects Effects 0.000 description 1
- 230000010365 information processing Effects 0.000 description 1
- 238000007689 inspection Methods 0.000 description 1
- 238000009434 installation Methods 0.000 description 1
- 239000005433 ionosphere Substances 0.000 description 1
- 230000003252 repetitive effect Effects 0.000 description 1
Classifications
-
- G—PHYSICS
- G08—SIGNALLING
- G08G—TRAFFIC CONTROL SYSTEMS
- G08G1/00—Traffic control systems for road vehicles
- G08G1/16—Anti-collision systems
- G08G1/161—Decentralised systems, e.g. inter-vehicle communication
-
- G—PHYSICS
- G08—SIGNALLING
- G08G—TRAFFIC CONTROL SYSTEMS
- G08G1/00—Traffic control systems for road vehicles
- G08G1/16—Anti-collision systems
- G08G1/164—Centralised systems, e.g. external to vehicles
-
- G—PHYSICS
- G08—SIGNALLING
- G08G—TRAFFIC CONTROL SYSTEMS
- G08G1/00—Traffic control systems for road vehicles
- G08G1/16—Anti-collision systems
- G08G1/167—Driving aids for lane monitoring, lane changing, e.g. blind spot detection
Landscapes
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Traffic Control Systems (AREA)
- Control Of Driving Devices And Active Controlling Of Vehicle (AREA)
- Navigation (AREA)
Abstract
本发明的车辆行驶位置判定方法是判定前车的行驶位置的车辆行驶位置判定方法,具备:取得规定时刻的前车与本车的相对位置信息的相对位置信息取得步骤;取得规定时刻以后的本车的行驶轨迹信息的本车行驶轨迹信息取得步骤;及基于相对位置信息和本车的行驶轨迹信息来判定前车的行驶位置的前车位置判定步骤。
Description
技术领域
本发明涉及对前车的行驶位置进行判定的车辆行驶位置判定方法及车辆行驶位置判定装置。
背景技术
一直以来,作为该领域的技术,已知有日本特开2003-337029号公报所记载的位置检测装置。在该装置中,根据本车制成的基于GPS的本车位置信息和从其他车接收到的基于GPS的其他车位置信息来算出本车与其他车的相对位置关系。并且,通过维持该位置关系并使之与读入了本车位置及其他车位置的地图上一致来特定,从而能够知道其他车的行驶位置。
【专利文献1】日本特开2003-337029号公报
在该装置中,考虑到了能够知道其他车在哪个道路上行驶的情况,但在近年来的各种驾驶辅助系统中,不仅要求特定其他车所行驶的道路,而且很多情况下要求特定到其他车在该道路中的哪个车道(行车线)上行驶的信息。然而,在上述的位置检测装置中,由于GPS的精度上的问题,难以特定到其他车所行驶的车道。另外,在上述的位置检测装置中,使用地图信息,但到车道为止的详细的信息存在于地图上的道路仅是一部分的主要道路,在除此以外的道路中,无法进行到车道为止的位置特定。另外,作为其他的方法,也考虑通过拍摄前车的相机影像、毫米波雷达来判定先行的其他车的车道的情况,但在与前车之间存在其他的加塞车辆时、因急转弯等周边环境的主要原因等而无法直接看见位置判定对象的其他车时,不能适用。
发明内容
因此,本发明的目的在于提供一种能够高精度地判定前车所行驶的车道的车辆行驶位置判定方法及车辆行驶位置判定装置。
本发明的车辆行驶位置判定方法用于判定前车的行驶位置,其特征在于,具备:取得规定时刻的前车与本车的相对位置信息的相对位置信息取得步骤;取得规定时刻以后的本车的行驶轨迹信息的本车行驶轨迹信息取得步骤;及基于相对位置信息和本车的行驶轨迹信息来判定前车的行驶位置的前车位置判定步骤。
根据该车辆行驶位置判定方法,取得规定时刻的前车与本车的相对位置信息,并取得该规定时刻以后的本车的行驶轨迹信息,基于相对位置和本车的行驶轨迹信息,能够高精度地判定前车的行驶位置,能够判定到前车所行驶的车道。
另外,也可以在相对位置信息取得步骤中,基于由GPS取得的前车的坐标信息与由GPS取得的本车的坐标信息的差值来算出相对位置信息。
根据该结构,通过称作GPS(Global Positioning System)的简便的单元,就能够得到本车和其他车的坐标信息并算出相对位置信息。
另外,本发明的车辆行驶位置判定方法也可以还具备取得规定时刻以后的前车的与换道相关的换道信息的换道信息取得步骤,在前车位置判定步骤中,还基于换道信息来判定前车的行驶位置。
根据该结构,通过将本车与其他车的规定时刻的相对位置信息、该规定时刻以后的本车辆的行驶轨迹信息、该规定时刻以后的前车的换道(行车线变更)的信息组合,从而能够高精度地判定其他车位于哪个车道。
另外,本发明的车辆行驶位置判定方法也可以还具备:取得规定时刻以后的前车的行驶轨迹信息的前车行驶轨迹信息取得步骤;及基于前车的行驶轨迹信息和换道信息来取得前车所行驶的车道的车道形状的车道形状取得步骤,在前车位置判定步骤中,还基于车道形状来判定前车的行驶位置。
根据该结构,基于规定时刻以后的前车的行驶轨迹信息和前车的换道信息而取得车道形状,进一步考虑该车道形状,从而能够高精度地判定前车的行驶位置。
另外,本发明的车辆行驶位置判定方法用于判定前车的行驶位置,其特征在于,具备:基于由GPS取得的前车的坐标信息和由GPS取得的本车的坐标信息来算出规定时刻的前车与本车的相对位置信息的相对位置信息取得步骤;取得规定时刻以后的本车的行驶轨迹信息的本车行驶轨迹信息取得步骤;及基于相对位置信息和本车的行驶轨迹信息来判定前车的行驶位置的前车位置判定步骤。
在该车辆行驶位置判定方法中,利用GPS取得规定时刻的本车与前车的相对位置信息,还取得规定时刻以后的本车的行驶轨迹信息。然后,基于相对位置和本车的行驶轨迹信息,能够高精度地判定前车的行驶位置,能够判定到前车所行驶的车道。
另外,本发明的车辆行驶位置判定装置用于判定前车的行驶位置,其特征在于,具备:取得规定时刻的前车与本车的相对位置信息的相对位置信息取得单元;取得规定时刻以后的本车的行驶轨迹信息的本车行驶轨迹信息取得单元;及基于相对位置信息和本车的行驶轨迹信息来判定前车的行驶位置的前车位置判定单元。
根据该车辆行驶位置判定装置,取得规定时刻的前车与本车的相对位置信息,并取得该规定时刻以后的本车的行驶轨迹信息,基于相对位置和本车的行驶轨迹信息,能够高精度地判定前车的行驶位置,能够判定到前车所行驶的车道。
另外,也可以是相对位置信息取得单元基于由GPS取得的前车的坐标信息与由GPS取得的本车的坐标信息的差值来算出相对位置信息。
根据该结构,通过GPS这样的简便的单元,就能够得到本车与其他车的坐标信息并算出相对位置信息。
另外,本发明的车辆行驶位置判定装置也可以还具备取得规定时刻以后的前车的与换道相关的换道信息的换道信息取得单元,前车位置判定单元还基于换道信息来判定前车的行驶位置。
根据该结构,通过将本车与其他车的规定时刻的相对位置信息、该规定时刻以后的本车辆的行驶轨迹信息、该规定时刻以后的前车的换道的信息组合,从而能够高精度地判定其他车位于哪个车道。
另外,本发明的车辆行驶位置判定装置也可以还具备:取得规定时刻以后的前车的行驶轨迹信息的前车行驶轨迹信息取得单元;及基于前车的行驶轨迹信息和换道信息来取得前车所行驶的车道的车道形状的车道形状取得单元,前车位置判定单元还基于车道形状来判定前车的行驶位置。
根据该结构,基于规定时刻以后的前车的行驶轨迹信息和前车的换道信息而取得车道形状,通过进一步考虑该车道形状,从而能够高精度地判定前车的行驶位置。
另外,本发明的车辆行驶位置判定装置用于判定前车的行驶位置,其特征在于,具备:基于由GPS取得的前车的坐标信息和由GPS取得的本车的坐标信息来算出规定时刻的前车与本车的相对位置信息的相对位置信息取得单元;取得规定时刻以后的本车的行驶轨迹信息的本车行驶轨迹信息取得单元;及基于相对位置信息和本车的行驶轨迹信息来判定前车的行驶位置的前车位置判定单元。
在该车辆行驶位置判定装置中,利用GPS取得规定时刻的本车与前车的相对位置信息,进而取得规定时刻以后的本车的行驶轨迹信息。然后,基于相对位置和本车的行驶轨迹信息,能够高精度地判定前车的行驶位置,能够判定到前车所行驶的车道。
【发明效果】
根据本发明的车辆行驶位置判定方法及车辆行驶位置判定装置,能够高精度地判定前车所行驶的车道。
附图说明
图1是表示本发明的车辆行驶位置判定装置的一实施方式的框图。
图2是表示在具有两车道的道路上行驶的本车和前车的俯视图。
图3是表示本发明的车辆行驶位置判定方法的一实施方式的流程图。
图4是表示时刻t1的本车与前车的位置关系的俯视图。
图5是表示同车道判定区域和判定结束线的俯视图。
图6是表示时刻t2的本车与前车的位置关系的俯视图。
图7是表示时刻t2的本车与前车的其他的位置关系的俯视图。
图8是表示在图3的处理后进一步进行的处理的流程图。
图9是表示前车的从时刻t2到时刻t3的行驶轨迹的俯视图。
图10是表示基于图9的行驶轨迹等而取出的车道形状的俯视图。
图11是表示时刻t3的本车与前车的位置关系的俯视图。
图12是表示根据道路形状及行驶轨迹而导出换道次数的方法的一例的俯视图。
图13是表示同车道判定区域的其他的例子的俯视图。
具体实施方式
以下,参照附图,详细地说明本发明的车辆行驶位置判定方法及车辆行驶位置判定装置的优选的实施方式。
(第1实施方式)
如图1所示,车辆行驶位置判定装置1是搭载于车辆A的装置,如图2所示,是判定在与本车辆A相同的道路100上行驶的前车B在该道路的哪个车道(行车线)上行驶的装置。在从本车辆A能直接看见前车B时,也可以使用相机、雷达装置来判定前车B所行驶的车道,但车辆行驶位置判定装置1在即使无法直接看见前车B时,也能够进行前车B所行驶的车道的判定。在以下的说明中,以道路100由左车道100L及右车道100R这两个车道构成的情况为例进行说明。
如图1所示,车辆行驶位置判定装置1具备GPS部11、INS部13、通信部15、相机部17、及控制ECU(Electronic Control Unit:电子控制单元)20。
GPS(Global Positioning System)部11接收来自GPS卫星的GPS数据信号。控制ECU20能够基于接收到的GPS数据信号,获得本车的坐标信息、本车的行驶轨迹。INS(Inertial Navigation System:惯性导航系统)部13与GPS部11分别地能够通过偏摆传感器、G传感器的测定信息的惯性导航来取得本车的行驶轨迹。在不能进行基于GPS部11的本车行驶轨迹的取得时,也能够通过INS部13来取得本车行驶轨迹。
通信部15在与前车B的通信部215之间进行车车间通信。通过该车车间通信,能够在本车与其他车之间共有彼此的本车位置、本车行驶轨迹的信息。即,车辆A能够将由GPS部11所得到的本车位置、本车行驶轨迹的信息向车辆B发送,另外,车辆A能够接收车辆B通过GPS部211得到的车辆B的位置、行驶轨迹的信息。另外,通过车车间通信,还能够在本车与其他车之间共有彼此的行驶状态(例如,车速、加速度等)、其他的信息。
相机部17取得本车前方及/或本车后方的影像。例如,前车B包含在影像内时,控制ECU20能够基于影像而取得前车B的行驶轨迹。另外,通过根据相机部17的影像来检测道路的中心线,从而能够检测本车辆的换道(行车线变更)。
车辆A的控制ECU20是进行车辆行驶位置判定装置1的整体的控制的电子控制单元,例如以包括CPU、ROM、RAM在内的计算机为主体构成。控制ECU20进行基于由GPS部11、INS部13、通信部15及相机部17得到的信号的各种信息处理。
与以上的车辆A同样地,搭载于车辆B的车辆行驶位置判定装置201具备GPS部211、INS部213、通信部215、相机部217、控制ECU220。GPS部211、INS部213、通信部215、相机部217、控制ECU220的结构分别与上述的GPS部11、INS部13、通信部15、相机部17、控制ECU20相同,因此省略重复的说明。
车辆A的控制ECU20具有相对位置计测部21、本车行驶轨迹计测部23、及车道判定部25。这些称为相对位置计测部21、本车行驶轨迹计测部23及车道判定部25的各结构要素是控制ECU20的CPU、RAM、ROM等硬件按照规定的程序进行协作而动作,从而软件性地实现的结构要素。
相对位置计测部21基于由GPS部11得到的本车辆A的位置坐标Pa与车辆B由GPS部211进行测位并通过车车间通信发送的车辆B的位置坐标Pb的差值,通过所谓“车车间码差分测位法”来算出车辆A、B的相对位置。根据该车车间码差分测位法,能够消除电离层/对流圈对GPS卫星电波的影响,因此能够高精度地取得车辆A、B的相对位置。
本车行驶轨迹计测部23利用GPS部11持续取得本车位置坐标,从而通过GPS速度的累计,而算出本车的行驶轨迹。另外,关于利用GPS部11无法取得本车位置坐标的区间,能够根据来自INS部13的信息对行驶轨迹进行增补。车道判定部25最终判定前车B是在与本车辆A相同的车道上行驶还是在不同的车道上行驶。
另一方面,车辆B的车辆行驶位置判定装置201的控制ECU220具备换道判定部227、换道计数部229、及本车行驶轨迹计测部223。这些被称为换道判定部227、换道计数部229、本车行驶轨迹计测部223的各结构要素是控制ECU220的CPU、RAM、ROM等硬件按照规定的程序进行协作而动作,从而软件性地实现的结构要素。换道判定部227根据由相机部217得到的车辆前方及/或车辆后方的影像来检测道路100的中心线103(图2),并通过识别车辆B横穿该中心线103的情况,而检测车辆B的换道。换道计数部229对换道判定部227检测到的换道的次数进行计数。另外,本车行驶轨迹计测部223具备与车辆A的本车行驶轨迹计测部23同样的结构。
接下来,参照图3的流程图,说明基于此种车辆A、B的结构来判定车辆A、前车B所行驶的车道的处理。在以下的说明中,某时刻t的本车辆A的位置表示为“Pa(t)”,某时刻t的前车B的位置表示为“Pb(t)”。另外,某时刻t的车辆B相对于车辆A的相对位置表示为“Pab(t)”。另外,在以下的说明中,表示各时刻时,如“时刻t1”、“时刻t2”、…这样对t添加下标进行表示,下标的数字越大越表示未来的时刻。
在某时刻t1,在道路100上行驶中的车辆A、B的位置关系如图4所示。如图3所示,在该时刻t1,车辆A的相对位置计测部21从GPS部11取得表示本车辆A的位置Pa(t1)的坐标的GPS码(S101)。此时,车辆B取得表示本车辆B的位置Pb(t1)的坐标的GPS码,通过通信部215向车辆A发送GPS码。车辆A的相对位置计测部21通过通信部15而取得车辆B的GPS码(S103)。需要说明的是,在此,能够得到表示车辆A、B的三维坐标的GPS码,但在以下的处理中,仅使用平面坐标的信息(例如,东西方向的坐标及南北方向的坐标),而不使用上下方向的坐标。
接下来,相对位置计测部21运算车辆A的GPS码与车辆B的GPS码的差值,通过车车间码差分测位法,而算出车辆A、B的相对位置Pab(t1)(S105)。此时,如图5所示,相对位置计测部21假想性地设定以位置Pb(t1)为中心的半径r的同车道判定区域C。另外,在比位置Pb(t1)靠前进方向的紧前方的位置上假想性地设定横穿道路100的判定结束线D。上述的半径r例如设定为1m。
该时刻t1之后,车辆A的本车行驶轨迹计测部23在本车辆A通过同车道判定区域C(S107)或本车辆A通过判定结束线D(S109)之前,持续取得本车辆A的行驶轨迹。并且,在本车辆A的行驶轨迹通过了同车道判定区域C或判定结束线D的任一者时,在此时的时刻t2,进行判断位置Pa(t2)和位置Pb(t1)是否在相同车道内的车道比较处理(S111)。
即,在时刻t2,如图6所示,在本车辆A通过了同车道判定区域C时(S107为是),可以认为该时刻t2的车辆A的位置Pa(t2)处于与位置Pb(t1)相同的车道。因此,这种情况下,在S111中,本车行驶轨迹计测部23理解到本车辆A在当前的时刻t2所行驶的车道与车辆B在过去的时刻t1所存在的车道为相同的车道。
另一方面,在时刻t2,如图7所示,本车辆A未通过同车道判定区域C而通过了判定结束线D时(S109为是),可以认为该时刻t2的车辆A的位置Pa(t2)处于与位置Pb(t1)不同的车道。因此,这种情况下,在S111中,本车行驶轨迹计测部23理解到本车辆A在当前的时刻t2所行驶的车道与车辆B在过去的时刻t1所存在的车道为不同的车道。
基于车辆A进行上述处理,另一方面,车辆B的换道判定部227对从时刻t1到时刻t2期间的本车辆B的换道的次数进行计数。例如,在图6、7的例子的情况下,车辆B在从时刻t1到时刻t2期间进行一次换道。车辆A在时刻t2,通过车车间通信接收来自车辆B的换道次数信息(S113)。
接下来,车道判定部25根据由S111进行的车道比较的信息和由S113进行的换道次数是偶数次还是奇数次,来判定位置Pa(t2)和位置Pb(t2)是否处于相同的车道内(S115)。即,例如图6所示的例子的情况下,位置Pa(t2)和位置Pb(t1)处于相同的车道,车辆B的换道次数为奇数次(这种情况下为一次),因此判明位置Pa(t2)和位置Pb(t2)处于不同的车道内。因此,车道判定部25能够判定为在当前的时刻t2的时刻,前车B在与本车辆A不同的车道上行驶。同样地,例如图7所示的例子的情况下,位置Pa(t2)和位置Pb(t1)处于不同的车道,车辆B的换道次数为奇数次(这种情况下为一次),因此判明位置Pa(t2)和位置Pb(t2)处于同一车道内。因此,车道判定部25能够判定为在当前时刻t2的时刻,前车B在与本车辆A相同的车道上行驶。
根据以上的车辆行驶位置判定装置1及车辆行驶位置判定方法,在时刻t1,使用车车间码差分测位法,因此与车道的宽度相比,能够取得高精度的相对位置Pab(t1)。除了该相对位置Pab(t1)之外,将能够准确地计数的上述换道次数信息组合,而进行位置Pa(t2)与位置Pb(t2)的车道比较,因此能够准确地判定前车B是否在与本车辆A相同的车道上行驶。另外,根据该车辆行驶位置判定装置1及车辆行驶位置判定方法,即使在本车辆A与前车B之间存在其他的加塞车辆时、因急转弯等周边环境的主要原因等而从本车辆A观察时未直接看见前车B时,也能够进行判定。
另外,车辆A通过将在S115中判定的位置Pa(t2)与位置Pb(t2)的车道比较信息向车辆B发送,从而车辆B能够判定后方的车辆A是否在与本车B相同的车道上行驶。即,该车辆行驶位置判定装置1、201也能够作为车辆B判定后方的车辆A所行驶的车道的装置而进行利用。
另外,根据该结构,在时刻t2以后,车辆A通过仅取得时刻t2以后的车辆B的换道次数,从而能够识别车辆B在哪个车道100R、100L上行驶。因此,在时刻t2以后,车辆B的换道判定部227也可以每当检测出换道时,将换道检测信息从车辆B向车辆A发送。另外,同样地,车辆B通过仅取得时刻t2以后的车辆A的换道次数,从而能够识别车辆A在哪个车道100R、100L上行驶。因此,车辆A、B在时刻t2以后,仅通过换道次数信息的更换这样的小通信量,就能够判定对方的车辆的行驶的车道。
(第二实施方式)
在本实施方式的车辆行驶位置判定装置及车辆行驶位置判定方法中,在前述的处理S115之后,还进行判定处理,能够再次检查S115中的判定结果。以下,参照图8~图12,说明处理S115之后进行的处理。
如图8所示,在时刻t2之后,车辆B的本车行驶轨迹计测部223算出从时刻t2到任意的时刻t3的本车辆B的行驶轨迹(图9)。此外,车辆B的换道计数部229取得从时刻t2到时刻t3的换道次数。车辆A通过车车间通信而从车辆B接收这些车辆B的行驶轨迹信息及换道次数信息(S201)。如图10所示,车辆A的车道判定部25基于接收到的车辆B的行驶轨迹信息所示的轨迹形状和接收到的换道次数信息,来取出车道形状110(S203)。即,例如若车辆B的换道次数为0次,则车道形状110与车辆B的行驶轨迹的形状相同。需要说明的是,车辆A也可以基于本车辆A的行驶轨迹信息及换道次数信息来进行车道形状110的取出。
此外,在时刻t3,如图11所示,车辆A的相对位置计测部21通过车车间码差分测位法来求出相对位置Pab(t3)(S205)。然后,车道判定部25相对于基于取出的车道形状110的车道的延伸方向,算出向量Pab(t3)所成的角度α(S207)。在此,若时刻t3的车辆A和车辆B在相同的车道上行驶,则认为角度α接近零,若时刻t3的车辆A和车辆B在不同的车道上行驶,则认为角度α增大某种程度。因此,车道判定部25在角度α超过规定的阈值Z时(S209中为是),判定为时刻t3的车辆A和车辆B在不同的车道上行驶(S211),在角度α未超过规定的阈值Z时(S209中为否),判定为时刻t3的车辆A和车辆B在相同的车道上行驶(S213)。通过判断该判定结果与前述的处理S115所进行的判定结果之间是否存在矛盾,从而能够进行判定结果的再次检查,能够得到可靠性更高的判定结果。
本发明并未限定为上述的实施方式。例如,车辆B的换道计数部229使用基于相机部217的中心线检测而对换道次数进行计数,但也可以将其取代,而采用如下的换道次数的计数方法。即,如图12所示,换道计数部229根据车辆B所预先保持的地图信息,读出当前行驶中的道路的道路形状120(例如,中心线的形状)。此外,换道计数部229使由本车行驶轨迹计测部223所得到的行驶轨迹121与道路形状120重合,对行驶轨迹121与道路形状120的交叉点进行计数,从而能够导出换道次数。在图12的例子的情况下,能够求出换道次数为3次。需要说明的是,也可以取代从地图信息中取得道路形状120,而效仿于前述的图8的S201、S203的处理,基于车辆B的行驶轨迹信息所示的轨迹形状和接收到的换道次数信息,来取出道路形状120。
另外,设前述的同车道判定区域C(图5)的半径r为1m,但半径r的尺寸也可以考虑道路100上的车道宽度,以能够判断车辆A是否通过了与位置Pb(t1)相同的车道的方式设定适当尺寸。另外,同车道判定区域C并未局限于圆形,例如图13所示,也可以设定将位置Pb(t1)包围的四边形的同车道判定区域C2。另外,同车道判定区域C2可以形成为沿着车道的延伸方向延伸的四边形,该四边形的车道的延伸方向的长度、宽度也可以根据道路形状、车辆A、B的车速来适当变更。例如,也可以是车辆A、B的车速越大而将同车道判定区域C2的车道的延伸方向的长度设定得越长。另外,例如在道路100为高速道路时,与一般道路相比,沿着车道的延伸方向设定长的同车道判定区域C3。如此,在车辆A的车速大的情况下,通过延长同车道判定区域,而能够可靠地检测车辆A通过了同车道判定区域的情况。如上所述,通过调整同车道判定区域的形状、宽窄,从而能够提高判定可靠性。
另外,在相对位置计测部21中,仅使用了由GPS部11及GPS部211取得的三维坐标中的平面坐标的信息,但也可以使用车辆A与车辆B的三维的相对位置Pab(t)。这种情况下,例如,根据在高架道路上行驶的车辆A,而能够进行判定在高架下的道路上行驶的车辆B的行驶位置这样的利用。另外,换道计数部229也可以对车辆B的向右的换道次数和向左的换道次数进行区别来计数。这种情况下,也能够应用于车辆A、B在具有三条以上车道的道路上行驶的情况。
【工业实用性】
本发明涉及对前车的行驶位置进行判定的车辆行驶位置判定方法及车辆行驶位置判定装置,能够高精度地判定前车所行驶的车道。
标号说明
1、201…车辆行驶位置判定装置,11、211…GPS部,21…相对位置计测部(相对位置信息取得单元),23…本车行驶轨迹计测部(本车行驶轨迹信息取得单元),25…车道判定部(前车位置判定单元),223…本车行驶轨迹计测部(前车行驶轨迹信息取得单元),229…换道计数部(换道信息取得单元),A…车辆(本车),B…车辆(前车)。
Claims (6)
1.一种车辆行驶位置判定方法,用于判定前车的行驶位置,其特征在于,具备:
取得规定时刻的所述前车与本车的相对位置信息的相对位置信息取得步骤,
取得所述规定时刻以后的所述本车的行驶轨迹信息的本车行驶轨迹信息取得步骤,及
基于所述相对位置信息和所述本车的行驶轨迹信息来判定所述前车的行驶位置的前车位置判定步骤,
在所述相对位置信息取得步骤中,基于由GPS取得的所述前车的坐标信息与由GPS取得的所述本车的坐标信息的差值来算出所述相对位置信息,
所述车辆行驶位置判定方法还具备取得所述规定时刻以后的所述前车的与换道相关的换道信息的换道信息取得步骤,
在所述本车行驶轨迹信息取得步骤中,还取得表示所述规定时刻以后的所述本车的行驶轨迹通过了同车道判定区域和判定结束线中的哪一个的本车通过信息,其中,该同车道判定区域被假想地设定在所述规定时刻的所述前车的位置,该判定结束线被假想地设定在所述同车道判定区域的前方,
在所述前车位置判定步骤中,还基于所述换道信息和所述本车通过信息来判定所述前车的行驶位置。
2.一种车辆行驶位置判定方法,用于判定前车的行驶位置,其特征在于,具备:
取得规定时刻的所述前车与本车的相对位置信息的相对位置信息取得步骤,
取得所述规定时刻以后的所述本车的行驶轨迹信息的本车行驶轨迹信息取得步骤,及
基于所述相对位置信息和所述本车的行驶轨迹信息来判定所述前车的行驶位置的前车位置判定步骤,
在所述相对位置信息取得步骤中,基于由GPS取得的所述前车的坐标信息与由GPS取得的所述本车的坐标信息的差值来算出所述相对位置信息,
所述车辆行驶位置判定方法还具备取得所述规定时刻以后的所述前车的与换道相关的换道次数信息的换道次数信息取得步骤,
在所述前车位置判定步骤中,还基于所述换道次数信息来判定所述前车的行驶位置,
所述车辆行驶位置判定方法还具备:
取得所述规定时刻以后的所述前车的行驶轨迹信息的前车行驶轨迹信息取得步骤,及
基于所述前车的行驶轨迹信息和所述换道次数信息来取得所述前车所行驶的车道的车道形状的车道形状取得步骤,
在所述前车位置判定步骤中,还根据所述相对位置信息的相对位置向量与基于所述车道形状的车道的延伸方向所成的角度,来判定所述前车的行驶位置。
3.一种车辆行驶位置判定方法,用于判定前车的行驶位置,其特征在于,具备:
基于由GPS取得的所述前车的坐标信息和由GPS取得的本车的坐标信息来算出规定时刻的所述前车与所述本车的相对位置信息的相对位置信息取得步骤,
取得所述规定时刻以后的所述本车的行驶轨迹信息的本车行驶轨迹信息取得步骤,及
基于所述相对位置信息和所述本车的行驶轨迹信息来判定所述前车的行驶位置的前车位置判定步骤,
还具备取得所述规定时刻以后的所述前车的与换道相关的换道信息的换道信息取得步骤,
在所述本车行驶轨迹信息取得步骤中,还取得表示所述规定时刻以后的所述本车的行驶轨迹通过了同车道判定区域和判定结束线中的哪一个的本车通过信息,其中,该同车道判定区域被假想地设定在所述规定时刻的所述前车的位置,该判定结束线被假想地设定在所述同车道判定区域的前方,
在所述前车位置判定步骤中,还基于所述换道信息和所述本车通过信息来判定所述前车的行驶位置。
4.一种车辆行驶位置判定装置,用于判定前车的行驶位置,其特征在于,具备:
取得规定时刻的所述前车与本车的相对位置信息的相对位置信息取得单元,
取得所述规定时刻以后的所述本车的行驶轨迹信息的本车行驶轨迹信息取得单元,及
基于所述相对位置信息和所述本车的行驶轨迹信息来判定所述前车的行驶位置的前车位置判定单元,
所述相对位置信息取得单元基于由GPS取得的所述前车的坐标信息与由GPS取得的所述本车的坐标信息的差值来算出所述相对位置信息,
所述车辆行驶位置判定装置还具备取得所述规定时刻以后的所述前车的与换道相关的换道信息的换道信息取得单元,
所述本车行驶轨迹信息取得单元还取得表示所述规定时刻以后的所述本车的行驶轨迹通过了同车道判定区域和判定结束线中的哪一个的本车通过信息,其中,该同车道判定区域被假想地设定在所述规定时刻的所述前车的位置,该判定结束线被假想地设定在所述同车道判定区域的前方,
所述前车位置判定单元还基于所述换道信息和所述本车通过信息来判定所述前车的行驶位置。
5.一种车辆行驶位置判定装置,用于判定前车的行驶位置,其特征在于,具备:
取得规定时刻的所述前车与本车的相对位置信息的相对位置信息取得单元,
取得所述规定时刻以后的所述本车的行驶轨迹信息的本车行驶轨迹信息取得单元,及
基于所述相对位置信息和所述本车的行驶轨迹信息来判定所述前车的行驶位置的前车位置判定单元,
所述相对位置信息取得单元基于由GPS取得的所述前车的坐标信息与由GPS取得的所述本车的坐标信息的差值来算出所述相对位置信息,
所述车辆行驶位置判定装置还具备取得所述规定时刻以后的所述前车的与换道相关的换道次数信息的换道次数信息取得单元,
所述前车位置判定单元还基于所述换道次数信息来判定所述前车的行驶位置,
所述车辆行驶位置判定装置还具备:
取得所述规定时刻以后的所述前车的行驶轨迹信息的前车行驶轨迹信息取得单元,及
基于所述前车的行驶轨迹信息和所述换道次数信息来取得所述前车所行驶的车道的车道形状的车道形状取得单元,
所述前车位置判定单元还根据所述相对位置信息的相对位置向量与基于所述车道形状的车道的延伸方向所成的角度,来判定所述前车的行驶位置。
6.一种车辆行驶位置判定装置,用于判定前车的行驶位置,其特征在于,具备:
基于由GPS取得的所述前车的坐标信息和由GPS取得的本车的坐标信息来算出规定时刻的所述前车与所述本车的相对位置信息的相对位置信息取得单元,
取得所述规定时刻以后的所述本车的行驶轨迹信息的本车行驶轨迹信息取得单元,及
基于所述相对位置信息和所述本车的行驶轨迹信息来判定所述前车的行驶位置的前车位置判定单元,
还具备取得所述规定时刻以后的所述前车的与换道相关的换道信息的换道信息取得单元,
在所述本车行驶轨迹信息取得单元中,还取得表示所述规定时刻以后的所述本车的行驶轨迹通过了同车道判定区域和判定结束线中的哪一个的本车通过信息,其中,该同车道判定区域被假想地设定在所述规定时刻的所述前车的位置,该判定结束线被假想地设定在所述同车道判定区域的前方,
所述前车位置判定单元还基于所述换道信息和所述本车通过信息来判定所述前车的行驶位置。
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
PCT/JP2009/060698 WO2010143291A1 (ja) | 2009-06-11 | 2009-06-11 | 車両走行位置判定方法及び車両走行位置判定装置 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN102460535A CN102460535A (zh) | 2012-05-16 |
CN102460535B true CN102460535B (zh) | 2014-09-03 |
Family
ID=43308559
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN200980159798.1A Active CN102460535B (zh) | 2009-06-11 | 2009-06-11 | 车辆行驶位置判定方法及车辆行驶位置判定装置 |
Country Status (5)
Country | Link |
---|---|
US (1) | US8510027B2 (zh) |
JP (1) | JP5218656B2 (zh) |
CN (1) | CN102460535B (zh) |
DE (1) | DE112009004902B4 (zh) |
WO (1) | WO2010143291A1 (zh) |
Families Citing this family (28)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP2011075396A (ja) * | 2009-09-30 | 2011-04-14 | Sanyo Electric Co Ltd | 車車間通信装置 |
JP5616301B2 (ja) * | 2011-08-10 | 2014-10-29 | 株式会社日本自動車部品総合研究所 | 車両検出装置 |
DE102011084084A1 (de) * | 2011-10-06 | 2013-04-11 | Robert Bosch Gmbh | Anzeigeverfahren und Anzeigesystem für ein Fahrzeug |
DE102012020297B4 (de) * | 2012-10-17 | 2017-08-31 | Audi Ag | Verfahren zur Zuordnung eines Senders zu einem detektierten Objekt in der Kraftfahrzeug-zu-Kraftfahrzeug-Kommunikation und Kraftfahrzeug |
US20150353014A1 (en) * | 2012-10-25 | 2015-12-10 | Po Yiu Pauline Li | Devices, systems and methods for identifying potentially dangerous oncoming cars |
US9113786B2 (en) * | 2012-10-25 | 2015-08-25 | Po Yiu Pauline Li | Devices, systems and methods for identifying potentially dangerous oncoming cars |
JP6214995B2 (ja) * | 2013-10-11 | 2017-10-18 | 株式会社東芝 | 駐車車両検出装置、車両管理システム、制御方法及び制御プログラム |
DE102013223428A1 (de) * | 2013-11-18 | 2015-05-21 | Robert Bosch Gmbh | Verfahren und Fahrerassistenzeinrichtung zur Unterstützung von Spurwechseln bzw. Überholmanövern eines Kraftfahrzeugs |
JP6225039B2 (ja) * | 2014-01-31 | 2017-11-01 | 株式会社日立製作所 | 画像検索システム、画像検索装置及び画像検索方法 |
KR101558746B1 (ko) * | 2014-03-13 | 2015-10-07 | 현대자동차주식회사 | 차량간 무선통신을 이용한 목표차량 검출 장치 및 그 방법 |
US9436182B2 (en) | 2014-05-23 | 2016-09-06 | Google Inc. | Autonomous vehicles |
US9631933B1 (en) | 2014-05-23 | 2017-04-25 | Google Inc. | Specifying unavailable locations for autonomous vehicles |
KR102263731B1 (ko) | 2014-11-11 | 2021-06-11 | 현대모비스 주식회사 | 주변차량의 위치정보 보정 시스템 및 방법 |
JP6553930B2 (ja) * | 2015-04-14 | 2019-07-31 | 日立オートモティブシステムズ株式会社 | 車両情報処理装置、及び車両情報処理プログラム |
US9733096B2 (en) | 2015-06-22 | 2017-08-15 | Waymo Llc | Determining pickup and destination locations for autonomous vehicles |
JP6582844B2 (ja) * | 2015-10-07 | 2019-10-02 | いすゞ自動車株式会社 | 運転状態検知装置 |
CN106408935B (zh) * | 2015-12-20 | 2020-03-31 | 杭州后博科技有限公司 | 一种基于导航的机动车连续变道行为监控系统及方法 |
US9766344B2 (en) * | 2015-12-22 | 2017-09-19 | Honda Motor Co., Ltd. | Multipath error correction |
DE102016202829A1 (de) | 2016-02-24 | 2017-08-24 | Bayerische Motoren Werke Aktiengesellschaft | Vorrichtung zur Querführungsunterstützung für ein straßengebundenes Fahrzeug |
DE102016202830A1 (de) * | 2016-02-24 | 2017-08-24 | Bayerische Motoren Werke Aktiengesellschaft | Vorrichtung und Verfahren zur Querführungsunterstützung für ein straßengebundenes Fahrzeug |
WO2017208306A1 (ja) * | 2016-05-30 | 2017-12-07 | 株式会社クボタ | 自動走行作業車両 |
CN107192396A (zh) * | 2017-02-13 | 2017-09-22 | 问众智能信息科技(北京)有限公司 | 汽车精确导航方法和装置 |
JP6664360B2 (ja) * | 2017-09-08 | 2020-03-13 | 本田技研工業株式会社 | 判定装置および車両 |
JP6601696B2 (ja) * | 2018-01-19 | 2019-11-06 | 本田技研工業株式会社 | 予測装置、予測方法、およびプログラム |
JP2019174151A (ja) * | 2018-03-27 | 2019-10-10 | 株式会社島津製作所 | 分光器 |
CN109671300B (zh) * | 2019-01-16 | 2021-03-19 | 上海交通大学 | 一种多车协作车道检测方法 |
CN113994406B (zh) | 2019-06-19 | 2023-09-08 | 三菱电机株式会社 | 相对位置判定装置、相对位置判定方法以及存储介质 |
DE102020111486A1 (de) * | 2020-04-28 | 2021-10-28 | Daimler Ag | Verkehrsregelkonforme Entscheidungsfindung in dynamischen Verkehrsszenarien |
Citations (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN1124858A (zh) * | 1994-12-12 | 1996-06-19 | 黄金富 | 运动装置在运行中的定位、自动导航与防撞系统 |
CN1761979A (zh) * | 2003-01-21 | 2006-04-19 | 拜伦·金 | 基于gps的车辆报警和定位系统及方法 |
Family Cites Families (22)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
DE19507957C1 (de) * | 1995-03-07 | 1996-09-12 | Daimler Benz Ag | Fahrzeug mit optischer Abtasteinrichtung für einen seitlichen Fahrbahnbereich |
US7202776B2 (en) * | 1997-10-22 | 2007-04-10 | Intelligent Technologies International, Inc. | Method and system for detecting objects external to a vehicle |
US6768944B2 (en) * | 2002-04-09 | 2004-07-27 | Intelligent Technologies International, Inc. | Method and system for controlling a vehicle |
US6526352B1 (en) * | 2001-07-19 | 2003-02-25 | Intelligent Technologies International, Inc. | Method and arrangement for mapping a road |
US7085637B2 (en) * | 1997-10-22 | 2006-08-01 | Intelligent Technologies International, Inc. | Method and system for controlling a vehicle |
JP3932806B2 (ja) * | 1997-12-01 | 2007-06-20 | 株式会社日立製作所 | 自動車の走行制御装置 |
JP3658519B2 (ja) * | 1999-06-28 | 2005-06-08 | 株式会社日立製作所 | 自動車の制御システムおよび自動車の制御装置 |
JP3630100B2 (ja) * | 2000-12-27 | 2005-03-16 | 日産自動車株式会社 | 車線検出装置 |
JP3772969B2 (ja) | 2001-10-16 | 2006-05-10 | オムロン株式会社 | 車載用レーダ装置 |
JP3766909B2 (ja) * | 2001-11-30 | 2006-04-19 | 株式会社日立製作所 | 走行環境認識方法および装置 |
JP3932975B2 (ja) | 2002-05-17 | 2007-06-20 | アイシン・エィ・ダブリュ株式会社 | 位置検出装置 |
JP3887280B2 (ja) * | 2002-07-18 | 2007-02-28 | 本田技研工業株式会社 | 車載表示装置 |
US6691018B1 (en) * | 2002-11-21 | 2004-02-10 | Visteon Global Technologies, Inc. | Method and system for identifying a lane change |
JP4110999B2 (ja) * | 2003-02-21 | 2008-07-02 | 日産自動車株式会社 | 車両用運転操作補助装置およびその装置を備える車両 |
WO2005020182A1 (ja) | 2003-08-20 | 2005-03-03 | Hitachi, Ltd. | 先行車選択装置及び先行車選択方法 |
JP4496974B2 (ja) | 2005-01-28 | 2010-07-07 | 日産自動車株式会社 | 先行車両情報提示システム |
US7729857B2 (en) * | 2005-08-18 | 2010-06-01 | Gm Global Technology Operations, Inc. | System for and method of detecting a collision and predicting a vehicle path |
JP4887980B2 (ja) * | 2005-11-09 | 2012-02-29 | 日産自動車株式会社 | 車両用運転操作補助装置および車両用運転操作補助装置を備えた車両 |
JP4918807B2 (ja) * | 2006-04-06 | 2012-04-18 | トヨタ自動車株式会社 | 車両位置演算装置、車両選定方法 |
JP4816248B2 (ja) * | 2006-05-23 | 2011-11-16 | 日産自動車株式会社 | 車両用運転操作補助装置 |
JP4420011B2 (ja) * | 2006-11-16 | 2010-02-24 | 株式会社日立製作所 | 物体検知装置 |
DE102008012655A1 (de) * | 2007-05-30 | 2008-12-04 | Continental Teves Ag & Co. Ohg | Relative Positionsbestimmung von Fahrzeugen |
-
2009
- 2009-06-11 WO PCT/JP2009/060698 patent/WO2010143291A1/ja active Application Filing
- 2009-06-11 DE DE112009004902.8T patent/DE112009004902B4/de active Active
- 2009-06-11 CN CN200980159798.1A patent/CN102460535B/zh active Active
- 2009-06-11 US US13/262,838 patent/US8510027B2/en active Active
- 2009-06-11 JP JP2011518183A patent/JP5218656B2/ja active Active
Patent Citations (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN1124858A (zh) * | 1994-12-12 | 1996-06-19 | 黄金富 | 运动装置在运行中的定位、自动导航与防撞系统 |
CN1761979A (zh) * | 2003-01-21 | 2006-04-19 | 拜伦·金 | 基于gps的车辆报警和定位系统及方法 |
Non-Patent Citations (3)
Title |
---|
JP特开2004-280521A 2004.10.07 |
JP特开2004-50923A 2004.02.19 |
JP特开2007-280060A 2007.10.25 |
Also Published As
Publication number | Publication date |
---|---|
WO2010143291A1 (ja) | 2010-12-16 |
US8510027B2 (en) | 2013-08-13 |
DE112009004902T5 (de) | 2012-06-21 |
DE112009004902B4 (de) | 2016-10-20 |
CN102460535A (zh) | 2012-05-16 |
US20120029813A1 (en) | 2012-02-02 |
JP5218656B2 (ja) | 2013-06-26 |
JPWO2010143291A1 (ja) | 2012-11-22 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN102460535B (zh) | 车辆行驶位置判定方法及车辆行驶位置判定装置 | |
US11313976B2 (en) | Host vehicle position estimation device | |
CN103781685B (zh) | 车辆用自主行驶控制系统 | |
CN107000749B (zh) | 车辆的行驶控制装置以及行驶控制方法 | |
CN105270410A (zh) | 用于自主驾驶车辆的路径规划的精确曲率估计算法 | |
RU2706763C1 (ru) | Устройство локализации транспортного средства | |
CN102044170B (zh) | 车辆的驾驶辅助控制装置 | |
CN109477728B (zh) | 用于确定车辆相对于路面行车道的横向位置的方法和装置 | |
CN107798914B (zh) | 自动车辆交叉车流检测系统 | |
CN106842269A (zh) | 定位方法及系统 | |
JP6654923B2 (ja) | 地図情報出力装置 | |
CN109155107A (zh) | 用于自动化车辆场景感知的感知系统 | |
CN111108344B (zh) | 位置捕捉系统以及位置捕捉方法 | |
KR20160131915A (ko) | 오인식 판정 장치 | |
CN112577526B (zh) | 一种多传感器融合定位的置信度计算方法及系统 | |
EP2352664A1 (en) | Method and system for determining road data | |
WO2007138854A1 (ja) | 自車位置測定装置 | |
CN109791698B (zh) | 用于确定车辆相对于路面的车道的横向位置的方法、设备和电脑可读的具有指令的存储介质 | |
JP6941178B2 (ja) | 自動運転制御装置及び方法 | |
CN102673560A (zh) | 识别拐弯机动的方法和驾驶员辅助系统 | |
CN110167813A (zh) | 行驶路径识别装置及行驶路径识别方法 | |
CN112673230B (zh) | 行驶辅助方法及行驶辅助装置 | |
KR101980509B1 (ko) | 차간 거리 추정 방법 및 차간 거리 추정 장치 | |
CN114586083A (zh) | 信息处理装置、信息处理系统、信息处理方法和信息处理程序 | |
CN115195731A (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 | ||
C14 | Grant of patent or utility model | ||
GR01 | Patent grant |