(57)【特許請求の範囲】
【請求項１】
自車両前方の立体物を認識する前方立体物認識手段と、
自車進行路を推定する自車進行路推定手段と、
前記自車進行路上に前記立体物が存在するとき、当該立体物の中から制御対象物を選定する制御対象物選定手段と、
自車速に応じて変化する前方注視点を前記自車進行路上に設定する前方注視点設定手段と、
前記制御対象物に対して自車両が衝突する可能性が高いと判定したとき、前記制御対象物に自車両との衝突予想面を設定し、前記衝突予想面において前記自車進行路及び前記前方注視点を反射させた反射進行路及び反射注視点を設定する反射手段と、
前記自車進行路に接し、且つ、前記反射注視点において前記反射進行路に接する接円の円弧を前記制御対象物との衝突回避のための走行軌跡として設定する走行軌跡設定手段と、を備えたことを特徴する車両の運転支援装置。
【発明の詳細な説明】
【技術分野】
【０００１】
本発明は、ステレオカメラ、レーザーレーダ等で検出した前方の立体物に対して接触を回避するための制御を行う車両の運転支援装置に関する。
【背景技術】
【０００２】
近年、自動車等の車両においては、カメラで撮像した画像やレーダ装置から発射された電波の反射波等を解析して車両の周囲に存在する物体を検出し、検出した物体の情報に基づいて自車両と他の物体との衝突の可能性の有無を判断し、衝突の可能性がある場合には警報を鳴らしてドライバの注意を喚起したり、衝突を回避するように自動操舵や制動制御を行ったりする等の運転支援制御を行う技術が開示されている。
【０００３】
例えば、特許文献１には、進行方向前方に存在する物体を検知し、物体の検知結果と所定の接触判定条件とに基づき、自車両と物体との接触に係る判定を行い、その判定結果に応じてスロットルアクチュエータ、ブレーキアクチュエータ、ステアリングアクチュエータ、報知装置等を適切なタイミングで作動させる技術が開示されている。
【先行技術文献】
【特許文献】
【０００４】
【特許文献１】特開２０１０−２６０５０４号公報
【発明の概要】
【発明が解決しようとする課題】
【０００５】
ところで、この種の運転支援装置において、自車進行路上の障害物（制御対象物）との衝突回避を操舵によって行う場合、時々刻々と変化する物体との相対関係等に応じて、自車両が採るべき好適な走行軌跡を、簡便な方法によって設定することが重要となる。
【０００６】
本発明は上記事情に鑑みてなされたもので、自車進行路上の制御対象物との衝突回避のために好適な走行軌跡を、簡便な方法によって設定することができる車両の運転支援装置を提供することを目的とする。
【課題を解決するための手段】
【０００７】
本発明の一態様による車両の運転支援装置は、自車両前方の立体物を認識する前方立体物認識手段と、自車進行路を推定する自車進行路推定手段と、前記自車進行路上に前記立体物が存在するとき、当該立体物の中から制御対象物を選定する制御対象物選定手段と、自車速に応じて変化する前方注視点を前記自車進行路上に設定する前方注視点設定手段と、前記制御対象物に対して自車両が衝突する可能性が高いと判定したとき、前記制御対象物に自車両との衝突予想面を設定し、前記衝突予想面において前記自車進行路及び前記前方注視点を反射させた反射進行路及び反射注視点を設定する反射手段と、前記自車進行路に接し、且つ、前記反射注視点において前記反射進行路に接する接円の円弧を前記制御対象物との衝突回避のための走行軌跡として設定する走行軌跡設定手段と、を備えたものである。
【発明の効果】
【０００８】
本発明の車両の運転支援装置によれば、自車進行路上の制御対象物との衝突回避のために好適な走行軌跡を、簡便な方法によって設定することができる。
【図面の簡単な説明】
【０００９】
【図１】運転支援装置の概略構成図
【図２】立体物の選定領域を示す説明図
【図３】衝突予想面と回避走行軌跡を示す説明図
【図４】衝突予想面と回避走行軌跡を示す説明図
【図５】衝突回避制御ルーチンを示すフローチャート
【発明を実施するための形態】
【００１０】
以下、図面を参照して本発明の形態を説明する。図面は本発明の一実施形態に係り、図１は運転支援装置の概略構成図、図２は立体物の選定領域を示す説明図、図３，４は衝突予想面と回避走行軌跡を示す説明図、図５は衝突回避制御ルーチンを示すフローチャートである。
【００１１】
図１において、符号１は自動車等の車両（自車両）であり、この車両１には運転支援装置２が搭載されている。この運転支援装置２は、例えば、ステレオカメラ３、ステレオ画像認識装置４、制御ユニット５等を有して構成されている。
【００１２】
また、自車両１には、自車速Ｖを検出する車速センサ１１、ヨーレートγを検出するヨーレートセンサ１２、運転支援制御の各種機能のＯＮ−ＯＦＦ切替等を行うメインスイッチ１３、ステアリングホイールに連結するステアリング軸に対設されて舵角θｓｔを検出する舵角センサ１４ａ、操舵トルクをＴｄｒｖを検出する操舵トルクセンサ１４ｂ、ドライバによるアクセルペダルの踏込量（アクセル開度）θａｃｃを検出するアクセル開度センサ１５等が設けられている。
【００１３】
ステレオカメラ３は、ステレオ画像光学系として、例えば電荷結合素子（ＣＣＤ）等の固体撮像素子を用いた１組のＣＣＤカメラで構成されている。これら左右のＣＣＤカメラは、それぞれ車室内の天井前方に一定の間隔を持って取り付けられ、車外の対象を異なる視点からステレオ撮像し、画像データをステレオ画像認識装置４に出力する。なお、以下の説明において、ステレオ撮像された画像のうち一方の画像（例えば、右側の画像）を基準画像と称し、他方の画像（例えば、左側の画像）を比較画像と称す。
【００１４】
ステレオ画像認識装置４は、先ず、基準画像を４×４画素の小領域に分割し、それぞれの小領域の輝度或いは色のパターンを比較画像と比較して対応する領域を見つけ出し、基準画像全体に渡る距離分布を求める。さらに、ステレオ画像認識装置４は、基準画像上の各画素について隣接する画素との輝度差を調べ、これらの輝度差が閾値を超えているものをエッジ点として抽出するとともに、抽出した画素（エッジ点）に距離情報を付与することで、距離画像（距離情報を備えたエッジ点の分布画像）を生成する。そして、ステレオ画像認識装置４は、生成した距離画像に対して周知のグルーピング処理を行い、予め記憶しておいた３次元的な枠（ウインドウ）と比較することで、自車前方の白線、側壁、立体物等を認識する。
【００１５】
ここで、本実施形態において認識対象となる白線とは、例えば、単一の車線区画線で構成される白線（一重白線）や車線区画線の内側に補助区画線が併設される白線（二重白線）のように、道路上に延在して自車走行レーンを区画する線を総称するものであり、各線の形態としては、実線、破線等を問わず、さらに、黄色線等を含む。また、本実施形態の白線認識においては、道路上に実在する白線が二重白線であっても、左右それぞれ単一の近似線で近似して認識するものとする。
【００１６】
また、ステレオ画像認識装置４は、立体物認識において、例えば、ウインドウとの比較結果等に基づき、検出した立体物が普通車、大型車、歩行者、或いは、その他の立体物（側壁や路上落下物等）の何れの種別に属するかの認識を行うとともに、立体物幅等の認識を行う。なお、ステレオ画像認識装置４は、遠方において検出した立体物が普通車、大型車、或いは、歩行者等として区別できないと判断した場合、当該立体物をその他の立体物として認識する。このように、本実施形態において、ステレオ画像認識装置４は、ステレオカメラ３とともに、前方立体物認識手段としての機能を実現する。
【００１７】
制御ユニット５には、ステレオ画像認識装置４で認識された自車両１前方の走行環境情報が入力される。さらに、制御ユニット５には、自車両１の走行情報として、車速センサ１１からの車速Ｖ、ヨーレートセンサ１２からのヨーレートγ等が入力されるとともに、ドライバによる操作入力情報として、メインスイッチ１３からの操作信号、舵角センサ１４ａからの舵角θｓｔ、操舵トルクセンサ１４ｂからの操舵トルクＴｄｒｖ、アクセル開度センサ１５からのアクセル開度θａｃｃ等が入力される。
【００１８】
自車両１前方の立体物情報を含む走行環境情報がステレオ画像認識装置４から入力されると、制御ユニット５は、各種運転支援制御の制御対象となる立体物の選定を行う。この立体物の選定に際し、制御ユニット５は、例えば、図２に示すように、先ず、自車進行路を推定し、推定した自車進行路に沿った所定幅の領域を立体物の選定領域Ａｓとして設定する。なお、自車進行路は、例えば、自車両１の車速Ｖとヨーレートγとに基づいて設定される。そして、制御ユニット５は、設定した選定領域Ａｓにラップしている立体物を自車進行路上の立体物として抽出し、抽出した立体物の中から自車両１に最も近い立体物を制御対象物として選定する。
【００１９】
そして、例えば、ドライバによるメインスイッチ１３の操作を通じて、運転支援制御の機能の１つであるＡＣＣ（Adaptive Cruise Control）機能の実行が指示されると、制御ユニット５は、自車進行路上に制御対象物として先行車（普通車、或いは、大型車等）を選定しているか否かの判定を行う。その結果、制御対象物として先行車が選定されていない場合、制御ユニット５は、スロットル弁１６の開閉制御（エンジンの出力制御）を通じて、ドライバが設定したセット車速に自車両１の車速Ｖを維持させる定速走行制御を実行する。一方、制御対象物として先行車が選定され、且つ、当該先行車の車速がセット車速以下の場合、制御ユニット５は、先行車との車間距離を目標車間距離に収束させながら追従する追従走行制御を実行する。この追従走行制御において、制御ユニット５は、基本的にはスロットル弁１６の開閉制御（エンジンの出力制御）を通じて、先行車との車間距離を目標車間距離に収束させる。
【００２０】
さらに、制御ユニット５は、制御対象物（先行車、歩行者、或いは、側壁等のその他の立体物）に対して衝突の可能性が高いと判断した場合、当該制御対象物に対する衝突回避制御を実行する。
【００２１】
この衝突回避制御はＡＣＣの実行中等においても適宜実行されるものであり、制御ユニット５は、基本的には、ブレーキの自動介入制御を用いて制御対象物との衝突回避制御を行う。但し、制御ユニット５は、操舵による制御対象物との衝突回避の可能性を判定し、操舵による衝突回避が可能であると判定した場合、操舵の自動介入制御を用いた衝突回避制御を、ブレーキの自動介入制御よりも優先して実行する。
【００２２】
具体的に説明すると、制御ユニット５は、自車両１の前方に存在する制御対象物との衝突の可能性等を判定する。また、制御ユニット５は、自車進行路の前方に、例えば、車速Ｖに応じた前方注視点を設定する。そして、制御ユニット５は、制御対象物に対して自車両１が衝突する可能性が高いと判定したとき、当該制御対象物に自車両１との衝突予想面を設定し、衝突予想面において自車進行路及び前方注視点を反射させた反射進行路及び反射注視点を演算する。さらに、制御ユニット５は、自車進行路に接し、且つ、反射注視点において反射進行路に接する接円の円弧を、制御対象物との衝突回避のための走行軌跡として設定する。そして、制御ユニット５は、例えば、設定した走行軌跡の曲率半径が現在の自車両１の走行状態（車速Ｖ等）において安全に旋回し得る曲率半径であると判定した場合、電動パワーステアリングモータ１８の出力制御（操舵の自動介入制御）を用いた旋回による衝突回避制御を行う。一方、制御ユニット５は、例えば、設定した走行軌跡の曲率半径が現在の自車両１の走行状態（車速Ｖ等）において安全に旋回し得る曲率半径でないと判定した場合、ブレーキブースタ１７からの出力液圧の制御（ブレーキの自動介入制御）を用いた減速による衝突回避制御を行う。
【００２３】
このように、本実施形態において、制御ユニット５は、自車進行路推定手段、制御対象物選定手段、前方注視点設定手段、反射手段、及び、走行軌跡設定手段としての各機能を実現する。
【００２４】
次に、制御対象物に対する衝突回避制御について、図５に示す衝突回避制御ルーチンのフローチャートに従って説明する。このルーチンは設定時間毎に繰り返し実行されるものであり、ルーチンがスタートすると、制御ユニット５は、先ず、ステップＳ１０１において、現在、自車進行路上に制御対象物が存在するか否かを調べる。
【００２５】
そして、ステップＳ１０１において、自車進行路上に制御対象物が存在しないと判定した場合、制御ユニット５は、そのままルーチンを抜ける。
【００２６】
一方、ステップＳ１０１において、自車進行路上に制御対象物が存在すると判定した場合、制御ユニット５は、ステップｓ１０２に進み、自車両１と制御対象物との衝突の可能性を判定する。
【００２７】
すなわち、ステップＳ１０２において、制御ユニット５は、例えば、自車両１と制御対象物との相対距離Ｄrel及び相対速度Ｖrelを算出し、相対距離Ｄrelを相対速度Ｖrelで除した値を衝突予測時間ＴＴＣ（Time To Collision）として算出する。そして、制御ユニット５は、ステップＳ１０２において、算出した衝突予測時間ＴＴＣが予め設定された閾値Ｔth以上である場合、自車両１と制御対象物との衝突の可能性が低いと判定し、そのままルーチンを抜ける。
【００２８】
一方、制御ユニット５は、ステップＳ１０２において、算出した衝突予測時間ＴＴＣが閾値Ｔth未満であると判定した場合、自車両１と制御対象物との衝突の可能性が高いと判定し、ステップＳ１０３に進む。
【００２９】
ステップＳ１０２からステップＳ１０３進むと、制御ユニット５は、自車進行路の前方に前方注視点を設定する。すなわち、ステップＳ１０３において、制御ユニット５は、例えば、現在の車速Ｖに設定時間Ｔ０を乗算した距離を算出し、当該距離だけ前方に離間した自車進行路上の点を、前方注視点として設定する。
【００３０】
続くステップＳ１０４において、制御ユニット５は、制御対象物に対し、自車両１が衝突する際の衝突予想面を設定する。すなわち、制御ユニット５は、例えば、図３，４に示すように、制御対象物を構成する距離画像上のエッジ点の点群のうち、自車両１に対向する側に分布するエッジ点の点群を用いて、衝突予想面を設定する。より具体的には、本実施形態において、制御ユニット５は、衝突予想面を路面上に二次元的に設定するものであり、制御対象物を構成する距離画像上の各エッジ点を路面上に投影し、投影した各エッジ点から求めたハフ直線等を衝突予想面として設定する。
【００３１】
続くステップＳ１０５において、制御ユニット５は、自車進行路及び前方注視点を衝突予想面において仮想的に反射させることにより、反射進行路及び反射注視点を設定する。すなわち、制御ユニット５は、例えば、図３，４に示すように、自車進行路及び前方注視点を、衝突予想面に対する入射角θと等しい反射角θで反射させることにより、反射進行路及び反射注視点を設定する。
【００３２】
続くステップＳ１０６において、制御ユニット５は、自車進行路、反射進行路、及び、反射注視点に基づき、自車両１が制御対象物との衝突を回避するための走行軌跡を設定する。すなわち、制御ユニット５は、例えば、図３，４に示すように、自車進行路に接し、且つ、反射注視点において反射進行路に接する接円の円弧を、制御対象物との衝突回避のための走行軌跡として一義的に設定する。
【００３３】
そして、ステップＳ１０６からステップＳ１０７に進むと、制御ユニット５は、ステップＳ１０６で設定した走行軌跡の曲率半径Ｒが、現在の自車両１の走行状態において安全に旋回し得る曲率半径であるか否かを調べる。すなわち、制御ユニット５には、例えば、自車両１が安全に旋回し得る車速Ｖ毎の曲率半径の閾値Ｒth（Ｖ）が予めマップ化されて格納されており、制御ユニット５は、走行軌跡の曲率半径Ｒと閾値Ｒth（Ｖ）との比較により、自車両１が走行軌跡に沿って安全に旋回し得るか否かを調べる。
【００３４】
そして、ステップＳ１０７において、走行軌跡の曲率半径Ｒが閾値Ｒth（Ｖ）以上であり、自車両１が安全に旋回可能であると判定した場合、制御ユニット５は、ステップＳ１０８に進み、電動パワーステアリングモータ１８の出力制御（操舵の自動介入制御）を用いた旋回による衝突回避制御を行った後、ルーチンを抜ける。
【００３５】
一方、ステップＳ１０７において、走行軌跡の曲率半径Ｒが閾値Ｒth（Ｖ）未満であり、自車両１が安全に旋回できないと判定した場合、制御ユニット５は、ステップＳ１０９に進み、ブレーキブースタ１７からの出力液圧の制御（ブレーキの自動介入制御）を用いた減速による衝突回避制御を行った後、ルーチンを抜ける。
【００３６】
このような実施形態によれば、自車速に応じて変化する前方注視点を自車進行路上に設定する前方注視点設定手段と、自車進行路上の制御対象物に対して自車両１が衝突する可能性が高いと判定したとき、制御対象物に自車両１との衝突予想面を設定し、衝突予想面において自車進行路及び前方注視点を反射させた反射進行路及び反射注視点を設定する反射手段と、自車進行路に接し、且つ、反射注視点において反射進行路に接する接円の円弧を制御対象物との衝突回避のための走行軌跡として設定する走行軌跡設定手段と、を備えて制御ユニット５を構成することにより、自車進行路上の制御対象物との衝突回避のために好適な走行軌跡を、簡便な方法によって設定することができる。
【００３７】
すなわち、制御対象物に対して自車進行路及び前方注視点を仮想的に反射させた反射進行路及び反射注視点という概念を導入し、これら反射進行路及び反射注視点と、自車進行路とに基づいて円弧による走行軌跡を一義的に設定することにより、時々刻々変化する制御対象物との相対関係に基づいて、衝突回避のための走行軌跡を簡便な方法によって設定することができる。
【００３８】
この場合において、前方注視点が最適な位置に設定されるよう設定時間Ｔ０等をチューニングすることにより、反射注視点における接円弧によって定義される走行軌跡のチューニング等を容易に実現することができる。
【００３９】
また、反射進行路及び反射注視点は自車両１に対する衝突予想面の傾斜状態に応じて変化するものであり、衝突予想面が自車両１に対して正対しているほど、反射進行路及び反射注視点の反射角θが大きくなり、走行軌跡の曲率半径Ｒが小さく設定される。この場合、旋回による衝突回避制御がキャンセルされて制動による衝突回避制御が実行されるので、一般的に衝突予想面が自車両１に対して正対していることが想定される先行車等に対しては適切な追従停止制御等を実現することができる。逆に、衝突予想面が自車両１に対して大きく傾斜することが想定される側壁等に対しては、走行軌跡の曲率半径Ｒが大きく設定されるので、旋回による衝突回避制御を的確に実行することができる。
【００４０】
なお、本発明は、以上説明した各実施形態に限定されることなく、種々の変形や変更が可能であり、それらも本発明の技術的範囲内である。
【符号の説明】
【００４１】
１  …  車両（自車両）
２  …  運転支援装置
３  …  ステレオカメラ（前方立体物認識手段）
４  …  ステレオ画像認識装置（前方立体物認識手段）
５  …  制御ユニット（自車進行路推定手段、制御対象物選定手段、前方注視点設定手段、反射手段、走行軌跡設定手段）
１１  …  車速センサ
１２  …  ヨーレートセンサ
１３  …  メインスイッチ
１４ａ  …  舵角センサ
１４ｂ  …  操舵トルクセンサ
１５  …  アクセル開度センサ
１６  …  スロットル弁
１７  …  ブレーキブースタ
１８  …  電動パワーステアリングモータ
【図１】
0006535537.tif 000002
【図２】
0006535537.tif 000003
【図３】
0006535537.tif 000004
【図４】
0006535537.tif 000005
【図５】
0006535537.tif 000006