[go: up one dir, main page]

JP6331858B2 - Advance vehicle overtaking support system - Google Patents

Advance vehicle overtaking support system Download PDF

Info

Publication number
JP6331858B2
JP6331858B2 JP2014161484A JP2014161484A JP6331858B2 JP 6331858 B2 JP6331858 B2 JP 6331858B2 JP 2014161484 A JP2014161484 A JP 2014161484A JP 2014161484 A JP2014161484 A JP 2014161484A JP 6331858 B2 JP6331858 B2 JP 6331858B2
Authority
JP
Japan
Prior art keywords
vehicle
preceding vehicle
overtaking
probability distribution
distance
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
Application number
JP2014161484A
Other languages
Japanese (ja)
Other versions
JP2016038717A (en
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.)
Nissan Motor Co Ltd
Original Assignee
Nissan Motor 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 Nissan Motor Co Ltd filed Critical Nissan Motor Co Ltd
Priority to JP2014161484A priority Critical patent/JP6331858B2/en
Publication of JP2016038717A publication Critical patent/JP2016038717A/en
Application granted granted Critical
Publication of JP6331858B2 publication Critical patent/JP6331858B2/en
Expired - Fee Related legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Images

Landscapes

  • Traffic Control Systems (AREA)

Description

本発明は、先行車追越支援装置に関する。   The present invention relates to a preceding vehicle overtaking support apparatus.

従来、先行車追越支援装置としては、例えば、特許文献1に記載の従来技術がある。
特許文献1に記載の従来技術では、先行車前方のスペースを検出し、検出したスペースに、自車が先行車を追い越した後に進入できるかどうかを判定するものがある。
Conventionally, as a preceding vehicle overtaking support device, for example, there is a conventional technique described in Patent Document 1.
In the prior art described in Patent Document 1, there is a technique for detecting a space ahead of a preceding vehicle and determining whether the vehicle can enter the detected space after passing the preceding vehicle.

特開2007−108967号公報JP 2007-108967 A

しかしながら、特許文献1に記載の従来技術では、先先行車の挙動を考慮しないため、自車が先行車の追い越しを終えたときに、先行車前方のスペースがなくなっている可能性があった。それゆえ、自車の追い越し動作が無駄になる可能性があった。
本発明は、上記のような点に着目してなされたもので、自車による先行車の追い越しをより適切に支援可能な先行車追越支援装置を提供することを目的とする。
However, in the prior art described in Patent Document 1, since the behavior of the preceding vehicle is not taken into consideration, there is a possibility that the space ahead of the preceding vehicle is lost when the host vehicle finishes overtaking the preceding vehicle. Therefore, the overtaking operation of the own vehicle may be wasted.
The present invention has been made paying attention to the above points, and an object thereof is to provide a preceding vehicle overtaking support apparatus that can more appropriately support overtaking of a preceding vehicle by the own vehicle.

上記課題を解決するために、本発明の一態様は、目標経路上に複数の追越地点候補を設定する。続いて、複数の追越地点候補それぞれに対し、先行車の現在地と、先行車の車速と、自車が現在地から追越地点候補に到達するまでにかかる時間(予想到達時間)とを用いて、予想到達時間後の先行車の位置を推定する。続いて、先先行車の現在地と、予想到達時間後の先先行車の車速の確率分布とを用いて、予想到達時間後の先先行車の位置を推定する。続いて、予想到達時間後の先行車の位置と、予想到達時間後の先先行車の位置とを用いて、複数の追越地点候補のうちから、予想到達時間後の先行車と先先行車との距離が予め定めた設定距離以上である追越地点候補を追越地点として設定する。   In order to solve the above problems, according to one embodiment of the present invention, a plurality of overtaking point candidates are set on a target route. Next, for each of the multiple overtaking point candidates, using the current location of the preceding vehicle, the speed of the preceding vehicle, and the time it takes for the vehicle to reach the overtaking point candidate from the current location (expected arrival time) The position of the preceding vehicle after the expected arrival time is estimated. Subsequently, the position of the preceding vehicle after the estimated arrival time is estimated using the current location of the preceding vehicle and the probability distribution of the vehicle speed of the preceding vehicle after the estimated arrival time. Subsequently, using the position of the preceding vehicle after the estimated arrival time and the position of the preceding preceding vehicle after the estimated arrival time, the preceding vehicle and the preceding preceding vehicle after the estimated arrival time from among a plurality of overtaking point candidates. A candidate for an overtaking point whose distance to the vehicle is equal to or greater than a predetermined set distance is set as an overtaking point.

本発明の一態様によれば、予想到達時間後、つまり、自車が現在地から追越地点候補に到達するときの先先行車の車速の確率分布を考慮して、予想到達時間後の先先行車の位置を推定する。それゆえ、予想到達時間後に、先行車の前方に自車が入るだけの適切なスペースがあるか否かを事前により適切に判断できる。これにより、自車による先行車の追い越しをより適切に支援することができる。   According to one aspect of the present invention, after the expected arrival time, that is, in consideration of the probability distribution of the vehicle speed of the preceding vehicle when the host vehicle reaches the overtaking point candidate from the current location, Estimate the position of the car. Therefore, after the expected arrival time, it can be appropriately determined in advance whether or not there is an appropriate space enough for the host vehicle to enter in front of the preceding vehicle. Thereby, the overtaking of the preceding vehicle by the own vehicle can be supported more appropriately.

第1実施形態に係る運転支援装置1の概略構成を表す概念図である。It is a conceptual diagram showing schematic structure of the driving assistance device 1 which concerns on 1st Embodiment. 第1実施形態のコントローラ5の内部構成を表すブロック図である。It is a block diagram showing the internal structure of the controller 5 of 1st Embodiment. 見通し距離Lmを説明するための図である。It is a figure for demonstrating line-of-sight distance Lm. 先先行車車速確率分布f(v)を表す図である。It is a figure showing the preceding preceding vehicle vehicle speed probability distribution f (v). 標準偏差σvの設定方法を表す図である。It is a figure showing the setting method of standard deviation (sigma) v. コントローラ5が実行する先行車追越支援処理を表すフローチャートである。It is a flowchart showing the preceding vehicle overtaking support process which the controller 5 performs. 第2実施形態のコントローラ5の内部構成を表すブロック図である。It is a block diagram showing the internal structure of the controller 5 of 2nd Embodiment.

本発明に係る実施形態について図面を参照しつつ説明する。
(第1実施形態)
(構成)
図1に示すように、先行車追越支援装置1は、車両(以下、「自車」とも呼ぶ)Aに搭載されている。そして、先行車追越支援装置1は、自車状態検出部2と、ナビゲーション装置3と、外部情報認識部4と、コントローラ5とを備える。
Embodiments according to the present invention will be described with reference to the drawings.
(First embodiment)
(Constitution)
As shown in FIG. 1, the preceding vehicle overtaking support device 1 is mounted on a vehicle (hereinafter also referred to as “own vehicle”) A. The preceding vehicle overtaking support device 1 includes a host vehicle state detection unit 2, a navigation device 3, an external information recognition unit 4, and a controller 5.

自車状態検出部2は、自車Aの走行状態を検出する。自車状態検出部2は、車速検出部2aと、加速度検出部2bと、ヨーレート検出部2cとを備える。
車速検出部2aは、自車Aの車速を検出する。そして、車速検出部2aは、検出結果をナビゲーション装置3とコントローラ5とに出力する。車速検出部2aとしては、例えば、自車Aの駆動輪に取り付けられ、駆動輪の車輪速に比例して発生するパルスを検出し、検出したパルスを用いて自車Aの車速を演算するロータリーエンコーダを採用できる。
The own vehicle state detection unit 2 detects the traveling state of the own vehicle A. The own vehicle state detection unit 2 includes a vehicle speed detection unit 2a, an acceleration detection unit 2b, and a yaw rate detection unit 2c.
The vehicle speed detector 2a detects the vehicle speed of the host vehicle A. Then, the vehicle speed detection unit 2 a outputs the detection result to the navigation device 3 and the controller 5. As the vehicle speed detection unit 2a, for example, a rotary attached to the drive wheel of the host vehicle A that detects a pulse generated in proportion to the wheel speed of the drive wheel and calculates the vehicle speed of the host vehicle A using the detected pulse. An encoder can be used.

加速度検出部2bは、自車Aの加速度を検出する。そして、加速度検出部2bは、検出結果をナビゲーション装置3とコントローラ5とに出力する。
ヨーレート検出部2cは、自車Aのヨーレートを検出する。そして、ヨーレート検出部2cは、検出結果をナビゲーション装置3とコントローラ5とに出力する。
The acceleration detector 2b detects the acceleration of the host vehicle A. Then, the acceleration detection unit 2b outputs the detection result to the navigation device 3 and the controller 5.
The yaw rate detection unit 2c detects the yaw rate of the vehicle A. Then, the yaw rate detection unit 2 c outputs the detection result to the navigation device 3 and the controller 5.

ナビゲーション装置3は、地図データベース3aと、自車位置検出部3bと、目標経路設定部3cと、経路表示部3dとを備える。
地図データベース3aは、地図情報を記憶している。地図情報としては、例えば、道路の位置、道路構造(カーブの位置、停止線の位置、信号機の位置)がある。
自車位置検出部3bは、自車Aの現在地を検出する。自車位置検出部3bとしては、例えば、GPS(Global Positioning System)信号を受信し、受信したGPS信号を用いて自車Aの現在地(絶対座標。緯度経度)を検出するGPS受信装置を採用できる。そして、自車位置検出部3bは、検出結果を目標経路設定部3cに出力する。
The navigation device 3 includes a map database 3a, a vehicle position detection unit 3b, a target route setting unit 3c, and a route display unit 3d.
The map database 3a stores map information. The map information includes, for example, a road position and a road structure (curve position, stop line position, traffic light position).
The own vehicle position detection unit 3b detects the current location of the own vehicle A. For example, a GPS receiver that receives a GPS (Global Positioning System) signal and detects the current location (absolute coordinates, latitude and longitude) of the vehicle A using the received GPS signal can be adopted as the vehicle position detection unit 3b. . And the own vehicle position detection part 3b outputs a detection result to the target route setting part 3c.

目標経路設定部3cは、自車状態検出部2で検出した自車Aの走行状態と、地図データベース3aが記憶している地図情報と、自車位置検出部3bで検出した自車Aの現在地と、予め定めた目的地とを用いて、自車Aの目標経路を設定する。自車Aの目標経路としては、例えば、自車Aの現在地から目的地までの経路がある。そして、目標経路設定部3cは、地図情報と自車Aの現在地と設定結果とをコントローラ5に出力する。
経路表示部3dは、地図データベース3aが記憶している地図情報と、目標経路設定部3cで探索した目標経路とを用いて、目標経路を自車A周囲の地図に重畳させた画像をモニタに表示する。これにより、探索した目標経路を、自車Aの運転者に提示する。
外部情報認識部4は、自車A周囲に存在する周囲移動体を検出する。そして、外部情報認識部4は、検出結果をコントローラ5に出力する。外部情報認識部4としては、例えば、自車Aの前端部に配置され、自車A周囲にレーザー光を出射し、出射したレーザー光の反射光を用いて周囲移動体を検出するレーザレンジファインダを採用できる。
The target route setting unit 3c includes the traveling state of the vehicle A detected by the vehicle state detection unit 2, the map information stored in the map database 3a, and the current location of the vehicle A detected by the vehicle position detection unit 3b. And the target route of the own vehicle A is set using a predetermined destination. As a target route of the own vehicle A, for example, there is a route from the current location of the own vehicle A to the destination. Then, the target route setting unit 3 c outputs the map information, the current location of the vehicle A, and the setting result to the controller 5.
The route display unit 3d uses the map information stored in the map database 3a and the target route searched by the target route setting unit 3c to monitor an image in which the target route is superimposed on a map around the vehicle A. indicate. Thereby, the searched target route is presented to the driver of the vehicle A.
The external information recognition unit 4 detects a surrounding moving body that exists around the host vehicle A. Then, the external information recognition unit 4 outputs the detection result to the controller 5. The external information recognition unit 4 is, for example, a laser range finder that is arranged at the front end of the host vehicle A, emits laser light around the host vehicle A, and detects a surrounding moving body using reflected light of the emitted laser beam. Can be adopted.

コントローラ5は、A/D(Analog to Digital)変換回路とD/A(Digital to Analog)変換回路とCPU(Central Processing Unit)とROM(Read Only Memory)とRAM(Random Access Memory)等から構成した集積回路を備える。ROMは、各種処理を実現する1または2以上のプログラムを記憶している。CPUは、自車状態検出部2とナビゲーション装置3と外部情報認識部4との検出結果を用いROMが記憶している1または2以上のプログラムに従って各種処理(例えば、後述する先行車追越支援処理)を実行する。そして、CPUは、図2に示すように、先行車検出部5aと、追越地点候補設定部5bと、先行車位置推定部5cと、先先行車現在地検出部5dと、確率分布設定部5eと、先先行車位置推定部5fと、先行車前方スペース判定部5gと、追越地点設定部5hと、目標経路生成部5iと、目標操舵生成部5jと、目標速度算出部5kとを備える。   The controller 5 includes an A / D (Analog to Digital) conversion circuit, a D / A (Digital to Analog) conversion circuit, a CPU (Central Processing Unit), a ROM (Read Only Memory), a RAM (Random Access Memory), and the like. An integrated circuit is provided. The ROM stores one or more programs that realize various processes. The CPU uses the detection results of the vehicle state detection unit 2, the navigation device 3, and the external information recognition unit 4 to perform various processes (for example, a preceding vehicle overtaking support described later) according to one or more programs stored in the ROM. Process). Then, as shown in FIG. 2, the CPU detects the preceding vehicle detection unit 5a, the passing point candidate setting unit 5b, the preceding vehicle position estimation unit 5c, the preceding preceding vehicle current location detection unit 5d, and the probability distribution setting unit 5e. A preceding vehicle position estimation unit 5f, a preceding vehicle forward space determination unit 5g, a passing point setting unit 5h, a target route generation unit 5i, a target steering generation unit 5j, and a target speed calculation unit 5k. .

先行車検出部5aは、先行車現在地検出部5aaと、先行車車速検出部5abとを備える。先行車現在地検出部5aaは、ナビゲーション装置3と外部情報認識部4との検出結果等(目標経路、周囲移動体)を用いて、目標経路のうちの自車A前方の部分(以下、「自車前方経路」とも呼ぶ)から先行車Bを検出する。具体的には、先行車現在地検出部5aaは、周囲移動体のうち、自車前方経路上に存在し且つ自車Aから最も近い位置に存在する周囲移動物体を先行車Bとして検出する。続いて、先行車現在地検出部5aaは、検出した先行車Bの現在地を検出する。続いて、先行車車速検出部5abは、検出した先行車Bの車速Vs(目標経路に沿った方向の車速)を検出する。そして、先行車現在地検出部5aaと先行車車速検出部5abとは、検出結果を追越地点候補設定部5bと先行車位置推定部5cと確率分布設定部5eと目標速度算出部5kとに出力する。   The preceding vehicle detection unit 5a includes a preceding vehicle current position detection unit 5aa and a preceding vehicle vehicle speed detection unit 5ab. The preceding vehicle current position detection unit 5aa uses a detection result (target route, surrounding moving body) of the navigation device 3 and the external information recognition unit 4 (target route, surrounding moving body), and a portion of the target route in front of the own vehicle A (hereinafter referred to as “self”). The preceding vehicle B is detected from the “vehicle forward route”. Specifically, the preceding vehicle current position detection unit 5aa detects, as a preceding vehicle B, a surrounding moving object that is present on the forward path of the host vehicle and is closest to the host vehicle A among the surrounding moving bodies. Subsequently, the preceding vehicle current position detection unit 5aa detects the current position of the detected preceding vehicle B. Subsequently, the preceding vehicle speed detector 5ab detects the detected vehicle speed Vs of the preceding vehicle B (the vehicle speed in the direction along the target route). The preceding vehicle current position detection unit 5aa and the preceding vehicle vehicle speed detection unit 5ab output detection results to the passing point candidate setting unit 5b, the preceding vehicle position estimation unit 5c, the probability distribution setting unit 5e, and the target speed calculation unit 5k. To do.

追越地点候補設定部5bは、先行車検出部5aの検出結果を用いて、先行車検出部5aで先行車Bを検出したか否かを判定する。そして、追越地点候補設定部5bは、先行車Bを検出したと判定した場合には、ナビゲーション装置3と先行車検出部5aとの検出結果等(地図情報、自車Aの現在地、目標経路、先行車Bの車速)を用いて、自車前方経路上に先行車Bの追い越しを行う追越地点の候補である複数の追越地点候補を設定する。   The overtaking point candidate setting unit 5b determines whether the preceding vehicle B is detected by the preceding vehicle detection unit 5a using the detection result of the preceding vehicle detection unit 5a. If the overtaking point candidate setting unit 5b determines that the preceding vehicle B has been detected, the detection results of the navigation device 3 and the preceding vehicle detecting unit 5a, etc. (map information, current location of the vehicle A, target route) , The vehicle speed of the preceding vehicle B) is set on the forward path of the host vehicle, and a plurality of candidate for passing points that are candidates for passing the preceding vehicle B are set.

具体的には、追越地点候補設定部5bは、自車位置検出部3bと目標経路設定部3cとの検出結果等(自車Aの現在地、目標経路)と、地図データベース3aの記憶内容とを用いて、自車前方経路上に予め定めた設定位置(自車Aの将来位置)から見通すことができる距離(以下、「見通し距離」とも呼ぶ)Lmを算出する。見通し距離Lmとしては、例えば、図3に示すように、自車Aが片側1車線ずつの対面通行の道路を走行しているときに、自車前方経路における、自車Aから自車Aに最も近いカーブのカーブ内側の道路境界に延ばした直線(接線)とカーブ内側の道路境界との交点を点Dとし、この接線とカーブ外側の道路境界との交点を点Eとし、点Dと点Eとを通る直線と目標経路(ナビゲーション装置3で設定した目標経路)との交点を点Fとした場合、設定位置から点Fまでの目標経路に沿った距離がある。これにより、追越地点候補設定部5bは、予め定めた複数の設定位置(自車Aの将来位置)それぞれに対して見通し距離Lmを算出する。   Specifically, the overtaking point candidate setting unit 5b includes the detection results of the own vehicle position detection unit 3b and the target route setting unit 3c (the current location of the own vehicle A, the target route), and the stored contents of the map database 3a. Is used to calculate a distance (hereinafter also referred to as “line-of-sight distance”) Lm that can be seen from a predetermined set position (the future position of the own vehicle A) on the forward path of the own vehicle. As the line-of-sight distance Lm, for example, as shown in FIG. 3, when the vehicle A is traveling on a face-to-face road with one lane on each side, the vehicle A to the vehicle A in the forward path of the vehicle The intersection of the straight line (tangent) extending to the road boundary inside the curve of the nearest curve and the road boundary inside the curve is point D, the intersection of this tangent and the road boundary outside the curve is point E, and point D and point When the intersection of the straight line passing through E and the target route (target route set by the navigation device 3) is a point F, there is a distance along the target route from the set position to the point F. Thereby, the overtaking point candidate setting unit 5b calculates the line-of-sight distance Lm for each of a plurality of predetermined setting positions (future positions of the vehicle A).

続いて、追越地点候補設定部5bは、先行車検出部5aの検出結果(先行車Bの車速Vs)と、地図データベース3aの記憶内容とを用いて、先行車Bを追い越す際に必要な距離(以下、「追越必要距離」とも呼ぶ)Loを算出する。追越必要距離Loとしては、例えば、先行車Bの車速Vsと、自車Aや先行車Bが走行している道路の法定速度Vlimと、追い越し開始時の自車Aの車速V0と、先行車Bの全長lvsと、目標車間時間Tsと、目標加速度a0とを用いて、下記(1)式で算出される距離がある。

Figure 0006331858
Subsequently, the overtaking point candidate setting unit 5b is necessary for overtaking the preceding vehicle B by using the detection result (the vehicle speed Vs of the preceding vehicle B) of the preceding vehicle detection unit 5a and the stored contents of the map database 3a. A distance (hereinafter also referred to as “necessary overtaking distance”) Lo is calculated. As the overtaking required distance Lo, for example, the vehicle speed Vs of the preceding vehicle B, the legal speed Vlim of the road on which the own vehicle A or the preceding vehicle B is traveling, the vehicle speed V0 of the own vehicle A at the time of overtaking, There is a distance calculated by the following equation (1) using the total length lvs of the vehicle B, the target inter-vehicle time Ts, and the target acceleration a0.
Figure 0006331858

ここで、目標車間時間Tsとしては、例えば、比較的短い時間(例えば、2秒程度)を用いる。また、先行車Bの全長lvsとしては、例えば、一般的な車の全長(例えば、5[m]程度)を用いる。なお、外部情報認識部4を先行車Bの種別(大型自動車、普通自動車)を判定可能な構成とし、判定した種別に応じて先行車Bの全長lvsを設定する構成としてもよい。例えば、先行車Bの種別が「大型自動車」であると判定した場合には先行車Bの全長lvsを7[m]とし、先行車Bの種別が「普通自動車」であると判定した場合には先行車Bの全長lvsを5[m]とする。また、目標加速度a0としては、例えば、自車Aの乗員が不快に感じない程度の加速度(例えば、1.5[m/s2])を用いる。
続いて、追越地点候補設定部5bは、算出した見通し距離Lmのうちから、追越必要距離Loより長い見通し距離Lmを選択し、選択した見通し距離Lmに対応する予め定めた設定位置(自車Aの将来位置)それぞれを追越地点候補として設定する。
Here, as the target inter-vehicle time Ts, for example, a relatively short time (for example, about 2 seconds) is used. Further, as the total length lvs of the preceding vehicle B, for example, the total length (for example, about 5 [m]) of a general vehicle is used. The external information recognition unit 4 may be configured to be able to determine the type of the preceding vehicle B (large vehicle, ordinary vehicle) and set the total length lvs of the preceding vehicle B according to the determined type. For example, when it is determined that the type of the preceding vehicle B is “large vehicle”, the total length lvs of the preceding vehicle B is set to 7 [m], and when the type of the preceding vehicle B is determined to be “normal vehicle”. The total length lvs of the preceding vehicle B is 5 [m]. Further, as the target acceleration a0, for example, an acceleration (for example, 1.5 [m / s 2 ]) that does not make the occupant of the vehicle A feel uncomfortable is used.
Subsequently, the overtaking point candidate setting unit 5b selects a line-of-sight distance Lm longer than the necessary overtaking distance Lo from the calculated line-of-sight distance Lm, and sets a predetermined setting position (automatic) corresponding to the selected line-of-sight distance Lm. Each future position of the car A) is set as an overtaking point candidate.

先行車位置推定部5cは、追越地点候補設定部5bで設定した複数の追越地点候補それぞれに対し、自車Aが現在地から追越地点候補に到達するまでにかかる時間である予想到達時間後の先行車Bの位置(以下、「将来先行車位置」とも呼ぶ)を推定する。将来先行車位置の算出は、例えば、自車状態検出部2、ナビゲーション装置3(目標経路設定部3c)、先行車検出部5aと追越地点候補設定部5bとの検出結果等(自車Aの車速、目標経路、先行車Bの現在地、先行車Bの車速、複数の追越地点候補)を用いて行う。
具体的には、先行車位置推定部5cは、複数の追越地点候補それぞれに対し、自車Aの現在地から追越地点候補までの目標経路に沿った距離を先行車Bの車速で除算して予想到達時間を算出する。続いて、先行車位置推定部5cは、算出した予想到達時間それぞれに対し、先行車Bの車速に乗算した乗算結果それぞれを将来先行車位置とする。
The preceding vehicle position estimation unit 5c is the estimated arrival time that is the time it takes for the vehicle A to reach the overtaking point candidate from the current location for each of the plurality of overtaking point candidates set by the overtaking point candidate setting unit 5b. The position of the subsequent preceding vehicle B (hereinafter also referred to as “future preceding vehicle position”) is estimated. The future preceding vehicle position is calculated by, for example, the detection result of the own vehicle state detection unit 2, the navigation device 3 (target route setting unit 3c), the preceding vehicle detection unit 5a and the overtaking point candidate setting unit 5b (the own vehicle A Vehicle speed, target route, current location of preceding vehicle B, vehicle speed of preceding vehicle B, and a plurality of overtaking point candidates).
Specifically, the preceding vehicle position estimation unit 5c divides the distance along the target route from the current location of the own vehicle A to the passing point candidate by the vehicle speed of the preceding vehicle B for each of the plurality of passing point candidates. To calculate the expected arrival time. Subsequently, the preceding vehicle position estimating unit 5c sets each of the multiplication results obtained by multiplying the calculated predicted arrival times by the vehicle speed of the preceding vehicle B as the future preceding vehicle position.

先先行車現在地検出部5dは、ナビゲーション装置3と外部情報認識部4との検出結果等(目標経路、周囲移動体)を用いて、自車前方経路から先行車B前方の先先行車Cを検出する。具体的には、先先行車現在地検出部5dは、周囲移動体のうち、自車前方経路上に存在し且つ自車Aから2番目に近い位置に存在する周囲移動物体(先行車Bの前方で、先行車Bから最も近い位置に存在する周囲移動物体)を先先行車Cとして検出する。続いて、先先行車現在地検出部5dは、検出した先先行車Cの位置と車速(目標経路に沿った方向の車速)とを検出する。そして、検出結果を確率分布設定部5eに出力する。
その際、先先行車現在地検出部5dは、自車Aから最も近い位置に存在する移動物体(例えば、先行車B)によって外部情報認識部4の検出範囲に死角を生じ、自車前方経路上に存在し且つ自車Aから2番目に近い位置に存在する移動物体(先先行車C)を検出できない場合(以下、「先先行車有死角状態」とも呼ぶ)には、無効値を出力する。
The preceding preceding vehicle current position detection unit 5d uses the detection results of the navigation device 3 and the external information recognition unit 4 (target route, surrounding moving body) and the like to determine the preceding preceding vehicle C ahead of the preceding vehicle B from the own vehicle forward route. To detect. Specifically, the preceding preceding vehicle current position detection unit 5d is a surrounding moving object that exists on the front path of the own vehicle and is located at the second closest position from the own vehicle A among the surrounding moving bodies (in front of the preceding vehicle B). Then, the surrounding moving object present at the closest position from the preceding vehicle B) is detected as the preceding preceding vehicle C. Subsequently, the preceding preceding vehicle current position detection unit 5d detects the detected position of the preceding preceding vehicle C and the vehicle speed (the vehicle speed in the direction along the target route). Then, the detection result is output to the probability distribution setting unit 5e.
At that time, the preceding preceding vehicle current position detection unit 5d generates a blind spot in the detection range of the external information recognition unit 4 due to a moving object (for example, the preceding vehicle B) that is closest to the own vehicle A, When the moving object (the preceding preceding vehicle C) that is present at the second closest position from the own vehicle A cannot be detected (hereinafter also referred to as “the leading preceding vehicle dead angle state”), an invalid value is output. .

なお、本実施形態では、先先行車有死角状態である場合、無効値を出力する例を示したが、他の構成を採用することもできる。例えば、先先行車Cが検出されていない場合、自車Aが信号機の手前で停止しているときに自車A前方の停止線から自車Aの現在地までの距離を検出し、検出した距離が予め定めた設定距離以上である場合、先行車B前方に先先行車Cが存在しているものとして、先先行車Cの現在地を設定する構成としてもよい。具体的には、自車Aの停止時に、自車Aから停止線までの距離が自車Aの全長(以下、「自車全長」とも呼ぶ)lvに対して十分大きい場合(例えば、自車全長lvの3倍)、先先行車Cが存在すると判定する構成としてもよい。自車Aから停止線までの距離としては、例えば、自車位置検出部3bの検出結果(自車Aの現在地)と地図データベース3aの記憶内容(停止線の位置)とを用いて、自車Aの現在地と停止線の位置との差分を採用できる。この場合、先行車Bの現在地から自車全長lv前方の位置を先先行車Cの位置とし、自車Aや先行車B、先先行車Cの走行車線の法定速度を先先行車Cの車速としてもよい。   In the present embodiment, an example in which an invalid value is output in the case of the leading vehicle dead angle state is shown, but other configurations may be employed. For example, when the preceding vehicle C is not detected, the distance from the stop line ahead of the vehicle A to the current location of the vehicle A is detected when the vehicle A is stopped in front of the traffic light. Is equal to or greater than a predetermined set distance, the current location of the preceding vehicle C may be set assuming that the preceding vehicle C exists ahead of the preceding vehicle B. Specifically, when the host vehicle A stops, the distance from the host vehicle A to the stop line is sufficiently larger than the total length of the host vehicle A (hereinafter also referred to as “own vehicle total length”) lv (for example, the host vehicle It is also possible to determine that the preceding vehicle C is present (three times the total length lv). As the distance from the own vehicle A to the stop line, for example, using the detection result (current position of the own vehicle A) of the own vehicle position detection unit 3b and the stored content (the position of the stop line) of the map database 3a, The difference between the current location of A and the position of the stop line can be adopted. In this case, the position ahead of the vehicle's own vehicle length lv from the current location of the preceding vehicle B is the position of the preceding preceding vehicle C, and the legal speeds of the traveling lanes of the own vehicle A, the preceding vehicle B, and the preceding preceding vehicle C are It is good.

このように、第1実施形態では、先先行車Cが検出されていない場合、自車Aが信号機の手前で停止しているときに自車A前方の停止線から自車Aの現在地までの距離を検出し、検出した距離が予め定めた設定距離以上である場合、先行車B前方に先先行車Cが存在しているものとして、先先行車Cの現在地を設定する。それゆえ、先先行車Cを直接に検出できない場合にも、先先行車Cの存在を推定することができる。そのため、追い越しできるシーンを増やすことができ、遅い先行車Bに追従する時間を短縮することができる。   As described above, in the first embodiment, when the preceding vehicle C is not detected, when the host vehicle A is stopped in front of the traffic light, from the stop line in front of the host vehicle A to the current location of the host vehicle A When the distance is detected and the detected distance is equal to or larger than a predetermined distance, the current location of the preceding vehicle C is set assuming that the preceding vehicle C exists ahead of the preceding vehicle B. Therefore, even when the preceding vehicle C cannot be directly detected, the presence of the preceding vehicle C can be estimated. Therefore, the number of scenes that can be overtaken can be increased, and the time for following the slow preceding vehicle B can be shortened.

一方、先先行車現在地検出部5dは、自車Aから最も近い位置に存在する移動物体(例えば、先行車B)によって外部情報認識部4の検出範囲に死角を生じていないが、自車前方経路上に存在し且つ自車Aから2番目に近い位置に存在する移動物体(先先行車C)を検出できない場合には、外部情報認識部4の検出範囲最大値(最大距離)を先先行車Cの位置とし、自車Aや先行車Bの走行車線の法定速度を先先行車Cの車速としてもよい。   On the other hand, the preceding preceding vehicle current position detection unit 5d does not cause a blind spot in the detection range of the external information recognition unit 4 due to a moving object (for example, the preceding vehicle B) that is closest to the own vehicle A. When the moving object (the preceding preceding vehicle C) that exists on the route and is located at the second closest position from the own vehicle A cannot be detected, the maximum value (maximum distance) of the detection range of the external information recognition unit 4 is preceded. The position of the vehicle C may be used, and the legal speed of the traveling lane of the own vehicle A or the preceding vehicle B may be the vehicle speed of the preceding preceding vehicle C.

確率分布設定部5eは、追越地点候補設定部5bで設定した複数の追越地点候補それぞれに対し、先先行車Cの走行状態(以下、「先先行車状態」とも呼ぶ)を推定する。先先行車状態の推定は、例えば、自車状態検出部2とナビゲーション装置3と先行車検出部5aと追越地点候補設定部5bと先先行車現在地検出部5dとの検出結果等(自車Aの車速、現在地、追越地点候補、先先行車Cの車速、現在地)を用いて行う。   The probability distribution setting unit 5e estimates the traveling state of the preceding vehicle C (hereinafter also referred to as “the preceding vehicle state”) for each of the plurality of passing point candidates set by the passing point candidate setting unit 5b. The preceding preceding vehicle state is estimated by, for example, the detection results of the own vehicle state detecting unit 2, the navigation device 3, the preceding vehicle detecting unit 5a, the overtaking point candidate setting unit 5b, and the preceding preceding vehicle current location detecting unit 5d, etc. A vehicle speed, current location, overtaking point candidate, vehicle speed of current vehicle C, current location).

先先行車状態としては、例えば、先先行車Cの初期位置、予想到達時間後(自車Aが追越地点候補に到達したとき)の先先行車Cの車速の確率分布(以下、「先先行車車速確率分布」とも呼ぶ)f(v)がある。先先行車Cの初期位置としては、例えば、先先行車現在地検出部5dが先先行車Cを検出したときの目標経路上における先先行車Cの位置がある。また、先先行車車速確率分布f(v)としては、例えば、図4に示すように、先先行車現在地検出部5dで検出した先先行車Cの車速を平均車速vmとする、単峰性の確率密度関数(例えば、正規分布)がある。正規分布を用いる場合、平均車速vmを用いて、下記(2)式に従って先先行車車速確率分布f(v)を算出する構成としてもよい。

Figure 0006331858
As the preceding preceding vehicle state, for example, the initial position of the preceding preceding vehicle C, the probability distribution of the vehicle speed of the preceding preceding vehicle C after the expected arrival time (when the own vehicle A reaches the overtaking point candidate) F (v) ”, which is also called“ preceding vehicle speed probability distribution ”. The initial position of the preceding preceding vehicle C includes, for example, the position of the preceding preceding vehicle C on the target route when the preceding preceding vehicle current position detection unit 5d detects the preceding preceding vehicle C. Further, as the preceding preceding vehicle speed probability distribution f (v), for example, as shown in FIG. 4, the vehicle speed of the preceding preceding vehicle C detected by the preceding preceding vehicle current position detection unit 5d is set to an average vehicle speed vm. There is a probability density function (for example, normal distribution). When the normal distribution is used, the preceding vehicle vehicle speed probability distribution f (v) may be calculated using the average vehicle speed vm according to the following equation (2).
Figure 0006331858

ここで、先先行車車速確率分布f(v)では、自車Aの現在地と先先行車Cの現在地とを用いて、図5(a)に示すように、先先行車現在地検出部5dが先先行車Cを検出したときの先先行車Cと自車Aとの距離が遠いほど標準偏差σv(f(v)のばらつき)を大きくする。また、先先行車車速確率分布f(v)では、自車Aの車速を用いて、図5(b)に示すように、先先行車現在地検出部5dが先先行車Cを検出した前後で、自車Aの現時点の車速の変化量が大きいほど標準偏差σv(f(v)のばらつき)を大きくする。   Here, in the preceding preceding vehicle speed probability distribution f (v), using the current location of the host vehicle A and the current location of the preceding preceding vehicle C, as shown in FIG. The standard deviation σv (variation in f (v)) is increased as the distance between the preceding vehicle C and the host vehicle A when the preceding vehicle C is detected is increased. Further, in the preceding preceding vehicle speed probability distribution f (v), before and after the preceding preceding vehicle current position detection unit 5d detects the preceding preceding vehicle C, as shown in FIG. The standard deviation σv (variation in f (v)) is increased as the change amount of the current vehicle speed of the own vehicle A is larger.

このように、第1実施形態では、先先行車Cと自車Aとの距離が遠いほど、先先行車車速確率分布f(v)のばらつきを大きくする。それゆえ、先先行車Cと自車Aとの距離が遠く、先先行車現在地検出部5dによる先先行車Cの現在地の検出精度が低下する場合に、先先行車Cの位置の確率分布(先先行車位置確率分布)における、先先行車Cが存在する可能性がある位置の範囲を広げることができる。   Thus, in 1st Embodiment, the dispersion | variation in the preceding preceding vehicle vehicle speed probability distribution f (v) is enlarged, so that the distance of the preceding preceding vehicle C and the own vehicle A is far. Therefore, when the distance between the preceding vehicle C and the host vehicle A is long and the detection accuracy of the current location of the preceding vehicle C by the preceding preceding vehicle current location detection unit 5d decreases, the probability distribution of the position of the preceding vehicle C ( In the preceding preceding vehicle position probability distribution), the range of positions where the preceding preceding vehicle C may exist can be expanded.

また、第1実施形態では、自車Aの現時点の車速の変化量が大きいほど、先先行車車速確率分布f(v)のばらつきを大きくする。それゆえ、自車Aの現時点の車速の変化量が大きく、ピッチングが発生し、先先行車現在地検出部5dによる先先行車Cの現在地の検出精度が低下する場合に、先先行車Cの位置の確率分布(先先行車位置確率分布)における、先先行車Cが存在する可能性がある位置の範囲を広げることができる。   In the first embodiment, the variation in the vehicle speed probability distribution f (v) of the preceding vehicle increases as the change amount of the current vehicle speed of the host vehicle A increases. Therefore, when the amount of change in the current vehicle speed of the own vehicle A is large, pitching occurs, and the detection accuracy of the current position of the preceding vehicle C by the preceding vehicle current position detection unit 5d decreases, the position of the preceding vehicle C In this probability distribution (previous vehicle position probability distribution), the range of positions where the preceding vehicle C may exist can be expanded.

なお、本実施形態では、自車Aの車速を用いて、自車Aの現時点の車速の変化量が大きいほど標準偏差σv(f(v)のばらつき)を大きくする例を示したが、他の構成を採用することもできる。例えば、自車Aの加速度を用いて、自車Aの加速度の変化量が大きいほど、自車Aの現時点の車速の変化量が大きいと判定し、標準偏差σvを大きくする構成としてもよい。   In the present embodiment, an example is shown in which the standard deviation σv (f (v) variation) is increased as the change amount of the current vehicle speed of the host vehicle A is increased using the vehicle speed of the host vehicle A. It is also possible to adopt the configuration. For example, using the acceleration of the host vehicle A, the standard deviation σv may be increased by determining that the change amount of the current vehicle speed of the host vehicle A is larger as the change amount of the acceleration of the host vehicle A is larger.

また、先先行車車速確率分布f(v)では、先先行車現在地検出部5dで検出した先先行車Cの位置から、追越地点候補設定部5bで設定した追越地点候補までの距離が遠く、予想到達時間、つまり、自車Aが追越地点候補に到達するまでの時間が長くなる場合には、予想到達時間が長いほど標準偏差σv(f(v)のばらつき)を大きくする。
このように、第1実施形態では、予想到達時間が長いほど、先先行車Cの車速の確率分布(先先行車車速確率分布)のばらつきを大きくする。それゆえ、予想到達時間(自車Aが現在地から追越地点候補に到達するまでの時間)が長く、先先行車Cの位置の検出結果の信頼度が下がる場合に、先先行車Cの位置の確率分布(先先行車位置確率分布)における、先先行車Cが存在する可能性がある位置の範囲を広げることができる。
In the preceding preceding vehicle speed probability distribution f (v), the distance from the position of the preceding preceding vehicle C detected by the preceding preceding vehicle current position detection unit 5d to the passing point candidate set by the passing point candidate setting unit 5b is When the estimated arrival time, that is, the time until the own vehicle A reaches the overtaking point candidate becomes long, the standard deviation σv (variation of f (v)) is increased as the estimated arrival time is longer.
As described above, in the first embodiment, the longer the expected arrival time, the larger the variation in the vehicle speed probability distribution of the preceding preceding vehicle C (the preceding preceding vehicle vehicle speed probability distribution). Therefore, when the expected arrival time (the time until the vehicle A reaches the overtaking point candidate from the current location) is long and the reliability of the detection result of the position of the preceding preceding vehicle C decreases, the position of the preceding preceding vehicle C In this probability distribution (previous vehicle position probability distribution), the range of positions where the preceding vehicle C may exist can be expanded.

その際、先先行車車速確率分布f(v)では、ナビゲーション装置3で設定した目標経路を用いて、目標経路(自車前方経路)のうち自車Aの現在地から追越地点候補までの経路の曲率の変化が予め定めた設定値以上になると判定した場合、設定値未満になると判定した場合よりも、標準偏差σvを大きくする。例えば、曲率変化が大きいほど、図5(c)の予想到達時間の変化量に対する標準偏差σvの傾きをより急峻とする。   At that time, in the preceding preceding vehicle vehicle speed probability distribution f (v), the route from the current location of the vehicle A to the overtaking point candidate in the target route (vehicle forward route) using the target route set by the navigation device 3. When it is determined that the change in curvature is greater than or equal to a predetermined set value, the standard deviation σv is made larger than when it is determined that the change is less than the set value. For example, as the curvature change is larger, the slope of the standard deviation σv with respect to the change amount of the expected arrival time in FIG.

このように、第1実施形態では、目標経路のうち自車Aの現在地から追越地点候補までの経路の曲率の変化量が予め定めた設定値以上になると判定した場合、設定値未満になると判定した場合よりも、先先行車Cの車速の確率分布(先先行車車速確率分布)のばらつきを大きくする。それゆえ、道路形状が複雑となっており、曲率の変化で先先行車Cの車速が変化しやすい場合に、先先行車Cの位置の確率分布(先先行車位置確率分布)における、先先行車Cが存在する可能性がある位置の範囲を広げることができる。   Thus, in 1st Embodiment, when it determines with the variation | change_quantity of the curvature of the path | route from the present location of the own vehicle A to an overtaking point candidate among target routes becoming more than a predetermined setting value, it will become less than a setting value. The variation in the probability distribution of the vehicle speed of the preceding preceding vehicle C (the preceding preceding vehicle speed probability distribution) is made larger than that in the case of the determination. Therefore, when the road shape is complicated and the vehicle speed of the preceding preceding vehicle C is likely to change due to a change in curvature, the preceding leading vehicle C position probability distribution (the preceding leading vehicle position probability distribution) The range of positions where the car C may be present can be expanded.

さらに、先先行車車速確率分布f(v)では、ナビゲーション装置3で設定した目標経路を用いて、目標経路(自車前方経路)のうち自車Aの現在地から追越地点候補までの経路上に分岐点(例えば、交差点)があると判定した場合、分岐点がないと判定した場合よりも、標準偏差σv(f(v)のばらつき)を大きくする。例えば、図5(c)の予想到達時間の変化量に対する標準偏差σvの傾きをより急峻とする。   Further, in the preceding preceding vehicle vehicle speed probability distribution f (v), on the route from the current location of the vehicle A to the overtaking point candidate in the target route (own vehicle forward route) using the target route set by the navigation device 3. When it is determined that there is a branch point (for example, an intersection), the standard deviation σv (variation of f (v)) is made larger than when it is determined that there is no branch point. For example, the slope of the standard deviation σv with respect to the amount of change in the expected arrival time in FIG.

このように、第1実施形態では、目標経路のうち自車Aの現在地から追越地点候補までの経路上に分岐点があると判定した場合、分岐点がないと判定した場合よりも、先先行車車速確率分布のばらつきを大きくする。それゆえ、道路形状が複雑となっており、分岐点で先先行車Cが目標経路からはずれやすい場合に、先先行車位置確率分布における、先先行車Cが存在する可能性がある位置の範囲を広げることができる。   Thus, in 1st Embodiment, when it determines with a branch point on the path | route from the present location of the own vehicle A to a passing point candidate among target routes, it is ahead of the case where it determines with there being no branch point. Increase the variation in the vehicle speed probability distribution of the preceding vehicle. Therefore, when the road shape is complicated and the leading vehicle C is likely to deviate from the target route at the branch point, the range of positions where the leading vehicle C may exist in the leading vehicle position probability distribution. Can be spread.

なお、確率分布設定部5eは、先先行車車速確率分布のばらつきが予め定めた設定値以上となった場合、または後述する先先行車位置確率分布のばらつき(標準偏差)が予め定めた設定値以上となった場合、先先行車車速確率分布の推定を一旦停止する構成としてもよい。この場合、先先行車車速確率分布の推定を一旦停止した後、先先行車現在地検出部5dで先先行車Cの現在地を検出した場合、先先行車車速確率分布の推定を再開する。   Note that the probability distribution setting unit 5e sets a predetermined value when the variation of the preceding preceding vehicle vehicle speed probability distribution is equal to or more than a predetermined setting value, or the variation (standard deviation) of the preceding preceding vehicle position probability distribution described later. When it becomes above, it is good also as a structure which stops estimation of a preceding preceding vehicle vehicle speed probability distribution once. In this case, once the estimation of the preceding preceding vehicle vehicle speed probability distribution is temporarily stopped and then the current position of the preceding preceding vehicle C is detected by the preceding preceding vehicle current position detection unit 5d, the estimation of the preceding preceding vehicle vehicle speed probability distribution is resumed.

このように、第1実施形態では、先先行車車速確率分布のばらつきが予め定めた設定値以上となった場合、または先先行車位置確率分布のばらつきが予め定めた設定値以上となった場合、先先行車車速確率分布の推定を一旦停止し、その後、先先行車現在地検出部5dが先先行車Cの現在地を検出した場合、先先行車車速確率分布の推定を再開する。それゆえ、先先行車Cの車速の検出結果の信頼度が下がる場合、または先先行車Cの位置の検出結果の信頼度が下がる場合に、先先行車車速確率分布の推定を停止できる。   As described above, in the first embodiment, when the variation of the preceding preceding vehicle vehicle speed probability distribution is equal to or larger than the predetermined setting value, or when the variation of the preceding preceding vehicle position probability distribution is equal to or larger than the predetermined setting value. When the estimation of the preceding preceding vehicle vehicle speed probability distribution is temporarily stopped and then the preceding preceding vehicle current position detection unit 5d detects the current position of the preceding preceding vehicle C, the estimation of the preceding preceding vehicle vehicle speed probability distribution is resumed. Therefore, when the reliability of the detection result of the vehicle speed of the preceding vehicle C is lowered, or when the reliability of the detection result of the position of the preceding vehicle C is lowered, the estimation of the vehicle speed probability distribution of the preceding vehicle can be stopped.

先先行車位置推定部5fは、追越地点候補設定部5bで設定した複数の追越地点候補それぞれに対し、予想到達時間後(自車Aが追越地点候補に到達したとき)の先先行車Cの位置を推定する。予想到達時間後(自車Aが追越地点候補に到達したとき)の先先行車Cの位置としては、例えば、予想到達時間後の先先行車Cの位置の確率分布(以下、「先先行車位置確率分布」とも呼ぶ)がある。先先行車Cの位置の推定は、例えば、追越地点候補設定部5bと確率分布設定部5eとの検出結果等(追越地点候補、先先行車Cの初期位置(現在地)、先先行車車速確率分布f(v))を用いて行う。   The preceding preceding vehicle position estimating unit 5f precedes each of the plurality of passing point candidates set by the passing point candidate setting unit 5b after the expected arrival time (when the vehicle A reaches the passing point candidate). The position of the car C is estimated. As the position of the preceding vehicle C after the estimated arrival time (when the vehicle A reaches the overtaking point candidate), for example, the probability distribution of the position of the preceding vehicle C after the estimated arrival time (hereinafter referred to as “the preceding preceding vehicle”). Car position probability distribution ”). The position of the preceding preceding vehicle C is estimated by, for example, detecting results of the passing point candidate setting unit 5b and the probability distribution setting unit 5e (passing point candidate, initial position of the preceding vehicle C (current location), leading vehicle, etc. Car speed probability distribution f (v)) is used.

具体的には、先先行車位置推定部5fは、先先行車車速確率分布f(v)に対し、自車Aが現在地から追越地点候補に到達するまでにかかる時間(予想到達時間)を乗算して、乗算結果を先先行車Cの移動距離の確率分布とする。先先行車Cの移動距離の確率分布は、追越地点候補毎に算出する。続いて、先先行車位置推定部5fは、先先行車Cが初期位置から目標経路に沿って、算出した先先行車Cの移動距離の確率分布分だけ移動した場合を、予想到達時間後の先先行車Cの位置の確率分布(先先行車位置確率分布)として算出する。先先行車位置確率分布も、追越地点候補毎に算出する。そして、先先行車位置推定部5fは、算出結果を先行車前方スペース判定部5gに出力する。
その際、先先行車位置推定部5fは、移動距離の確率分布の分散が十分に大きいと(例えば、先先行車Cの位置の確率分布の標準偏差を3倍した値のうちに、予想時間後の自車Aの推定位置が含まれる場合)、推定精度が悪いと判定し、無効値を出力する。
Specifically, the preceding preceding vehicle position estimation unit 5f calculates the time (predicted arrival time) required for the own vehicle A to reach the overtaking point candidate from the current location with respect to the preceding preceding vehicle speed probability distribution f (v). Multiplication is performed to obtain the multiplication result as a probability distribution of the moving distance of the preceding vehicle C. The probability distribution of the moving distance of the preceding vehicle C is calculated for each passing point candidate. Subsequently, the preceding preceding vehicle position estimation unit 5f determines that the preceding preceding vehicle C has moved from the initial position along the target route by the calculated probability distribution of the moving distance of the preceding preceding vehicle C. It is calculated as a probability distribution of the position of the preceding vehicle C (a preceding vehicle position probability distribution). The preceding preceding vehicle position probability distribution is also calculated for each passing point candidate. Then, the preceding preceding vehicle position estimating unit 5f outputs the calculation result to the preceding vehicle forward space determining unit 5g.
At this time, if the variance of the probability distribution of the travel distance is sufficiently large (for example, the predicted time within the value obtained by multiplying the standard deviation of the probability distribution of the position of the preceding vehicle C by three). If the estimated position of the following own vehicle A is included), it is determined that the estimation accuracy is poor and an invalid value is output.

先行車前方スペース判定部5gは、追越地点候補設定部5bで設定した複数の追越地点候補それぞれに対し、予想到達時間後(自車Aが追越地点候補に到達したとき)に先行車Bの前方に十分なスペースが確保されるか否かを判定する。具体的には、先行車前方スペース判定部5gは、自車Aが先行車Bを追い越した後に、自車A前方及び後方に安全な距離を確保するために必要な、先行車Bの前方の距離(以下、「先行車前方必要距離」とも呼ぶ)Laを算出する。先行車前方必要距離Laの算出は、先行車位置推定部5c及び先先行車位置推定部5fの検出結果(予想到達時間後の先行車Bの位置、予想到達時間後の先先行車Cの位置の確率分布(先先行車位置確率分布))を用いて行う。   The preceding vehicle forward space determination unit 5g, for each of the plurality of overtaking point candidates set by the overtaking point candidate setting unit 5b, after the expected arrival time (when the vehicle A reaches the overtaking point candidate) It is determined whether a sufficient space is secured in front of B. Specifically, the preceding vehicle forward space determination unit 5g is provided in front of the preceding vehicle B, which is necessary to secure a safe distance ahead and behind the own vehicle A after the own vehicle A overtakes the preceding vehicle B. A distance (hereinafter also referred to as “necessary distance ahead of the preceding vehicle”) La is calculated. The calculation of the preceding vehicle forward required distance La is based on the detection results of the preceding vehicle position estimating unit 5c and the preceding preceding vehicle position estimating unit 5f (the position of the preceding vehicle B after the estimated arrival time, the position of the preceding vehicle C after the estimated arrival time). ) Probability distribution (priority vehicle position probability distribution)).

先行車前方必要距離Laとしては、例えば、予め定めた自車全長lvと、予め定めた目標車間時間Taとを用いて、下記(3)式に従って算出する構成としてもよい。目標車間時間Taとしては、例えば、安全が確保できる時間(例えば、2秒程度)を設定する。
La=lv+2VoTa …(3)
続いて、先行車前方スペース判定部5gは、先行車位置推定部5cで推定した将来先行車位置(自車Aが追越地点候補に到達したときの先行車Bの位置)と、先先行車位置推定部5fで推定した先先行車位置確率分布(自車Aが追越地点候補に到達したときの先先行車Cの位置の確率分布)の平均値から標準偏差の3倍までの距離範囲内の各点との距離の最小値(以下、「推定先行車前方距離」とも呼ぶ)Leを算出する。
The required distance La ahead of the preceding vehicle may be calculated according to the following formula (3) using, for example, a predetermined own vehicle total length lv and a predetermined target inter-vehicle time Ta. As the target inter-vehicle time Ta, for example, a time during which safety can be ensured (for example, about 2 seconds) is set.
La = lv + 2VoTa (3)
Subsequently, the preceding vehicle forward space determination unit 5g determines the future preceding vehicle position estimated by the preceding vehicle position estimation unit 5c (the position of the preceding vehicle B when the own vehicle A reaches the overtaking point candidate) and the preceding preceding vehicle. Distance range from the average value of the leading vehicle position probability distribution estimated by the position estimating unit 5f (probability distribution of the position of the leading vehicle C when the vehicle A reaches the overtaking point candidate) to three times the standard deviation The minimum value (hereinafter also referred to as “estimated preceding vehicle forward distance”) Le of the distance to each point is calculated.

続いて、先行車前方スペース判定部5gは、算出した推定先行車前方距離Leが先行車前方必要距離Laより大きいか否か(Le>La)を判定する。そして、先行車前方スペース判定部5gは、Le>Laであると判定した場合には、自車Aが追越地点候補に到達したとき(予想到達時間後)に先行車Bの前方に十分なスペースが確保されると判定する。これにより、先行車前方スペース判定部5gは、複数の追越地点候補それぞれに対し、予想到達時間後に先行車Bの前方に十分なスペースが確保されるか否かを判定する。   Subsequently, the preceding vehicle forward space determination unit 5g determines whether or not the calculated estimated preceding vehicle forward distance Le is larger than the preceding vehicle forward required distance La (Le> La). If the preceding vehicle forward space determination unit 5g determines that Le> La, the vehicle is sufficient in front of the preceding vehicle B when the own vehicle A reaches the overtaking point candidate (after the estimated arrival time). It is determined that space is reserved. Accordingly, the preceding vehicle forward space determination unit 5g determines whether or not a sufficient space is secured in front of the preceding vehicle B after the estimated arrival time for each of the plurality of overtaking point candidates.

追越地点設定部5hは、追越地点候補設定部5bで設定した複数の追越地点候補のうちから、先行車前方スペース判定部5gで先行車Bの前方に十分な距離が確保されると判定された追越地点候補、つまり、予想到達時間後(自車Aが追越地点候補に到達したとき)の先行車Bと先先行車Cとの距離が予め定めた先行車前方必要距離La以上である追越地点候補を選択する。例えば、十分な距離が確保されると判定された追越地点候補が複数存在する場合には、その距離が最も長い追越地点候補を選択する。続いて、追越地点設定部5hは、選択した追越地点候補を先行車Bの追い越しを行う追越地点として設定する。   When the overtaking point setting unit 5h secures a sufficient distance ahead of the preceding vehicle B by the preceding vehicle forward space determination unit 5g from among the plurality of overtaking point candidates set by the overtaking point candidate setting unit 5b. Predetermined vehicle front required distance La in which the determined distance between the preceding vehicle B and the preceding preceding vehicle C after the estimated arrival time (when the own vehicle A reaches the passing point candidate) is determined. The overtaking point candidate as described above is selected. For example, when there are a plurality of overtaking point candidates determined to have a sufficient distance, the overtaking point candidate with the longest distance is selected. Subsequently, the overtaking point setting unit 5h sets the selected overtaking point candidate as an overtaking point where the preceding vehicle B is to be overtaken.

このように、第1実施形態では、先先行車Cの現在地と、予想到達時間後の先先行車Cの車速の確率分布(先先行車車速確率分布)とを用いて、予想到達時間後の先先行車Cの位置の確率分布(先先行車位置確率分布)を先先行車Cの位置として推定する。それゆえ、先先行車Cの位置の確率分布(先先行車位置確率分布)を用いて、先行車Bの前方に確保される前方距離を判定できる。これにより、より適切に追越地点を設定できる。   As described above, in the first embodiment, the current position of the preceding preceding vehicle C and the vehicle speed probability distribution (the preceding preceding vehicle vehicle speed probability distribution) of the preceding preceding vehicle C after the estimated reaching time are used. The probability distribution of the position of the preceding vehicle C (the preceding vehicle position probability distribution) is estimated as the position of the preceding vehicle C. Therefore, the front distance secured ahead of the preceding vehicle B can be determined using the probability distribution of the position of the preceding preceding vehicle C (the preceding preceding vehicle position probability distribution). Thereby, an overtaking point can be set more appropriately.

目標経路生成部5iは、地図データベース3aと自車位置検出部3bと目標経路設定部3cと外部情報認識部4と追越地点設定部5hとの検出結果等を用いて、自車Aの自動走行のための目標経路(以下、「自動走行用目標経路」とも呼ぶ)を生成する。自動走行用目標経路の生成は、例えば、自車Aの現在地から進行方向に十分に離れた位置(例えば、自車Aが現在の車速で5秒走行した場合の到達地点)まで行う。
具体的には、目標経路生成部5iは、地図データベース3aと自車位置検出部3bとの検出結果等(地図情報、自車Aの現在地)を用いて、自車線の中央(左右の道路境界の中央)を通る中央線(以下、「ベース経路」とも呼ぶ)を算出する。続いて、目標経路生成部5iは、ベース経路を自動走行用目標経路として目標操舵生成部5jに出力する。
The target route generation unit 5i uses the map database 3a, the vehicle position detection unit 3b, the target route setting unit 3c, the external information recognition unit 4, and the detection result of the overtaking point setting unit 5h, etc. A target route for traveling (hereinafter also referred to as “automatic traveling target route”) is generated. The automatic travel target route is generated, for example, to a position sufficiently away from the current location of the own vehicle A in the traveling direction (for example, the arrival point when the own vehicle A travels at the current vehicle speed for 5 seconds).
Specifically, the target route generation unit 5i uses the detection results of the map database 3a and the vehicle position detection unit 3b (map information, the current location of the vehicle A), and the center of the vehicle lane (the left and right road boundaries). Center line (hereinafter also referred to as “base route”). Subsequently, the target route generation unit 5i outputs the base route as a target route for automatic travel to the target steering generation unit 5j.

なお、目標経路生成部5iは、自車位置検出部3bと外部情報認識部4と追越地点設定部5hの検出結果(自車Aの現在地、移動物体の位置、追越地点)を用いて、追越地点に自車Aが近づいたと判定した場合、追越地点付近に対向車を検出していない場合には、自車Aの進路を対向車線に変更して、先行車Bを追い越すための経路(以下、「追越用経路」とも呼ぶ)を自動走行用目標経路とする。対向車としては、例えば、外部情報認識部4で検出した移動物体の位置と、地図データベース3aの記憶内容(地図情報)とを用いて、自車A前方の対向車線上に存在し且つ自車Aから最も近くにある移動物体がある。追越用経路としては、例えば、ベース経路と同様に、地図データベース3aが記憶している道路境界を用いて、対向車線の左右の道路境界の中央を通る中央線を算出する。   The target route generation unit 5i uses the detection results (the current location of the vehicle A, the position of the moving object, the passing point) of the own vehicle position detection unit 3b, the external information recognition unit 4, and the passing point setting unit 5h. If it is determined that the vehicle A has approached the overtaking point, and the oncoming vehicle is not detected in the vicinity of the overtaking point, the course of the own vehicle A is changed to the oncoming lane and the preceding vehicle B is overtaken. Route (hereinafter also referred to as “passing route”) is set as the automatic travel target route. As an oncoming vehicle, for example, using the position of the moving object detected by the external information recognition unit 4 and the stored contents (map information) of the map database 3a, the vehicle is on the oncoming lane ahead of the own vehicle A and the own vehicle. There is a moving object closest to A. As the overtaking route, for example, the center line passing through the center of the left and right road boundaries of the oncoming lane is calculated using the road boundaries stored in the map database 3a as in the base route.

また、目標経路生成部5iは、自車Aが対向車線に車線変更した後、自車Aが先行車Bを追い越したと判定した場合、自車Aの進路を対向車線からもとの自車線に変更する経路(以下、「復帰用経路」とも呼ぶ)を自動走行用目標経路とする。例えば、先行車Bが自車A前方側から後方側に移動したと判定した場合に、自車Aが先行車Bを追い越したと判定する。復帰用経路としては、例えば、地図データベース3aの記憶内容(地図情報)を用いて、追越用経路(先行車Bを追い越すための経路)とベース経路(ベースとなる経路)とをクロソイド曲線や円弧を組み合わせて滑らかに繋ぐラインを算出する。   Further, if the target route generation unit 5i determines that the own vehicle A has overtaken the preceding vehicle B after the own vehicle A has changed to the opposite lane, the route of the own vehicle A is changed from the opposite lane to the original own lane. The route to be changed (hereinafter also referred to as “return route”) is set as the automatic travel target route. For example, when it is determined that the preceding vehicle B has moved from the front side of the own vehicle A to the rear side, it is determined that the own vehicle A has overtaken the preceding vehicle B. As the return route, for example, using the stored contents (map information) of the map database 3a, the overtaking route (the route for overtaking the preceding vehicle B) and the base route (the base route) can be defined as a clothoid curve, Calculate a smoothly connected line by combining arcs.

目標操舵生成部5jは、目標経路生成部5iの検出結果(自動走行用目標経路)を用いて、自車Aの目標操舵量を生成する。目標操舵量としては、例えば、自車Aに自動走行用目標経路をトレースさせる操舵量を算出する。目標操舵量の生成方法としては、例えば、自車A前方注視点における、自車Aの自動走行用目標経路からのずれを低減させる操舵角を演算する制御系(例えば、PID制御系)を採用する方法がある。続いて、目標操舵生成部5jは、生成した目標操舵量どおりに操向輪を転舵させる指令(以下、「転舵角指令値」とも呼ぶ)を転舵角制御装置6に出力する。   The target steering generation unit 5j generates a target steering amount of the vehicle A using the detection result (automatic travel target route) of the target route generation unit 5i. As the target steering amount, for example, a steering amount that causes the own vehicle A to trace the target route for automatic travel is calculated. As a method for generating the target steering amount, for example, a control system (for example, a PID control system) that calculates a steering angle that reduces the deviation of the own vehicle A from the target route for automatic travel at the front gazing point of the own vehicle A is adopted. There is a way to do it. Subsequently, the target steering generation unit 5j outputs a command for turning the steered wheels according to the generated target steering amount (hereinafter also referred to as “steering angle command value”) to the steering angle control device 6.

目標速度算出部5kは、先行車検出部5aと目標経路生成部5iとの検出結果等(先行車Bの現在地、車速Vs、自動走行用目標経路)を用いて、自車Aの目標車速を算出する。目標車速の算出方法としては、例えば、先行車Bと自車Aとの距離、先行車Bの車速Vsと、自動走行用目標経路とを用いて、先行車Bと自車Aとの距離を予め定めた設定距離より大きくする車速を演算する制御系(例えば、PID制御系)を採用する方法がある。続いて、目標速度算出部5kは、算出した目標車速に自車Aの車速が追従するように自車Aを加速させる駆動力指令値をパワートレーンコントローラ7に出力する。また、目標速度算出部5kは、算出した目標車速に自車Aの車速が追従するように自車Aを減速させる制動力指令値をブレーキコントローラ8に出力する。   The target speed calculation unit 5k calculates the target vehicle speed of the host vehicle A using the detection results of the preceding vehicle detection unit 5a and the target route generation unit 5i (current position of the preceding vehicle B, vehicle speed Vs, target route for automatic travel). calculate. As a calculation method of the target vehicle speed, for example, the distance between the preceding vehicle B and the own vehicle A is calculated using the distance between the preceding vehicle B and the own vehicle A, the vehicle speed Vs of the preceding vehicle B, and the target route for automatic travel. There is a method that employs a control system (for example, a PID control system) that calculates a vehicle speed that is greater than a predetermined set distance. Subsequently, the target speed calculation unit 5k outputs a driving force command value for accelerating the own vehicle A to the power train controller 7 so that the vehicle speed of the own vehicle A follows the calculated target vehicle speed. In addition, the target speed calculation unit 5k outputs a braking force command value for decelerating the host vehicle A to the brake controller 8 so that the vehicle speed of the host vehicle A follows the calculated target vehicle speed.

なお、本実施形態では、自車Aの現在地から追越地点までの走行経路(目標経路)に沿った距離が予め定めた設定距離以下になった場合、先行車Bと自車Aとの距離が増加し、その後、自車Aの速度が先行車Bの速度よりも高くなるように自車Aの車速を制御する構成としてもよい。例えば、追越地点設定部5hで設定した追越地点付近を自車Aが通過する際に、自車Aを減速させて、先行車Bと自車Aとの距離を一時的に大きくし、その後、自車Aを加速させて、先行車Bと自車Aとの距離をもとに戻す構成としてもよい。これにより、自車Aを加速させ、先行車Bと自車Aとの間に速度差をもたせ(自車Aの速度>先行車Bの速度)、自車Aを追越地点に到着させることができる。その際、予め定めた速度差Vtと、自車Aの追い越し開始時の車速V0とを用いて、下記(4)式に従って目標距離に加算する距離Dtを算出する。これにより、追越地点に対してDt手前まで先行車Bがきたときに、目標距離が一時的にDtだけ広がる。

Figure 0006331858
In the present embodiment, the distance between the preceding vehicle B and the own vehicle A when the distance along the travel route (target route) from the current location of the own vehicle A to the passing point is equal to or less than a predetermined set distance. It is good also as a structure which controls the vehicle speed of the own vehicle A so that the speed of the own vehicle A may become higher than the speed of the preceding vehicle B after that. For example, when the own vehicle A passes the vicinity of the overtaking point set by the overtaking point setting unit 5h, the own vehicle A is decelerated and the distance between the preceding vehicle B and the own vehicle A is temporarily increased. Thereafter, the vehicle A may be accelerated to return the distance between the preceding vehicle B and the vehicle A to the original. As a result, the own vehicle A is accelerated, a speed difference is provided between the preceding vehicle B and the own vehicle A (the speed of the own vehicle A> the speed of the preceding vehicle B), and the own vehicle A arrives at the overtaking point. Can do. At that time, the distance Dt to be added to the target distance is calculated according to the following equation (4) using the predetermined speed difference Vt and the vehicle speed V0 at the time of starting overtaking of the own vehicle A. Thereby, when the preceding vehicle B comes before Dt with respect to the overtaking point, the target distance is temporarily increased by Dt.
Figure 0006331858

このように、第1実施形態では、自車Aの現在地から追越地点までの目標経路に沿った距離を算出し、算出した距離が予め定めた設定距離以下になった場合、先行車Bと自車Aとの距離が増加し、その後、自車Aの車速が先行車Bの車速よりも高くなるように自車Aの車速を制御する。それゆえ、追い越しの準備を早くから行うことができ、追い越しに必要な走行距離を短縮できる。そのため、追い越しできるシーンを増やすことができ、遅い先行車Bに追従する時間を短縮することができるため、乗員の不快感を低減できる。   As described above, in the first embodiment, the distance along the target route from the current location of the own vehicle A to the overtaking point is calculated, and when the calculated distance is equal to or less than a predetermined set distance, The vehicle speed of the own vehicle A is controlled so that the distance from the own vehicle A increases and then the vehicle speed of the own vehicle A becomes higher than the vehicle speed of the preceding vehicle B. Therefore, preparation for overtaking can be made early, and the travel distance required for overtaking can be shortened. Therefore, the number of scenes that can be overtaken can be increased, and the time for following the slow preceding vehicle B can be shortened, so that discomfort for the occupant can be reduced.

転舵角制御装置6は、コントローラ5が出力した転舵角指令値を用い、転舵角指令値が表す転舵角が発生するように転舵角制御装置9を制御する。転舵角制御装置9としては、例えば、操向輪を転舵する駆動源(モータ、油圧装置)がある。
パワートレーンコントローラ7は、コントローラ5が出力した駆動力指令値を用い、駆動力指令値が表す駆動力が発生するように駆動力制御装置10を制御する。駆動力制御装置10としては、例えば、駆動輪を駆動する駆動源(エンジン、モータ)がある。
ブレーキコントローラ8は、コントローラ5が出力した制動力指令値を用い、制動力指令値が表す制動力が発生するように制動力制御装置11を制御する。制動力制御装置11としては、例えば、各輪に油圧で制動力を発生するホイールシリンダがある。
The turning angle control device 6 uses the turning angle command value output by the controller 5 to control the turning angle control device 9 so that the turning angle represented by the turning angle command value is generated. As the turning angle control device 9, for example, there is a drive source (motor, hydraulic device) for turning the steered wheels.
The power train controller 7 uses the driving force command value output from the controller 5 to control the driving force control device 10 so that the driving force represented by the driving force command value is generated. As the driving force control device 10, for example, there is a driving source (engine, motor) for driving driving wheels.
The brake controller 8 controls the braking force control device 11 using the braking force command value output from the controller 5 so that the braking force represented by the braking force command value is generated. As the braking force control device 11, for example, there is a wheel cylinder that generates a braking force hydraulically at each wheel.

(先行車追越支援処理)
次に、コントローラ5が実行する先行車追越支援処理について図面を参照しつつ説明する。先行車追越支援処理は、予め定めた設定周期毎に実施する。
図6に示すように、まずステップS101では、コントローラ5(先行車検出部5a、先行車現在地検出部5aa)は、自車前方経路から先行車Bを検出する。続いて、コントローラ5(追越地点候補設定部5b)は、自車前方経路から先行車Bを検出できたか否かを判定する。そして、コントローラ5(追越地点候補設定部5b)は、自車前方経路から先行車Bを検出できたと判定した場合には(Yes)、ステップS102に移行する。一方、コントローラ5(追越地点候補設定部5b)は、自車前方経路から先行車Bを検出できないと判定した場合には(No)、この先行車追越支援処理を終了する。
(Private vehicle overtaking support processing)
Next, the preceding vehicle overtaking support process executed by the controller 5 will be described with reference to the drawings. The preceding vehicle overtaking support process is performed at predetermined intervals.
As shown in FIG. 6, first, in step S101, the controller 5 (the preceding vehicle detection unit 5a, the preceding vehicle current position detection unit 5aa) detects the preceding vehicle B from the own vehicle forward path. Subsequently, the controller 5 (the passing point candidate setting unit 5b) determines whether or not the preceding vehicle B has been detected from the route ahead of the host vehicle. If the controller 5 (passing point candidate setting unit 5b) determines that the preceding vehicle B has been detected from the route ahead of the host vehicle (Yes), the process proceeds to step S102. On the other hand, when the controller 5 (passing point candidate setting unit 5b) determines that the preceding vehicle B cannot be detected from the route ahead of the host vehicle (No), the preceding vehicle passing support process is terminated.

ステップS102では、コントローラ5(追越地点候補設定部5b)は、自車前方経路上に複数の追越地点候補(先行車Bの追い越しを行う追越地点の候補)を設定する。
続いてステップS103に移行して、コントローラ5(先行車位置推定部5c)は、ステップS102で設定した複数の追越地点候補のうちから、変数i番目の追越地点候補を選択する。なお、変数iは、この先行車追越支援処理の開始時に初期値「1」に設定する。続いて、コントローラ5(先行車位置推定部5c)は、変数iに「1」を加算する。
In step S102, the controller 5 (passing spot candidate setting unit 5b) sets a plurality of passing spot candidates (passing spot candidates for passing the preceding vehicle B) on the route ahead of the host vehicle.
Then, it transfers to step S103 and the controller 5 (preceding vehicle position estimation part 5c) selects the variable i-th passing point candidate from the some passing point candidates set by step S102. The variable i is set to an initial value “1” at the start of the preceding vehicle overtaking support process. Subsequently, the controller 5 (preceding vehicle position estimation unit 5c) adds “1” to the variable i.

続いてステップS104に移行して、コントローラ5(先行車位置推定部5c)は、ステップS103で選択した変数i番目の追越地点候補に対し、予想到達時間後(自車Aが追越地点候補に到達するとき)の先行車Bの位置(将来先行車位置)を算出する。
続いてステップS105に移行して、コントローラ5(先先行車現在地検出部5d)は、自車前方経路から先行車B前方の先先行車C(自車前方経路上に存在し且つ自車Aから2番目に近い位置に存在する周囲移動物体)と、先先行車Cの位置及び車速とを検出する。続いて、コントローラ5(確率分布設定部5e)は、検出結果を用いて、先先行車状態(先先行車Cの初期位置、先先行車車速確率分布f(v))を推定する。
Subsequently, the process proceeds to step S104, where the controller 5 (preceding vehicle position estimation unit 5c) determines the variable i-th overtaking point candidate selected in step S103 after the expected arrival time (the own vehicle A is the overtaking point candidate). The position of the preceding vehicle B (future preceding vehicle position) is calculated.
Subsequently, the process proceeds to step S105, and the controller 5 (the preceding preceding vehicle current position detection unit 5d) starts from the own vehicle forward path and the preceding preceding vehicle C ahead of the preceding vehicle B (exists on the own vehicle forward path and from the own vehicle A). The surrounding moving object present at the second closest position) and the position and vehicle speed of the preceding vehicle C are detected. Subsequently, the controller 5 (probability distribution setting unit 5e) uses the detection result to estimate the preceding vehicle state (the initial position of the preceding vehicle C, the preceding vehicle speed probability distribution f (v)).

続いてステップS106に移行して、コントローラ5(先先行車位置推定部5f)は、ステップS105で推定した先先行車状態を用いて、予想到達時間後(自車Aが追越地点候補に到達したとき)の先先行車Cの位置(先先行車位置確率分布)を推定する。
続いてステップS107に移行して、コントローラ5(先行車前方スペース判定部5g)は、ステップS103で選択したi番目の追越地点候補に対し、予想到達時間後(自車Aが追越地点候補に到達したとき)に先行車Bの前方に十分なスペースが確保されるか否かを判定する(推定先行車前方距離Le>先行車前方必要距離La)。
Subsequently, the process proceeds to step S106, and the controller 5 (the preceding preceding vehicle position estimation unit 5f) uses the preceding preceding vehicle state estimated in step S105, and after the predicted arrival time (the vehicle A reaches the overtaking point candidate). The position of the preceding vehicle C (probability distribution of the preceding vehicle).
Subsequently, the process proceeds to step S107, where the controller 5 (preceding vehicle forward space determination unit 5g) compares the i-th overtaking point candidate selected in step S103 after the expected arrival time (the own vehicle A is the overtaking point candidate). It is determined whether or not a sufficient space is secured in front of the preceding vehicle B (estimated preceding vehicle forward distance Le> preceding vehicle forward required distance La).

続いてステップS108に移行して、コントローラ5(追越地点設定部5h)は、ステップS107で先行車B前方に十分なスペースが確保されると判定された場合には、i番目の追越地点候補を先行車Bの追い越しを行う追越地点として設定する。一方、コントローラ5(追越地点設定部5h)は、ステップS107で先行車B前方に十分なスペースが確保されないと判定された場合には、追越候補地点を設定しない。   Subsequently, the process proceeds to step S108, and if it is determined in step S107 that sufficient space is secured in front of the preceding vehicle B, the controller 5 (the passing point setting unit 5h) is the i-th passing point. The candidate is set as an overtaking point where the preceding vehicle B is to be overtaken. On the other hand, if it is determined in step S107 that sufficient space is not secured in front of the preceding vehicle B, the controller 5 (the passing point setting unit 5h) does not set a passing candidate point.

続いてステップS109に移行して、コントローラ5(追越地点設定部5h)は、ステップS102で設定した複数の追越地点候補すべてに対し、ステップS103〜S108のフローを実行したか否かを判定する。そして、コントローラ5(追越地点設定部5h)は、複数の追越地点候補すべてに対しステップS103〜S108のフローを実行したと判定した場合には(Yes)、ステップS110に移行する。一方、コントローラ5(追越地点設定部5h)は、複数の追越地点候補すべてに対しステップS103〜S108のフローを実行していないと判定した場合には(No)、ステップS03に戻る。   Subsequently, the process proceeds to step S109, where the controller 5 (overtaking point setting unit 5h) determines whether or not the flow of steps S103 to S108 has been executed for all of the plurality of overtaking point candidates set in step S102. To do. If the controller 5 (the overtaking point setting unit 5h) determines that the flow of steps S103 to S108 has been executed for all of the plurality of overtaking point candidates (Yes), the process proceeds to step S110. On the other hand, if the controller 5 (the overtaking point setting unit 5h) determines that the flow of steps S103 to S108 is not executed for all of the plurality of overtaking point candidates (No), the process returns to step S03.

ステップS110では、コントローラ5(目標経路生成部5i)は、ステップS109で設定した追越地点と、地図データベース3a、自車位置検出部3b、目標経路設定部3c及び外部情報認識部4の検出結果等とを用いて、自車Aの自動走行のための目標経路(自動走行用目標経路)を生成する。なお、コントローラ5(目標操舵生成部5j)は、ステップS108で複数の追越地点を設定した場合には、複数の追越地点のうちから選択した1つの追越地点を用いる。続いて、コントローラ5(目標操舵生成部5j)は、生成した自動走行用目標経路を自車Aにトレースさせる操舵量(目標操舵量)を算出する。続いて、コントローラ5(目標操舵生成部5j)は、算出した目標操舵量どおりに操向輪を転舵させる指令(転舵角指令値)を転舵角制御装置6に出力する。   In step S110, the controller 5 (target route generation unit 5i) detects the overtaking point set in step S109 and the detection results of the map database 3a, the vehicle position detection unit 3b, the target route setting unit 3c, and the external information recognition unit 4. Is used to generate a target route (automatic travel target route) for automatic traveling of the vehicle A. In addition, the controller 5 (target steering production | generation part 5j) uses one passing point selected from several passing points, when a several passing point is set by step S108. Subsequently, the controller 5 (target steering generation unit 5j) calculates a steering amount (target steering amount) for causing the own vehicle A to trace the generated automatic traveling target route. Subsequently, the controller 5 (target steering generating unit 5j) outputs a command (steering angle command value) for turning the steered wheels according to the calculated target steering amount to the steering angle control device 6.

続いて、コントローラ5(目標速度算出部5k)は、先行車Bの現在地と先行車Bの車速Vsと自動走行用目標経路とを用いて、先行車Bと自車Aとの距離を予め定めた設定距離より大きくする車速(目標車速)を算出する。続いて、コントローラ5(目標速度算出部5k)は、算出した目標車速に自車Aの車速が追従するように自車Aを加速させる駆動力指令値をパワートレーンコントローラ7に出力する、または、自車Aを減速させる制動力指令値をブレーキコントローラ8に出力した後、この先行車追越支援処理を終了する。   Subsequently, the controller 5 (target speed calculation unit 5k) predetermines the distance between the preceding vehicle B and the own vehicle A using the current location of the preceding vehicle B, the vehicle speed Vs of the preceding vehicle B, and the target route for automatic travel. The vehicle speed (target vehicle speed) that is greater than the set distance is calculated. Subsequently, the controller 5 (target speed calculation unit 5k) outputs a driving force command value for accelerating the host vehicle A to the power train controller 7 so that the vehicle speed of the host vehicle A follows the calculated target vehicle speed, or After the braking force command value for decelerating the host vehicle A is output to the brake controller 8, the preceding vehicle overtaking support process is terminated.

なお、第1実施形態では、設定した追越地点を用いて、自車Aの転舵角と駆動力と制動力とを制御する例を示したが、他の構成を採用することもできる。例えば、設定した追越地点を自車Aの運転者に提示する構成としてもよい。具体的には、目標経路設定部3cのモニタが、目標経路を自車A周囲の地図に重畳させた画像に加え、追越地点を表示する構成としてもよい。これにより、自車Aの運転者に追越地点を報知できる。   In the first embodiment, an example in which the turning angle, the driving force, and the braking force of the vehicle A are controlled using the set overtaking point is shown, but other configurations may be employed. For example, the set overtaking point may be presented to the driver of the vehicle A. Specifically, the monitor of the target route setting unit 3c may be configured to display the overtaking point in addition to the image in which the target route is superimposed on a map around the host vehicle A. Thereby, the overtaking point can be notified to the driver of the vehicle A.

(動作その他)
次に、本実施形態の先行車追越支援装置1を搭載した車両の動作について説明する。
片側1車線ずつの対面通行の道路で、自動走行用目標経路(自動走行のための目標経路)に沿って走行するように自車Aの転舵角と駆動力と制動力とが制御されているときに、自車A前方の目標経路上に先行車Bが現れたとする。すると、コントローラ5が、自車前方経路から先行車Bを検出し、先行車Bを検出できたと判定する(図6のステップS101「Yes」)。続いて、コントローラ5が、検出した先行車Bの追い越しを行う複数の追越地点の候補(複数の追越地点候補)を設定する(図6のステップS102)。
(Operation other)
Next, the operation of the vehicle equipped with the preceding vehicle overtaking support device 1 of this embodiment will be described.
The steering angle, driving force, and braking force of the vehicle A are controlled so that the vehicle travels along a target route for automatic driving (target route for automatic driving) on a road that faces each other in one lane. It is assumed that the preceding vehicle B appears on the target route ahead of the own vehicle A when the vehicle is traveling. Then, the controller 5 detects the preceding vehicle B from the host vehicle forward route and determines that the preceding vehicle B has been detected (step S101 “Yes” in FIG. 6). Subsequently, the controller 5 sets a plurality of overtaking point candidates (a plurality of overtaking point candidates) for overtaking the detected preceding vehicle B (step S102 in FIG. 6).

続いて、コントローラ5が、変数iを「1」に初期化し、設定した複数の追越地点候補のうちから、変数i番目(1番目)の追越地点候補を選択する(図6のステップS103)。続いて、コントローラ5が、選択した変数i番目(1番目)の追越地点候補に対し、予想到達時間後(自車Aが追越地点候補に到達するとき)の先行車Bの位置(将来先行車位置)を算出する(図6のステップS104)。続いて、コントローラ5が、先先行車Cと、先先行車Cの位置及び車速とを検出し、検出結果を用いて先先行車状態(先先行車Cの初期位置、推定車速分布f(v))を推定する(図6のステップS105)。続いて、コントローラ5が、推定した先先行車状態を用いて、予想到達時間後(自車Aが追越地点候補に到達するとき)の先先行車位置確率分布を推定する(図6のステップS106)。   Subsequently, the controller 5 initializes the variable i to “1”, and selects the variable i-th (first) overtaking point candidate from the set overtaking point candidates (step S103 in FIG. 6). ). Subsequently, the controller 5 selects the position of the preceding vehicle B after the expected arrival time (when the own vehicle A reaches the passing point candidate) for the selected variable i-th (first) passing point candidate (future The preceding vehicle position is calculated (step S104 in FIG. 6). Subsequently, the controller 5 detects the preceding preceding vehicle C, the position and the vehicle speed of the preceding preceding vehicle C, and uses the detection result to determine the preceding preceding vehicle state (the initial position of the preceding preceding vehicle C, the estimated vehicle speed distribution f (v )) Is estimated (step S105 in FIG. 6). Subsequently, the controller 5 uses the estimated preceding preceding vehicle state to estimate the preceding preceding vehicle position probability distribution after the expected arrival time (when the vehicle A reaches the overtaking point candidate) (step in FIG. 6). S106).

ここで、コントローラ5が、i番目(1番目)の追越地点候補に対し、予想到達時間後(自車Aが追越地点候補に到達するとき)に先行車B前方に十分なスペースが確保されたとする(図6のステップS107)。すると、コントローラ5が、先行車B前方に十分なスペースが確保されると判定し、i番目(1番目)の追越地点候補を先行車Bの追越地点候補を追越地点として設定する(図5のステップS108、S109「No」)。
そして、コントローラ5が、ステップS103〜S109のフローを繰り返し実行し、1または2以上の追越候補地点を設定する(図6のステップS108)。なお、コントローラ5が、2以上の追越地点を設定した場合には、複数の追越地点のうちから選択した1つの追越地点を、設定した追越地点として用いる(図6のステップS110)。
Here, the controller 5 secures sufficient space ahead of the preceding vehicle B after the expected arrival time (when the own vehicle A reaches the overtaking point candidate) for the i-th (first) overtaking point candidate. Suppose that it was done (step S107 of FIG. 6). Then, the controller 5 determines that a sufficient space is secured in front of the preceding vehicle B, and sets the i-th (first) passing point candidate as the passing point candidate of the preceding vehicle B ( Steps S108 and S109 “No” in FIG. 5).
Then, the controller 5 repeatedly executes the flow of steps S103 to S109, and sets one or more overtaking candidate points (step S108 in FIG. 6). In addition, when the controller 5 sets two or more passing points, one passing point selected from a plurality of passing points is used as the set passing point (step S110 in FIG. 6). .

続いて、コントローラ5が、設定した追越地点で先行車Bの追い越しを行うための追越用経路(自動走行用目標経路)を生成し、生成した自動走行用目標経路を自車Aにトレースさせる操舵量(目標操舵量)を算出する(図6のステップS110)。続いて、コントローラ5が、算出した目標操舵量どおりに操向輪を転舵させる指令(転舵角指令値)を転舵角制御装置6に出力する(図6のステップS110)。続いて、コントローラ5が、先行車Bと自車Aとの距離を予め定めた設定距離より大きくする車速(目標車速)を算出する(図6のステップS110)。続いて、コントローラ5が、算出した目標車速に自車Aの車速が追従するように自車Aを加速させる指令(駆動力指令値)をパワートレーンコントローラ7に出力する、または、自車Aを減速させる指令(制動力指令値)をブレーキコントローラ8に出力する(図6のステップS110)。これにより、自車Aが、先行車Bの追い越しを行うための追越用経路(自動走行用目標経路)をトレースする。   Subsequently, the controller 5 generates an overtaking route (automatic traveling target route) for overtaking the preceding vehicle B at the set overtaking point, and traces the generated automatic traveling target route to the own vehicle A. A steering amount (target steering amount) to be calculated is calculated (step S110 in FIG. 6). Subsequently, the controller 5 outputs a command (steering angle command value) for turning the steered wheels according to the calculated target steering amount to the turning angle control device 6 (step S110 in FIG. 6). Subsequently, the controller 5 calculates a vehicle speed (target vehicle speed) that makes the distance between the preceding vehicle B and the host vehicle A larger than a predetermined set distance (step S110 in FIG. 6). Subsequently, the controller 5 outputs a command (driving force command value) for accelerating the host vehicle A so that the vehicle speed of the host vehicle A follows the calculated target vehicle speed, or the host vehicle A A command for decelerating (braking force command value) is output to the brake controller 8 (step S110 in FIG. 6). As a result, the own vehicle A traces the overtaking path (automatic traveling target path) for overtaking the preceding vehicle B.

このように、第1実施形態では、目標経路上に複数の追越地点候補を設定する。続いて、複数の追越地点候補それぞれに対し、先行車Bの現在地と、先行車Bの車速と、自車Aが現在地から追越地点候補に到達するまでにかかる時間(予想到達時間)とを用いて、予想到達時間後の先行車Bの位置を推定する。続いて、先先行車Cの現在地と、予想到達時間後の先先行車Cの車速の確率分布(先先行車車速確率分布)とを用いて、予想到達時間後の先先行車Cの位置を推定する。続いて、予想到達時間後の先行車Bの位置と、予想到達時間後の先先行車Cの位置とを用いて、複数の追越地点候補のうちから、予想到達時間後の先行車Bと先先行車Cとの距離が予め定めた設定距離以上である追越地点候補を追越地点として設定する。それゆえ、予想到達時間後、つまり、自車Aが現在地から追越地点候補に到達するときの先先行車Cの車速の確率分布(先先行車車速確率分布)を考慮して、予想到達時間後の先先行車Cの位置を推定する。そのため、予想到達時間後に、先行車Bの前方に自車Aが入るだけの適切なスペースがあるか否かを事前により適切に判断できる。これにより、先行車Bの追い越しをより適切に支援できる。   Thus, in the first embodiment, a plurality of overtaking point candidates are set on the target route. Subsequently, for each of the plurality of overtaking point candidates, the current location of the preceding vehicle B, the vehicle speed of the preceding vehicle B, and the time it takes for the vehicle A to reach the overtaking point candidate from the current location (expected arrival time) Is used to estimate the position of the preceding vehicle B after the expected arrival time. Next, using the current location of the preceding preceding vehicle C and the vehicle speed probability distribution of the preceding preceding vehicle C after the estimated arrival time (the preceding preceding vehicle speed probability distribution), the position of the preceding preceding vehicle C after the estimated reaching time is determined. presume. Subsequently, using the position of the preceding vehicle B after the estimated arrival time and the position of the preceding preceding vehicle C after the estimated arrival time, the preceding vehicle B after the estimated arrival time is selected from the plurality of overtaking point candidates. A passing point candidate whose distance from the preceding vehicle C is a predetermined distance or more is set as a passing point. Therefore, the estimated arrival time is considered in consideration of the vehicle speed probability distribution of the preceding preceding vehicle C (the preceding preceding vehicle vehicle speed probability distribution) when the own vehicle A reaches the overtaking point candidate from the current location. The position of the subsequent preceding preceding vehicle C is estimated. Therefore, after the estimated arrival time, it can be appropriately determined in advance whether or not there is an appropriate space enough for the host vehicle A to enter the front of the preceding vehicle B. Thereby, the overtaking of the preceding vehicle B can be supported more appropriately.

第1実施形態では、図2の目標経路設定部3cが目標経路設定部を構成する。以下同様に、図2の追越地点候補設定部5bが追越地点候補設定部を構成する。また、図2の先行車現在地検出部5aaが先行車現在地検出部を構成する。さらに、図2の先行車車速検出部5abが先行車車速検出部を構成する。また、図2の先行車位置推定部5cが先行車位置推定部を構成する。さらに、図2の先先行車現在地検出部5dが先先行車現在地検出部を構成する。また、図2の確率分布設定部5eが確率分布設定部を構成する。さらに、図2の先先行車位置推定部5fが先先行車位置推定部を構成する。また、図2の追越地点設定部5hが追越地点設定部を構成する。さらに、図2の目標速度算出部5kが車速制御部を構成する。さらに、図2の経路表示部3dが追越地点提示部を構成する。   In the first embodiment, the target route setting unit 3c in FIG. 2 constitutes a target route setting unit. Similarly, the overtaking point candidate setting unit 5b of FIG. 2 constitutes an overtaking point candidate setting unit. Further, the preceding vehicle current position detection unit 5aa in FIG. 2 constitutes a preceding vehicle current position detection unit. Further, the preceding vehicle speed detector 5ab of FIG. 2 constitutes the preceding vehicle speed detector. Further, the preceding vehicle position estimating unit 5c in FIG. 2 constitutes a preceding vehicle position estimating unit. Further, the preceding preceding vehicle current position detection unit 5d in FIG. 2 constitutes a preceding preceding vehicle current position detection unit. Further, the probability distribution setting unit 5e in FIG. 2 constitutes a probability distribution setting unit. Further, the preceding preceding vehicle position estimating unit 5f in FIG. 2 constitutes the preceding preceding vehicle position estimating unit. The overtaking point setting unit 5h in FIG. 2 constitutes an overtaking point setting unit. Furthermore, the target speed calculation unit 5k in FIG. 2 constitutes a vehicle speed control unit. Further, the route display unit 3d in FIG. 2 constitutes an overtaking point presenting unit.

(第1実施形態の効果)
第1実施形態に係る先行車追越支援装置1は、次のような効果を奏する。
(1)第1実施形態に係る先行車追越支援装置1によれば、コントローラ5は、目標経路上に複数の追越地点候補を設定する。続いて、コントローラ5は、複数の追越地点候補それぞれに対し、先行車Bの現在地と、先行車Bの車速と、自車Aが現在地から追越地点候補に到達するまでにかかる時間(予想到達時間)とを用いて、予想到達時間後の先行車Bの位置を推定する。続いて、コントローラ5は、先先行車Cの現在地と、予想到達時間後の先先行車Cの車速の確率分布(先先行車車速確率分布)とを用いて、予想到達時間後の先先行車Cの位置を推定する。続いて、コントローラ5は、予想到達時間後の先行車Bの位置と、予想到達時間後の先先行車Cの位置とを用いて、複数の追越地点候補のうちから、予想到達時間後の先行車Bと先先行車Cとの距離が予め定めた設定距離以上である追越地点候補を追越地点として設定する。
(Effect of 1st Embodiment)
The preceding vehicle overtaking support device 1 according to the first embodiment has the following effects.
(1) According to the preceding vehicle overtaking support apparatus 1 according to the first embodiment, the controller 5 sets a plurality of overtaking point candidates on the target route. Subsequently, the controller 5 determines, for each of the plurality of overtaking point candidates, the current location of the preceding vehicle B, the vehicle speed of the preceding vehicle B, and the time it takes for the own vehicle A to reach the overtaking location candidate from the current location. The position of the preceding vehicle B after the expected arrival time is estimated using the (arrival time). Subsequently, the controller 5 uses the current location of the preceding preceding vehicle C and the vehicle speed probability distribution of the preceding preceding vehicle C after the estimated arrival time (the preceding preceding vehicle speed probability distribution) to determine the preceding preceding vehicle after the estimated reaching time. Estimate the position of C. Subsequently, the controller 5 uses the position of the preceding vehicle B after the estimated arrival time and the position of the preceding vehicle C after the estimated arrival time, from among a plurality of overtaking point candidates, A passing point candidate in which the distance between the preceding vehicle B and the preceding preceding vehicle C is equal to or greater than a predetermined set distance is set as the passing point.

このような構成によれば、予想到達時間後、つまり、自車Aが現在地から追越地点候補に到達するときの先先行車Cの車速の確率分布(先先行車車速確率分布)を考慮して、予想到達時間後の先先行車Cの位置を推定する。それゆえ、予想到達時間後に、先行車Bの前方に自車Aが入るだけの適切なスペースがあるか否かを事前により適切に判断できる。これにより、自車Aによる先行車Bの追い越しをより適切に支援することができる。   According to such a configuration, the probability distribution of the vehicle speed of the preceding vehicle C (the preceding vehicle speed probability distribution) when the own vehicle A reaches the overtaking point candidate from the current location after the estimated arrival time is taken into consideration. Thus, the position of the preceding vehicle C after the estimated arrival time is estimated. Therefore, after the expected arrival time, it can be appropriately determined in advance whether or not there is an appropriate space for the host vehicle A to enter in front of the preceding vehicle B. Thereby, the overtaking of the preceding vehicle B by the own vehicle A can be supported more appropriately.

(2)第1実施形態に係る先行車追越支援装置1によれば、コントローラ5は、先先行車Cの現在地と、予想到達時間後の先先行車Cの車速の確率分布(先先行車車速確率分布)とを用いて、予想到達時間後の先先行車Cの位置の確率分布(先先行車位置確率分布)を先先行車Cの位置として推定する。
このような構成によれば、先先行車Cの位置の確率分布(先先行車位置確率分布)を用いて、先行車Bの前方に確保される前方距離を判定できる。
(2) According to the preceding vehicle overtaking support apparatus 1 according to the first embodiment, the controller 5 determines the current location of the preceding preceding vehicle C and the probability distribution of the vehicle speed of the preceding preceding vehicle C after the expected arrival time (the preceding preceding vehicle). Vehicle speed probability distribution), the probability distribution of the position of the preceding vehicle C after the estimated arrival time (the preceding vehicle position probability distribution) is estimated as the position of the preceding vehicle C.
According to such a configuration, the front distance secured ahead of the preceding vehicle B can be determined using the probability distribution of the position of the preceding preceding vehicle C (the preceding preceding vehicle position probability distribution).

(3)第1実施形態に係る先行車追越支援装置1によれば、コントローラ5は、先先行車Cと自車Aとの距離が遠いほど、先先行車車速確率分布のばらつきを大きくする。
このような構成によれば、先先行車Cと自車Aとの距離が遠く、先先行車現在地検出部5dによる先先行車Cの現在地の検出精度が低下する場合に、先先行車Cの位置の確率分布(先先行車位置確率分布)における、先先行車Cが存在する可能性がある位置の範囲を広げることができる。これにより、より適切に追越地点を設定できる。
(3) According to the preceding vehicle overtaking support device 1 according to the first embodiment, the controller 5 increases the variation of the preceding preceding vehicle vehicle speed probability distribution as the distance between the preceding preceding vehicle C and the host vehicle A increases. .
According to such a configuration, when the distance between the preceding vehicle C and the host vehicle A is long and the detection accuracy of the current position of the preceding vehicle C by the preceding vehicle current position detection unit 5d decreases, In the position probability distribution (previous vehicle position probability distribution), the range of positions where the preceding vehicle C may exist can be expanded. Thereby, an overtaking point can be set more appropriately.

(4)第1実施形態に係る先行車追越支援装置1によれば、コントローラ5は、自車Aの現時点の車速の変化量が大きいほど、先先行車車速確率分布のばらつきを大きくする。
このような構成によれば、自車Aの現時点の車速の変化量が大きく、ピッチングが発生し、先先行車現在地検出部5dによる先先行車Cの現在地の検出精度が低下する場合に、先先行車Cの位置の確率分布(先先行車位置確率分布)における、先先行車Cが存在する可能性がある位置の範囲を広げることができる。これにより、より適切に追越地点を設定できる。
(4) According to the preceding vehicle overtaking support device 1 according to the first embodiment, the controller 5 increases the variation of the preceding preceding vehicle vehicle speed probability distribution as the change amount of the current vehicle speed of the host vehicle A increases.
According to such a configuration, when the amount of change in the current vehicle speed of the host vehicle A is large, pitching occurs, and the detection accuracy of the current location of the preceding vehicle C by the preceding preceding vehicle current location detection unit 5d decreases. In the probability distribution of the position of the preceding vehicle C (the preceding preceding vehicle position probability distribution), the range of positions where the preceding preceding vehicle C may exist can be expanded. Thereby, an overtaking point can be set more appropriately.

(5)第1実施形態に係る先行車追越支援装置1によれば、コントローラ5は、予想到達時間が長いほど、先先行車車速確率分布のばらつきを大きくする。
このような構成によれば、予想到達時間(自車Aが現在地から追越地点候補に到達するまでの時間)が長く、先先行車Cの位置の検出結果の信頼度が下がる場合に、先先行車Cの位置の確率分布(先先行車位置確率分布)における、先先行車Cが存在する可能性がある位置の範囲を広げることができる。これにより、より適切に追越地点を設定できる。
(5) According to the preceding vehicle overtaking support apparatus 1 according to the first embodiment, the controller 5 increases the variation in the preceding preceding vehicle vehicle speed probability distribution as the expected arrival time is longer.
According to such a configuration, when the expected arrival time (the time until the vehicle A reaches the overtaking point candidate from the current location) is long, and the reliability of the detection result of the position of the preceding vehicle C decreases, In the probability distribution of the position of the preceding vehicle C (the preceding preceding vehicle position probability distribution), the range of positions where the preceding preceding vehicle C may exist can be expanded. Thereby, an overtaking point can be set more appropriately.

(6)第1実施形態に係る先行車追越支援装置1によれば、コントローラ5は、先先行車車速確率分布のばらつきが予め定めた設定値以上となった場合、または先先行車位置確率分布のばらつきが予め定めた設定値以上となった場合、先先行車車速確率分布の推定を一旦停止し、その後、先先行車Cの現在地を検出した場合、先先行車車速確率分布の推定を再開する。
このような構成によれば、先先行車Cの車速の検出結果の信頼度が下がる場合、または先先行車Cの位置の検出結果の信頼度が下がる場合に、先先行車車速確率分布の推定を停止する。これにより、より適切に追越地点を設定できる。
(6) According to the preceding vehicle overtaking support apparatus 1 according to the first embodiment, the controller 5 determines that the variation of the preceding preceding vehicle speed probability distribution is equal to or greater than a predetermined set value, or the preceding preceding vehicle position probability. When the variation in the distribution is equal to or greater than a predetermined set value, the estimation of the preceding preceding vehicle vehicle speed probability distribution is temporarily stopped. After that, when the current location of the preceding preceding vehicle C is detected, the preceding preceding vehicle vehicle speed probability distribution is estimated. Resume.
According to such a configuration, when the reliability of the detection result of the vehicle speed of the preceding vehicle C is lowered, or when the reliability of the detection result of the position of the preceding vehicle C is lowered, the estimation of the vehicle speed probability distribution of the preceding vehicle is reduced. To stop. Thereby, an overtaking point can be set more appropriately.

(7)第1実施形態に係る先行車追越支援装置1によれば、コントローラ5は、目標経路のうち自車Aの現在地から追越地点候補までの経路の曲率の変化量が予め定めた設定値以上になると判定した場合、設定値未満になると判定した場合よりも、先先行車車速確率分布のばらつきを大きくする。
このような構成によれば、道路形状が複雑となっており、曲率の変化で先先行車Cの車速が変化しやすい場合に、先先行車Cの位置の確率分布(先先行車位置確率分布)における、先先行車Cが存在する可能性がある位置の範囲を広げることができる。
(7) According to the preceding vehicle overtaking support apparatus 1 according to the first embodiment, the controller 5 determines in advance the amount of change in the curvature of the route from the current location of the vehicle A to the overtaking point candidate in the target route. When it is determined that the value is greater than or equal to the set value, the variation in the vehicle speed probability distribution of the preceding preceding vehicle is made larger than when it is determined that the value is less than the set value.
According to such a configuration, when the road shape is complicated and the vehicle speed of the preceding vehicle C is likely to change due to a change in curvature, the probability distribution of the position of the preceding vehicle C (the preceding vehicle position probability distribution). ), The range of positions where the preceding vehicle C may be present can be widened.

(8)第1実施形態に係る先行車追越支援装置1によれば、コントローラ5は、目標経路のうち自車Aの現在地から追越地点候補までの経路上に分岐点があると判定した場合、分岐点がないと判定した場合よりも、先先行車車速確率分布のばらつきを大きくする。
このような構成によれば、道路形状が複雑となっており、分岐点で先先行車Cが目標経路からはずれやすい場合に、先先行車Cの位置の確率分布(先先行車位置確率分布)における、先先行車Cが存在する可能性がある位置の範囲を広げることができる。
(8) According to the preceding vehicle overtaking support apparatus 1 according to the first embodiment, the controller 5 determines that there is a branch point on the route from the current location of the vehicle A to the overtaking point candidate in the target route. In this case, the variation in the vehicle speed probability distribution of the preceding preceding vehicle is made larger than when it is determined that there is no branch point.
According to such a configuration, when the road shape is complicated and the leading vehicle C tends to deviate from the target route at the branch point, the probability distribution of the position of the leading vehicle (the leading vehicle position probability distribution). The range of the position where the preceding preceding vehicle C may exist can be widened.

(9)第1実施形態に係る先行車追越支援装置1によれば、コントローラ5は、先先行車Cが検出されていない場合、自車Aが信号機の手前で停止しているときに自車A前方の停止線から自車Aの現在地までの距離を検出し、検出した距離が予め定めた設定距離以上である場合、先行車B前方に先先行車Cが存在しているものとして、先先行車Cの現在地を設定する。
このような構成によれば、先先行車Cを直接に検出できない場合にも、先先行車Cの存在を推定することができる。それゆえ、追い越しできるシーンを増やすことができ、遅い先行車Bに追従する時間を短縮することができるため、乗員の不快感を低減できる。
(9) According to the preceding vehicle overtaking support device 1 according to the first embodiment, when the preceding preceding vehicle C is not detected, the controller 5 automatically detects when the own vehicle A is stopped in front of the traffic light. When the distance from the stop line ahead of the car A to the current location of the host vehicle A is detected and the detected distance is equal to or larger than a predetermined set distance, it is assumed that the preceding preceding car C exists in front of the preceding car B. The current location of the preceding vehicle C is set.
According to such a configuration, the presence of the preceding vehicle C can be estimated even when the preceding vehicle C cannot be directly detected. Therefore, the number of scenes that can be overtaken can be increased, and the time required to follow the slow preceding vehicle B can be shortened, so that passenger discomfort can be reduced.

(10)第1実施形態に係る先行車追越支援装置1によれば、コントローラ5は、自車Aの現在地から追越地点までの目標経路に沿った距離を算出し、算出した距離が予め定めた設定距離以下になった場合、先行車Bと自車Aとの距離が増加し、その後、先行車Bと自車Aとの速度差が予め定めた速度差以上となるように自車Aの車速を制御する。
このような構成によれば、追い越しの準備を早くから行うことができ、追い越しに必要な走行距離を短縮できる。それゆえ、追い越しできるシーンを増やすことができ、遅い先行車Bに追従する時間を短縮することができるため、乗員の不快感を低減できる。
(10) According to the preceding vehicle overtaking support apparatus 1 according to the first embodiment, the controller 5 calculates the distance along the target route from the current location of the host vehicle A to the overtaking point, and the calculated distance is calculated in advance. When the distance is less than the predetermined set distance, the distance between the preceding vehicle B and the own vehicle A increases, and then the own vehicle so that the speed difference between the preceding vehicle B and the own vehicle A is equal to or greater than the predetermined speed difference. A vehicle speed is controlled.
According to such a configuration, preparation for overtaking can be made early and the travel distance required for overtaking can be shortened. Therefore, the number of scenes that can be overtaken can be increased, and the time required to follow the slow preceding vehicle B can be shortened, so that passenger discomfort can be reduced.

(11)第1実施形態に係る先行車追越支援装置1によれば、経路表示部3dは、設定した追越地点を自車Aの運転者に提示する構成としてもよい。
このような構成によれば具体的には、目標経路設定部3cのモニタが、目標経路を自車A周囲の地図に重畳させた画像に加え、追越地点を表示する構成としてもよい。これにより、追越地点を運転者に報知できる。
(11) According to the preceding vehicle overtaking support apparatus 1 according to the first embodiment, the route display unit 3d may be configured to present the set overtaking point to the driver of the own vehicle A.
Specifically, according to such a configuration, the monitor of the target route setting unit 3c may display a passing point in addition to an image in which the target route is superimposed on a map around the host vehicle A. Thereby, the driver can be notified of the overtaking point.

(第2実施形態)
次に、本発明に係る第2実施形態について図面を参照しつつ説明する。なお、上記実施形態と同様な構成等については同一の符号を使用して、その詳細は省略する。
第2実施形態は、予想到達時間後の先行車Bの位置と、予想到達時間後の先先行車Cの位置との距離が予め定めた設定距離(例えば、自車全長lv)未満であると判定した場合、複数の追越地点候補のうちから、先行車Bと先先行車Cとを連続して追い越すことが可能な追越地点候補を追越地点として設定する点が第1実施形態と異なる。
(Second Embodiment)
Next, a second embodiment according to the present invention will be described with reference to the drawings. In addition, about the structure similar to the said embodiment, the same code | symbol is used and the detail is abbreviate | omitted.
In the second embodiment, the distance between the position of the preceding vehicle B after the estimated arrival time and the position of the preceding vehicle C after the estimated arrival time is less than a predetermined set distance (for example, the total length lv of the host vehicle). If the determination is made, a point that sets a passing point candidate capable of continuously overtaking the preceding vehicle B and the preceding preceding vehicle C among the plurality of passing point candidates as the passing point is the same as in the first embodiment. Different.

この場合、コントローラ5は、第1実施形態の図2の内部構成に加え、図7に示す内部構成も有する。図7に示す内部構成では、図2の追越地点候補設定部5bと、先行車位置推定部5cと、先先行車現在地検出部5dと、確率分布設定部5eと、先先行車位置推定部5fと、先行車前方スペース判定部5gとを一部変更した、追越地点候補設定部5b*と、先行車位置推定部5c*と、前方車現在地検出部5d*と、確率分布設定部5e*と、前方車位置推定部5f*と、先行車前方スペース判定部5g*と、追越地点設定部5h*とを備える。これら各構成要素5b*、5c*、5d*、5e*、5f*、5g*、5h*では、先先行車Cに代えて前方車C*を用いる。前方車C*としては、例えば、自車前方経路上に存在し且つ先行車B前方に存在するすべての周囲移動物体がある。   In this case, the controller 5 has the internal configuration shown in FIG. 7 in addition to the internal configuration of FIG. 2 of the first embodiment. In the internal configuration shown in FIG. 7, the overtaking point candidate setting unit 5b, the preceding vehicle position estimating unit 5c, the preceding preceding vehicle current position detecting unit 5d, the probability distribution setting unit 5e, and the preceding preceding vehicle position estimating unit shown in FIG. 5f and a preceding vehicle forward space determination unit 5g are partially changed, an overtaking point candidate setting unit 5b *, a preceding vehicle position estimation unit 5c *, a forward vehicle current position detection unit 5d *, and a probability distribution setting unit 5e *, A forward vehicle position estimation unit 5f *, a preceding vehicle forward space determination unit 5g *, and an overtaking point setting unit 5h *. In each of these components 5b *, 5c *, 5d *, 5e *, 5f *, 5g *, and 5h *, the preceding vehicle C * is used instead of the preceding preceding vehicle C. As the forward vehicle C *, for example, there are all the surrounding moving objects that exist on the route ahead of the host vehicle and in front of the preceding vehicle B.

例えば、追越地点候補設定部5b*では、自車前方経路上に先行車Bと前方車C*とを連続して追い越すための追越地点の候補である複数の追越地点候補を設定する。ここで、追越必要距離Loとしては、対象とする前方車C*の速度vsnと、自車Aや先行車Bが走行している道路の法定速度Vlimと、追い越し開始時の自車Aの車速V0と、対象とする前方車C*と自車Aとの相対距離xnと、目標車間時間Tsとを用いて、下記(5)式で算出される距離を用いる。

Figure 0006331858
For example, the overtaking point candidate setting unit 5b * sets a plurality of overtaking point candidates that are candidates for overtaking points for successively overtaking the preceding vehicle B and the preceding vehicle C * on the route ahead of the vehicle. . Here, as the required overtaking distance Lo, the speed vsn of the target forward vehicle C *, the legal speed Vlim of the road on which the own vehicle A and the preceding vehicle B are traveling, and the own vehicle A at the time of overtaking start. The distance calculated by the following equation (5) is used using the vehicle speed V0, the relative distance xn between the target forward vehicle C * and the subject vehicle A, and the target inter-vehicle time Ts.
Figure 0006331858

ここで、図2に示す内部構成と同様に、目標車間時間Tsとしては、例えば、比較的短い時間(例えば、2秒程度)を用いる。また、目標加速度a0としては、例えば、自車Aの乗員が不快に感じない程度の加速度(例えば、1.5[m/s2])を用いる。
また、先行車位置推定部5c*では、設定した複数の追越地点候補それぞれに対し、予想到達時間(自車Aが現在地から追越地点候補に到達するまでの時間)後の先行車Bの位置を推定する。さらに、先先行車現在地検出部5d*では、すべての前方車C*を検出する。また、確率分布設定部5e*では、複数の追越地点候補それぞれに対し、検出したすべての前方車C*の走行状態(以下、「前方車状態」とも呼ぶ)を推定する。さらに、先先行車位置推定部5f*では、推定した前方車状態を用いて、複数の追越地点候補それぞれに対し、予想到達時間後のすべての前方車C*の位置(前方車C*の位置の確率分布)を推定する。また、先行車前方スペース判定部5g*では、推定した予想到達時間後のすべての前方車C*の位置を用いて、複数の追越地点候補それぞれに対し、予想到達時間後に少なくとも1台の前方車C*の前方に十分なスペースが確保されるか否かを判定する。さらに、追越地点設定部5h*は、設定した複数の追越地点候補のうちから、前方車C*の前方に十分な距離が確保されると判定された追越地点候補、つまり、予想到達時間後の前方車C*間の距離が予め定めた先行車前方必要距離La以上である追越地点候補を選択する。
なお、その他の内部構成は図2の内部構成と同様である。
Here, similarly to the internal configuration shown in FIG. 2, for example, a relatively short time (for example, about 2 seconds) is used as the target inter-vehicle time Ts. Further, as the target acceleration a0, for example, an acceleration (for example, 1.5 [m / s 2 ]) that does not make the occupant of the vehicle A feel uncomfortable is used.
In addition, the preceding vehicle position estimation unit 5c *, for each of a plurality of set overtaking point candidates, for the preceding vehicle B after the expected arrival time (time until the vehicle A reaches the overtaking point candidate from the current location). Estimate the position. Further, the preceding preceding vehicle current position detection unit 5d * detects all the preceding vehicles C *. In addition, the probability distribution setting unit 5e * estimates the traveling state of all the detected forward vehicles C * (hereinafter also referred to as “forward vehicle state”) for each of the plurality of overtaking point candidates. Further, the preceding preceding vehicle position estimation unit 5f * uses the estimated preceding vehicle state to determine the positions of all the preceding vehicles C * after the estimated arrival time (for the preceding vehicle C *) for each of the plurality of overtaking point candidates. (Probability distribution of position). Further, the preceding vehicle forward space determination unit 5g * uses the positions of all the forward vehicles C * after the estimated expected arrival time, and at least one forward vehicle after the estimated arrival time for each of the plurality of overtaking point candidates. It is determined whether sufficient space is secured in front of the car C *. Further, the overtaking point setting unit 5h * determines the overtaking point candidate that has been determined that a sufficient distance is secured ahead of the preceding vehicle C * from among the set overtaking point candidates, that is, the expected arrival point. An overtaking point candidate is selected in which the distance between the preceding vehicle C * after the time is equal to or greater than the predetermined distance La ahead of the preceding vehicle.
The other internal configuration is the same as the internal configuration of FIG.

(第2実施形態の効果)
第2実施形態に係る先行車追越支援装置1は、第1実施形態に係る先行車追越支援装置1の効果(1)〜(11)に加え、次のような効果を奏する。
(1)第2実施形態に係る先行車追越支援装置1によれば、コントローラ5は、予想到達時間後の先行車Bの位置と、予想到達時間後の先先行車Cの位置との距離が予め定めた設定距離未満であると判定した場合、複数の追越地点候補のうちから、先行車Bと先先行車Cとを連続して追い越すことが可能な追越地点候補を追越地点として設定する。
このような構成によれば、先行車Bと先先行車Cとの間に自車Aを進入させることができる適切なスペースを確保できない場合には、先行車Bと先先行車Cとを同時に追い越すことができる。それゆえ、追い越しできるシーンを増やすことができ、遅い先行車Bに追従する時間を短縮することができるため、乗員の不快感を低減できる。
(Effect of 2nd Embodiment)
The preceding vehicle overtaking support apparatus 1 according to the second embodiment has the following effects in addition to the effects (1) to (11) of the preceding vehicle overtaking support apparatus 1 according to the first embodiment.
(1) According to the preceding vehicle overtaking support device 1 according to the second embodiment, the controller 5 determines the distance between the position of the preceding vehicle B after the estimated arrival time and the position of the preceding vehicle C after the estimated arrival time. Is determined to be less than a predetermined set distance, an overtaking point candidate capable of continuously overtaking the preceding vehicle B and the preceding preceding vehicle C among the plurality of overtaking point candidates is determined as the overtaking point. Set as.
According to such a configuration, when it is not possible to secure an appropriate space for allowing the host vehicle A to enter between the preceding vehicle B and the preceding preceding vehicle C, the preceding vehicle B and the preceding preceding vehicle C are simultaneously set. Overtake. Therefore, the number of scenes that can be overtaken can be increased, and the time required to follow the slow preceding vehicle B can be shortened, so that passenger discomfort can be reduced.

3c 目標経路設定部
3d 経路表示部
5b 追越地点候補設定部
5aa 先行車現在地検出部
5ab 先行車車速検出部
5c 先行車位置推定部
5d 先先行車現在地検出部
5e 確率分布設定部
5f 先先行車位置推定部
5h 追越地点設定部
5k 目標速度算出部
3c target route setting unit 3d route display unit 5b overtaking point candidate setting unit 5aa preceding vehicle current location detection unit 5ab preceding vehicle vehicle speed detection unit 5c preceding vehicle position estimation unit 5d ahead preceding vehicle current location detection unit 5e probability distribution setting unit 5f ahead preceding vehicle Position estimation unit 5h Passing point setting unit 5k Target speed calculation unit

Claims (11)

自車の目標経路を設定する目標経路設定部と、
前記自車前方の先行車の車速を検出する先行車車速検出部と、
前記先行車の車速を用いて、前記目標経路上に前記先行車の追い越しを行う追越地点の候補である複数の追越地点候補を設定する追越地点候補設定部と、
前記先行車の現在地を検出する先行車現在地検出部と、
複数の前記追越地点候補それぞれに対し、前記先行車の現在地と、前記先行車の車速と、前記自車が現在地から前記追越地点候補に到達するまでにかかる時間である予想到達時間とを用いて、前記予想到達時間後の前記先行車の位置を推定する先行車位置推定部と、
前記先行車前方の先先行車の現在地を検出する先先行車現在地検出部と、
前記予想到達時間後の前記先先行車の車速の確率分布を設定する確率分布設定部と、
前記先先行車の現在地と、前記予想到達時間後の前記先先行車の車速の確率分布とを用いて、前記予想到達時間後の前記先先行車の位置の確率分布を前記予想到達時間後の前記先先行車の位置として推定する先先行車位置推定部と、
前記予想到達時間後の前記先行車の位置と、前記予想到達時間後の前記先先行車の位置とを用いて、複数の前記追越地点候補のうちから、前記予想到達時間後の前記先行車と前記先先行車との距離が予め定めた設定距離以上である前記追越地点候補を前記追越地点として設定する追越地点設定部と、を備えたことを特徴とする先行車追越支援装置。
A target route setting unit for setting the target route of the vehicle;
A preceding vehicle speed detecting unit for detecting a vehicle speed of the vehicle ahead of the preceding vehicle,
Using the vehicle speed of the preceding vehicle, an overtaking point candidate setting unit that sets a plurality of overtaking point candidates that are candidates for overtaking the overtaking of the preceding vehicle on the target route;
A preceding vehicle current position detection unit for detecting a current position of the preceding vehicle;
For each of the plurality of overtaking point candidates, the current location of the preceding vehicle, the vehicle speed of the preceding vehicle, and the expected arrival time that is the time it takes for the vehicle to reach the overtaking point candidate from the current location. Using a preceding vehicle position estimating unit that estimates the position of the preceding vehicle after the expected arrival time;
A preceding preceding vehicle current location detection unit for detecting a current location of a preceding preceding vehicle ahead of the preceding vehicle;
A probability distribution setting unit that sets a probability distribution of the vehicle speed of the preceding preceding vehicle after the expected arrival time;
Using the current location of the preceding preceding vehicle and the probability distribution of the vehicle speed of the preceding preceding vehicle after the estimated arrival time, the probability distribution of the position of the preceding preceding vehicle after the estimated arrival time is calculated after the estimated arrival time. the previous preceding vehicle position estimating section for estimating a position of the destination preceding vehicle,
Using the position of the preceding vehicle after the estimated arrival time and the position of the preceding preceding vehicle after the estimated arrival time, the preceding vehicle after the estimated arrival time from among a plurality of the overtaking point candidates And an overtaking point setting unit for setting the overtaking point candidate whose distance from the preceding preceding vehicle is equal to or greater than a predetermined set distance as the overtaking point. apparatus.
前記確率分布設定部は、前記先先行車と前記自車との距離が遠いほど、前記先先行車の車速の確率分布のばらつきを大きくすることを特徴とする請求項に記載の先行車追越支援装置。 2. The preceding vehicle follow-up according to claim 1 , wherein the probability distribution setting unit increases the variation in the probability distribution of the vehicle speed of the preceding preceding vehicle as the distance between the preceding preceding vehicle and the host vehicle increases. Yue support device. 前記確率分布設定部は、前記自車の現時点の車速の変化量が大きいほど、前記先先行車の車速の確率分布のばらつきを大きくすることを特徴とする請求項1または2に記載の先行車追越支援装置。 The preceding vehicle according to claim 1 or 2 , wherein the probability distribution setting unit increases the variation in the probability distribution of the vehicle speed of the preceding preceding vehicle as the amount of change in the current vehicle speed of the host vehicle increases. Overtaking support device. 前記確率分布設定部は、前記予想到達時間が長いほど、前記先先行車の車速の確率分布のばらつきを大きくすることを特徴とする請求項1から3のいずれか1項に記載の先行車追越支援装置。 The preceding vehicle follow-up according to any one of claims 1 to 3 , wherein the probability distribution setting unit increases the variation in the probability distribution of the vehicle speed of the preceding preceding vehicle as the predicted arrival time is longer. Yue support device. 前記確率分布設定部は、前記先先行車の車速の確率分布のばらつきが予め定めた設定値以上となった場合、または前記先先行車の位置の確率分布のばらつきが予め定めた設定値以上となった場合、前記先先行車の車速の確率分布の推定を一旦停止し、その後、前記先先行車現在地検出部で前記先先行車の現在地を検出した場合、前記先先行車の車速の確率分布の推定を再開することを特徴とする請求項に記載の先行車追越支援装置。 The probability distribution setting unit is configured such that when the variation in the probability distribution of the vehicle speed of the preceding preceding vehicle is equal to or larger than a predetermined setting value, or the variation in the probability distribution of the position of the preceding preceding vehicle is equal to or larger than the predetermined setting value If it is, the estimation of the vehicle speed probability distribution of the preceding preceding vehicle is temporarily stopped, and then when the current position of the preceding preceding vehicle is detected by the preceding preceding vehicle current position detection unit, the probability distribution of the vehicle speed of the preceding preceding vehicle The preceding vehicle overtaking support device according to claim 4 , wherein the estimation of the vehicle is resumed. 前記確率分布設定部は、前記目標経路のうち前記自車の現在地から前記追越地点候補までの経路の曲率の変化量が予め定めた設定値以上になると判定した場合、前記設定値未満になると判定した場合よりも、前記先先行車の車速の確率分布のばらつきを大きくすることを特徴とする請求項4または5に記載の先行車追越支援装置。 If the probability distribution setting unit determines that the amount of change in the curvature of the target route from the current location of the host vehicle to the overtaking point candidate is greater than or equal to a predetermined set value, 6. The preceding vehicle overtaking support apparatus according to claim 4 or 5 , wherein the variation in the probability distribution of the vehicle speed of the preceding preceding vehicle is made larger than that in the case of determination. 前記確率分布設定部は、前記目標経路のうち前記自車の現在地から前記追越地点候補までの経路上に分岐点があると判定した場合、前記分岐点がないと判定した場合よりも、前記先先行車の車速の確率分布のばらつきを大きくすることを特徴とする請求項4から6のいずれか1項に記載の先行車追越支援装置。 If the probability distribution setting unit determines that there is a branch point on the route from the current location of the vehicle to the overtaking point candidate in the target route, than the case where it is determined that there is no branch point, The preceding vehicle overtaking support apparatus according to any one of claims 4 to 6 , wherein the variation in the probability distribution of the vehicle speed of the preceding preceding vehicle is increased. 前記先先行車位置推定部は、前記先先行車が検出されていない場合、前記自車が信号機の手前で停止しているときに前記自車前方の停止線から前記自車の現在地までの距離を検出し、検出した距離が予め定めた設定距離以上である場合、前記先行車前方に前記先先行車が存在しているものとして、前記先先行車の現在地を設定することを特徴とする請求項1からのいずれか1項に記載の先行車追越支援装置。 When the preceding preceding vehicle is not detected, the preceding preceding vehicle position estimating unit is a distance from the stop line ahead of the own vehicle to the current location of the own vehicle when the own vehicle is stopped in front of the traffic light. When the detected distance is equal to or greater than a predetermined set distance, the current location of the preceding preceding vehicle is set assuming that the preceding preceding vehicle exists in front of the preceding vehicle. Item 8. The preceding vehicle overtaking support device according to any one of Items 1 to 7 . 前記追越地点設定部は、前記予想到達時間後の前記先行車の位置と、前記予想到達時間後の前記先先行車の位置との距離が予め定めた設定距離未満であると判定した場合、複数の前記追越地点候補のうちから、前記先行車と前記先先行車とを連続して追い越すことが可能な前記追越地点候補を前記追越地点として設定することを特徴とする請求項1からのいずれか1項に記載の先行車追越支援装置。 When the overtaking point setting unit determines that the distance between the position of the preceding vehicle after the estimated arrival time and the position of the preceding preceding vehicle after the estimated arrival time is less than a predetermined set distance, 2. The overtaking point candidate capable of continuously overtaking the preceding vehicle and the preceding preceding vehicle among the plurality of overtaking point candidates is set as the overtaking point. The preceding vehicle overtaking support device according to any one of 1 to 8 . 前記自車の現在地から前記追越地点までの前記目標経路に沿った距離が予め定めた設定距離以下になった場合、前記先行車と前記自車との距離が増加し、その後、前記自車の車速が前記先行車の車速よりも高くなるように前記自車の車速を制御する車速制御部を備えることを特徴とする請求項1からのいずれか1項に記載の先行車追越支援装置。 When the distance along the target route from the current location of the host vehicle to the overtaking point is equal to or less than a predetermined set distance, the distance between the preceding vehicle and the host vehicle increases, and then the host vehicle The preceding vehicle overtaking support according to any one of claims 1 to 9 , further comprising a vehicle speed control unit that controls a vehicle speed of the host vehicle so that a vehicle speed of the vehicle is higher than a vehicle speed of the preceding vehicle. apparatus. 前記追越地点設定部で設定した前記追越地点を前記自車の運転者に提示する追越地点提示部を備えたことを特徴とする請求項1から10のいずれか1項に記載の先行車追越支援装置。 Prior according to any one of claims 1 to 10, characterized in that it comprises a passing-point presentation unit for presenting the overtaking point set by the overtaking point setting unit to the driver of the vehicle Car overtaking support device.
JP2014161484A 2014-08-07 2014-08-07 Advance vehicle overtaking support system Expired - Fee Related JP6331858B2 (en)

Priority Applications (1)

Application Number Priority Date Filing Date Title
JP2014161484A JP6331858B2 (en) 2014-08-07 2014-08-07 Advance vehicle overtaking support system

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
JP2014161484A JP6331858B2 (en) 2014-08-07 2014-08-07 Advance vehicle overtaking support system

Publications (2)

Publication Number Publication Date
JP2016038717A JP2016038717A (en) 2016-03-22
JP6331858B2 true JP6331858B2 (en) 2018-05-30

Family

ID=55529743

Family Applications (1)

Application Number Title Priority Date Filing Date
JP2014161484A Expired - Fee Related JP6331858B2 (en) 2014-08-07 2014-08-07 Advance vehicle overtaking support system

Country Status (1)

Country Link
JP (1) JP6331858B2 (en)

Cited By (1)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US20220348204A1 (en) * 2021-04-29 2022-11-03 Volvo Car Corporation Method for controlling autonomous vehicle, and autonomous vehicle

Families Citing this family (3)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP7160251B2 (en) * 2017-01-12 2022-10-25 モービルアイ ビジョン テクノロジーズ リミテッド Navigation system, method and program
US11332141B2 (en) 2017-06-20 2022-05-17 Mitsubishi Electric Corporation Path estimation device and path estimation method
CN114187759B (en) * 2021-11-19 2023-01-03 东南大学 Road side unit driving assistance method and device based on data driving model

Family Cites Families (5)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JPH068747A (en) * 1992-06-25 1994-01-18 Isuzu Motors Ltd Speed control device for vehicle
JP2005149402A (en) * 2003-11-19 2005-06-09 Fujitsu Ten Ltd Driving assistance device
JP5017839B2 (en) * 2005-10-13 2012-09-05 日産自動車株式会社 Overtaking support device for vehicles
JP2009301132A (en) * 2008-06-10 2009-12-24 Aisin Aw Co Ltd Driving support device, driving support method, and program
JP5397231B2 (en) * 2010-01-12 2014-01-22 トヨタ自動車株式会社 Risk avoidance support device

Cited By (1)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US20220348204A1 (en) * 2021-04-29 2022-11-03 Volvo Car Corporation Method for controlling autonomous vehicle, and autonomous vehicle

Also Published As

Publication number Publication date
JP2016038717A (en) 2016-03-22

Similar Documents

Publication Publication Date Title
US12311971B2 (en) Vehicle control system, and vehicle control method
EP3591638B1 (en) Drive assistance method and drive assistance device
JP7048398B2 (en) Vehicle control devices, vehicle control methods, and programs
JP6380920B2 (en) Vehicle control device
JP6221569B2 (en) Driving assistance device
JP6369061B2 (en) Lane change support device
US11631257B2 (en) Surroundings recognition device, and surroundings recognition method
JP6409744B2 (en) Vehicle travel support device
WO2016092591A1 (en) Collision risk calculation device, collision risk display device, and vehicle body control device
JP6508114B2 (en) Automatic operation control system of moving object
JP6892887B2 (en) Vehicle control device and vehicle
JP7552918B2 (en) Vehicle control method and vehicle control device
JP6331858B2 (en) Advance vehicle overtaking support system
JP2019127081A (en) Automatic driving control device and automatic driving control method of vehicle
WO2016189727A1 (en) Travel control device and method
JP2020163967A (en) Vehicle drive assisting system
JPWO2018047232A1 (en) Vehicle control device
KR101470231B1 (en) Method and apparatus for controlling driving of vehicle, vehicle control system performing thereof
JP6314744B2 (en) Moving object track prediction device
CN115175838B (en) Vehicle control method and vehicle control device
JP2020023214A (en) Driving support method and driving support device
JP2017194930A (en) Automatic operation control system for moving body
JP2021172107A (en) Travel support method and travel support apparatus
JP2024039134A (en) Vehicle control device and vehicle control method
WO2023188095A1 (en) Travel path estimation device

Legal Events

Date Code Title Description
A621 Written request for application examination

Free format text: JAPANESE INTERMEDIATE CODE: A621

Effective date: 20170330

A131 Notification of reasons for refusal

Free format text: JAPANESE INTERMEDIATE CODE: A131

Effective date: 20180123

A977 Report on retrieval

Free format text: JAPANESE INTERMEDIATE CODE: A971007

Effective date: 20180124

A521 Request for written amendment filed

Free format text: JAPANESE INTERMEDIATE CODE: A523

Effective date: 20180316

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: 20180403

A61 First payment of annual fees (during grant procedure)

Free format text: JAPANESE INTERMEDIATE CODE: A61

Effective date: 20180416

R151 Written notification of patent or utility model registration

Ref document number: 6331858

Country of ref document: JP

Free format text: JAPANESE INTERMEDIATE CODE: R151

LAPS Cancellation because of no payment of annual fees