以下、本発明の実施形態を図面に基づいて説明する。本実施形態では、本発明に係る車両の走行制御装置を、車両に搭載された走行制御システムに適用した場合を例にして説明する。本発明の走行制御装置の実施の形態は限定されず、車両側と情報の授受が可能な携帯端末装置に適用することもできる。走行制御装置、走行制御システム、及び携帯端末装置は、いずれも演算処理を実行するコンピュータである。
図1は、走行制御システム1のブロック構成を示す図である。本実施形態の走行制御システム1は、車両に搭載され、走行制御装置100と車載装置200とを備える。
本実施形態の走行制御装置100は、自車両が走行している車線を認識し、車線のレーンマーカの位置と自車両の位置とが所定の関係を維持するように、自車両の動きを制御する車線逸脱防止機能(レーンキープサポート機能)を備える。本実施形態の走行制御装置100は車線の中央を自車両が走行するように、自車両の動きを制御する。走行制御装置100は、車線のレーンマーカから自車両までの路幅方向に沿う距離が所定値域となるように、自車両の動きを制御してもよい。
なお、本実施形態におけるレーンマーカは、レーンを規定する機能を有するものであれば限定されず、路面に描かれた線図であってもよいし、レーンの間に存在する植栽であってもよいし、レーンの路肩側に存在するガードレール、縁石、歩道、二輪車専用道路などの道路構造物であってもよい。また、レーンの路肩側に存在する看板、標識、店舗、街路樹などの不動の物体であってもよい。これらのレーンマーカの検出手法は限定されず、本願出願時に知られたパターンマッチングなどの各種の手法を用いることができる。
本実施形態の走行制御装置100は通信装置20を有し、車載装置200は通信装置40を有し、両装置は有線通信又は無線通信により互いに情報の授受を行う。
まず、車載装置200について説明する。
本実施形態の車載装置200は、検出装置50と、センサ60と、車両コントローラ70と、駆動装置80と、操舵装置90と、出力装置110と、ナビゲーション装置120とを備える。車載装置200を構成する各装置は、相互に情報の授受を行うためにCAN(Controller Area Network)その他の車載LANによって接続されている。
以下、車載装置200を構成する各装置についてそれぞれ説明する。
検出装置50は、車両が回避するべき回避対象の存在及びその存在位置を検出する。特に限定されないが、本実施形態の検出装置50はカメラ51を含む。本実施形態のカメラ51は、例えばCCD等の撮像素子を備えるカメラである。カメラ51は自車両の所定の位置に設置され、自車両の周囲を撮像し、自車両の周囲に存在する回避対象を含む画像データを取得する。
検出装置50は、取得した画像データを処理し、自車両に対する回避対象の位置に基づいて、自車両から回避対象までの距離を算出する、検出装置50は、回避対象の位置の経時的な変化から自車両と回避対象の相対速度、自車両と回避対象の相対加速度を対象情報として算出する。画像データに基づく自車両と他車両との位置関係の導出処理、その経時的な変化量に基づく速度情報の導出処理については、本願出願時に知られている手法を適宜に用いることができる。
また、検出装置50は、画像データを解析し、その解析結果に基づいて回避対象の種別を識別してもよい。検出装置50は、パターンマッチング技術などを用いて、画像データに含まれる回避対象が、車両であるか、歩行者であるか、標識であるか否かを識別する。検出装置50は、画像データから対象物の像を抽出し、その像の大きさや形状から対象物の具体的な種別(四輪車、二輪車、バス、トラック、工事車両など)や、車種(小型車、大型車)を識別できる。さらに、検出装置50は、画像データに含まれるナンバープレートに表記された識別子から、その車両の種別、車種を識別できる。回避対象の各種別と大きさは予め対応づけ、その情報を参照して回避対象の大きさを求めてもよい。これら種別の識別情報、回避対象の大きさの情報は、対象領域の設定処理において用いることができる。
なお、本実施形態の検出装置50はレーダー装置52を用いてもよい。レーダー装置52としては、ミリ波レーダー、レーザーレーダー、超音波レーダーなどの出願時に知られた方式のものを用いることができる。
回避対象の位置を含む対象情報は、走行制御装置100側へ送出される。検出装置50は、回避対象の位置の変化から求めた回避対象の速度情報、加速度情報、回避対象の種別情報、回避対象が車両である場合には車種などの情報を対象情報に含めて、走行制御装置100側へ送出してもよい。
本実施形態における「回避対象」は、自車両が避けて走行するべき対象である。つまり、自車両は、回避対象に接近しすぎない状態を維持して走行する。検出装置50は、自車両と所定の位置関係を有する対象を回避対象として検出する。検出装置50は、自車両の走行レーン上に存在し、自車両の走行方向前方に存在する物体等であって、自車両から所定距離以内に存在するものを回避対象として検出する。
本実施形態の回避対象は、静止物と移動物を含む。静止している回避対象としては、駐車中の他車両、停車中の他車両、歩道,中央分離帯,ガードレールなどの道路構造物、標識,電柱などの道路設置物、落下物や除雪された雪などの道路の載置物など、車両の走行の障害となる物体が含まれる。移動する回避対象としては、他車両、歩行者が含まれる。他車両としては、自車両の前方を走行する他車両、自車両の前方側方を走行する他車両、後方を走行する他車両、後方側方を走行する他車両、自車両の進行方向からその自車両に接近する他車両(対向車両)が含まれる。車両としては、自転車、バイクなどの二輪車、バス,トラックなどの大型車両、トレーラ、クレーン車などの特殊車両が含まれる。さらに、回避対象としては、工事現場、路面の損傷エリア、水溜りなど、物体が存在しないものの自車両が回避すべき対象を含む。
本実施形態のセンサ60は、操舵角センサ61、車速センサ62を備える。操舵角センサ61は、自車両の操舵量、操舵速度、操舵加速度などの操舵に関する操舵情報を検出し、車両コントローラ70、走行制御装置100へ送出する。車速センサ62は、自車両の車速、加速度を検出し、車両コントローラ70、走行制御装置100へ送出する。
本実施形態の車両コントローラ70は、エンジンコントロールユニット(Engine Control Unit, ECU)などの車載コンピュータであり、車両の運転状態を電子的に制御する。本実施形態の車両としては、電動モータを走行駆動源として備える電気自動車、内燃機関を走行駆動源として備えるエンジン自動車、電動モータ及び内燃機関の両方を走行駆動源として備えるハイブリッド自動車を例示できる。なお、電動モータを走行駆動源とする電気自動車やハイブリッド自動車には、二次電池を電動モータの電源とするタイプや燃料電池を電動モータの電源とするタイプのものも含まれる。
本実施形態の駆動装置80は、自車両Vの駆動機構を備える。駆動機構には、上述した走行駆動源である電動モータ及び/又は内燃機関、これら走行駆動源からの出力を駆動輪に伝達するドライブシャフトや自動変速機を含む動力伝達装置、及び車輪を制動する制動装置81などが含まれる。駆動装置80は、運転者のアクセル操作及びブレーキ操作による入力信号、車両コントローラ70又は走行制御装置100から取得した制御信号に基づいてこれら駆動機構の各制御信号を生成し、車両の加減速を含む走行制御を実行する。駆動装置80に制御情報を送出することにより、車両の加減速を含む走行制御を自動的に行うことができる。なお、ハイブリッド自動車の場合には、車両の走行状態に応じた電動モータと内燃機関とのそれぞれに出力するトルク配分も駆動装置80に送出される。
本実施形態の操舵装置90は、ステアリングアクチュエータを備える。ステアリングアクチュエータは、ステアリングのコラムシャフトに取り付けられるモータ等を含む。操舵装置90は、車両コントローラ70から取得した制御信号、又は運転者のステアリング操作により入力信号に基づいて車両の転回制御を実行する。車両コントローラ70は、操舵量を含む制御情報を操舵装置90に送出することにより、転回制御を実行する。また、走行制御装置100は、車両の各輪の制動量をコントロールすることにより転回制御を実行してもよい。この場合、車両コントローラ70は、各輪の制動量を含む制御情報を制動装置81へ送出することにより、車両の転回制御を実行する。
本実施形態のナビゲーション装置120は、自車両の現在位置から目的地までの経路を設定し、後述する出力装置110を介して経路案内情報を出力する。ナビゲーション装置120は、位置検出装置121と、道路種別、道路幅、道路形状その他の道路情報122と、道路情報122が各地点に対応づけられた地図情報123とを有する。本実施形態の位置検出装置121は、グローバル・ポジショニング・システム(Global Positioning System, GPS)を備え、走行中の車両の走行位置(緯度・経度)を検出する。ナビゲーション装置120は、位置検出装置121により検出された自車両の現在位置に基づいて、自車両が走行する道路リンクを特定する。本実施形態の道路情報122は、各道路リンクの識別情報ごとに、道路種別、道路幅、道路形状、追い越しの可否(隣接レーンへの進入の可否)その他の道路に関する情報を対応づけて記憶する。そして、ナビゲーション装置120は、道路情報122を参照し、自車両が走行する道路リンクが属する道路に関する情報を取得し、走行制御装置100へ送出する。自車両が走行する道路種別、道路幅、道路形状は、走行制御処理において、自車両が走行する目標経路RTの算出に用いられる。なお、本実施形態における目標経路RTは、自車両V1が将来通過する一つ又は複数の地点の特定情報(座標情報)を含む。本実施形態の目標経路RTは、自車両V1の次の走行位置を示唆する一つの点を少なくとも含む。目標経路RTは、連続した線により構成されてもよいし、離散的な点により構成されてもよい。
本実施形態の出力装置110は、走行支援に関する各種の情報をユーザ又は周囲の車両の乗員に向けて出力する。本実施形態において、出力装置110は、対象情報に応じた情報、対象領域の位置に応じた情報、目標経路の位置に応じた情報、及び目標経路上を自車両に走行させる制御情報に応じる情報のうち、何れか一つ以上を出力する。本実施形態の出力装置110は、ディスプレイ111、スピーカ112、車室外ランプ113、車室内ランプ114を含む。車室外ランプ113は、ヘッドライト、ウィンカランプ、ブレーキランプを含む。車室内ランプ114は、インジケータの点灯表示、ディスプレイ111の点灯表示、その他ステアリングに設けられたランプや、ステアリング周囲に設置されたランプを含む。また、本実施形態の出力装置110は、通信装置40を介して、高度道路交通システム(Intelligent Transport Systems:ITS)などの外部装置に走行支援に関する各種の情報を出力してもよい。高度道路交通システムなどの外部装置は、車両の速度、操舵情報、走行経路などを含む走行支援に関する情報を、複数の車両の交通管理に用いる。
情報の具体的な出力態様を、自車両の左側前方に回避対象としての駐車車両が存在する場合を例にして説明する。
出力装置110は、対象情報に応じた情報として、駐車車両が存在する方向や位置を自車両の乗員に提供する。ディスプレイ111は、駐車車両が存在する方向や位置を視認可能な態様で表示する。スピーカ112は「左側前方に駐車車両が存在します」といった駐車車両が存在する方向や位置を伝えるテキストを発話出力する。車室外ランプ113である左右のドアミラーに設けられたランプのうち、左側のランプのみを点滅させて、左側前方に駐車車両が存在することを自車両の乗員に知らせてもよい。車室内ランプ114であるステアリング近傍の左右に設けられたランプのうち、左側のランプのみを点滅させて、左側前方に駐車車両が存在することを乗員に知らせてもよい。
また、対象領域の位置に応じた情報として、対象領域の設定方向や設定位置を、出力装置110を介して出力してもよい。先述したように、対象領域が左側前方に設定されたことを、ディスプレイ111、スピーカ112、車室外ランプ113、車室内ランプ114により乗員に知らせることができる。
本実施形態では、自車両の動きを他車両の乗員に予め知らせる観点から、対象領域の設定方向や設定位置を、車室外ランプ113を用いて外部に出力する。対象領域が設定されると、これを回避するために自車両の進行方向が変更され、転回操作(操舵操作を含む、以下同じ)が行われる。対象領域が設定されたことを外部に知らせることにより、対象領域を回避するために自車両の進行方向が変化することを、予め、他車両のドライバに予告できる。例えば、対象領域が左側前方に設定されたときに、右側のウィンカランプ(車室外ランプ113)を点灯させることにより、左側に存在する回避対象の側方を通り過ぎるために自車両が右側に移動することを外部の他車両等に知らせることができる。
さらに、目標経路の位置に応じた情報として、目標経路の形状や曲点の位置をディスプレイ111、スピーカ112により乗員に知らせることができる。ディスプレイ111は、目標経路の形状等を視認可能な線図として表示する。スピーカ112は、「前方の駐車車両を回避するので、右にハンドルを切ります」などのアナウンスを出力する。
さらにまた、目標経路上を自車両に走行させる制御情報に応じた情報として、転回操作や加減速が実行されることをディスプレイ111、スピーカ112、車室外ランプ113、車室内ランプ114を介して、自車両の乗員又は他車両の乗員に予め知らせる。
このように、回避対象の側方を通り過ぎる際の走行制御に関する情報を出力することにより、自車両及び/又は他車両の乗員に自車両の挙動を予め知らせることができる。出力装置110は、通信装置20を介して上述した情報を高度道路交通システムの外部装置に出力してもよい。これにより、自車両の乗員及び/他車両の乗員は、走行制御される自車両の挙動に応じた対応ができる。
以下、本実施形態の走行制御装置100について説明する。
図1に示すように、本実施形態の走行制御装置100は、制御装置10と、通信装置20と、出力装置30とを備える。通信装置20は、車載装置200との情報の授受を行う。出力装置30は、先述した車載装置200の出力装置110と同様の機能を有する。出力装置30として、車載装置110の出力装置110を用いてもよい。走行制御装置100が、乗員によって持ち運び可能なコンピュータである場合には、走行制御装置100は、車載装置200の車室外ランプ113、車室内ランプ114の点滅を制御する制御情報を、各装置に出力してもよい。
走行制御装置100の制御装置10は、自車両の走行制御を実行させるプログラムが格納されたROM(Read Only Memory)12と、このROM12に格納されたプログラムを実行することで、走行制御装置100として機能する動作回路としてのCPU(Central Processing Unit)11と、アクセス可能な記憶装置として機能するRAM(Random Access Memory)13と、を備えるコンピュータである。
本実施形態に係る走行制御装置100の制御装置10は、対象情報取得機能と、自車情報取得機能と、領域設定機能と、経路設定機能と、制御機能とを有する。本実施形態の制御装置10は、上記機能を実現するためのソフトウェアと、上述したハードウェアの協働により各機能を実行する。
以下、本実施形態に係る走行制御装置100の各機能について説明する。
まず、制御装置10の対象情報取得機能について説明する。制御装置10は、自車両が回避すべき回避対象の位置を含む対象情報を取得する。回避対象は自車両と所定の位置関係を有する。制御装置10は、検出装置50により検出された回避対象の位置を含む対象情報を取得する。対象情報は回避対象の相対位置、相対速度、相対加速度を含む。
回避対象が他車両であり、この他車両と自車両とが車車間通信が可能であれば、自車両の制御装置10は、他車両の車速センサが検出した他車両の車速、加速度を対象情報として取得してもよい。もちろん、制御装置10は、高度道路交通システムの外部装置から他車両の位置、速度、加速度を含む対象情報を取得することもできる。
制御装置10の自車情報取得機能について説明する。制御装置10は、自車両の位置を含む自車情報を取得する。自車両の位置は、ナビゲーション装置120の位置検出装置121により取得できる。自車情報は、自車両の車速、加速度を含む。制御装置10は、自車両の速度を車速センサ62から取得する。自車両の速度は、自車両の位置の経時的な変化に基づいて取得することもできる。自車両の加速度は、自車両の速度から求めることができる。自車情報は、自車両の現在位置と車速から求められた、将来の時刻における自車両の位置を含む。の将来の時刻における自車両の位置に基づいて、将来の時刻における自車両と回避対象との位置関係を求めることができる。
制御装置10の領域設定機能について説明する。制御装置10は、取得した対象情報に含まれる回避対象の位置に基づいて、対象領域を設定する。回避対象は、自車両の周囲に存在し、自車両が回避するべき立体物である。
図2A〜図2Cは、対象領域Rの設定手法の一例を示す図である。図2A〜図2Cに示す例において、自車両の走行方向Vd1は、図中+y方向である。同図において、自車両が走行する走行レーンLn1の延在方向も、図中+y方向である。
図2Aは、自車両V1の走行レーンLn1の左側の路肩側に駐車された他車両V2が検出された状態を上方から見た図である。図2Aは、自車両V1は、その後方から他車両V2に接近し、他車両V2(回避対象)の側方を通り、レーンLn1内を走行方向Vd1に向かって走行する場面を示す。回避対象としての他車両V2は自車両V1の前方に存在する。検出された他車両V2は、自車両V1が走行する走行レーンLn1に存在し、自車両V1の直進を妨げるため、自車両V1が回避するべき回避対象である。
本例において、制御装置10は、自車両V1が走行方向Vd1に沿って回避対象V2に接近するときに、自車両の位置と回避対象の位置との関係に基づいて対象領域R0を設定する(以下、R1,R2を含めRと総称することもある)。対象領域Rは、自車両V1と回避対象V1との距離が所定値X1未満となる接近状態又は接触状態が生じることを避ける観点から設定されてもよいし、自車両V1と回避対象V1との距離を所定値X2以上に保つ観点から設定されてもよい。
制御装置10は、他車両V2を含む所定の範囲に対象領域Rを設定する。制御装置10は、他車両V2などの回避対象の位置に基づいて、対象領域Rを設定する。対象領域Rの設定において用いられる「回避対象の位置」は、予め定義できる。回避対象が他車両V2である場合には、他車両V2の重心位置、中央位置、他車両V2のフロント部分の何れかの位置、他車両V2のリア部分の何れかの位置、他車両V2の左右ドア部分の何れかの位置を、「他車両V2の位置」として定義できる。制御装置10は、「回避対象の位置」を基準として、対象領域Rを設定する。本図では、対象領域R0を例にして説明するが、後述する対象領域R1,R2についても同じである。
本実施形態において、対象領域R0は、他車両V2の外形に沿った形状としてもよいし、他車両V2を内包する形状としてもよい。また、制御装置10は、対象領域R0の境界を、他車両V2の外形に沿った形状としてもよいし、他車両V2を包含する円形、楕円形、矩形、多角形としてもよい。また、対象領域R0は、対象領域R0の境界を他車両V2の表面(外縁)から所定距離(A)未満として、対象領域R0の面積を小さく設定してもよいし、対象領域R0の境界を、他車両V2から離隔させた所定距離B(B>A)以上として、対象領域R0の面積を大きく設定してもよい。
図2Aに示す対象領域R0は、他車両V2を包含する矩形の形状で定義されている。図2Aに示すように、自車両の走行方向Vd1を前方とし、その逆方向を後方として定義した場合において、対象領域R0はその前後に前後端部RL1,RL2を有する。この前後端部RL1,RL2は、自車両の走行レーンLn1の延在方向(+y)に沿う対象領域R0の長さを規定する端線である。図2Aに示す対象領域R0の走行レーンLn1の延在方向(+y)に沿う長さは、前後端部RL1の(y1)とRL2(y2)の間の距離であるL0である。前後端部RL1,RL2のうち、対象領域R0に接近する自車両V1から見て手前側(上流側)に位置する前後端部を第1端部RL1とする。一方、前後端部RL1,RL2のうち、回避対象に接近又はその側方を通過する自車両V1から見て奥手側(下流側)に位置する前後端部を第2端部RL2とする。第1端部RL1及び第2端部RL2は、他車両V2の位置(基準位置)V20からの距離により設定される。第1端部RL1と第2端部RL2は、対象領域R0の境界上に位置する。
図2Aに示すように、自車両の車幅方向をVw1(図中X方向)として定義した場合において、対象領域R0はその左右のそれぞれに左右端部RW1,RW2を有する。この左右端部RW1,RW2は、自車両V1との車幅方向に沿う距離を規定する端線(端部)である。また、左右端部RW1,RW2は、自車両の走行レーンLn1の路幅方向(X)に沿う対象領域の長さ(幅)を規定する端線である。図2Aに示す対象領域R0の路幅方向に(X)沿う長さは、左端部RW1(レーンマーカx1側の端部)と右端部RW2(レーンマーカx2側の端部)との間の距離W0である。自車両が車幅方向に沿って回避対象V2に接近するときに、対象領域R0の左右端部RW1,RW2のうち、自車両V1から見てその自車両V1の側方に位置する左右端部を第1横端部RW1とする。一方、左右端部RW1,RW2のうち、自車両V1から見てその自車両V1の側方とは反対の側方(路肩側)に位置する左右端部を第2横端部RW2とする。第1横端部RW1及び第2横端部RW2は、他車両V2の位置(基準位置)V20からの距離により設定できる。第1横端部RW1と第2横端部RW2は、対象領域R0の境界上に位置する。
なお、図2Aに示すように、自車両V1の走行レーンLn1の対向車線Ln2を対向走行する対向車両V3が存在する場合には、制御装置10は対向車両V3を回避対象として検出する。同図には示さないが、制御装置10は、同様の手法で、対向車両V3を含む範囲の対象領域を設定する。
本実施形態の制御装置10は、他車両V2に対する自車両V1の相対速度が異なる場合には、他車両V2を回避するために設定される対象領域R0の適切な長さが異なるという観点から、回避対象としての他車両V2に対する自車両V1の相対速度に応じて、自車両V1が走行するレーンの延在方向(+y)に沿う対象領域R0の長さL0を設定する。制御装置10は、自車両V1の位置y0から第1端部RL1までの確保すべき間隔として距離dRLを定義してもよい。
ちなみに、対象領域R0は回避対象を検出したタイミング、つまり回避のための転回のための操作(操舵操作など)が行われるよりも前のタイミングにおいて設定される。回避対象に対する自車両V1の相対速度を考慮せずに、画一的な手法により対象領域R0を設定すると、実際の相対速度によっては、対象領域R0の境界に基づいて算出された目標経路RT1を変更せざるを得ない場合がある。目標経路RT1が変更されると、転回量、転回角、車速、加速度などが変更されるので、車両の挙動の連続性を保つことができない。このような車両の挙動に対して乗員は違和感を覚える場合がある。
これに対し、本実施形態では、回避対象としての他車両V2に対する自車両V1の実際の相対速度に応じて、自車両V1が走行するレーンの延在方向(+y)に沿う対象領域R1の長さL1を設定するので、適切な対象領域R1を設定できる。相対速度に応じて対象領域R1を設定し、対象領域R1の境界の位置に基づいて設定された目標経路RT1によれば、走行制御の実行中に目標経路RT1が変更されることが抑制される。このため、自車両の転回量、転回角、車速、加速度などが急に変更されることがない。この結果、車両の挙動の連続性が保たれるので乗員は違和感を覚えることがない。
図2Bに基づいて、回避対象としての他車両V2に対する自車両V1の相対速度に応じて長さL10を有する対象領域R1を設定する処理を説明する。図2Bに示す対象領域R1は、他車両V2に対する自車両V1の相対速度が図2Aで説明した自車両V1の相対速度よりも高いという前提において設定された領域である。なお、図2Bでは、説明の便宜のために、他車両V2に対する自車両V1の相対速度が低い場合に設定された対象領域R0を、他車両V2に対する自車両V1の相対速度が高い場合に設定された対象領域R1に重畳して示す。
本実施形態の制御装置10は、他車両V2に対する自車両V1の相対速度が高いほど、自車両V1が走行するレーンの延在方向に沿う対象領域R1の長さL10を長く設定する。対象領域R1の長さL10を調節する際に参照される他車両V2に対する自車両V1の相対速度は、自車両V1の車長方向成分の相対速度としてもよいし、車幅方向成分と車長方向成分を合成した相対速度としてもよい。回避対象に接近中(直進中)の自車両V1においては、車長方向成分の相対速度のほうが車幅方向の相対速度成分よりも大きいため、合成した相対速度によっても回避対象への接近度を判断できる。
他車両V2に対する自車両V1の相対速度が高い場合に設定された対象領域R1の長さL10は、他車両V2に対する自車両V1の相対速度が低い場合に設定された対象領域R0の長さL0よりも長い(L10>L0)。本実施形態では、他車両V2に対する自車両V1の相対速度が高い場合に、対象領域R0の長さL0を長くするので、回避対象V2の側方を通る際の目標経路RTの長さを長くできる。つまり、他車両V2の側方を通るための転回操作が行われる地点間の距離を長くできるので、転回操作時における自車両V1の転回量や転回速度を低く制御できる。転回量や転回速度が低く抑制できれば、自車両V1の速度や加速度を変更させることも抑制できる。この結果、乗員が違和感を覚えないように走行制御を実行できる。
本実施形態において、対象領域R1の長さを延長する手法としては、自車両V1から見て手前側に位置する第1端部RL1aを自車両V1側に設定する手法と、自車両V1から見て奥手側に位置する第2端部RL2aを自車両V1の進行方向の奥手側に設定する手法とがある。
制御装置10は、他車両V2に対する自車両V1の相対速度が高いほど、対象領域R1の前後端部RL1a,RL2aのうち自車両V1から見て手前側(進行方向反対側:図中−y方向、以下同じ)に位置する第1端部RL1aと他車両V2との距離が長くなるように対象領域R1を設定する。つまり、他車両V2に対する自車両V1の相対速度が高いほど、第1端部RL1aは自車両V1の側の位置に設定される。図2Bに示す例では、相対速度がVR2であるときの対象領域R1の第1端部RL1aの位置は、相対速度がVR0(VR1>VR0)であるときの対象領域R0の第1端部RL1aの位置よりも距離L1だけ自車両V1側へシフトする。自車両V1が回避対象の側方を通り過ぎるために設定された目標経路RT1aの曲点(転回開始点)を自車両V1側にシフトさせることができるので、転回開始点における転回量(操舵量を含む、以下同じ)、転回速度(操舵速度を含む、以下同じ)を低く制御できる。
制御装置10は、他車両V2に対する自車両V1の相対速度が高いほど、対象領域R1の前後端部RL1a,RL2aのうち自車両V1から見て奥手側(進行方向側:図中+y方向、以下同じ)に位置する第2端部RL2aと他車両V2との距離が長くなるように対象領域R1を設定する。つまり、他車両V2に対する自車両V1の相対速度が高いほど、第2端部RL2aは自車両V1の奥手側の位置に設定される。図2Bに示す例では、相対速度がVR2であるときの対象領域R1の第2端部RL2aの位置は、相対速度がVR0(VR1>VR0)であるときの対象領域R0の第2端部RL2aの位置よりも距離L2だけ自車両V1の進行方向側へシフトする。自車両V1が回避対象の側方を通り過ぎ、レーンLn1の中央位置に戻るために設定された目標経路RT1aの曲点(転回完了点:直進状態への復帰点)を自車両V1の進行方向側にシフトさせることができるので、転回完了点における転回量、転回速度を低く制御できる。
これにより、他車両V2を回避し、対象領域R1を通り過ぎる際の目標経路を緩やかな曲線で形成できる。つまり、自車両V1の転回量、転回速度を低く制御できるので、乗員に違和感のない走行制御を実行できる。
上述した、対象領域R1の前後端部RL1a,RL2aのうち自車両V1から見て手前側に位置する第1端部RL1aを手前側の位置とする対象領域R1の設定手法と、自車両V1から見て奥手側に位置する第2端部RL2aを奥手側の位置とする対象領域R1の設定手法は、それぞれ独立に適用してもよいし、両手法を同時に適用してもよい。つまり、対象領域R1の長さを延長させる場合には、第1端部RL1aのみを回避対象に接近する自車両V1側にシフトしてもよいし、第2端部RL2aのみを自車両V1の進行方向側にシフトしてもよい。もちろん、第1端部RL1aを回避対象に接近する自車両V1側に延長しつつ第2端部RL2aを自車両V1の進行方向側にシフトしてもよい。また、回避対象が静止物又は低速で移動する移動物である場合には、自車両V1の速度に基づいて、第1端部RL1a,第2端部RL2aのシフト量を制御してもよい。
続いて、図2Cに基づいて、回避対象としての他車両V2に対する自車両V1の車幅方向成分の相対速度に応じて、自車両V1と対象領域R2との車幅方向に沿う距離を制御する処理を説明する。図2Cに示す対象領域R2は、他車両V2に対する自車両V1の車幅方向成分の相対速度が図2Aで説明した自車両V1の車幅方向成分の相対速度よりも高いという条件の下に設定された領域である。なお、図2Cでは、説明の便宜のために、他車両V2に対する自車両V1の相対速度が低い場合に設定された対象領域R0を、他車両V2に対する自車両V1の相対速度が高い場合に設定された対象領域R2に重畳して示す。
本実施形態の制御装置10は、他車両V2に対する自車両V1の車幅方向成分の相対速度が高いほど、対象領域Rの左右端部RW1,RW2のうち、他車両V2の側方を通過する際の自車両V1から見て当該自車両V1側に位置する(自車両V1に最も近い)横端部RW1と回避対象である他車両V2との距離が長くなるように、対象領域R2を設定する。つまり、他車両V2に対する自車両V1の車幅方向成分の相対速度が高いほど、第1横端部RW1は他車両V2から離隔した位置に設定される。図2Cに示す例では、車幅方向の相対速度がVR4であるときの対象領域R1の第1横端部RW1aの位置は、相対速度がVR3(VR4>VR3)であるときの対象領域R0の第1横端部RW1aの位置よりも距離W1だけ他車両V2から離隔する方向へシフトする。第1横端部RW1aの位置は、他車両V2の側方に設けられる自車両V1の目標経路RT側にシフトする。本実施形態では、他車両V2に対する自車両V1の車幅方向成分の相対速度が高い場合に、対象領域R1の第1横端部RW1aの位置が他車両V2から離隔する位置にシフトされる。自車両V1はこのように設定された対象領域R1の位置に基づく目標経路RTに沿って移動する。つまり、自車両V1が他車両V2に接近しすぎる(所定距離以上接近する)ことを防止できる。この結果、乗員が回避対象を避けるときの運転感覚に合致した、違和感のない走行制御を実行できる。
図2Cでは他車両V2の側方を通過する際の複数のタイミングにおける自車両V1位置のうち一つのタイミングにおける自車両V1の位置をV1tとして示す。他車両V2の側方を通過する際のタイミング又は位置は、他車両V2と自車両V1の距離、角度により任意に定義できる。「他車両V2の側方」には、前方の側方(右前方、左前方)と後方の側方(右後方、左後方)を含む。
ちなみに、本実施形態の制御装置10は、適切な目標経路RTを算出するために、各種の車両情報に基づいて、将来の自車両V1の位置を予測する処理を実行する。本実施形態では、将来、回避対象の側方を通る際の各タイミングにおける自車両V1の横位置(x方向に沿う位置)を予測できる。制御装置10は、予測された自車両V1の横位置に基づいて、接近しつつある回避対象の対象領域Rの横端部RW1の位置を算出できる。
なお、対象領域Rの横端部RW1の位置を変更することにより、対象領域R1の幅W10も変更される。本実施形態の対象領域R1の幅W10は、回避対象側のレーンマーカ(例えばx1)の位置に基づいて定義する。他車両V2に対する自車両V1の相対速度が高い場合に設定された対象領域R1の幅W10は、他車両V2に対する自車両V1の相対速度が低い場合に設定された対象領域R0の幅W0よりも大きい(W10>W0)。
また、制御装置10は、他車両V2に対する自車両V1の車幅方向に沿う距離が短いほど、対象領域R2の横端部RW1bと他車両V2との距離が長くなるように、対象領域R2を設定できる。本実施形態では、車幅方向に沿う自車両V1と他車両V2が接近しているほど、自車両V1側に位置する横端部RW1bを、他車両V2から離隔した位置にシフトする。対象領域R2の横端部RW1bを他車両V2から離隔させることにより、目標経路RT1bの横位置(x方向の位置)を他車両V2から離隔させることができる。この結果、目標経路RT1bに従って走行する自車両V1が他車両V2に接近しすぎない。
次に、図3A及び図3Bに基づいて、具体的な対象領域R0の設定手法について説明する。走行する自車両V1の目標経路RTに影響を与えるのは、対象領域R0(上述したR1,R2を含む)の左右端部のうち自車両V1に隣接する横端部RW1であるため、説明の対象とする対象領域R0の横位置は、自車両V1側に位置する横端部RW1の位置である。
図3Aに示すように、対象領域Rの路肩側のレーンマーカx1からの幅がW0である場合には、幅W0と自車両V1の幅VWとの和(W0+VW)が、走行レーン幅LWよりも小さい場合に、自車両V1は回避対象OB1の側方を走行できる。本実施形態では、上記条件を満たすように、対象領域Rの位置(路肩側のレーンマーカx1と自車両V1側の横端部RW1との幅方向の距離:サイドディスタンスの一態様)を算出する。対象領域Rの横端部RW1の位置は、路肩側のレーンマーカx1からの距離により定義してもよいし、対象領域Rの幅W0により定義してもよい。また、対象領域Rの横端部RW1を、レーンLn1の対向車線側のレーンマーカx2からの距離により定義してもよい。
さらに、本実施形態では、自車両V1と対象領域R0との間に最低限確保するべき安全代d1と、乗員が安心して回避対象OB1の側方を通過できる余裕代d2とを考慮して、対象領域R0の横位置RW1又はその幅W0´を設定してもよい。これらd1,d2は、併せて設定されてもよいし、別々に設定されてもよい。この場合には、制御装置10は、W0+VW+(d1 and/or d2)<LWとなるように対象領域R0の幅W0を算出する。なお、走行レーン幅LWは、道路情報122に含まれる道路幅LW2とレーン数とに基づいて算出してもよいし、検出装置50の画像情報から一対のレーンの位置を検出し、画像情報に基づいてレーン幅を算出してもよい。自車両V1の幅VWは、車両コントローラ70から取得する。
対象領域R0の幅W0は、自車両V1が走行するレーンを規定する一対のレーンマーカx1,x2のいずれか一方から、対象領域R0の自車両V1側の端部RW1までの距離としてもよい。対象領域R0の自車両V1側の横端部RW1の位置は、回避対象OB1の側方を走行する際の自車両V1からの距離により規定してもよい。特に限定されないが、幅W0の寸法を、回避対象OB1に対する自車両V1の相対速度の2乗に比例する値としてもよい。
また、図3Aに示すように、本実施形態では、自車両V1の走行レーンに対向する対向レーンを対向走行する対向車両V3が存在する場合には、対向車両V3を含む対象領域R3を設定する。上述した対象領域R1の設定手法と同様の手法により、対象領域R3を設定する。対象領域R3の自車両V1側の横端部RW3は、対向車両V3の位置に基づいて設定される。
本例において、自車両V1はレーンマーカx2を超えて走行することができない。この場合において、制御装置10は、W0+VW+(d1and/ord2)+dV1<LW2となるように対象領域R0の幅W0を算出する。つまりVW<LW2−(W0´+dV1)の関係が成立するときに自車両V1は駐車中の他車両V2を回避しつつ、対向する対向車両V3とすれ違うことができる。仮に、上記関係が成立しない場合には、自車両V1は、他車両V2の手前(−y側)で停車して、対向車両V3が自車両V1の横を通り過ぎるタイミングを待機する。なお、dV1は対向レーンの幅など、自車両V1が走行するときに最低限確保する幅である。
さらに、図3Bに示すように、回避対象が中央分離帯OB4などの道路構造物である場合も同様に適用できる。同図に示すように、中央分離帯OB4を含むように対象領域R4を設定する。この場合において、制御装置10は、W0+VW+(d1 and/or sd2)+d4+W4*(1/2)<LWとなるように対象領域R0の幅W0の寸法(端部間の距離)を算出する。
次に、図4A〜図4Cに基づいて、自車両V1と回避対象である駐車中の他車両V2、対向車両V3とすれ違う場面において適用される対象領域Rの設定手法について説明する。制御装置10は、回避対象が検出された場合には、回避対象と自車両V1とのすれ違いが開始する地点(位置)とすれ違いが完了する地点(位置)、自車両V1が回避対象の追い越しを開始する地点(位置)と追い越しが完了する地点(位置)を算出する。
図4Aに示すように、制御装置10は、自車情報と対象情報に基づいて、自車両V1の前方端部と対象領域R2との距離が所定値未満となる追越し開始位置PS2を検出する。自車両V1の先端部分と前方に駐車中の他車両V2の後方端部とのY軸方向の位置が略一致したとき(距離が所定値未満となったとき)に、自車両V1は他車両V2の追い越しを開始する。自車両V1が駐車中の他車両V2を追い越し始める追い越し開始位置はPS2である。
制御装置10は、自車両V1の前方端部と対象領域R3との距離が所定値未満となるすれ違い開始位置PS3を検出する。自車両V1の先端部分と対向走行する対向車両V3の先端部分とのY軸方向の位置が略一致したとき(距離が所定値未満となったとき)に、両者はすれ違いを開始する。対向走行中(移動中)の対向車両V3と自車両V1とのすれ違い開始位置はPS3である。
制御装置10は、現在の自車情報と対象情報に基づいて、追い越し開始位置PS2,すれ違い開始位置PS3における自車情報と対象情報を取得する。制御装置10は、追い越し開始位置PS2,すれ違い開始位置PS3における自車情報と対象情報に基づいて、対象領域Rを設定する。
本実施形態において、制御装置10は、追い越し開始位置PS2,すれ違い開始位置PS3の算出を所定周期で実行する。これにより、正確な追い越し開始位置PS2,すれ違い開始位置PS3を求めることができる。そして、自車両V1が、実際に回避対象である他車両V2の追い越しを開始した後は、追い越し開始位置の算出を終了し、対向車両V3とすれ違いを開始した後は、すれ違い開始位置の算出処理を終了する。そして、追い越し開始位置PS2、すれ違い開始位置PS3における対象情報から設定された対象領域Rを回避するように、自車両V1の走行制御を実行する。追い越し開始位置PS2,すれ違い開始位置PS3の近傍を走行するタイミングは、自車両V1と回避対象とが最も接近する可能性が高いタイミングである。このような追い越し開始位置PS2,すれ違い開始位置PS3における対象情報に基づいて対象領域Rを設定し、これを回避させることにより、安全性の高い走行制御を実行できる。
制御装置10は、追い越し開始位置PS2,すれ違い開始位置PS3における自車情報と対象情報から得た他車両V2,V3(回避対象)の対象情報とに基づいて、対象領域R2,R3の前後端部のうち自車両V1から見て手前側に位置する第1端部の位置RL1を設定する。対象情報は、回避対象(他車両)の位置、速度、又は加速度の何れかの情報を含む。自車情報は、自車両の位置、速度、又は加速度の何れかの情報を含む。
制御装置10は、追い越し開始位置PS2,すれ違い開始位置PS3における自車情報と他車両V2,V3(回避対象)の対象情報とに基づいて、対象領域R2,R3の左右端部のうち自車両V1側に位置する横端部の位置RW1を設定する。追い越し開始位置PS2,すれ違い開始位置PS3における他車両V2,V3との相対位置に基づいて対象領域R2,R3の第1端部の位置RL1、第2端部の位置RL2、横端部の位置RW1を設定することにより、他車両V2,V3を回避できる。回避対象が対向車両V3のように移動体である場合には、自車両V1と対向車両V3の位置関係は刻々と変化する。本実施形態によれば、自車両V1と対向車両V3とが実際にすれ違うときの位置関係に基づいて、適切な対象領域R3を設定できる。
また、制御装置10は、対向走行する対向車両V3とのすれ違い開始位置PS3が、対象領域R3(又は対向車両V3)の自車両V1側の前方端部RL1と所定距離未満である場合には、減速して対向車両V3が自車両V1の側方を通過するのを待ち、対向車両V3が通過してから、すれ違い開始位置PS3を含む領域を通過してもよい。
制御装置10は、追い越し開始位置、すれ違い開始位置が自車両V1からの距離が所定値以内の範囲に複数検出された場合、つまり、自車両V1が所定距離内に追い越しとすれ違いが同時に発生したり、複数の回避対象とすれ違う場合には、自車両V1と各回避対象との相対位置に応じた重み係数を求める。この重み係数は、自車両V1が追い越し又はすれ違う複数の回避対象に対する注意度に応じた係数である。制御装置10は、自車情報と対象情報から自車両と回避対象との相対位置に応じた重み係数を回避対象ごとに算出する。
対向車両V3のように自車両V1に接近し、自車両V1とすれ違う回避対象に対しては、駐車中の他車両V2のように静止し、自車両V1が追い越す回避対象よりも高い重み係数が設定される。自車両V1がすれ違う対向車両V3のように自車両V1との相対速度が高い回避対象に対しては、自車両V1が追い越す前方駐車中の他車両V2のように自車両V1との相対速度が低い回避対象よりも高い重み係数が設定される。自車両V1との距離が近い回避対象に対しては、自車両V1との距離が遠い回避対象よりも高い重み係数が設定される。自車両V1との相対距離が大きい回避対象に対しては、自車両V1との相対距離が小さい回避対象よりも、高い重み係数が設定される。
そして、制御装置10は、算出された重み係数に応じて、回避対象の対象領域R2の左右端部のうち自車両V1から見て自車両V1側に位置する横端部RW1の位置を設定する。本実施形態では、重み係数が高いほど横端部RW1の位置を回避対象から離隔した位置に(自車両V1側に)シフトする。図4Aに示す例において、自車両V1に接近する回避対象の対象領域R3と自車両V1との車幅方向に沿う距離d13は、静止している回避対象の対象領域R2と自車両V1との車幅方向に沿う距離d1(又はd1+d2)よりも長い(d13>d1(d1+d2))。レーンマーカ自車両V1との相対速度が高い回避対象の対象領域R3と自車両V1との車幅方向に沿う距離d13は、相対速度低い回避対象の対象領域R2と自車両V1との車幅方向に沿う距離d1(又はd1+d2)よりも長い(d13>d1(d1+d2))。車幅方向において自車両V1との距離が短い回避対象の対象領域R3と自車両V1との距離d13は、車幅方向において自車両V1との距離が長い回避対象の対象領域R2と自車両V1との距離d1(又はd1+d2)よりも長い(d13>d1(d1+d2))。
一例ではあるが、図4Aの状態を例にして説明する。図4Aに示すように、自車両V1は、左手の駐車中の他車両V2と、隣接対向レーンを走行する対向車両V3との間を走行する。このとき、自車両V1にはVW10(又はVW10´)の幅の走行用スペースが与えられる。制御装置10は、自車両V1の左右の対象領域R2とR3にそれぞれ重み係数を付与する。制御装置10は、駐車中の他車両V2の対象領域R2に対する重み係数WH1と、対向走行する対向車両V3の対象領域R3に対する重み係数WH2とを設定する。制御装置10は、各重み係数WH1を用いて、対象領域R2の左右端部のうち自車両V1側の横端部RW1と他車両V2との距離を設定する。対象領域R3についても同様に、自車両V1側に位置する横端部RW1と対向車両V3との距離を設定する。
制御装置10は、他車両V2側のレーンマーカx1から対象領域R0の横端部RW1の幅W0(又はW0´)を設定してもよい。制御装置10は、対向車両V3側のレーンマーカx3から対象領域R3の横端部RW1までのW3´を設定してもよい。
幅W0´=VW10・xWH1/(WH1+WH2)
幅W3´=VW10・xWH2/(WH1+WH2)
対向走行する対向車両V3の対象領域R3に係るWH2を相対的に大きくすることにより(WH2>WH1)、対向走行する対向車両V3の対象領域R3と自車両V1との車幅方向の沿う距離d13を通常時に適用される規定の距離よりも長くできる。これにより、自車両V1が対向走行する対向車両V3に接近しすぎることを防止できる。
このように、重み係数を用いることにより、自車両V1と距離が近い回避対象及び/又は自車両V1との相対速度が大きい回避対象に対しては、対象領域R0の横端部RW1の位置を他車両V2,V3からより離隔させる。これにより、対象領域R0に基づく目標経路RTを走行する自車両V1が他車両V2,V3に接近しすぎないようにできる。これにより、回避対象に接近した場合のリスクを低減できる。
次に、図4B、図4Cに基づいて、追い越し、すれ違いが完了した位置を考慮した対象領域R2,R3の設定手法について説明する。制御装置10は、自車情報と対象情報に基づいて、自車両V1の後方端部と対象領域R2との距離が減少した後に増加する位置を、追い越し完了位置PE2、すれ違い完了位置PE3として検出する。制御装置10は、自車両V1の後方端部と駐車中の他車両V2の先端部分とのY軸方向の位置が略一致したとき(距離が所定値未満となったとき)に、他車両V2の追い越しは完了したと判断する。自車両V1が駐車中の他車両V2を追い抜いた追い抜き完了位置はPE2である。また、自車両V1の後方端部と対向走行する対向車両V3の後方端部とのY軸方向の位置が略一致したとき(距離が所定値未満となったとき)に、両者のすれ違い状態は完了したと判断する。対向走行中(移動中)の対向車両V3と自車両V1とのすれ違い完了位置はPE3である。制御装置10は、現在の自車情報と対象情報に基づいて、追い抜き完了位置PE2,すれ違い完了位置PE3における自車情報と対象情報を取得する。制御装置10は、追い抜き完了位置PE2,すれ違い完了位置PE3における自車情報と対象情報に基づいて、対象領域Rを設定する。
本実施形態において、制御装置10は、追い抜き完了位置PE2,すれ違い完了位置PE3の算出を所定周期で実行する。これにより、追い抜き完了位置PE2,すれ違い完了位置PE3を求めることができる。対向車両V3とのすれ違い完了位置における対象領域R3と自車両V1との距離d13は所定時間維持される。つまり、図4Bの状態において、自車両V1がすれ違い完了位置PE3を通過した後の所定時間に渡って、対象領域R3と自車両V1との距離d13は一定に保たれる。また、自車両V1と対象領域R1との間の余裕代の距離d1,d2も所定時間に渡って一定に保たれる。結果として、レーンマーカx1から自車両V1までの距離W0´も所定時間に渡って一定に保たれる。自車両V1が回避対象である他車両V2を実際に追い抜いた後は、追い抜き完了位置の算出処理を終了する。自車両V1が回避対象である対向車両V3とすれ違いを完了した後は、すれ違い完了位置の算出処理を終了する。
制御装置10は、対象領域R2,R3を設定する際に、追い抜き完了位置PE2,すれ違い完了位置PE3における自車情報と他車両V2,V3(回避対象)の対象情報とに基づいて、対象領域R2の前後端部のうち自車両から見て奥手側の第2端部の位置RL2とを設定する。図4Bに示すように、本実施形態の制御装置10は、対象領域R3の第2端部の位置RL2の位置をすれ違い完了位置PE3に合わせる。これにより、すれ違い完了のタイミングまで同じ幅W3の対象領域R3に基づいて走行制御が実行される。少なくともすれ違い完了時までは転回がされないようにできる。そして、すれ違いが完了したら、自車両V1は適切な位置(走行レーンの中央)に戻る。
また、図4Cに示すように、すれ違い完了位置PE3を自車両V1の進行方向側にシフトしてもよい。つまり、対象領域R0の第2端部の位置RL2をすれ違い完了位置PE3よりも、自車両V1から見て奥手側(走行方向側)にシフトする。これにより、すれ違い完了の後、所定時間に渡って、車幅方向に沿う自車両V1と対象領域R3との距離が保たれた状態で走行制御が実行される。すれ違い完了の後も同じ制御内容が維持されるので、すれ違いが完了した直後に転回が実行されることを防止できる。そして、すれ違いが完了し、シフト量(距離L3)を走行した後に、自車両V1は適切な位置(走行レーンの中央)に戻る。この処理は、追い抜き完了位置PE2の通過時点でも適用できる。
なお、すれ違い完了位置PE3のシフト量L3は、自車両V1の車速に応じて決定できる。すれ違い完了位置PE3のシフト量L3は自車両V1の車速が高いほど小さくすることが好ましい。すれ違い完了位置PE3を進行方向の奥手側へシフトすることにより、対象領域R3の対向車両V3からの距離L3を相対的に長くできる。この距離L3は先述したすれ違い完了位置PE3のシフト量に対応する。制御装置10は、自車両V1の車速が高いほど、対象領域R3の第2端部RL2が奥手側への延長量を小さくする。この処理は、追い抜き完了位置PE2についても適用できる。
同様に、制御装置10は、追い抜き完了位置PE2,すれ違い完了位置PE3における自車情報と対象情報から得た他車両V2,V3(回避対象)の対象情報とに基づいて、対象領域R3の左右端部のうち自車両V1側に位置する横端部RW1の位置を設定する。自車両V1が回避対象としての他車両V2,V3に最も接近する追越し開始位置PS2から追い抜き完了位置PE2までにおける他車両V2,V3との相対位置に基づいて対象領域R0,R3の第1端部の位置RL1、第2端部の位置RL2、横端部の位置RW1を設定する。同様に、すれ違い開始位置PS3からすれ違い完了位置PE3までにおける他車両V2,V3との相対位置に基づいて対象領域R0,R3の第1端部の位置RL1、第2端部の位置RL2、横端部の位置RW1を設定する。これにより、自車両V1が他車両V2,V3を回避できる対象領域R2,R3を設定できる。特に、回避対象が対向車両V3のように移動体である場合には、自車両V1と対向車両V3の位置関係は刻々と変化するが、本実施形態によれば、実際にすれ違う際の最も接近する位置関係に応じた適切な対象領域R3を設定できる。
制御装置10は、対向走行する対向車両V3とのすれ違い完了位置PE3が、対象領域R3(又は対向車両V3)の自車両V1側の後方端部RL2と所定距離未満である場合には、加速して対向車両V3が他車両V2に接近する前に対向車両V3の横を通過してもよいし、減速して対向車両V3の通過を待ち、対向車両V3の通過後に、すれ違い完了位置PE3を含む領域を通過してもよい。すれ違い完了位置PE2,PE3近傍において自車両V1に減速させることにより、安全性の高い走行制御を実行できる。
なお、図4Aに示すように、駐車中の他車両V2の対象領域R2について、回避対象V2の手前側の端部から対象領域R2の第1端部RL1までの距離L1、回避対象V2の奥手側の端部から対象領域R0の第2端部RL2までの距離L2については最小値を設定し、それよりも小さい値としないようにしてもよい。対象領域R2の横幅W0についても最小値を設定し、それよりも小さい値としないようにしてもよい。対向車両V3の先端から対象領域R3の第1端部RL1までの距離L13、対象領域R3の幅W3についても最小値を設定し、それよりも小さい値としないようにしてもよい。
続いて、制御装置10の経路設定機能について説明する。本実施形態の制御装置10は、設定された対象領域R0の境界の位置に基づいて目標経路RTを算出し、自車両V1と回避対象との距離を制御する。ここで、「対象領域R0の位置に基づいて目標経路RTを算出する」手法は限定されない。制御装置10は、対象領域R0内に自車両V1が進入しないように目標経路RTを算出してもよいし、対象領域R0と自車両V1の存在領域との重複面積が所定値未満となるように目標経路RTを算出してもよいし、対象領域R0の境界線から所定距離だけ離隔した位置を目標経路RTとして算出してもよいし、対象領域R0の境界線を目標経路RTとして算出してもよい。先述したように、対象領域R0は、自車両V1と回避対象との距離が所定値未満とならないように、又は、自車両V1と回避対象との距離が所定閾値に保たれるように設定される。このため、目標経路RTも自車両V1と回避対象との距離が所定値未満とならない位置に、又は、自車両V1と回避対象との距離が所定閾値に保たれる位置に設定される。
制御装置10の制御機能について説明する。本実施形態の制御装置10は、目標経路RT上を自車両V1に走行させる制御情報を車両側の車両コントローラ70、駆動装置80、及び操舵装置90に出力する。
制御装置10から制御情報を取得した本実施形態の車両コントローラ70は、駆動装置80及び操舵装置90を制御して、目標経路RTに沿って自車両V1を走行させる。車両コントローラ70は、検出装置50により検出された道路形状や、ナビゲーション装置120の道路情報122及び地図情報123が記憶するレーンマーカモデルを用いて、自車両が車線に対して所定の横位置を維持しながら走行するように操舵装置90の制御を行う。車両コントローラ70は、操舵角センサ61から取得した操舵角、車速センサ62から取得した車速、およびステアリングアクチュエータの電流の情報に基づいて、操舵制御量(転回制御量)を算出し、ステアリングアクチュエータに電流指令を送ることで、自車両が目標の横位置を走行するように制御を行う。なお、自車両V1の横位置を制御する方法として、上述した操舵装置90を用いる他、駆動装置80及び/又は制動装置81を用いて左右の駆動輪の回転速度差により自車両V1の走行方向(すなわち、横位置)を制御してもよい。その意味において、車両の「転回」とは、操舵装置90による場合の他、駆動装置80及び/又は制動装置81による場合も含む趣旨である。
最後に、本実施形態の制御装置10の提示機能について説明する。制御装置10は、算出された、対象情報に応じた情報、対象領域Rの位置に応じた情報、目標経路の位置に応じた情報、及び目標経路上を自車両に走行させる制御情報に応じる情報を出力装置110に送出し、上述した態様で外部に出力させる。
続いて、本実施形態の走行制御装置100の制御手順を、図5及び図6のフローチャートに基づいて説明する。なお、各ステップでの処理の内容は、上述したとおりであるため、ここでは処理の流れを中心に説明する。
まず、図5に基づいて、走行制御の全体の手順について説明する。
ステップS101において、制御装置10は、少なくとも自車両V1の位置を含む自車情報を取得する。自車情報は、自車両V1の車速・加速度を含んでもよい。ステップS102において、制御装置10は、自車両V1が回避すべき回避対象の位置を含む対象情報を取得する。対象情報は、回避対象の速度・加速度を含んでもよい。
ステップS103において、制御装置10は、回避対象の検出結果を検出装置50から取得する。回避対象の検出結果は、回避対象の位置の情報を含む。ステップS104において、制御装置10は、回避対象の位置に応じて対象領域Rを設定する。対象領域Rの設定処理のサブルーチンについては、図6において説明する。
ステップS105において、制御装置10は、対象領域Rの境界の位置に基づいて目標経路RTを算出する。目標経路RTは、自車両V1が走行する一又は複数の目標座標を含む。各目標座標は、目標横位置(目標X座標)と目標縦位置(目標Y座標)とを含む。算出された一又は複数の目標座標と自車両V1の現在位置とを結ぶことにより、目標経路RTを求める。なお、ステップS105に示す目標座標の算出方法については後述する。
ステップ106において、制御装置10は、ステップS105で算出された目標座標の目標横位置を取得する。また、ステップS107において、制御装置10は、自車両V1の現在の横位置とステップS106で取得した目標横位置との比較結果に基づいて、横位置に関するフィードバックゲインを算出する。
そして、ステップS108において、制御装置10は、自車両V1の実際の横位置と、現在位置に対応する目標横位置と、ステップS107のフィードバックゲインとに基づいて、目標横位置上を自車両V1に移動させるために必要な転回角や転回角速度等に関する目標制御値を算出する。ステップS112において、制御装置10は、目標制御値を車載装置200に出力する。これにより、自車両V1は、目標横位置により定義される目標経路RT上を走行する。なお、ステップS105において複数の目標座標が算出された場合には、目標横位置を取得する度にステップS106〜S112の処理を繰り返し、取得した目標横位置のそれぞれについての制御値を車載装置200に出力する。
ステップS109において、制御装置10は、ステップS105で算出された一又は複数の目標座標についての目標縦位置を取得する。また、ステップS110において、制御装置10は、自車両V1の現在の縦位置、現在位置における車速及び加減速と、現在の縦位置に対応する目標縦位置、その目標縦位置における車速及び加減速との比較結果に基づいて、縦位置に関するフィードバックゲインを算出する。そして、ステップS111において、制御装置10は、目標縦位置に応じた車速および加減速度と、ステップS110で算出された縦位置のフィードバックゲインとに基づいて、縦位置に関する目標制御値を算出する。ステップS109〜S112の処理は、先述したステップS106〜S108,S112と同様に、目標縦位置を取得する度に繰り返し、取得した目標横位置のそれぞれについての制御値を車載装置200に出力する。
ここで、縦方向の目標制御値とは、目標縦位置に応じた加減速度および車速を実現するための駆動機構の動作(エンジン自動車にあっては内燃機関の動作、電気自動車系にあっては電動モータ動作を含み、ハイブリッド自動車にあっては内燃機関と電動モータとのトルク配分も含む)およびブレーキ動作についての制御値である。たとえば、エンジン自動車にあっては、制御機能は、現在および目標とするそれぞれの加減速度および車速の算出値に基づいて、目標吸入空気量(スロットルバルブの目標開度)と目標燃料噴射量を算出し、これを駆動装置80へ送出する。なお、制御機能は、加減速度および車速を算出し、これらを車両コントローラ70へ送出し、車両コントローラ70において、これら加減速度および車速を実現するための駆動機構の動作(エンジン自動車にあっては内燃機関の動作、電気自動車系にあっては電動モータ動作を含み、ハイブリッド自動車にあっては内燃機関と電動モータとのトルク配分も含む)およびブレーキ動作についての制御値をそれぞれ算出してもよい。
そして、ステップS112に進み、制御装置10は、ステップS111で算出された縦方向の目標制御値を、車載装置200に出力する。車両コントローラ70は、転回制御及び駆動制御を実行し、自車両に目標横位置及び目標縦位置によって定義される目標経路RT上を走行させる。
ステップS113において、制御装置10は、出力装置110に情報を提示させる。出力装置110に提示させる情報は、ステップS106において算出された対象領域の位置・速度であってもよいし、ステップS105〜S111において算出された目標経路の形状であってもよいし、ステップS112において車載装置200へ出力された目標制御値であってもよい。
ステップS114において、ドライバがステアリング操作等をしたか否か、ドライバの操作介入の有無を判断する。ドライバの操作が検出されなければ、ステップS101へ戻り、新たな対象領域の設定、目標経路の算出及び走行制御を繰り返す。他方、ドライバが操作をした場合には、ステップS115に進み、走行制御を中断する。次のステップS116において、走行制御を中断した旨の情報を提示する。
続いて、図6のフローチャートに基づいて、本実施形態の走行制御装置100の対象領域の設定処理(図5 S104)のサブルーチンについて説明する。
自車情報、対象情報を取得した後(ステップS103)、ステップS201において、制御装置10は、自車両V1が走行するレーンに存在する回避対象(駐車中の他車両など)が検出されたら、ステップS202へ進む。ステップS202において、自車両V1が走行するレーンの対向レーンに回避対象(対向走行する他車両など)が検出された場合には、ステップS203へ進み、そうでない場合にはステップS211へ進む。
ステップS211以降は、自車両V1の走行レーンに回避対象が存在する場合の処理である。ステップS211において、制御装置10は走行レーンに検出された回避対象の位置に応じて対象領域Rを設定する。ステップS212において、制御装置10は、自車両V1が走行レーン内を対象領域R内に進入せずに、走行可能か否かを判断する。
走行レーンの幅から対象領域Rの幅を減算した距離が自車両V1の車幅よりも広ければ、自車両V1は対象領域R内に進入せずに走行レーンを走行できる。この場合はステップS213に進み、制御装置10は、対象領域とレーンマーカの略中央を通る経路を目標経路RTとして算出する。
他方、自車両V1が対象領域R内に進入せずに走行レーンを走行できないときには、ステップS214へ進む。ステップS214において、隣接する走行レーンに進入可能であるか否かを判断する。隣接する走行レーンへの進入可否は、そのレーンに追い越し規制が適応されているか否かの情報を含む道路情報122に基づいて判断する。ステップS214において、自車両V1が隣接する走行レーンへ進入可能である場合には、ステップS215へ進み、目標経路RTを算出する。他方、自車両V1が隣接する走行レーンへ進入不可能である場合には、ステップS216へ進み、自車両V1を減速又は停止させる。
ステップS202に戻り、対向レーンに存在する回避対象(対向走行する対向車両V3)が検出された場合には、ステップ203に進む。ステップS203において、制御装置10は、自車情報と対象情報に基づいて、すれ違い開始位置とすれ違い完了位置を所定周期で算出する。そして、制御装置10は、すれ違い開始位置における自車情報と対象情報に基づいて対象領域Rを設定する。同様に、すれ違い完了位置における自車情報と対象情報に基づいて対象領域Rを設定する。
具体的に図4Aに示す状況を例にすると、ステップS204において、先にすれ違う他車両V2とのすれ違い開始位置及び/又はすれ違い完了位置における自車情報と対象情報に基づいて他車両V2を回避する対象領域Rを設定する。ステップS205において、後にすれ違う対向車両V3とのすれ違い開始位置及び/又はすれ違い完了位置における自車情報と対象情報に基づいて対向車両V3を回避する対象領域Rを設定する。
本実施形態では、すれ違い開始位置及び/又はすれ違い完了位置における自車情報と対象情報とに基づいて対象領域Rを設定する。制御装置10は、他車両V2との距離を適当に保ちつつ他車両V2とすれ違い、さらに、左右の他車両V2及び対向車両V3との距離を適当に保ちつつ対向車両V3とすれ違うように、自車両V1を走行させる。これにより、自車両V1は回避対象と適切な距離を保ちながら、回避対象とすれ違うことができる。
上述したように、制御装置10は、複数の回避対象が検出され、自車両V1が二つ以上の回避対象に挟まれた状態である場合には、重みづけ係数を用いて対象領域R2の横端部と自車両Vとの距離d1(d1+d2)を設定してもよい。これにより、対象領域Rと自車両V1との車幅方向の距離が安定し、対象領域Rの境界に基づいて算出される目標経路RTの位置も左右にぶれない。
上述したように、制御装置10は、すれ違い開始地点PS、すれ違い完了地点PEの位置に応じて、対象領域R2の長さL0を設定する。これにより、対象領域R2の第1端部RL1、第2端部RL2の位置がすれ違い開始地点PS、すれ違い完了地点PEの位置に応じて調整されるので、回避対象を回避するための転回操作を行うポイントを適切に設定できる。これにより、すれ違い開始地点PS、すれ違い完了ポイントREにおける状況に適した対象領域R2を設定できる。
なお、ステップS204とステップS205は、自車両V1に近い回避対象について順次行われる処理であるので、状況に応じてステップの何れか一方が実行される場合もある。
続くステップS206において、制御装置10は、設定した対象領域Rに基づいて、図5のステップS105の目標経路の算出処理を開始し、ステップS106以降の処理を実行する。
本発明の実施形態の走行制御装置100は、以上のように構成され動作するので、以下の効果を奏する。
[1]本実施形態の走行制御装置100によれば、回避対象としての他車両V2に対する自車両V1の実際の相対速度に応じて、自車両V1が走行するレーンの延在方向(+y)に沿う対象領域Rの長さL10を設定するので、適切な対象領域Rを設定できる。相対速度を考慮した対象領域Rを設定し、これを回避するように目標経路RTを算出する。これにより、走行制御の実行中に目標経路RTが変更されることを抑制できる。つまり、自車両の転回量、転回角、車速、加速度などが急に変更されることがない。この結果、車両の挙動の連続性が保たれるので、乗員は違和感を覚えることがない。
[2]本実施形態の走行制御装置100によれば、相対速度が高いほど、対象領域Rの第1端部RL1を他車両V2(回避対象)から自車両V1側に離隔させた位置に設定する。これにより、この対象領域R1を回避する目標経路RT1の曲点(転回開始点)は、自車両V1側に設定される。これにより、転回開始点における転回量、転回速度が低くなるので、他車両V2を回避するための目標経路を緩やかな曲線で形成できる。自車両V1の転回量、転回速度が低くなるので、乗員は違和感を覚えることがない。
[3]本実施形態の走行制御装置100によれば、相対速度が高いほど、対象領域Rの第2端部RL2を、他車両V2(回避対象)から自車両V1の進行方向側に離隔させた位置に設定する。これにより、対象領域R1を回避する目標経路RT1の曲点(転回完了点:直進状態への復帰点)を自車両V1の進行方向側にシフトさせることができる。これにより、転回完了点における転回量、転回速度を低くすることができ、他車両V2を回避するための目標経路を緩やかな曲線で形成できる。自車両V1の転回量、転回速度を低く制御できる。
[4]本実施形態の走行制御装置100は、車幅方向成分の回避対象に対する相対速度が高いほど、対象領域Rの左右端部のうち自車両V1から見て自車両V1の側方に位置する横端部と回避対象との距離が長くなるように、対象領域Rを設定する。これにより、自車両V1が高い相対速度で他車両V2に接近するときには、対象領域Rの境界位置に基づいて算出される目標経路RTを他車両V2から離隔させ、自車両V1が他車両V2に接近しすぎないようにできる。車幅方向成分の相対速度を考慮して対象領域Rを設定するので、走行制御の実行中に目標経路RTが変更されることを抑制できる。つまり、自車両の転回量、転回角、車速、加速度などが急に変更されることがない。この結果、車両の挙動の連続性を保つことができる。
[5]本実施形態の走行制御装置100は、車幅方向に沿う回避対象に対する距離が短いほど、対象領域Rの左右端部のうち自車両V1から見て自車両側の横端部と回避対象との距離が長くなるように対象領域Rを設定する。対象領域Rの横端部を自車両V1側へシフトすることにより、対象領域Rの境界の位置に基づいて算出される目標経路RTの位置を回避対象から離隔させることができる。これにより、自車両V1が他車両V2に接近しすぎないようにできる。そして、上記[4]で述べた作用効果を奏する。
[6]本実施形態の走行制御装置100によれば、自車両V1が回避対象に最も接近する追い越し開始位置PS2,すれ違い開始位置PS3における他車両V2,V3との相対位置に基づいて対象領域Rの第1端部の位置RL1,RL3を設定することにより、他車両V2,V3を回避できる。特に、回避対象が対向車両V3のように移動体である場合には、自車両V1と対向車両V3の位置関係が刻々に変化するが、実際に追い越すとき又はすれ違うときの位置関係に応じた対象領域Rを設定できる。
[7]本実施形態の走行制御装置100によれば、自車両V1が回避対象に最も接近する追い越し開始位置PS2,すれ違い開始位置PS3における他車両V2,V3との相対位置に基づいて対象領域Rの横端部の位置RW1を設定することにより、他車両V2,V3を回避できる。特に、回避対象が対向車両V3のように移動体である場合には、自車両V1と対向車両V3の位置関係が刻々に変化するが、実際に追い越すとき又はすれ違うときの位置関係に応じた対象領域Rを設定できる。
[8]本実施形態の走行制御装置100によれば、自車両V1と距離が近い回避対象及び/又は自車両V1との相対速度が大きい回避対象に対しては、横端部RW1が回避対象からより遠い位置となるように対象領域Rを設定する。これにより、自車両V1が回避対象に接近しすぎることを抑制できる。自車両V1が回避対象に接近した場合のリスクを低減させる。
[9]本実施形態の走行制御装置100によれば、自車両V1が回避対象としての他車両V2,V3に最も接近する追い越し開始位置PS2から追い越し完了位置PE2,すれ違い開始位置PS3からすれ違い完了位置PE3までにおける他車両V2,V3との相対位置に基づいて対象領域Rの第2端部の位置RL2を設定することにより、追い越し又はすれ違いの状況を考慮した対象領域R3を設定できる。
[10]本実施形態の走行制御装置100によれば、自車両V1が回避対象としての他車両V2,V3に最も接近する追い越し開始位置PS2から追い越し完了位置PE2までにおける他車両V2との相対位置、又はすれ違い開始位置PS2からすれ違い完了位置PE3までにおける対向車両V3との相対位置に基づいて対象領域Rの横端部の位置RW1を設定することにより、追い越し又はすれ違いの状況を考慮した対象領域Rを設定できる。また、回避対象が対向車両V3のように位置関係が刻々と変化する移動体であっても、実際にすれ違うときの位置関係に応じて、適切な対象領域Rを設定できる。
[11]本実施形態の走行制御装置100によれば、対象領域Rを回避する走行制御に関する情報を外部に出力することにより、自車両及び/又は他車両の乗員に自車両の挙動を予め知らせることができる。これにより、自車両の乗員及び/他車両の乗員は、自車両の挙動に応じた対応ができる。
[12]本実施形態の走行制御方法が制御装置10により実行されることにより、上記走行制御装置100と同様の作用を奏し、同様の効果を奏する。
なお、以上説明した実施形態は、本発明の理解を容易にするために記載されたものであって、本発明を限定するために記載されたものではない。したがって、上記の実施形態に開示された各要素は、本発明の技術的範囲に属する全ての設計変更や均等物をも含む趣旨である。
すなわち、本明細書では、本発明に係る走行制御装置の一態様として、車載装置200ともに走行制御システム1を構成する走行制御装置100を例にして説明するが、本発明はこれに限定されるものではない。
本明細書では、対象情報取得手段と、設定手段と、制御手段と、を備える走行制御装置の一例として、対象情報取得機能と、領域設定機能と、制御機能とを実行する制御装置10を備える走行制御装置100を例にして説明するが、これに限定されるものではない。本明細書では、自車情報取得手段をさらに備える走行制御装置の一例として、制御装置10が自車情報取得機能を実行する走行制御装置100を例にして説明するが、これに限定されるものではない。本明細書では、出力手段をさらに備える走行制御装置の一例として、出力装置30,110をさらに備える走行制御装置100を例にして説明するが、これに限定されるものではない。