JP2021051654A - 先行車両特定装置 - Google Patents
先行車両特定装置 Download PDFInfo
- Publication number
- JP2021051654A JP2021051654A JP2019175285A JP2019175285A JP2021051654A JP 2021051654 A JP2021051654 A JP 2021051654A JP 2019175285 A JP2019175285 A JP 2019175285A JP 2019175285 A JP2019175285 A JP 2019175285A JP 2021051654 A JP2021051654 A JP 2021051654A
- Authority
- JP
- Japan
- Prior art keywords
- vehicle
- traveling direction
- unit
- traveling
- preceding vehicle
- 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
Links
- 238000000605 extraction Methods 0.000 claims abstract description 77
- 239000000284 extract Substances 0.000 claims abstract description 37
- 238000004891 communication Methods 0.000 claims abstract description 21
- 238000000034 method Methods 0.000 description 32
- 238000001514 detection method Methods 0.000 description 11
- 238000012545 processing Methods 0.000 description 9
- 238000010586 diagram Methods 0.000 description 6
- 230000000694 effects Effects 0.000 description 3
- 238000012986 modification Methods 0.000 description 3
- 230000004048 modification Effects 0.000 description 3
- 238000005259 measurement Methods 0.000 description 2
- 230000006870 function Effects 0.000 description 1
Images
Landscapes
- Traffic Control Systems (AREA)
Abstract
Description
実施の形態に係る先行車両特定装置は、先行車両特定装置を搭載する自車の周辺に存在する車車間通信可能な他車から、他車の位置を定期的に取得する。そして、先行車両特定装置は、自車の進行方向前方に存在する他車の位置の時間変化に、自車の位置の時間変化が類似する場合、位置の時間変化が類似する他車を先行車両として特定する。図1は、実施の形態の概要を説明するための図である。自車Vは、複数の他車(B1〜B3及びC1〜C4)それぞれと車車間通信可能である。他車B1〜B3は、自車Vの前方に存在し、自車Vが走行する道路を自車Vに先行して走行する他車である。自車Vの位置の時間変化は、他車B1〜B3それぞれの位置の時間変化に類似する。そのため、先行車両特定装置は、他車B1〜B3を先行車両として特定する。
図2は、実施の形態に係る自車Vの構成を示す図である。自車Vは、先行車両特定装置1と、自車状態検出部2と、通信部3とを備える。
r0=(cosφ0、sinφ0)・・・(1)
自車Vの位置から他車の位置に向かうベクトルr0αは、自車Vの位置を示すベクトルX0と、他車の位置を示すベクトルXαとを用いて下記の式(2)で表される。
r0α=Xα−X0・・・(2)
そして、自車Vの走行方位を示すベクトルr0と、自車Vの位置から他車の位置に向かうベクトルr0αとのなす角θは、余弦を用いて以下の式(3)で表される。
cosθ=(r0・r0α)/|r0α|・・・(3)
rα(t−Δt)=(Vα(t−Δt)・Δt、φα(t−Δt))・・・(4)
|{Xα(t)−Xα(t−Δt)}−rα(t−Δt)|≦15(m)・・・(5)
前方車両抽出部123は、式(5)が成立する場合、他車を前方車両として抽出し、式(5)が成立しない場合、他車を前方車両として抽出しない。
以下、図7を参照しながら、先行車両Bを特定する処理の流れを説明する。図7は、先行車両Bを特定する処理の流れを示すフローチャートである。まず、自車情報取得部121は、自車Vの走行方位、位置、及び速度を含む自車情報を取得する(ステップS1)。次に、他車情報取得部122は、他車の走行方位、位置、及び速度を含む他車情報を取得する(ステップS2)。
以上説明したとおり、先行車両特定装置1は、自車Vの走行方位及び位置と、他車の走行方位及び位置とに基づいて、自車Vの走行方位と他車の走行方位との差が抽出範囲内であり、かつ自車Vの進行方向前方に存在する他車を抽出する。そして、先行車両特定装置1は、自車Vの位置の履歴である自車走行軌跡と、他車の位置の履歴である他車走行軌跡との関係が、自車Vが走行する道路を先行する先行車両を特定するためのマッチング条件を満たすか否かに基づいて先行車両を特定する。このようにすることで、先行車両特定装置は、自車Vの直前を先行する他車だけでなく、車車間通信可能な範囲内において、自車Vの直前を先行する他車よりもさらに先行する他車を先行車両として特定できる。また、先行車両特定装置1は、マッチング条件を満たさない他車を先行車両として特定しないので、先行車両ではない他車を、誤って先行車両として特定してしまうことを抑制できる。
上記の説明において、前方車両抽出部123は、自車Vの走行方位と他車の走行方位との差が抽出範囲内である他車を抽出し、抽出した他車のうち、自車Vの進行方向前方に存在する他車をさらに抽出した。これに限らず、前方車両抽出部123は、自車Vの進行方向前方に存在する他車を抽出し、抽出した他車のうち自車Vの走行方位と他車の走行方位との差が抽出範囲内である他車をさらに抽出してもよい。
以上の説明においては、先行車両特定装置1は、自車に先行する先行車両を特定したが、これに限らず、自車が他車に対して先行しているか否かを特定してもよい。言い換えると、先行車両特定装置1は、自車が他車に先行することを特定することにより、自車の後方を追従する後方走行車両を特定する。この場合、先行車両特定装置1は、自車の走行方位と他車の走行方位との差が抽出範囲内であり、かつ他車の進行方向前方に自車が存在するか否かを判定する。そして、先行車両特定装置1は、走行方位の差が抽出範囲内であり、かつ他車の進行方向前方に自車が存在すると判定した他車の他車走行軌跡と、自車走行軌跡との関係が道路を走行する先行車両を特定するためのマッチング条件を満たすか否かに基づいて後方走行車両を特定する。詳細な説明は省略するが、先行車両特定装置1は、実施の形態の説明における自車と他車とを入れ替えることにより後方走行車両を特定することができる。
2 自車状態検出部
3 通信部
11 記憶部
12 制御部
121 自車情報取得部
122 他車情報取得部
123 前方車両抽出部
124 区間特定部
125 先行車両特定部
126 距離特定部
Claims (8)
- 道路を走行中の自車の走行方位と位置とを含む自車情報を取得する自車情報取得部と、
車車間通信により他車の走行方位と位置とを含む他車情報を取得する他車情報取得部と、
前記自車情報と前記他車情報とに基づいて、前記自車の走行方位と前記他車の走行方位との差が判定距離内であり、かつ前記自車の進行方向前方に存在する他車を抽出する前方車両抽出部と、
前記前方車両抽出部が抽出した前記他車の位置の履歴である他車走行軌跡と、前記自車の位置の履歴である自車走行軌跡との関係が前記道路を走行する先行車両を特定するためのマッチング条件を満たすか否かに基づいて前記先行車両を特定する先行車両特定部と、
を備える先行車両特定装置。 - 前記他車走行軌跡に含まれる前記他車の位置それぞれと、前記自車走行軌跡に含まれる前記自車の位置それぞれを照合するためのマッチング区間を設定する区間設定部をさらに備え、
前記先行車両特定部は、前記マッチング区間の長さが所定長さ以上である場合、前記先行車両を特定する、
請求項1に記載の先行車両特定装置。 - 前記先行車両特定部は、前記マッチング区間内に含まれる前記自車の位置の数に対する、前記マッチング区間内に含まれる前記自車の位置それぞれの位置から所定距離内に前記他車の位置を含む前記自車の位置の数の割合が所定割合以上である場合、前記先行車両を特定する、
請求項2に記載の先行車両特定装置。 - 前記自車情報取得部は、前記自車の車速をさらに取得し、
前記他車情報取得部は、前記他車の車速をさらに取得し、
前記先行車両特定部は、前記マッチング区間における前記自車の車速に応じて定まる速度範囲内に、前記マッチング区間における前記他車の車速が含まれるか否かに基づいて前記先行車両を特定する、
請求項2又は3に記載の先行車両特定装置。 - 前記他車情報取得部は、前記他車の位置の精度を示す他車位置精度情報をさらに取得し、
前記前方車両抽出部は、前記他車情報取得部が取得した前記他車位置精度情報が示す前記精度が所定精度以上である他車を抽出する、
請求項1から4のいずれか一項に記載の先行車両特定装置。 - 前記前方車両抽出部は、前記他車情報が示す前記他車の位置及び走行方位に基づいて将来の前記他車の位置を推定した推定位置と、前記他車情報取得部が新たに取得した前記他車情報が示す前記他車の位置との差が所定距離以内である他車を抽出する、
請求項1から5のいずれか一項に記載の先行車両特定装置。 - 前記前方車両抽出部は、前記自車情報と前記他車情報とに基づいて、前記自車の走行方位と前記他車の走行方位との前記差が前記判定距離内である他車を抽出し、抽出した前記差が前記判定距離内である他車のうち、前記自車の進行方向前方に存在する他車をさらに抽出する、
請求項1から6のいずれか一項に記載の先行車両特定装置。 - 前記自車の位置から判定距離内に存在する前記先行車両の位置を始点として、前記他車情報取得部が最後に取得した前記他車情報が示す他車の位置を終点とする前記他車走行軌跡に沿った距離を特定する距離特定部をさらに備える、
請求項1から7のいずれか一項に記載の先行車両特定装置。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP2019175285A JP7247840B2 (ja) | 2019-09-26 | 2019-09-26 | 先行車両特定装置 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP2019175285A JP7247840B2 (ja) | 2019-09-26 | 2019-09-26 | 先行車両特定装置 |
Publications (2)
Publication Number | Publication Date |
---|---|
JP2021051654A true JP2021051654A (ja) | 2021-04-01 |
JP7247840B2 JP7247840B2 (ja) | 2023-03-29 |
Family
ID=75158026
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
JP2019175285A Active JP7247840B2 (ja) | 2019-09-26 | 2019-09-26 | 先行車両特定装置 |
Country Status (1)
Country | Link |
---|---|
JP (1) | JP7247840B2 (ja) |
Citations (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP2010238132A (ja) * | 2009-03-31 | 2010-10-21 | Equos Research Co Ltd | 車両制御装置、車両、及び車両制御プログラム |
JP2013047903A (ja) * | 2011-08-29 | 2013-03-07 | Denso Corp | 車両用無線通信装置及び通信システム |
WO2013038561A1 (ja) * | 2011-09-16 | 2013-03-21 | 富士通株式会社 | 車線判定装置、車線判定方法及び車線判定用コンピュータプログラム |
JP2017146724A (ja) * | 2016-02-16 | 2017-08-24 | 株式会社Subaru | 地図情報出力装置 |
-
2019
- 2019-09-26 JP JP2019175285A patent/JP7247840B2/ja active Active
Patent Citations (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP2010238132A (ja) * | 2009-03-31 | 2010-10-21 | Equos Research Co Ltd | 車両制御装置、車両、及び車両制御プログラム |
JP2013047903A (ja) * | 2011-08-29 | 2013-03-07 | Denso Corp | 車両用無線通信装置及び通信システム |
WO2013038561A1 (ja) * | 2011-09-16 | 2013-03-21 | 富士通株式会社 | 車線判定装置、車線判定方法及び車線判定用コンピュータプログラム |
JP2017146724A (ja) * | 2016-02-16 | 2017-08-24 | 株式会社Subaru | 地図情報出力装置 |
Also Published As
Publication number | Publication date |
---|---|
JP7247840B2 (ja) | 2023-03-29 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
JP6520597B2 (ja) | 車両位置補正装置 | |
US9891057B2 (en) | Information processing device, computer readable storage medium, and map data updating system | |
US8452535B2 (en) | Systems and methods for precise sub-lane vehicle positioning | |
US8989915B2 (en) | Vehicular wireless communication apparatus and communication system | |
CN108573611B (zh) | 一种限速标识融合方法以及限速标识融合系统 | |
EP3073224B1 (en) | Sensor data fusion based on digital map information | |
WO2018008082A1 (ja) | 走行車線推定システム | |
CN107830865B (zh) | 一种车辆目标分类方法、装置、系统及计算机程序产品 | |
KR102371984B1 (ko) | 도로 변경 지점 검출 방법 | |
JP2015212944A5 (ja) | ||
CN109752741A (zh) | 车辆定位设备 | |
CN104748756B (zh) | 使用云计算测量车辆位置的方法 | |
WO2014083410A1 (en) | Vehicle location estimation apparatus and vehicle location estimation method | |
WO2016172535A1 (en) | Detecting vehicle maneuvers with mobile phones | |
EP3218888B1 (en) | Trajectory detection | |
US10598499B2 (en) | Method and device for accelerated map-matching | |
CN110969178A (zh) | 自动驾驶车辆的数据融合系统、方法及自动驾驶系统 | |
JP6982430B2 (ja) | 車両の走行車線特定装置 | |
CN104395944A (zh) | 定向车道的识别 | |
JP2018147399A (ja) | 物標検出装置 | |
JP6507841B2 (ja) | 先行車両推定装置及びプログラム | |
CN114419929A (zh) | 一种碰撞风险评估方法、装置、电子设备及存储介质 | |
CN104422449A (zh) | 一种车辆导航的方法、装置 | |
CN114396958B (zh) | 基于多车道多传感器的车道定位方法、系统及车辆 | |
JP2008008628A (ja) | 自車位置決定装置 |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
A621 | Written request for application examination |
Free format text: JAPANESE INTERMEDIATE CODE: A621 Effective date: 20211028 |
|
A977 | Report on retrieval |
Free format text: JAPANESE INTERMEDIATE CODE: A971007 Effective date: 20220914 |
|
A131 | Notification of reasons for refusal |
Free format text: JAPANESE INTERMEDIATE CODE: A131 Effective date: 20220920 |
|
A521 | Request for written amendment filed |
Free format text: JAPANESE INTERMEDIATE CODE: A523 Effective date: 20221117 |
|
TRDD | Decision of grant or rejection written | ||
A01 | Written decision to grant a patent or to grant a registration (utility model) |
Free format text: JAPANESE INTERMEDIATE CODE: A01 Effective date: 20230214 |
|
A61 | First payment of annual fees (during grant procedure) |
Free format text: JAPANESE INTERMEDIATE CODE: A61 Effective date: 20230227 |
|
R150 | Certificate of patent or registration of utility model |
Ref document number: 7247840 Country of ref document: JP Free format text: JAPANESE INTERMEDIATE CODE: R150 |