JP6301713B2 - Travel route generator - Google Patents
Travel route generator Download PDFInfo
- Publication number
- JP6301713B2 JP6301713B2 JP2014083012A JP2014083012A JP6301713B2 JP 6301713 B2 JP6301713 B2 JP 6301713B2 JP 2014083012 A JP2014083012 A JP 2014083012A JP 2014083012 A JP2014083012 A JP 2014083012A JP 6301713 B2 JP6301713 B2 JP 6301713B2
- Authority
- JP
- Japan
- Prior art keywords
- travel
- host vehicle
- virtual
- virtual obstacle
- location
- Prior art date
- Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
- Active
Links
- 238000013459 approach Methods 0.000 claims description 31
- 238000001514 detection method Methods 0.000 claims description 29
- 238000010586 diagram Methods 0.000 description 30
- 238000000034 method Methods 0.000 description 28
- 238000012545 processing Methods 0.000 description 17
- 238000004519 manufacturing process Methods 0.000 description 16
- 238000012937 correction Methods 0.000 description 6
- 230000000052 comparative effect Effects 0.000 description 3
- 238000012706 support-vector machine Methods 0.000 description 3
- FFBHFFJDDLITSX-UHFFFAOYSA-N benzyl N-[2-hydroxy-4-(3-oxomorpholin-4-yl)phenyl]carbamate Chemical compound OC1=C(NC(=O)OCC2=CC=CC=C2)C=CC(=C1)N1CCOCC1=O FFBHFFJDDLITSX-UHFFFAOYSA-N 0.000 description 2
- 238000005192 partition Methods 0.000 description 2
- 230000005856 abnormality Effects 0.000 description 1
- 238000013528 artificial neural network Methods 0.000 description 1
- 238000012217 deletion Methods 0.000 description 1
- 230000037430 deletion Effects 0.000 description 1
- 230000001105 regulatory effect Effects 0.000 description 1
- 230000001502 supplementing effect Effects 0.000 description 1
Images
Landscapes
- Control Of Driving Devices And Active Controlling Of Vehicle (AREA)
- Traffic Control Systems (AREA)
Description
本発明は、自車両が走行する走行経路を生成する走行経路生成装置に関する。 The present invention relates to a travel route generation device that generates a travel route on which a host vehicle travels.
自車両が走行する走行経路を車両自体が生成する技術が公知である(例えば、特許文献1参照。)。特許文献1では、運転者が自車両を操作して障害物を避ける方向と一致するように、自車両の走行経路を生成している。 A technique is known in which the vehicle itself generates a travel route on which the host vehicle travels (see, for example, Patent Document 1). In Patent Document 1, the travel route of the host vehicle is generated so that the driver matches the direction of operating the host vehicle to avoid an obstacle.
特許文献1では、障害物を避ける走行経路を生成する場合、例えば走行経路が道路の境界に接近しすぎることを防止するために、実際の障害物とは異なる位置に仮想障害物を設定する。そして、設定した仮想障害物を避ける走行経路を生成することにより、結果として実際の障害物を避ける適切な走行経路を生成しようとしている。 In Patent Document 1, when a travel route that avoids an obstacle is generated, a virtual obstacle is set at a position different from the actual obstacle, for example, in order to prevent the travel route from being too close to the road boundary. Then, by generating a travel route that avoids the set virtual obstacle, an appropriate travel route that avoids the actual obstacle is generated as a result.
しかしながら、特許文献1では、仮想障害物の位置をずらしながら、その度に走行経路を修正し、この修正処理を適切な走行経路が生成されるまで継続するので、走行経路を生成するために要する時間が長くなるという問題がある。 However, in Patent Document 1, the travel route is corrected each time while shifting the position of the virtual obstacle, and this correction process is continued until an appropriate travel route is generated. Therefore, it is necessary to generate the travel route. There is a problem that time becomes long.
本発明は上記課題を解決するためになされたものであり、走行可能領域に基づいて生成される通常経路から外れる走行経路を短時間で生成する走行経路生成装置を提供することを目的とする。 The present invention has been made to solve the above-described problems, and an object of the present invention is to provide a travel route generation device that generates a travel route that deviates from a normal route generated based on a travelable region in a short time.
本発明の走行経路生成装置は、周囲情報取得手段と、走行情報取得手段と、走行可能領域検出手段と、仮想障害物設定手段と、経路生成手段と、を備えている。
周囲情報取得手段は自車両の周囲情報を取得し、走行情報取得手段は自車両の走行情報を取得し、走行可能領域検出手段は周囲情報取得手段が取得する周囲情報に基づいて自車両が走行できる走行可能領域を検出する。
The travel route generation device of the present invention includes surrounding information acquisition means, travel information acquisition means, travelable area detection means, virtual obstacle setting means, and route generation means.
The surrounding information acquisition means acquires the surrounding information of the own vehicle, the traveling information acquisition means acquires the traveling information of the own vehicle, and the traveling area detection means travels based on the surrounding information acquired by the surrounding information acquisition means. The possible travelable area is detected.
仮想障害物設定手段は、走行可能領域検出手段が検出する走行可能領域に基づいて設定される通常経路から外れて前記自車両が走行するときに、走行情報取得手段が走行情報として取得する自車両の進行方向に基づいて自車両の走行箇所の両側に仮想障害物を設定し、経路生成手段は仮想障害物設定手段が走行箇所の両側に設定した仮想障害物の間を通る走行経路を生成する。 The virtual obstacle setting means is a host vehicle that travel information acquisition means acquires as travel information when the host vehicle travels out of a normal route set based on the travelable area detected by the travelable area detection means. Based on the traveling direction of the vehicle, virtual obstacles are set on both sides of the travel location of the host vehicle, and the route generation means generates a travel route passing between the virtual obstacles set on both sides of the travel location by the virtual obstacle setting means. .
このように、自車両の進行方向に基づいて自車両の走行箇所の両側に仮想障害物を設定することにより、仮想障害物の間を通る走行経路を生成すればよい。したがって、通常経路から外れた走行経路を短時間で容易に生成できる。尚、仮想障害物を設定する自車両の走行箇所は、自車両がこれから走行する箇所と、現在の走行箇所と、過去に走行した箇所との少なくともいずれか1箇所あればよい。 Thus, a travel route passing between virtual obstacles may be generated by setting virtual obstacles on both sides of the travel location of the host vehicle based on the traveling direction of the host vehicle. Therefore, a travel route deviating from the normal route can be easily generated in a short time. In addition, the travel location of the own vehicle which sets a virtual obstacle should just be at least any one of the location where the own vehicle will travel from now on, the present travel location, and the location where it traveled in the past.
さらに、自車両に走行を回避する箇所がある場合には、走行箇所の両側に設定される仮
想障害物の少なくとも片側を走行回避箇所として設定することにより、通常経路から外れて走行回避箇所を避ける走行経路を短時間で容易に生成できる。
Further, when there is a place where the vehicle avoids traveling, by setting at least one side of the virtual obstacle set on both sides of the traveling place as the traveling avoidance place, the traveling avoidance place is avoided by deviating from the normal route. A travel route can be easily generated in a short time.
以下、本発明の実施形態を図に基づいて説明する。
[第1実施形態]
図1に示す走行経路生成装置2は、周囲情報取得部10と、走行情報取得部12と、走行可能領域検出部20と、仮想障害物設定部22と、経路生成部30とを備えており、CPU、RAM、ROM等を有するマイクロコンピュータにより主に構成されている。
Hereinafter, embodiments of the present invention will be described with reference to the drawings.
[First Embodiment]
The travel
周囲情報取得部10は、車両前方の直進方向を中心とする所定角度範囲を検出エリアとする前方センサと、車両左側方の車幅方向を中心とする所定角度範囲を検出エリアとする
左側方センサと、車両右側方の所定角度範囲(左側方センサと同様)を検出エリアとする右側方センサとが出力する信号に基づいて、車両周囲の物体および道路状況を表わす周囲情報を取得する。
The surrounding
また、周囲情報取得部10は、前記センサ群と、車両後方の指定角度範囲を検出エリアとする後方センサとが出力する信号に基づいて、車両周囲の物体および道路状況を表わす周囲情報を取得してもよい。
In addition, the surrounding
前方センサ、左右の側方センサおよび後方センサは、カメラ等の画像センサ、レーザレーダ、ミリ波レーダ、ソナー等の少なくともいずれかから構成されている。
車両周囲の物体は、車線区画突起物、他車両、歩行者等の他、自車両の走行可能領域を制限する地形や建造物等を含む。周囲情報取得部10は、個々の物体の情報として、位置、大きさ、高さ、道路に沿った長さ等を取得する。
The front sensor, the left and right side sensors, and the rear sensor are composed of at least one of an image sensor such as a camera, a laser radar, a millimeter wave radar, and a sonar.
Objects around the vehicle include lane division protrusions, other vehicles, pedestrians, and the like, as well as terrain and buildings that limit the travelable area of the vehicle. The surrounding
また、周囲情報取得部10は、道路状況として、車線境界線、車道中央線、車道外側線等の路面に描かれた区画線の種類と、区画線上の複数の位置座標に基づいて規定される直線、曲線等の道路形状の情報と、道路幅とを取得する。周囲情報取得部10は、道路状況として、ナビゲーション装置から道路形状および道路幅を取得してもよい。
Moreover, the surrounding
例えば図2において、周囲情報取得部10は、車線区画線200、202と駐車車両等の障害物220とを自車両100の周囲の物体および道路状況を表わす周囲情報として取得する。特徴点210、212、222は、それぞれ車線区画線200、202、および障害物220を表わしている。
For example, in FIG. 2, the surrounding
走行情報取得部12は、車速センサから自車両の車速を取得し、操舵角センサから自車両の操舵角を取得し、GPS装置などの衛星測位装置から自車両の位置(自車位置)を取得する。走行情報取得部12は、GPS装置から取得する位置情報から自車両の車速を求めてもよい。
The travel
そして、走行情報取得部12は、前進または後進を示すシフト位置と、操舵角センサが示す操舵方向とに基づいて自車両の進行方向を走行情報として取得する。これに対し、操舵角センサが示す操舵角から自車両の進路を予測し、自車位置から進路上の点を結ぶ直線の方向を進行方向としてもよい。また、走行情報取得部12は、GPS装置から取得する自車位置の変化から自車両の進行方向を走行情報として取得してもよい。
The travel
走行可能領域検出部20は、周囲情報取得部10が取得する周囲情報に基づいて、自車両が走行可能な領域を認識する。例えば図2において、走行可能領域検出部20は、車線区画線200と車線区画線202との間の領域で障害物220を除いた領域を走行可能領域として検出する。自車両100から見て、走行可能領域の左右の外側が走行不可領域となる。
The travelable
仮想障害物設定部22は、走行可能領域検出部20が検出する走行可能領域に基づいて設定される通常経路230から外れて自車両100が走行するときに、自車両100の進行方向に基づいて自車両100の走行箇所300の左右両側に仮想障害物310、312をそれぞれ設定する。
The virtual
仮想障害物設定部22は、自車両100の進行方向に基づいて、自車両100の右側および左側を認識し、右側に仮想障害物310を設定し、左側に仮想障害物312を設定する。符号310、312は、それぞれ仮想障害物310、312を表わす特徴点としても使用する。
The virtual
通常経路230から外れて自車両100が走行するときの走行箇所300は、例えば、運転者による操舵に基づき、通常経路230から外れて走行すると推定される自車両100の進行方向上の点、経路または領域である。また、走行箇所300は、自車両100がこれから走行する箇所と、現在の走行箇所と、過去に走行した箇所との少なくともいずれか1箇所あればよい。
The
次に、仮想障害物310、312の設定について説明する。図3に示すように、自車位置102と、自車両が走行する走行地点である走行箇所300とを結ぶ直線104を基準とし、直線104と自車両100の進行方向とに基づいて、走行箇所300の左右両側に仮想障害物310、312を設定する。
Next, setting of the
走行箇所300の両側に設定する仮想障害物310、312の数は左右それぞれに1個以上であればよい。そして、左右両側で同じ数であることが望ましい。これにより、経路生成部30で生成される走行経路が走行箇所300からずれることを低減できる。
The number of
また、走行箇所300の両側に走行箇所300から等距離に仮想障害物310と仮想障害物312とを設定することが望ましい。これにより、経路生成部30で生成される走行経路が走行箇所300からずれることを低減できる。
In addition, it is desirable to set the
ここで、図4の(A)に示すように、図4の(B)よりも仮想障害物310と仮想障害物312との間隔を狭くすると、走行経路は走行箇所300を通りやすくなる。走行経路が走行箇所300からずれてもよい場合は、図4の(B)に示すように、仮想障害物310と仮想障害物312との間隔を広くしてもよい。このように、走行箇所300を通過させたい要求度に応じて、仮想障害物310と仮想障害物312との間隔を設定することが望ましい。
Here, as shown in FIG. 4A, when the interval between the
また、走行箇所300は1点だけではなく、複数設定してもよい。例えば、図5に示すように、通常経路230(図2参照)から外れるが、ドライバの操舵角等から判断して自車両100が走行したい走行経路232が存在する場合、走行経路232上に複数の走行箇所300を設定する。そして、自車位置102と走行経路232とを結んだ直線104を基準とし、直線104と自車両100の進行方向とに基づいて、各走行箇所300の両側に仮想障害物310、312を設定する。
Moreover, you may set not only one point but the
また、図6に示すように、自車両100に通常経路から外れて走行したい走行領域110が存在する場合、走行領域110内の中心点112と自車位置102とを直線104で結ぶ。そして、走行領域110内の直線104上に複数の走行箇所300を設定する。そして、直線104を基準とし、直線104と進行方向とに基づいて、走行領域110内において各走行箇所300の両側に仮想障害物310、312を設定する。
In addition, as shown in FIG. 6, when there is a
図7に示すように、自車両100が障害物220を避けるために、現在の操舵角に対して点線で示す急操舵をすることなく走行できる範囲120を規定する場合、範囲120の境界の両側に仮想障害物310、312を設定する。現在の操舵角に対して急操舵をすることなく走行できる範囲120であるから、進行方向に向かって範囲120は広がっている。走行経路240は、仮想障害物310と仮想障害物312との間を通って生成される。
As shown in FIG. 7, when defining a
ここで、操舵に対して実際の進路が変更されるには、通常応答遅れがある。図7に示す急操舵をすることなく走行できる範囲120を規定する方式は、操舵に対する応答遅れによる進路変更の範囲を規定する場合にも適用できる。
Here, there is a normal response delay when the actual course is changed with respect to the steering. The method of defining the
図8に示すように、走行可能領域内で障害物220以外に走行を回避したい回避箇所320が存在する場合、仮想障害物設定部22は、例えば回避箇所320と車線区画線200、202との間で間隔が広い車線区画線200と回避箇所320との間に走行箇所300を設定する。そして、回避箇所320上に仮想障害物312を設定し、回避箇所320上に設定した仮想障害物312に対応して、走行箇所300に対して反対側の車線区画線200側に仮想障害物310を設定する。
As shown in FIG. 8, when there is an
また、仮想障害物設定部22は、自車両100が走行すると予測される走行経路に対して回避箇所320が左右のどちらにあるかを判定する。そして、この判定結果に基づき、回避箇所320に対して自車両100の予測走行経路側が走行箇所となるように、回避箇所320と、予測走行経路を挟んで回避箇所の反対側とに仮想障害物を設置することが望ましい。尚、現在の走行情報を取得できない場合、直前に取得した走行情報に基づいて走行経路を予測してもよい。
In addition, the virtual
また、図9に示すように、障害物220の横を通過する場合に、走行可能領域に基づいて障害物220と車線区画線200との間に設定される通常経路230を走行すると、障害物220に接触するおそれがあり安全が確保できないので通常経路230から外れる必要があると判断される場合には、安全マージンを見込んで障害物220から所定距離dを離して回避箇所320を設定してもよい。
As shown in FIG. 9, when the vehicle passes along the side of the
これにより、通常経路230よりも障害物220から離れた位置に走行経路240が生成される。
その結果、障害物220の横を通過する際に、自車両100は障害物220に接触することなく安全に走行できる。回避箇所320が領域の場合、領域内の少なくとも1点以上を仮想障害物として設定すればよい。
As a result, the
As a result, the
経路生成部30は、例えば図10に示すような道路状況において、車線区画線200を表わす特徴点210と障害物220を表わす特徴点222と仮想障害物310を表わす特徴点310とを一つのクラスとし、車線区画線202を表わす特徴点212と仮想障害物312を表わす特徴点312とを別のクラスとし、これら特徴点210、212、222、310、312を自車両100の進行方向に向かって左右両側の異なるクラスに分類する識別面250を生成する。
For example, in the road situation as shown in FIG. 10, the
経路生成部30は、例えばサポートベクターマシン(SVM)を識別器とし、識別面250に最も近い特徴点との距離が最大になるように識別関数を用いて識別面250を生成する。この識別面250が自車両100の走行経路240となる。
The
(経路生成処理1)
図11に走行経路生成装置2が実行する経路生成処理1のフローチャートを示す。経路生成処理1は常時実行される。図11において「S」はステップを表わしている。
(Route generation process 1)
FIG. 11 shows a flowchart of route generation processing 1 executed by the travel
周囲情報取得部10は、カメラの画像データおよびレーダが走査する走査情報等から、自車両の周囲の物体および道路状況を表わす周囲情報を取得する(S400)。走行可能領域検出部20は、S400において取得した周囲情報に基づいて、車線を区画する区画線から自車両が走行する走行路と障害物とを検出し(S402、S404)、走行路から障害物を除いた領域を、自車両が走行できる走行可能領域として検出する(S406)。
The surrounding
走行情報取得部12は、車速センサ、操舵角センサ、GPS、ナビゲーション装置等から、車速、自車位置等の走行情報を取得する(S408)。
仮想障害物設定部22は、S408において取得した走行情報に基づいて、自車両が走行可能領域に基づいて設定される通常経路から外れる必要があるか否かを判定する(S410)。通常経路から外れる必要がない場合(S410:No)、仮想障害物設定部22はS416に処理を移行する。
The travel
The virtual
自車両が通常経路から外れる必要がある場合(S410:Yes)、仮想障害物設定部22は、自車両の進路を示す走行箇所を設定する(S412)。自車両が走行を回避する走行回避箇所が設定される場合には、走行回避箇所を避けて走行するための走行箇所を設定する。
When the host vehicle needs to deviate from the normal route (S410: Yes), the virtual
そして、仮想障害物設定部22は自車両の進行方向に基づいて走行箇所の左右両側に仮想障害物を設定する(S414)。走行回避箇所がある場合には、走行回避箇所と、走行箇所を挟んで走行回避箇所の反対側とに仮想障害物を設定する。
Then, the virtual
S416において経路生成部30は、走行箇所の両側に仮想障害物が設定されている場合には、仮想障害物の間を通りS406で検出した走行可能領域を表わす特徴点を進行方向に対し左右両側に分類するように、仮想障害物が設定されてない場合には、S406で検出した走行可能領域を表わす特徴点を進行方向に対し左右両側に分類するように、識別器により走行経路を生成する。
In S416, when virtual obstacles are set on both sides of the travel location, the
以上説明した第1実施形態では、自車両の進行方向に基づいて自車両が走行すると推定される走行箇所の左右両側に仮想障害物を設定することにより、仮想障害物の間に位置する走行箇所を通る走行経路を短時間で容易に生成できる。 In the first embodiment described above, by setting virtual obstacles on both the left and right sides of the travel location where the host vehicle is estimated to travel based on the traveling direction of the host vehicle, the travel locations located between the virtual obstacles. A travel route passing through can be easily generated in a short time.
[第2実施形態]
図12に示す第2実施形態の走行経路生成装置4は、第1実施形態の走行経路生成装置2に対し車速設定部24が追加されている。それ以外の構成は第1実施形態と実質的に同一である。
[Second Embodiment]
In the travel route generation device 4 of the second embodiment shown in FIG. 12, a vehicle
図13に示すように、自車両100が走行箇所300を通過するときの車速(αkm/h)を設定する必要がある場合、車速設定部24は、仮想障害物設定部22が進行方向に基づいて走行箇所300の左右両側に仮想障害物310、312を設定するときに、走行箇所300を通過するときの車速(αkm/h)を仮想障害物310、312に設定する。
As shown in FIG. 13, when it is necessary to set the vehicle speed (α km / h) when the
車速設定部24は、例えば、第1実施形態の図9に示すように、障害物220の横を通過するときに自車両100が通過できる幅が狭くなっており、通常よりも車速を低下して通過した方がよいと判断される場合に、仮想障害物310、312に自車両100が走行箇所300を通過する車速を車速情報として設定する。
For example, as shown in FIG. 9 of the first embodiment, the vehicle
そして、図14に示すように、経路生成部30が仮想障害物310と仮想障害物312との間を通る走行経路240を生成すると、車速設定部24は、仮想障害物310と仮想障害物312とを結ぶ直線と走行経路240との交点に、車速情報としてαkm/hを設定することが望ましい。
Then, as illustrated in FIG. 14, when the
尚、通常よりも車速を低下して走行箇所300を走行した方がよい場合だけでなく、通常よりも車速を上昇させて走行箇所300を走行した方がよい場合にも、仮想障害物310、312に車速情報を設定してもよい。
The
(経路生成処理2)
図15に走行経路生成装置4が実行する経路生成処理2のフローチャートを示す。経路生成処理2は常時実行される。図15において「S」はステップを表わしている。図15のS420〜S434、S440は図11のS400〜416と実質的に同一処理であるから説明を省略する。
(Route generation process 2)
FIG. 15 shows a flowchart of
自車両100が走行箇所300を通過するときの車速を車速情報として設定する必要がない場合(S436:No)、車速設定部24はS440に処理を移行する。
自車両100が走行箇所300を通過するときの車速を車速情報として設定する必要がある場合(S436:Yes)、車速設定部24は、進行方向に基づいて走行箇所300の左右両側に設定される仮想障害物310、312に、走行箇所300を通過するときの自車両の車速を設定し、S440に処理を移行する。
When it is not necessary to set the vehicle speed when the
When it is necessary to set the vehicle speed when the
以上説明した第2実施形態では、自車両100が走行箇所300を通過するときの車速を車速情報として仮想障害物310、312に設定するので、自車両100は、設定された車速で走行箇所300を通過できる。
In the second embodiment described above, the vehicle speed when the
[第3実施形態]
図16に示す第3実施形態の走行経路生成装置6は、第2実施形態の走行経路生成装置2に対し、目的地点設定部14と経路修正部32とが追加されている。それ以外の構成は第2実施形態と実質的に同一である。
[Third Embodiment]
In the travel
図17に示すように、仮想障害物設定部22が走行箇所300として自車両の目的地点330を取得して設定する場合、車速設定部24は、目的地点330を走行箇所300として、進行方向に基づいて目的地点330の左右両側に設定される仮想障害物310、312に、目的地点330を通過するときの自車両の車速を設定する。
As shown in FIG. 17, when the virtual
仮想障害物設定部22は、自車両100が目的地点330を停止点として停止する場合には、図17に示すように、仮想障害物310、312に車速情報として0kmを設定する。そして、前述した図14の説明において車速情報として設定したαkm/hを0km/hと置き換えて、経路生成部30が仮想障害物310と仮想障害物312との間を通る走行経路240を生成すると、仮想障害物310と仮想障害物312とを結ぶ直線と走行経路240との交点に、車速情報として0km/hを設定することが望ましい。
When the
仮想障害物設定部22は、自車両100が目的地点330を通過点とする場合には、目的地点330の通過速度として0km/h以外の車速を仮想障害物310、312に設定する。
When the
目的地点330で停止する場合には、目的地点330よりも先の走行経路は不要であるから、経路修正部32は、図18の(A)に示すように、目的地点330よりも先に経路生成部30が生成した走行経路を削除してもよい。
When stopping at the destination point 330, a travel route ahead of the destination point 330 is not necessary, so the
また、目的地点330で停止できないことを想定する場合、経路修正部32は、図18の(B)に示すように、目的地点330に到達したときの進行方向を維持するように、経路生成部30が目的地点330よりも先に生成した走行経路を修正してもよい。
Further, when it is assumed that the vehicle cannot be stopped at the destination point 330, the
また、図19の(A)に示すように、障害物として例えば駐車車両130の後ろに停車する場合、仮想障害物設定部22は、安全マージンを見込んで駐車車両130の後ろの所定距離離れた位置に走行箇所として目的地点330を設定する。仮想障害物設定部22は、目的地点330の両側に仮想障害物310、312を設定し、仮想障害物310、312に車速情報として0kmを設定する。
Further, as shown in FIG. 19A, when the vehicle stops as an obstacle, for example, behind the parked
このとき、図19の(B)に示すように、目的地点330までの実線で示す走行経路240に加え、目的地点330よりも先の点線で示す走行経路240を経路生成部30が生成することで、目的地点330で停止できずに駐車車両130と衝突しそうな場合に備えることができる。
At this time, as shown in FIG. 19B, in addition to the
また、図20に示すように、前方車両132に追従して走行する場合、仮想障害物設定部22は、前方車両132の後方に所定の車間距離をおいた位置に走行箇所300を設定し、走行箇所300の両側に仮想障害物310、312を設定する。レーダ等で検出した前方車両132の車速をαkm/hとすると、車速設定部24は、仮想障害物310、312に車速情報として前方車両132の車速と同じαkmを設定する。
In addition, as shown in FIG. 20, when traveling following the
さらに仮想障害物設定部22は、前方車両132との衝突を避けるため、安全マージンを見込んで前方車両132の後ろに、車速情報としてαkm/hを設定した仮想障害物よりも前方車両132の近くの所定距離離れた位置に目的地点330を設定する。仮想障害物設定部22は目的地点330の両側に仮想障害物310、312を設定し、車速設定部24は仮想障害物310、312に車速情報として0kmを設定する。
Furthermore, in order to avoid a collision with the preceding
尚、車速情報として0kmを設定した目的地点330に加え、前方車両132の車速と同じαkmを設定した走行箇所300を目的地点としてもよい。
このとき、0kmを設定された目的地点330までの実線で示す走行経路240に加え、目的地点330よりも先の点線で示す走行経路240を経路生成部30が生成することで、目的地点330で停止できずに前方車両132と衝突しそうな場合に備えることができる。
In addition to the destination 330 where 0 km is set as the vehicle speed information, the
At this time, in addition to the
また、図21に示すように、自車両100が駐車エリア140に駐車する場合、駐車エリア140の入口中央に走行箇所300と、走行箇所300の両側の駐車エリア140の入口両端に仮想障害物310、312とを設定する。走行箇所300の両側の仮想障害物310、312に設定される車速情報は、駐車エリア140に安全に駐車できるように、例えば5km/hに設定される。
Further, as shown in FIG. 21, when the
そして、自車両100が駐車エリア140内で停止する位置に、走行箇所300として目的地点330と、目的地点330の両側に仮想障害物310、312を設定する。目的地点330の両側に設定する仮想障害物310と仮想障害物312との間隔は、駐車エリア140の真ん中に停車するために、入口の間隔よりも短くすることが望ましい。また、目的地点330の両側の仮想障害物310、312に設定される車速情報は、0km/hに設定される。
Then, at the position where the
自車両100が駐車エリア140に進入してくると、自車両100の進入方向が駐車エリア140に沿って平行になるように、走行箇所300の両側に設定する仮想障害物310と仮想障害物312とを結ぶ直線の傾きを徐々に修正する。
When the
(経路生成処理3)
図22に走行経路生成装置6が実行する経路生成処理3のフローチャートを示す。経路生成処理3は常時実行される。図22において「S」はステップを表わしている。図22のS450〜S458は図11のS400〜408と実質的に同一処理であるから説明を省略する。
(Route generation process 3)
FIG. 22 shows a flowchart of route generation processing 3 executed by the travel
仮想障害物設定部22は、S458において取得した走行情報に基づいて、自車両が走行可能領域に基づいて設定される通常経路から外れる必要があるか否かを判定する(S4
60)。通常経路から外れる必要がない場合(S460:No)、仮想障害物設定部22はS478に処理を移行する。
The virtual
60). When it is not necessary to deviate from the normal route (S460: No), the virtual
自車両が通常経路から外れる必要がある場合(S460:Yes)、仮想障害物設定部22は、自車両が前方車両等の移動物体への追従走行を行うか否かを判定する(S462)。自車両が移動物体への追従走行を行う場合(S462:Yes)、走行経路生成装置6はS472に処理を移行する。
When the own vehicle needs to deviate from the normal route (S460: Yes), the virtual
自車両が移動物体への追従走行を行わない場合(S462:No)、仮想障害物設定部22は自車両の目的地点を検出する(S464)。目的地点とは、例えば自車両の停止地点として、前述したように駐車車両または追従車両の所定距離後方、駐車エリアの停止位置等である。
When the own vehicle does not follow the moving object (S462: No), the virtual
目的地点がない場合(S466:No)、仮想障害物設定部22は自車両の進路を示す走行箇所を設定する(S468)。自車両が走行を回避する走行回避箇所が設定される場合には、走行回避箇所を避けて走行するための走行箇所を設定する。
If there is no destination point (S466: No), the virtual
そして、自車両の進行方向に基づいて走行箇所の両側に仮想障害物を設定する(S470)。走行回避箇所がある場合には、走行回避箇所と、走行箇所を挟んで走行回避箇所の反対側とに仮想障害物を設定し、S478に処理を移行する。 Then, virtual obstacles are set on both sides of the travel location based on the traveling direction of the host vehicle (S470). If there is a travel avoidance location, virtual obstacles are set on the travel avoidance location and the opposite side of the travel avoidance location across the travel location, and the process proceeds to S478.
目的地点がある場合(S466:Yes)、仮想障害物設定部22はS474に処理を移行する。
S472において仮想障害物設定部22は、カメラの画像データまたはレーダの走査情報に基づいて追従対象物を検出し、S474に処理を移行する。
If there is a destination point (S466: Yes), the virtual
In S472, the virtual
S474において、仮想障害物設定部22は、目的地点330を走行箇所として設定し、目的地点330の両側に仮想障害物310、312を設定する。S476において、車速設定部24は、仮想障害物310、312に目的地点330における自車両100の車速を設定し、S478に処理を移行する。
In S474, the virtual
S478において経路生成部30は、走行箇所の両側に仮想障害物が設定されている場合には仮想障害物の間を通るように、仮想障害物が設定されていない場合には、S456で検出した走行可能領域を表わす特徴点を進行方向に対し左右両側に分類するように、識別器により走行経路を生成する。
In S478, the
以上説明した第3実施形態では、例えば、駐車車両の後方に停車する場合、あるいは追従対象物として前方車両に追従する場合、あるいは駐車エリアに駐車する場合など、走行可能領域に基づいて設定される通常経路を外れた目的地点が自車両にある場合、自車両が走行する走行箇所として目的地点を設定し、目的地点の両側に仮想障害物を設定した。そして、仮想障害物に自車両が目的地点を通過する車速情報を設定した。これにより、自車両は、目的地点に停止、あるいは設定された車速で目的地点を通過できる。 In the third embodiment described above, for example, when stopping behind a parked vehicle, following a preceding vehicle as a tracking target, or parking in a parking area, the third embodiment is set based on the travelable area. When there is a destination point on the host vehicle that deviates from the normal route, the destination point is set as a travel point where the host vehicle travels, and virtual obstacles are set on both sides of the destination point. And the vehicle speed information which the own vehicle passes the destination point was set to the virtual obstacle. Accordingly, the host vehicle can stop at the destination point or pass through the destination point at the set vehicle speed.
[第4実施形態]
図23に示す第4実施形態の走行経路生成装置8は、第1実施形態の走行経路生成装置2に対し、走行履歴記憶部26が追加されている。それ以外の構成は第1実施形態と実質的に同一である。
[Fourth Embodiment]
In the travel
走行履歴記憶部26は、自車両が走行してきた走行履歴情報として、走行可能領域を規定する車線区画線および障害物等、ならびに自車両が走行してきた走行経路の少なくとも
いずれか一方をRAM等の記憶部に記憶する。
The travel
図24に示すように、自車両100が障害物220を避けて通過する途中においては、自車両100の後または横に位置する車線区画線200、202および障害物220は周囲情報を取得するカメラおよびレーダの死角になることがある。死角になっている領域260の車線区画線200、202および障害物220を考慮せず死角になっていない前方の周囲情報だけに基づいて走行経路を生成すると、自車両100の進路変更等により、死角になっている領域260の車線区画線200、202または障害物220に自車両100が接触することがある。
As shown in FIG. 24, while the
そこで、例えば障害物220を避けて走行中の場合には、仮想障害物設定部22は、直前に記憶されている走行履歴情報を読み出し、死角になっている走行可能領域を規定する車線区画線200、202および障害物220に仮想障害物310、312を設定する。
Therefore, for example, when the vehicle is traveling while avoiding the
これにより、死角になっている車線区画線200、202および障害物220、ならびにカメラおよびレーダから取得され死角になっていない周囲情報に基づいて自車両100の走行経路240が生成される。その結果、死角になっている車線区画線200、202および障害物220に接触せずに自車両100が走行できる。
As a result, the
また、図25に示すように、自車両100が車線変更する場合、死角になっている領域260の車線区画線200、202、204を考慮せず、死角になっていない前方の車線区画線200、202、204等の周囲情報だけに基づいて走行経路を生成すると、通常経路230で示される急な車線変更になることがある。
Also, as shown in FIG. 25, when the
そこで、仮想障害物設定部22は、直前に記憶されている走行可能領域の走行履歴情報を読み出し、死角になっている走行可能領域を規定する車線区画線200、202、204に仮想障害物310、312を設定する。これにより、死角になっている車線区画線200、202、204、ならびにカメラおよびレーダから取得され死角になっていない周囲情報に基づいて自車両100の走行経路240が生成される。その結果、死角になっている車線区画線200、202、204および障害物を考慮した滑らかな車線変更を行うことができる。
Therefore, the virtual
また、図26に示すように、自車両100が現在の自車位置102に達するまでに走行経路として走行軌跡234を走行して来ており、これから走行箇所300に向かって進路を変更する場合、自車位置102と走行箇所300とを結ぶ直線104を基準とし、直線104と自車両100の進行方向とに基づいて走行箇所300の左右両側に仮想障害物310、312を設定すると、点線で示す通常経路230のように急操舵になることがある。
In addition, as shown in FIG. 26, when the
そこで、仮想障害物設定部22は、直前に記憶されている走行軌跡234の走行履歴情報を読み出し、走行軌跡234上に複数の走行箇所300を設定する。そして、各走行箇所300の両側に仮想障害物310、312を設定する。
Therefore, the virtual
これにより、直前まで走行した走行軌跡234の形状に続いて走行箇所300に向かう滑らかな走行経路240が生成されるので、自車両100は滑らかな進路変更を行うことができる。
As a result, a
また、図27に示すように、自車両100が走行する道路の片側に非常駐車帯、待避所またはカープールレーン等の通常走行外領域270等が設けられ道路幅が急激に変化しており、通常走行外領域270側の車線区画線が不明瞭、または車線区画線がない場合、通
常走行外領域270を含んだ領域が走行可能領域として検出されることがある。この場合、通常走行外領域270側に移動した走行経路が通常経路230として生成され、自車両に100とって無駄な動きを伴う走行経路となる。
In addition, as shown in FIG. 27, an emergency parking zone, a rest area or a normal driving outside
そこで、仮想障害物設定部22は、直前に記憶されている走行可能領域を規定する走行履歴情報を読み出し、通常走行外領域270の手前を走行している道路幅となるように、通常走行外領域270を仕切る車線区画線があると思われる位置に仮想障害物310を設定し、自車両100の進行方向前方を走行箇所300として、走行箇所300に対して仮想障害物310と反対側に仮想障害物312を設定する。仮想障害物312は、車線区画線202上に設定してもよい。これにより、通常走行外領域270の領域を考慮せず、直前に走行していた道路幅にしたがって走行経路240が生成される。
Therefore, the virtual
(経路生成処理4)
図28に走行経路生成装置8が実行する経路生成処理4のフローチャートを示す。経路生成処理4は常時実行される。図28において「S」はステップを表わしている。図28のS480〜S486、S504〜S512は図11のS400〜S416と実質的に同一処理であるから説明を省略する。
(Route generation process 4)
FIG. 28 shows a flowchart of route generation processing 4 executed by the travel
S488において走行履歴記憶部26は、自車両が走行している走行可能領域において走行路の検出結果に車線区画線等の欠落があるか否かを、S480において取得した周囲情報に基づいて判定する。走行路の検出結果に欠落がない場合(S488:No)、走行履歴記憶部26は、走行路の検出結果を走行履歴情報として記憶し(S490)、S494に処理を移行する。
In S488, the travel
走行路の検出結果に欠落があると走行履歴記憶部26が判定すると(S488:Yes)、仮想障害物設定部22は、RAMに記憶されている走行路の欠落前の走行履歴情報を読み出して欠落部分を補う走行路情報を作成し(S492)、S494に処理を移行する。
When the travel
S494において走行履歴記憶部26は、自車両が走行している走行可能領域において、障害物の検出結果に欠落があるか否かを、S480において取得した周囲情報に基づいて判定する。障害物の検出結果に欠落がある場合(S494:Yes)、仮想障害物設定部22はS500に処理を移行する。
In S494, the travel
障害物の検出結果に欠落がない場合(S494:No)、走行履歴記憶部26は、障害物を検出するときにカメラおよびレーザ等の異常により誤検出の可能性があるか否かを判定する(S496)。障害物について誤検出の可能性がある場合(S496:Yes)、走行履歴記憶部26はS500に処理を移行する。
When there is no omission in the obstacle detection result (S494: No), the travel
障害物について誤検出の可能性がない場合(S496:No)、走行履歴記憶部26は障害物の検出結果を走行履歴情報として記憶し(S498)、S502に処理を移行する。
If there is no possibility of erroneous detection of the obstacle (S496: No), the travel
S500において仮想障害物設定部22は、RAMに記憶されている障害物の欠落前の走行履歴情報を読み出して欠落部分を補う障害物情報を作成し、S502に処理を移行する。
In S500, the virtual
S502において走行経路生成装置8は、走行路および障害物を含む走行可能領域の検出結果に欠落があった場合は欠落前の走行履歴情報によって欠落部分を補って走行可能領域を規定する。以下の処理は、前述したように図11のS408〜S416と実質的に同
一処理であるから説明を省略する。
In S <b> 502, when there is a lack in the detection result of the travelable area including the travel path and the obstacle, the travel
以上説明した第4実施形態では、自車両が走行した走行可能領域および走行軌跡の少なくともいずれか一方の走行履歴情報を記憶しておき、必要に応じて記憶されている走行履歴情報を読み出して走行可能領域または走行軌跡を規定する。これにより、記憶している走行履歴情報に基づいて適切な走行経路を生成できる。 In the fourth embodiment described above, the travel history information of at least one of the travelable region and the travel locus on which the host vehicle has traveled is stored, and the travel history information stored is read out as necessary. Define possible areas or travel trajectories. Thereby, an appropriate travel route can be generated based on the stored travel history information.
[第5実施形態]
図29に示す第5実施形態の走行経路生成装置150は、第1実施形態の走行経路生成装置2に対し、狭路判定部28が追加されている。それ以外の構成は第1実施形態と実質的に同一である。走行経路生成装置150は、自車両の進行方向の走行可能領域が狭路の場合の走行経路を生成する。
[Fifth Embodiment]
In the travel
(経路生成処理5)
図30に走行経路生成装置150が実行する経路生成処理5のフローチャートを示す。経路生成処理5は常時実行される。図30において「S」はステップを表わしている。図30のS520〜S528、S538は図11のS400〜408、S416と実質的に同一処理であるから説明を省略する。
(Route generation process 5)
FIG. 30 shows a flowchart of route generation processing 5 executed by the travel
S530において、狭路判定部28は、ナビゲーション装置の地図情報およびカメラの画像情報などに基づいて、自車両の進行方向の走行可能領域の走行路幅を算出する。そして、自車両の進行方向の走行可能領域が狭路であるか否かを判定する(S532)。狭路であるか否かの判定は、走行可能領域の走行路幅が所定範囲内であるか否かにより判定する。
In S530, the narrow
所定範囲の下限値は、自車両の車幅と狭路を通過するときの安全マージンとに基づいて設定された走行路幅の下限幅である。所定範囲の上限値は、この走行路幅を超えると仮想障害物を設定せずに生成された通常経路で自車両が通過できる値である。 The lower limit value of the predetermined range is a lower limit width of the traveling road width set based on the vehicle width of the host vehicle and a safety margin when passing through a narrow road. The upper limit value of the predetermined range is a value that allows the host vehicle to pass through a normal route that is generated without setting a virtual obstacle when the traveling road width is exceeded.
狭路であるか否かを判定するための所定範囲の下限値および上限値は、自車両の車幅等に基づいて予め固定値で設定されてもよいし、周囲情報に基づいた走行可能領域の危険度、ならびに走行情報に基づいた車速などに応じて適宜可変に設定してもよい。 The lower limit value and the upper limit value of the predetermined range for determining whether or not the road is a narrow road may be set in advance as a fixed value based on the vehicle width or the like of the host vehicle, or the travelable area based on surrounding information Depending on the risk level of the vehicle and the vehicle speed based on the travel information, it may be set to be variable as appropriate.
狭路ではない場合(S532:No)、狭路判定部28はS538に処理を移行する。この場合、仮想障害物を設定せずに走行経路が生成される。
狭路の場合(S532:Yes)、仮想障害物設定部22は、自車両が進入する進入路である狭路の手前に、走行箇所と、走行箇所の両側に仮想障害物とを設定し(S534、S536)、S538に処理を移行する。
When it is not a narrow road (S532: No), the narrow
In the case of a narrow road (S532: Yes), the virtual
図31に示すように、自車両100の進行方向の障害物220で区画された走行可能領域が狭路280である場合、例えばS534、S536において、仮想障害物設定部22は、自車両100にとって狭路280の手前に、狭路280の入口から少なくともL0の距離まで、狭路280の中心線282上に狭路280に沿って狭路280と平行に走行箇所300を設定する。L0は、自車両100の前端から後輪軸106の中央108までの長さである。
As illustrated in FIG. 31, when the travelable area defined by the
そして、仮想障害物設定部22は、自車両100にとって狭路280の手前に狭路280に沿って狭路280と平行に狭路280の入口から少なくともL0まで、走行箇所300の両側に走行箇所300から等しい距離に仮想障害物310、312を設定する。
The virtual
さらに、走行経路240が走行箇所300からずれずに走行箇所300上に狭路280に沿って狭路280と平行に生成されるように、仮想障害物310と仮想障害物312との間隔は、極力狭くなるように設定することが望ましい。図31では、仮想障害物310と仮想障害物312との間隔を、狭路280の幅よりも狭く自車両100の車幅よりも広くなるように設定しているが、車幅より狭くしてもよい。
Further, the interval between the
S538において経路生成部30は、図31に示すように走行箇所300および仮想障害物310、312が設定されている場合には、左右の障害物220の狭路280を区画する側にそれぞれ特徴点222、224を設定する。経路生成部30は、特徴点222と仮想障害物310を表わす特徴点310とを一つのクラスとし、特徴点224と仮想障害物312を表わす特徴点312とを別のクラスとし、これら特徴点222、310と特徴点224、312とを自車両100の進行方向に向かって左右両側の異なるクラスに分類するように走行経路240を生成する。
In S538, when the
これにより、自車両100の前端が狭路280の入口に達したときに、自車両100は狭路280に沿って平行に位置する。そして、後輪軸の中央108が走行経路240に一致するように自車両100を走行させれば、自車両100は左右の障害物220に接触することなく狭路280を通過できる。
Thus, when the front end of the
狭路280の走行路幅が広い場合には、図32に示すように、自車両100の進入方向を狭路280に対して斜めにしてもよい。この場合、狭路280の入口から最も離れた位置に設置する仮想障害物までの距離をXとすると、次式(1)を満たす距離Xまで中心線282上に狭路280に沿って狭路280と平行に走行箇所300を設定し、自車両100にとって狭路280の手前に狭路280に沿って狭路280と平行に距離Xまで、走行箇所300の両側に走行箇所300から等しい距離に仮想障害物310、312を設定する。
When the traveling road width of the
X>(L12−W2)1/2 ・・・(1)
仮想障害物310と仮想障害物312との間隔は、走行経路240が走行箇所300からずれずに走行箇所300上に狭路280に沿って狭路280と平行に生成されるように、極力狭くなるように設定することが望ましい。図32では、仮想障害物310と仮想障害物312との間隔を、狭路280の幅よりも狭く、自車両100の車幅よりも広くなるように設定しているが、車幅より狭くしてもよい。
X> (L1 2 −W 2 ) 1/2 (1)
The distance between the
式(1)において、L1は後輪軸106の中央108から自車両100の前方左角または前方右角までの長さを表わし、Wは狭路280の走行路幅の半分を表わしている。Wが(下限値/2)よりも大きい場合には、式(1)を満たす範囲でXを極力小さくすることにより、XをL0よりも短くすることができる。L1および前述したL0は、自車両の大きさを表わす車両定数である。
In Expression (1), L1 represents the length from the
これにより、Wが(下限値/2)よりも大きい場合には、図30よりも狭路280に近い位置から仮想障害物310、312に基づいて走行経路240が生成されるので、自車両100は大回りすることなく狭路280に進入できる。
Thereby, when W is larger than (lower limit value / 2), the
図32に示すように自車両100が狭路280の入口に斜めに進入しても、後輪軸106の中央108が走行経路240に一致するように自車両100を走行させれば、図32に示す状態から狭路280に進入しながら自車両100の向きを狭路280に沿って平行にすることにより、障害物220に接触せずに狭路280を安全に通過できる。
As shown in FIG. 32, even when the
図31、32では障害物220が狭路280を区画する例を図示したが、障害物220
以外に、例えば車線区画線で狭路280が規定されてもよい。
[比較例]
第5実施形態に対し、図33に示すように、狭路280の手前に仮想障害物310、312を設定しない比較例の場合、狭路280を区画する障害物220に特徴点222、224が設定されるだけである。この場合、自車両100が狭路280に進入してから自車両100の向きが狭路280に沿って修正されるので、狭路280を通過中に、自車両100が左右両側の障害物220のいずれかに接触することがある。
31 and 32, an example in which the
In addition, for example, the
[Comparative example]
In contrast to the fifth embodiment, as shown in FIG. 33, in the comparative example in which the
[第6実施形態]
図34に示す第6実施形態の走行経路生成装置160は、第1実施形態の走行経路生成装置2に対し、右左折判定部34が追加されている。それ以外の構成は第1実施形態と実質的に同一である。走行経路生成装置160は、自車両が右左折するときの走行経路を生成する。
[Sixth Embodiment]
In the travel
(経路生成処理6)
図35に走行経路生成装置160が実行する経路生成処理6のフローチャートを示す。経路生成処理6は常時実行される。図35において「S」はステップを表わしている。図35のS540〜S548、S556は図11のS400〜408、S416と実質的に同一処理であるから説明を省略する。
(Route generation process 6)
FIG. 35 shows a flowchart of the
S550において、右左折判定部34は、自車両が右左折するか否かを判定する。この判定は、自車両の進行方向に右折路または左折路が存在し、自車両が右折路または左折路に進入するか否かに基づいて判定される。
In S550, the right / left
右折路または左折路の存在は、例えば、ナビゲーション装置の地図情報およびカメラの画像情報などに基づいて判定される。右折路または左折路に進入するか否かは、例えば、ナビゲーション装置からの経路情報、ならびにドライバのステリング操作、ウインカーの点灯などに基づいて判定される。 The presence of the right turn road or the left turn road is determined based on, for example, map information of the navigation device and image information of the camera. Whether to enter a right turn road or a left turn road is determined based on, for example, route information from the navigation device, a driver's steering operation, turn-on of a blinker, and the like.
右左折しない場合(S550:No)、右左折判定部34はS556に処理を移行する。この場合、仮想障害物を設定せずに走行経路が生成される。
右左折する場合(S550:Yes)、仮想障害物設定部22は、右左折する進入路の手前に走行箇所と、走行箇所の両側に仮想障害物を設定し(S552、S554)、S556に処理を移行する。
If the vehicle does not turn right or left (S550: No), the right / left
When making a right or left turn (S550: Yes), the virtual
図36に示すように、自車両100が左折する場合、S552、S554において、仮想障害物設定部22は、自車両100にとって進入路290の手前に、例えば進入路290の入口から少なくともL0まで、進入路290の中心線292上に進入路290に沿って進入路290と平行に走行箇所300を設定する。L0は、前述したように自車両100の前端から後輪軸106の中央108までの長さである。
As shown in FIG. 36, when the
そして、仮想障害物設定部22は、自車両100にとって進入路290の手前に進入路290に沿って進入路290と平行に進入路290の入口から少なくとも長さL0まで、走行箇所300の両側に走行箇所300から等しい距離に仮想障害物310、312を設定する。
Then, the virtual
仮想障害物310と仮想障害物312との間隔は、走行経路240が走行箇所300からずれずに走行箇所300上に進入路290に沿って進入路290と平行に生成されるように、極力狭くなるように設定することが望ましい。図36では、仮想障害物310と仮想障害物312との間隔を、進入路290の幅よりも狭く、自車両100の車幅よりも広
くなるように設定しているが、車幅より狭くしてもよい。
The interval between the
S556において経路生成部30は、左折する手前の左右の障害物220、ならびに進入路290を区画する左右の障害物220の道路側に、それぞれ特徴点222、224を設定する。経路生成部30は、特徴点222と仮想障害物310を表わす特徴点310とを一つのクラスとし、特徴点224と仮想障害物312を表わす特徴点312とを別のクラスとし、これら特徴点222、310と特徴点224、312とを自車両100の進行方向に向かって左右両側の異なるクラスに分類するように走行経路240を生成する。
In S556, the
これにより、自車両100の前端が左折する進入路290の入口に達したときに、自車両100の向きを進入路290に沿って極力平行にすることができる。そして、走行経路240に一致するように自車両100を走行させれば、自車両100は左右の障害物220に接触することなく進入路290に進入して安全に走行できる。
Thereby, when the front end of the
図36では障害物220が進入路290を区画する例を図示したが、障害物220以外に、例えば車線区画線で進入路が規定されてもよい。
[他の実施形態]
走行経路を生成する識別器として、上記実施形態で説明したSVM以外にも、パーセプトロン、ニューラルネットワークを用いてもよい。
36 shows an example in which the
[Other Embodiments]
In addition to the SVM described in the above embodiment, a perceptron or a neural network may be used as an identifier for generating a travel route.
上記実施形態では、GPS装置などの衛星測位装置から自車両の位置を取得した。これ以外にも、周囲情報取得部10が取得する周囲情報として、例えば実際の建物、横断歩道、信号等の情報と地図DBが示す情報とを照合して自車両の位置を取得してもよい。
In the above embodiment, the position of the host vehicle is acquired from a satellite positioning device such as a GPS device. In addition to this, as the surrounding information acquired by the surrounding
また、走行可能領域検出部20は、車線変更、合流、分流等の運転者の操作に基づいて、道路の区画線を跨ぐ走行可能領域の形状を認識してもよい。
本発明は、生成された走行経路に基づいて自動運転する車両に適用すると、通常経路から外れても適切な走行経路を車両が生成するので効果的である。
Further, the travelable
The present invention is effective when applied to a vehicle that automatically drives based on the generated travel route, because the vehicle generates an appropriate travel route even if the vehicle deviates from the normal route.
第5実施形態および第6実施形態では、狭路280および進入路290の手前に狭路280および進入路290に沿ってそれぞれ走行箇所300と仮想障害物310、312とを複数設置した。これに対し、走行箇所300と仮想障害物310、312とを1個だけ設置してもよい。また、第5実施形態および第6実施形態において、走行箇所300と仮想障害物310、312とを直線上ではなく曲線上に設置し、狭路280または進入路290に進入するときに曲線の走行経路240を生成してもよい。
In the fifth embodiment and the sixth embodiment, a plurality of traveling
また、第5実施形態における狭路280は、自車両100の進行方向の走行可能領域の走行路幅が所定範囲であれば道路に限るものではなく、駐車エリア等であってもよい。
このように、本発明は、上記実施形態に限定されるものではなく、その要旨を逸脱しない範囲で種々の実施形態に適用可能である。例えば、第2実施形態、第3実施形態、第5実施形態、第6実施形態の走行経路生成装置4、6、150、160が第4実施形態の走行履歴記憶部26を備える構成でもよい。
Further, the
As described above, the present invention is not limited to the above-described embodiment, and can be applied to various embodiments without departing from the gist thereof. For example, the travel
2、4、6、8、150、160:走行経路生成装置、10:周囲情報取得部(周囲情報取得手段)、12:走行情報取得部(走行情報取得手段)、14:目的地点設定部(仮想障害物設定手段)、20:走行可能領域検出部(走行可能領域検出手段)、22:仮想障害物設定部(仮想障害物設定手段)、24:車速設定部(車速設定手段)、26:走行履歴記憶部(履歴記憶手段)、28:狭路判定部(狭路判定手段)、30:経路生成部(経路生成手段、特徴点設定手段、識別面生成手段)、32:経路修正部(経路生成手段)
、34:右左折判定部(右左折判定手段)、100:自車両、106:後輪軸、108:中央、110:走行領域、210、212、222、224、310、312:特徴点、230:通常経路、232、240:走行経路、234:走行軌跡、250:識別面、280:狭路(進入路)、290:進入路、300:走行箇所、310、312:仮想障害物、320:回避箇所、330:目的地点
2, 4, 6, 8, 150, 160: travel route generation device, 10: surrounding information acquisition unit (ambient information acquisition means), 12: travel information acquisition unit (travel information acquisition means), 14: destination point setting unit ( Virtual obstacle setting means), 20: travelable area detection unit (travelable area detection means), 22: virtual obstacle setting unit (virtual obstacle setting means), 24: vehicle speed setting unit (vehicle speed setting means), 26: Travel history storage unit (history storage unit), 28: Narrow road determination unit (narrow road determination unit), 30: Route generation unit (route generation unit, feature point setting unit, identification plane generation unit), 32: Route correction unit ( Route generation means)
, 34: right / left turn determination unit (right / left turn determination means), 100: own vehicle, 106: rear wheel axle, 108: center, 110: travel area, 210, 212, 222, 224, 310, 312: feature points, 230: Normal route, 232, 240: Travel route, 234: Travel track, 250: Identification plane, 280: Narrow road (entrance route), 290: Approach route, 300: Travel location, 310, 312: Virtual obstacle, 320: Avoidance Location, 330: destination point
Claims (21)
前記自車両の走行情報を取得する走行情報取得手段(12、S408、S428、S458、S504)と、
前記周囲情報取得手段が取得する前記周囲情報に基づいて前記自車両が走行できる走行可能領域を検出する走行可能領域検出手段(20、S406、S426、S456、S486)と、
前記走行可能領域検出手段が検出する前記走行可能領域に基づいて設定される通常経路(230)から外れて前記自車両が走行するときに、前記走行情報取得手段が前記走行情報として取得する前記自車両の進行方向に基づいて前記自車両の走行箇所(300)の両側に仮想障害物(310、312)を設定する仮想障害物設定手段(22、S412、S414、S432、S434、S468、S470、S474、S508、S510)と、
前記仮想障害物設定手段が前記走行箇所の両側に設定した前記仮想障害物の間を通る走行経路(240)を生成する経路生成手段(30、S416、S440、S478、S512)と、を備えることを特徴とする走行経路生成装置(2、4、6、8、150、160)。 Surrounding information acquisition means (10, S400, S420, S450, S480) for acquiring surrounding information of the host vehicle (100);
Travel information acquisition means (12, S408, S428, S458, S504) for acquiring the travel information of the host vehicle;
A travelable area detection means (20, S406, S426, S456, S486) for detecting a travelable area in which the host vehicle can travel based on the ambient information acquired by the ambient information acquisition means;
When the vehicle travels outside the normal route (230) set based on the travelable area detected by the travelable area detection means, the travel information acquisition means acquires the travel information as the travel information. Virtual obstacle setting means (22, S412, S414, S432, S434, S468, S470) for setting virtual obstacles (310, 312) on both sides of the travel location (300) of the host vehicle based on the traveling direction of the vehicle. S474, S508, S510),
Route generating means (30, S416, S440, S478, S512) for generating a travel route (240) passing between the virtual obstacles set on both sides of the travel location by the virtual obstacle setting means. A travel route generating device (2, 4, 6, 8, 150, 160) characterized by
前記目的地点における前記自車両の車速を設定する車速設定手段(24、S476)を備え、
前記経路生成手段(32)は、前記自車両が前記目的地点を停止点とする場合は前記目的地点の先に生成した前記走行経路を削除し、前記自車両が前記目的地点を通過点とする場合は前記目的地点よりも先に生成した前記走行経路を修正する、
ことを特徴とする請求項1から3のいずれか一項に記載の走行経路生成装置。 The virtual obstacle setting means (S474) uses the destination point (330) of the host vehicle as the travel location,
Vehicle speed setting means (24, S476) for setting the vehicle speed of the host vehicle at the destination point;
The route generation means (32) deletes the travel route generated before the destination point when the host vehicle uses the destination point as a stop point, and the host vehicle uses the destination point as a passing point. In the case of correcting the travel route generated before the destination point,
The travel route generation device according to any one of claims 1 to 3, wherein
前記仮想障害物設定手段は、前記記憶部に前記走行履歴情報として前記走行可能領域が記憶されている場合には、記憶されている前記走行履歴情報に基づいて前記仮想障害物を設定することにより前記自車両が走行した前記走行可能領域を規定し、前記記憶部に前記走行履歴情報として前記走行軌跡が記憶されている場合には、記憶されている前記走行軌跡上の1個以上の点の両側に前記仮想障害物を設定する、
ことを特徴とする請求項1から4のいずれか一項に記載の走行経路生成装置。 History storage means (26, S490, S498) for storing in the storage unit at least one of the travelable area traveled by the host vehicle and the travel locus (234) traveled by the host vehicle as travel history information,
The virtual obstacle setting means sets the virtual obstacle based on the stored travel history information when the travelable area is stored as the travel history information in the storage unit. When the travelable area in which the host vehicle has traveled is defined and the travel locus is stored as the travel history information in the storage unit, one or more points on the travel locus stored are stored. Set the virtual obstacles on both sides,
The travel route generation device according to any one of claims 1 to 4, wherein
前記仮想障害物設定手段は、前記自車両が右折または左折すると前記右左折判定手段が判定すると、右折または左折して進入する前記走行可能領域を進入路(290)とし、前記進入路の手前に前記走行箇所を設置し、前記走行箇所の両側に前記仮想障害物を設定する、
ことを特徴とする請求項1から12のいずれか一項に記載の走行経路生成装置。 Based on the surrounding information and the travel information, the vehicle includes right / left turn determination means (34) for determining whether or not the vehicle turns right or left.
When the vehicle turns right or left, the virtual obstacle setting means sets the travelable area to be entered by making a right or left turn as an approach path (290) and before the approach path. Installing the travel location and setting the virtual obstacle on both sides of the travel location;
The travel route generation device according to any one of claims 1 to 12, wherein
前記仮想障害物設定手段は、前記走行可能領域が狭路(280)であると前記狭路判定手段が判定すると、進入路である前記狭路の手前に前記走行箇所を設置し、前記走行箇所の両側に前記仮想障害物を設定する、
ことを特徴とする請求項1から13のいずれか一項に記載の走行経路生成装置。 Narrow road determination means (28) for determining whether or not the travelable area where the host vehicle enters is a narrow road,
The virtual obstacle setting means, when the narrow road determining means determines that the travelable area is a narrow road (280), installs the travel spot before the narrow road that is an approach road, and the travel spot Set the virtual obstacles on both sides of the
The travel route generation device according to any one of claims 1 to 13, wherein
狭路の入口から、X>(L2−W2)1/2を満たす距離Xまで、前記狭路の手前に前記狭路に沿って前記仮想障害物を設定することを特徴とする請求項14から16のいずれか一項に記載の走行経路生成装置。 Half of the width of the narrow road is W, the length from the center (108) of the rear wheel shaft (106) of the host vehicle to the front left corner or the front right corner of the host vehicle is L, from the entrance of the narrow street Assuming that the distance to the virtual obstacle installed at the farthest position is X, the virtual obstacle setting means is a distance X satisfying X> (L 2 −W 2 ) 1/2 from the entrance of the narrow path. The travel route generation device according to any one of claims 14 to 16, wherein the virtual obstacle is set along the narrow road before the narrow road.
前記走行可能領域の境界を表わす点と、前記仮想障害物を表わす点とを特徴点(210、212、222、224、310、312)として設定する特徴点設定手段と、
前記特徴点設定手段が設定する前記特徴点を前記自車両の進行方向に対し両側に分類する識別面(250)であって、前記識別面に最も近い前記特徴点との距離が最大になる前記識別面を生成する識別面生成手段と、
を有し、
前記経路生成手段は、前記識別面生成手段が生成する前記識別面を前記走行経路とする、
ことを特徴とする請求項1から19のいずれか一項に記載の走行経路生成装置。 The route generation means includes
Feature point setting means for setting a point representing the boundary of the travelable area and a point representing the virtual obstacle as feature points (210, 212, 222, 224, 310, 312);
An identification surface (250) for classifying the feature points set by the feature point setting means on both sides with respect to the traveling direction of the host vehicle, wherein the distance from the feature point closest to the identification surface is maximized. An identification surface generating means for generating an identification surface;
Have
The route generation means uses the identification surface generated by the identification surface generation means as the travel route.
The travel route generation device according to any one of claims 1 to 19, wherein
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP2014083012A JP6301713B2 (en) | 2013-08-12 | 2014-04-14 | Travel route generator |
Applications Claiming Priority (3)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP2013167546 | 2013-08-12 | ||
JP2013167546 | 2013-08-12 | ||
JP2014083012A JP6301713B2 (en) | 2013-08-12 | 2014-04-14 | Travel route generator |
Publications (2)
Publication Number | Publication Date |
---|---|
JP2015057688A JP2015057688A (en) | 2015-03-26 |
JP6301713B2 true JP6301713B2 (en) | 2018-03-28 |
Family
ID=52815757
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
JP2014083012A Active JP6301713B2 (en) | 2013-08-12 | 2014-04-14 | Travel route generator |
Country Status (1)
Country | Link |
---|---|
JP (1) | JP6301713B2 (en) |
Families Citing this family (22)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP6209287B2 (en) * | 2014-09-16 | 2017-10-04 | 本田技研工業株式会社 | Driving assistance device |
JP6446732B2 (en) * | 2015-08-06 | 2019-01-09 | 本田技研工業株式会社 | Vehicle control device, vehicle control method, and vehicle control program |
JP6512084B2 (en) * | 2015-12-04 | 2019-05-15 | 株式会社デンソー | Travel locus generation device, travel locus generation method |
JP6558238B2 (en) * | 2015-12-22 | 2019-08-14 | アイシン・エィ・ダブリュ株式会社 | Automatic driving support system, automatic driving support method, and computer program |
JP2017134520A (en) | 2016-01-26 | 2017-08-03 | トヨタ自動車株式会社 | Vehicle collision avoidance support system |
JP6330825B2 (en) | 2016-01-26 | 2018-05-30 | トヨタ自動車株式会社 | Vehicle collision avoidance support system |
JP6361666B2 (en) | 2016-01-26 | 2018-07-25 | トヨタ自動車株式会社 | Vehicle collision avoidance support system |
CN108778882B (en) * | 2016-03-15 | 2021-07-23 | 本田技研工业株式会社 | Vehicle control device, vehicle control method, and storage medium |
JP6827285B2 (en) * | 2016-09-05 | 2021-02-10 | 日産自動車株式会社 | Parking support method and parking support device |
US9989964B2 (en) * | 2016-11-03 | 2018-06-05 | Mitsubishi Electric Research Laboratories, Inc. | System and method for controlling vehicle using neural network |
JP2018092334A (en) * | 2016-12-01 | 2018-06-14 | 本田技研工業株式会社 | Travel control apparatus |
JP7132713B2 (en) | 2017-12-28 | 2022-09-07 | 株式会社Soken | Vehicle cruise control device, vehicle cruise control system, and vehicle cruise control method |
JP6359233B1 (en) * | 2018-01-17 | 2018-07-18 | 三菱電機株式会社 | Vehicle guidance device and vehicle guidance method |
JP7203514B2 (en) * | 2018-05-31 | 2023-01-13 | 株式会社デンソーテン | Driving area determination device, driving area determination method, and road surface image machine learning model generation method |
KR20210134853A (en) * | 2018-09-28 | 2021-11-10 | 바이두닷컴 타임즈 테크놀로지(베이징) 컴퍼니 리미티드 | Tunnel-based planning system used in autonomous vehicles |
JP7169892B2 (en) * | 2019-01-30 | 2022-11-11 | 日産自動車株式会社 | Driving support method and driving support device |
WO2020249995A1 (en) * | 2019-06-14 | 2020-12-17 | 日産自動車株式会社 | Travel assistance method and travel assistance device |
JP7121714B2 (en) * | 2019-09-17 | 2022-08-18 | 本田技研工業株式会社 | vehicle control system |
JP7464425B2 (en) * | 2020-03-31 | 2024-04-09 | 本田技研工業株式会社 | Vehicle control device, vehicle control method, and program |
KR102382119B1 (en) * | 2020-08-05 | 2022-04-04 | 한양대학교 에리카산학협력단 | System of avoiding dangerous situations for self driving cars |
CN118019675A (en) | 2021-09-23 | 2024-05-10 | 日产自动车株式会社 | Driving support method and driving support device |
CN116279596B (en) * | 2023-05-26 | 2023-08-04 | 禾多科技(北京)有限公司 | Vehicle control method, apparatus, electronic device, and computer-readable medium |
Family Cites Families (17)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP3289565B2 (en) * | 1995-08-23 | 2002-06-10 | トヨタ自動車株式会社 | Automatic steering system |
JP3917241B2 (en) * | 1997-06-25 | 2007-05-23 | 富士重工業株式会社 | Vehicle driving support device |
JP2002229645A (en) * | 2001-01-31 | 2002-08-16 | Shin Kobe Electric Mach Co Ltd | Control method for automatic traveling vehicle |
JP4657495B2 (en) * | 2001-05-29 | 2011-03-23 | 富士重工業株式会社 | Vehicle driving support device |
JP4059033B2 (en) * | 2002-08-12 | 2008-03-12 | 日産自動車株式会社 | Travel route generator |
US7016783B2 (en) * | 2003-03-28 | 2006-03-21 | Delphi Technologies, Inc. | Collision avoidance with active steering and braking |
JP4604683B2 (en) * | 2004-11-25 | 2011-01-05 | 日産自動車株式会社 | Hazardous situation warning device |
JP5272448B2 (en) * | 2008-03-04 | 2013-08-28 | 日産自動車株式会社 | Vehicle driving support apparatus and vehicle driving support method |
JP5467190B2 (en) * | 2008-06-17 | 2014-04-09 | 日産自動車株式会社 | Vehicle obstacle avoidance support apparatus and vehicle obstacle avoidance support method |
JP5374959B2 (en) * | 2008-08-08 | 2013-12-25 | 日産自動車株式会社 | Vehicle travel support device |
JP5426427B2 (en) * | 2010-02-19 | 2014-02-26 | 日立オートモティブシステムズ株式会社 | Driving support device |
JP2012081905A (en) * | 2010-10-13 | 2012-04-26 | Equos Research Co Ltd | Travel control device |
JP5782708B2 (en) * | 2010-12-03 | 2015-09-24 | 日産自動車株式会社 | Driving support device |
JP5699670B2 (en) * | 2011-02-18 | 2015-04-15 | 日産自動車株式会社 | Travel route generation device and travel route generation method |
JP2012214124A (en) * | 2011-03-31 | 2012-11-08 | Equos Research Co Ltd | Vehicle and vehicular control program |
JP5541217B2 (en) * | 2011-03-31 | 2014-07-09 | 株式会社エクォス・リサーチ | Vehicle and vehicle control program |
DE102013217430A1 (en) * | 2012-09-04 | 2014-03-06 | Magna Electronics, Inc. | Driver assistance system for a motor vehicle |
-
2014
- 2014-04-14 JP JP2014083012A patent/JP6301713B2/en active Active
Also Published As
Publication number | Publication date |
---|---|
JP2015057688A (en) | 2015-03-26 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
JP6301713B2 (en) | Travel route generator | |
JP6642334B2 (en) | Vehicle control device | |
KR102029562B1 (en) | Target path generation device and travel control device | |
US11260859B2 (en) | Vehicle control system, vehicle control method, and storage medium | |
JP4933962B2 (en) | Branch entry judgment device | |
JP6548129B2 (en) | Vehicle control system, vehicle control method, and program | |
JP6460580B2 (en) | Driving support control device | |
JP7373914B2 (en) | Vehicle and its control method | |
US20200180618A1 (en) | Vehicle control device | |
KR20170118501A (en) | Driving path planning apparatus and method for autonomous vehicles | |
JP6301714B2 (en) | Travel route generator | |
JP6629897B2 (en) | Vehicle control device | |
JP2019147436A (en) | Vehicle control device, vehicle control method, and program | |
US11370489B2 (en) | Vehicle and method for steering avoidance control | |
JP2024019638A (en) | Vehicle control device, vehicle control method, and vehicle control system | |
JP7226544B2 (en) | VEHICLE TRIP CONTROL METHOD AND TRIP CONTROL DEVICE | |
JP2021041754A (en) | Operation control method and operation control apparatus | |
JP6376520B2 (en) | Vehicle control device | |
JP7532242B2 (en) | Driving support method and driving support device | |
JP2021109576A (en) | Travel assistance method and travel assistance device for vehicle | |
JP2020163968A (en) | Vehicle drive assisting system | |
WO2023047148A1 (en) | Travel assistance method and travel assistance device | |
JP7508270B2 (en) | Vehicle driving support method and driving support device | |
WO2022123278A1 (en) | Travel assistance method and travel assistance device | |
JP2021187366A (en) | Automatic operation control method and automatic operation system |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
A521 | Request for written amendment filed |
Free format text: JAPANESE INTERMEDIATE CODE: A523 Effective date: 20150427 |
|
A621 | Written request for application examination |
Free format text: JAPANESE INTERMEDIATE CODE: A621 Effective date: 20160705 |
|
A977 | Report on retrieval |
Free format text: JAPANESE INTERMEDIATE CODE: A971007 Effective date: 20170419 |
|
A131 | Notification of reasons for refusal |
Free format text: JAPANESE INTERMEDIATE CODE: A131 Effective date: 20170606 |
|
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: 20180206 |
|
A61 | First payment of annual fees (during grant procedure) |
Free format text: JAPANESE INTERMEDIATE CODE: A61 Effective date: 20180301 |
|
R150 | Certificate of patent or registration of utility model |
Ref document number: 6301713 Country of ref document: JP Free format text: JAPANESE INTERMEDIATE CODE: R150 |
|
R250 | Receipt of annual fees |
Free format text: JAPANESE INTERMEDIATE CODE: R250 |
|
R250 | Receipt of annual fees |
Free format text: JAPANESE INTERMEDIATE CODE: R250 |
|
R250 | Receipt of annual fees |
Free format text: JAPANESE INTERMEDIATE CODE: R250 |
|
R250 | Receipt of annual fees |
Free format text: JAPANESE INTERMEDIATE CODE: R250 |