(57)【特許請求の範囲】
【請求項１】
異なる視点それぞれから車載カメラにより車両の周囲を撮影することにより取得された互いに視差を有する複数の画像を表す画像データに基づいて、前記車両の周囲の路面及び立体物を検出する第１検出部と、
ミリ波レーダにより前記立体物を検出する第２検出部と、
前記第１検出部及び前記第２検出部のいずれかの検出結果に基づいて、前記立体物を検出する検出制御部と、
を備え、
前記検出制御部は、
前記第１検出部により前記路面を検出可能である前記車両からの距離の範囲においては、前記第１検出部による検出結果に基づいて前記立体物を検出し、
前記第１検出部により前記路面を検出不可能である前記車両からの距離の範囲においては、前記第１検出部及び第２検出部による検出結果に基づいて前記立体物を検出する、立体物検出装置。
【請求項２】
前記検出制御部は、
予め設定された時間内に、前記第１検出部により前記路面を検出不可能である前記車両からの距離の範囲において前記第１検出部により検出されずに、前記第１検出部により前記路面を検出可能である前記車両からの距離の範囲において連続して前記第１検出部により検出された回数が閾値を超えている前記立体物については、前記第１検出部による検出結果に基づいて、前記立体物を検出し、
前記予め設定された時間内に、前記第１検出部により前記路面を検出不可能である前記車両からの距離の範囲において前記第１検出部により検出されずに、前記第１検出部により前記路面を検出可能である前記車両からの距離の範囲において連続して前記第１検出部により検出された回数が前記閾値以下である前記立体物については、前記第１検出部及び前記第２検出部による検出結果に基づいて、前記立体物を検出する、請求項１に記載の立体物検出装置。
【請求項３】
前記検出制御部により検出された立体物に応じて、前記車両の加速、減速及び操舵のいずれかを制御する車両制御を実行する車両制御部をさらに備えた、請求項１又は２に記載の立体物検出装置。
【請求項４】
立体物検出装置の第１検出部により、異なる視点それぞれから車載カメラにより車両の周囲を撮影することにより取得された互いに視差を有する複数の画像を表す画像データに基づいて、前記車両の周囲の路面及び立体物を検出する第１検出工程と、
前記立体物検出装置の第２検出部により、ミリ波レーダにより前記立体物を検出する第２検出工程と、
前記立体物検出装置の検出制御部により、前記第１検出工程及び前記第２検出工程のいずれかの検出結果に基づいて、前記立体物を検出する検出制御工程と、
を備え、
前記検出制御工程では、
前記第１検出部により前記路面を検出可能である前記車両からの距離の範囲においては、前記検出制御部により、前記第１検出工程による検出結果に基づいて前記立体物を検出し、
前記第１検出部により前記路面を検出不可能である前記車両からの距離の範囲においては、前記検出制御部により、前記第１検出工程及び前記第２検出工程による検出結果に基づいて前記立体物を検出する、立体物検出方法。
【請求項５】
前記検出制御工程では、
予め設定された時間内に、前記第１検出部により前記路面を検出不可能である前記車両からの距離の範囲において前記第１検出部により検出されずに、前記第１検出部により前記路面を検出可能である前記車両からの距離の範囲において連続して前記第１検出部により検出された回数が閾値を超えている前記立体物については、前記検出制御部により、前記第１検出部による検出結果に基づいて前記立体物を検出し、
前記予め設定された時間内に、前記第１検出部により前記路面を検出不可能である前記車両からの距離の範囲において前記第１検出部により検出されずに、前記第１検出部により前記路面を検出可能である前記車両からの距離の範囲において連続して前記第１検出部により検出された回数が前記閾値以下である前記立体物については、前記検出制御部により、前記第１検出部及び前記第２検出部による検出結果に基づいて前記立体物を検出する、請求項４に記載の立体物検出方法。
【請求項６】
前記立体物検出装置の車両制御部により、前記検出制御部により検出された立体物に応じて、前記車両の加速、減速及び操舵のいずれかを制御する車両制御を実行する車両制御工程をさらに備えた、請求項４又は５に記載の立体物検出方法。
【発明の詳細な説明】
【技術分野】
【０００１】
本発明の一側面及び他の側面は、立体物検出装置及び立体物検出方法に関する。
【背景技術】
【０００２】
異なる視点それぞれから車載カメラにより車両の周囲を撮影することにより取得された互いに視差を有する複数の画像を表す画像データに基づいて、車両の周囲の立体物を検出する技術が提案されている。例えば、特許文献１には、車載のステレオカメラにより取得された互いに視差を有する複数の画像を表す画像データに基づいて、車両の周囲の路面及び立体物を検出する装置が開示されている。
【先行技術文献】
【特許文献】
【０００３】
【特許文献１】米国特許出願公開第２０１４／００７１２４０号明細書
【発明の概要】
【発明が解決しようとする課題】
【０００４】
ところで、上記特許文献１の装置においては、実際には存在する立体物を検出することができない場合や、路面の模様等を立体物として誤検出する場合があり、改善が望まれている。
【０００５】
そこで本発明は、立体物の検出の信頼性を向上させることができる立体物検出装置及び立体物検出方法を提供することを目的とする。
【課題を解決するための手段】
【０００６】
本発明の一側面は、異なる視点それぞれから車載カメラにより車両の周囲を撮影することにより取得された互いに視差を有する複数の画像を表す画像データに基づいて、車両の周囲の路面及び立体物を検出する第１検出部と、ミリ波レーダにより立体物を検出する第２検出部と、第１検出部及び第２検出部のいずれかの検出結果に基づいて、立体物を検出する検出制御部とを備え、検出制御部は、第１検出部により路面を検出可能である範囲においては、第１検出部による検出結果に基づいて立体物を検出し、第１検出部により路面を検出不可能である範囲においては、第１検出部及び第２検出部による検出結果に基づいて立体物を検出する立体物検出装置である。
【０００７】
この構成によれば、検出制御部により、第１検出部により路面を検出可能である範囲においては、路面が検出可能であるために信頼度が高い第１検出部による検出結果に基づいて立体物が検出されるため、立体物を高精度で検出することができる。また、検出制御部により、第１検出部により路面を検出不可能である範囲においては、路面が検出不可能であるために信頼度が低い第１検出部による検出結果と、信頼度が高いミリ波レーダによる第２検出部による検出結果とに基づいて立体物が検出されるため、第１検出部により路面を検出不可能である範囲においても立体物を高精度で検出することができる。したがって、立体物の検出の信頼性を向上させることができる。
【０００８】
この場合、検出制御部は、予め設定された時間内に、第１検出部により路面を検出不可能である範囲において第１検出部により検出されずに、第１検出部により路面を検出可能である範囲において連続して第１検出部により検出された回数が閾値を超えている立体物については、第１検出部による検出結果に基づいて、立体物を検出し、予め設定された時間内に、第１検出部により路面を検出不可能である範囲において第１検出部により検出されずに、第１検出部により路面を検出可能である範囲において連続して第１検出部により検出された回数が閾値以下である立体物については、第１検出部及び第２検出部による検出結果に基づいて、立体物を検出してもよい。
【０００９】
この構成によれば、第１検出部により路面を検出不可能である範囲において第１検出部により検出されずに、第１検出部により路面を検出可能である範囲において連続して第１検出部により検出された回数が閾値を超えており、第１検出部による検出結果の信頼度が高いと考えられる立体物については、検出制御部により、第１検出部による検出結果に基づいて検出され、当該条件を満たさない立体物については、検出制御部により、第１検出部及び第２検出部による検出結果に基づいて検出されるため、第１検出部による誤った検出結果により立体物が検出されることを防止することができる。
【００１０】
また、検出制御部により検出された立体物に応じて、車両の加速、減速及び操舵のいずれかを制御する車両制御を実行する車両制御部をさらに備えていてもよい。
【００１１】
この構成によれば、車両制御部により、検出制御部により高信頼度で検出された立体物に応じて、車両の加速、減速及び操舵のいずれかを制御する車両制御が実行されるため、誤った検出結果に基づいた車両制御が実行されることを防止することができる。
【００１２】
また、本発明の他の側面は、立体物検出装置の第１検出部により、異なる視点それぞれから車載カメラにより車両の周囲を撮影することにより取得された互いに視差を有する複数の画像を表す画像データに基づいて、車両の周囲の路面及び立体物を検出する第１検出工程と、立体物検出装置の第２検出部により、ミリ波レーダにより立体物を検出する第２検出工程と、立体物検出装置の検出制御部により、第１検出工程及び第２検出工程のいずれかの検出結果に基づいて、立体物を検出する検出制御工程とを備え、検出制御工程では、第１検出部により路面を検出可能である範囲においては、検出制御部により、第１検出工程による検出結果に基づいて立体物を検出し、第１検出部により路面を検出不可能である範囲においては、検出制御部により、第１検出工程及び第２検出工程による検出結果に基づいて立体物を検出する立体物検出方法である。
【００１３】
この場合、検出制御工程では、予め設定された時間内に、第１検出部により路面を検出不可能である範囲において第１検出部により検出されずに、第１検出部により路面を検出可能である範囲において連続して第１検出部により検出された回数が閾値を超えている立体物については、検出制御部により、第１検出部による検出結果に基づいて立体物を検出し、予め設定された時間内に、第１検出部により路面を検出不可能である範囲において第１検出部により検出されずに、第１検出部により路面を検出可能である範囲において連続して第１検出部により検出された回数が閾値以下である立体物については、検出制御部により、第１検出部及び第２検出部による検出結果に基づいて立体物を検出してもよい。
【００１４】
また、立体物検出装置の車両制御部により、検出制御部により検出された立体物に応じて、車両の加速、減速及び操舵のいずれかを制御する車両制御を実行する車両制御工程をさらに備えてもよい。
【発明の効果】
【００１５】
本発明の一側面及び他の側面によれば、立体物の検出の信頼性を向上させることができる。
【図面の簡単な説明】
【００１６】
【図１】実施形態の立体物検出装置を示すブロック図である。
【図２】図１の立体物検出装置の動作を示すフローチャートである。
【図３】V-disparity平面に表れた路面の一例を示す図である。
【図４】V-disparityによる路面の検出結果の一例を示す図である。
【図５】視差画像中の横方向位置を横軸とし、視差を縦軸とした視差マップを示す図である。
【図６】撮影された画像中に立体物の検出結果を重畳した一例を示す図である。
【図７】俯瞰した平面に立体物の検出結果を重畳した一例を示す図である。
【図８】V-disparityによる路面の検出結果の別の例を示す図である。
【図９】撮影された画像中に立体物の検出結果を重畳した別の例を示す図である。
【図１０】俯瞰した平面に立体物の検出結果を重畳した別の例を示す図である。
【発明を実施するための形態】
【００１７】
以下、図面を参照して、本発明の実施形態に係る立体物検出装置及び立体物検出方法について説明する。
【００１８】
図１に示すように、第１実施形態に係る立体物検出装置１は、例えば、乗用車等の車両に搭載され、車両の周囲の立体物を検出する。立体物とは、例えば、車両の周囲の路面から突出した物体を意味し、路面と分離した物体及び路面と一体化した物体の両方を含む。路面とは、例えば、車両の走行可能な道路の表面である。なお、路面には、車両の走行する道路の表面の他、駐車場の通路及び駐車スペースの表面が含まれてもよい。
【００１９】
立体物検出装置１は、立体物を検出するためのＥＣＵ［Electronic  Control  Unit］２、ステレオカメラ（車載カメラ）３、ミリ波レーダ６、アクチュエータ７及びＨＭＩ８を備えている。ＥＣＵ２は、ＣＰＵ[Central  Processing  Unit]、ＲＯＭ[Read  Only  Memory]、ＲＡＭ[Random  Access  Memory]等を有する電子制御ユニットである。ＥＣＵ２では、ＲＯＭに記憶されているプログラムをＲＡＭにロードし、ＣＰＵで実行することで、各種の処理を実行する。ＥＣＵ２は、複数の電子制御ユニットから構成されていてもよい。
【００２０】
ステレオカメラ３は、異なる視点それぞれから車載カメラにより車両の周囲を撮影することにより取得された互いに視差を有する複数の画像を取得する画像取得機器である。ステレオカメラ３は、両眼視差を再現するように配置された第１カメラ４及び第２カメラ５を有している。第１カメラ４及び第２カメラ５は、例えば、車両のフロントガラスの裏側に設けられ、車両の前方を撮像する。
【００２１】
第１カメラ４及び第２カメラ５は、例えば、水平方向に所定間隔を隔てて取り付けられているため、物体を撮影すると、視差を有する複数の画像である左画像及び右画像が得られる。得られた２つの画像は視差を有している。このため、２つの画像から、２つの画像間での対応する点である視差点それぞれにおける視差に関する情報を含んだ視差画像を取得することができる。視差画像に基づいて、三角測量の原理により、視差点ごとの路面及び立体物までの距離を求めることができる。
【００２２】
なお、第１カメラ４及び第２カメラ５は、車両の側部又は車両の後部（例えばリアガラスの裏側）に設けられ、車両の側方又は後方を撮像してもよい。また、ステレオカメラ３は、３つ以上のカメラにより、３つ以上の異なる視点から車両の周囲を撮影することにより、互いに視差を有する３つ以上の画像を取得してもよい。ステレオカメラ３は、撮影した互いに視差を有する複数の画像を表す画像データをＥＣＵ２へ送信する。
【００２３】
なお、立体物検出装置１は、ステレオカメラ３に代えて、単眼カメラを備えていてもよい。単眼カメラにおいても、周知の手法（例えば撮像の時間差を利用した手法）を用いることにより、視差画像を得ることができる。
【００２４】
ミリ波レーダ６は、例えば、車両の車体前端及び車両の車体後端に設けられ、ミリ波を利用して車両前後の立体物を検出する。ミリ波レーダ６は、更に車両の側面に設けられ、自車両の側方の立体物を検出してもよい。ミリ波レーダ６は、例えば、ミリ波を車両の前後に送信し、他車両等の立体物に反射したミリ波を受信することで立体物を検出する。立体物は、複数の検出点として検出される。ミリ波レーダ６は、検出した立体物情報をＥＣＵ２へ送信する。立体物情報には、立体物（各検出点）の方向及び距離に関する情報が含まれる。
【００２５】
アクチュエータ７は、車両の走行制御を実行する装置である。アクチュエータ７は、スロットルアクチュエータ、ブレーキアクチュエータ及びステアリングアクチュエータを少なくとも含む。スロットルアクチュエータは、ＥＣＵ２からの制御信号に応じてエンジンに対する空気の供給量（スロットル開度）を制御し、車両の駆動力を制御する。なお、車両がハイブリッド車又は電気自動車である場合には、スロットルアクチュエータを含まず、動力源としてのモータにＥＣＵ２からの制御信号が入力されて当該駆動力が制御される。
【００２６】
ブレーキアクチュエータは、ＥＣＵ２からの制御信号に応じてブレーキシステムを制御し、車両の車輪へ付与する制動力を制御する。ブレーキシステムとしては、例えば、液圧ブレーキシステムを用いることができる。ステアリングアクチュエータは、電動パワーステアリングシステムのうちステアリングトルクを制御するアシストモータの駆動を、ＥＣＵ２からの制御信号に応じて制御する。これにより、ステアリングアクチュエータは、車両のステアリングトルクを制御する。
【００２７】
ＨＭＩ８は、車両の乗員（運転者を含む）と立体物検出装置１との間で情報の出力及び入力をするためのインターフェイスである。ＨＭＩ８は、例えば、乗員に画像情報を表示するためのディスプレイパネル、音声出力のためのスピーカ及び乗員が入力操作を行うための操作ボタン又はタッチパネルなどを備えている。ＨＭＩ８は、無線で接続された携帯情報端末を利用して、乗員に対する情報の出力を行ってもよく、携帯情報端末を利用して乗員による入力操作を受け付けてもよい。
【００２８】
次に、ＥＣＵ２の機能的構成について説明する。図１に示すように、ＥＣＵ２は、第１検出部１１、第２検出部１２、検出制御部１３及び車両制御部１４を有している。第１検出部１１は、異なる視点それぞれからステレオカメラ３により車両の周囲を撮影することにより取得された互いに視差を有する複数の画像を表す画像データに基づいて、車両の周囲の路面及び立体物を検出する。
【００２９】
第２検出部１２は、ミリ波レーダ６により立体物を検出する。第２検出部１２は、ミリ波レーダ６からの立体物情報に基づいて複数の検出点を検出し、ミリ波レーダ６から見た各検出点の方向及び距離を認識することにより立体物を検出する。
【００３０】
検出制御部１３は、第１検出部１１及び第２検出部１２のいずれかの検出結果に基づいて、立体物を検出する。より詳細には、検出制御部１３は、第１検出部１１により路面を検出不可能である範囲においては、第１検出部１１による検出結果に基づいて立体物を検出し、第１検出部１１により路面を検出不可能である範囲においては、第１検出部１１及び第２検出部１２による検出結果に基づいて立体物を検出する。第１検出部１１及び第２検出部１２のいずれかの検出結果を選択する方法の詳細については後述する。
【００３１】
車両制御部１４は、検出制御部１３により検出された立体物に応じて、車両の加速、減速及び操舵のいずれかを制御する車両制御を実行する。立体物に応じた車両制御は、例えば、立体物の距離、位置、大きさ及び速度等に基づいて行われる。車両制御部１４は、アクチュエータ７に制御信号を出力することにより、アクチュエータ７のスロットルアクチュエータにより車両の加速を制御し、アクチュエータ７のブレーキアクチュエータにより車両の減速を制御し、アクチュエータ７のステアリングアクチュエータにより車両の操舵を制御する。また、車両制御部１４は、検出制御部１３により検出された立体物に応じて、ＨＭＩ８により乗員に必要な情報を提供する。
【００３２】
以下、本実施形態の立体物検出装置１の動作について説明する。図２に示すように、第１検出工程として、立体物検出装置１のＥＣＵ２の第１検出部１１により、異なる視点それぞれからステレオカメラ３により車両の周囲を撮影することにより取得された互いに視差を有する複数の画像を表す画像データに基づいて、車両の周囲の路面及び立体物が検出される（Ｓ１）。
【００３３】
第１検出部１１は、視差点での視差に基づいて車両の周囲の路面を検出する。視差点での視差に基づいた路面の検出は、例えば、公知のv-disparityにより行うことができる。図３に示すように、v-disparityは、横軸に視差（視差が示す距離）をとり、縦軸に視差画像での垂直方向の座標をとり、視差画像に対して水平方向のヒストグラムを求めたグラフである。視差画像において、路面の領域は、例えば、視差画像の垂直方向の座標が上方に変化するのに伴って、視差が滑らかに減少する（視差が示す距離が増大する）。そのため、図３に示すように、v-disparity平面においては、路面は斜め方向に伸びる線分として射影される。
【００３４】
v-disparityに基づいて、図４に示すように路面が推定される。ステレオカメラ３では、距離が遠くなるほど視差が小さくなり、視差点により確実に路面を検出することが難しくなる。本実施形態では、視差画像の視差点から確実に路面を検出できる距離の閾値を路面検出距離ｄｔｈとする。また、車両から路面検出距離ｄｔｈ以内の距離が、路面を検出可能な範囲であると定める。路面検出距離ｄｔｈは車両が走行する走行環境によって変化する。視差点から確実に路面を検出できない場合でも、図４に破線で示すように、車両から近距離側の勾配を基にして遠方の路面が推定されてもよい。しかし、本実施形態では、路面検出距離ｄｔｈ以下の距離を確実に路面を検出できる範囲とし、視差点により路面を検出することにより、遠方の路面の勾配の変化に対応することができる。図４の例では、車両から３５ｍの距離が路面検出距離ｄｔｈである。
【００３５】
第１検出部１１は、上記のようにして検出された路面と視差点とに基づいて立体物を検出する。第１検出部１１は、図５に示すような視差投票マップを設定する。図５の視差投票マップでは、横方向の辺が視差画像の水平方向の座標に対応するように定められ、且つ縦方向の辺が視差の大きさに対応するように定められた複数の矩形状のブロックを配列させて構成されている。視差投票マップの複数の矩形状のブロックそれぞれは、視差画像内において、設定された範囲内の水平方向の座標と設定された範囲内の視差とを有する視差点の集合を示す。
【００３６】
第１検出部１１は、図５に示すような視差投票マップのブロックそれぞれに対応した視差点を分類（投票）する。第１検出部１１は、視差投票マップのブロックそれぞれに、視差点それぞれの視差画像における水平方向座標、視差点それぞれの視差、視差点それぞれの視差画像における垂直方向座標及び視差点の数を関連付けて記憶する。例えば、路面上に立体物が存在する場合には、視差投票マップの互いに隣接する複数のブロックにおいて、同程度の視差を有し、上記のようにして検出した路面の視差点の垂直方向座標よりも上方向の垂直方向座標を有する視差点が数多く分類されている場合は、当該視差点は立体物を示していると推定することができる。以上のようにして、第１検出部１１は、車両の周囲の路面及び立体物を検出する。
【００３７】
図２に示すように、第２検出工程として、立体物検出装置１のＥＣＵ２の第２検出部１２は、ミリ波レーダ６により立体物を検出する（Ｓ２）。検出制御工程として、立体物検出装置１のＥＣＵ２の検出制御部１３により、第１検出工程及び第２検出工程のいずれかの検出結果に基づいて、立体物が検出される（Ｓ３）。検出制御工程では、第１検出部１１により路面を検出可能である範囲においては（Ｓ４）、検出制御部１３により、第１検出工程による検出結果に基づいて立体物が検出される（Ｓ５）。一方、第１検出部１１により路面を検出不可能である範囲においては（Ｓ４）、検出制御部１３により、第１検出工程及び第２検出工程による検出結果に基づいて立体物が検出される（Ｓ６）。
【００３８】
なお、第１検出部１１による検出結果に基づいて立体物が検出されるとは、例えば、第１検出部１１による検出結果のみに基づいて立体物が検出されることを意味する。また、第１検出部１１及び第２検出部１２による検出結果に基づいて立体物が検出されるとは、例えば、第１検出部１１による検出結果により立体物が検出され、且つ第２検出部１２による検出結果により当該立体物が検出されている場合に、当該立体物の存在が検出されることを意味する。
【００３９】
検出制御工程においては、予め設定された時間内に、第１検出部１１により路面を検出不可能である範囲において第１検出部１１により検出されずに、第１検出部１１により路面を検出可能である範囲において連続して第１検出部１１により検出された回数が閾値（例えば、２回）を超えている立体物については、検出制御部１３により、第１検出部１１による検出結果に基づいて立体物が検出される。予め設定された時間内に、一回でも第１検出部１１により路面を検出不可能である範囲において第１検出部１１により検出された立体物については、検出制御部１３により上記の回数が０回に初期化される。
【００４０】
一方、予め設定された時間内に、第１検出部１１により路面を検出不可能である範囲において第１検出部１１により検出されずに、第１検出部１１により路面を検出可能である範囲において連続して第１検出部により検出された回数が上記閾値以下である立体物については、検出制御部１３により、第１検出部１１及び第２検出部１２による検出結果に基づいて、立体物が検出される。なお、上記の予め設定された時間は、車両からの距離が長いほど長くなるように設定されてもよい。また、上記閾値は、車両からの距離が長いほど多くなるように設定されてもよい。
【００４１】
以下、本実施形態の立体物検出装置１の検出結果の例について説明する。図６の画像Ｉ１及び図７の俯瞰した平面に実線の枠内に検出された立体物Ｂｉは、路面を検出可能である範囲において第１検出部１１による検出結果に基づいて検出された立体物である。一方、図６及び図７に破線の枠内に検出された立体物Ｂｏは、路面を検出不可能である範囲において第１検出部１１による検出結果に基づいて検出された立体物である。図６及び図７の例では、対向車は、路面を検出可能な範囲に存在するため、ステレオカメラ３の画像データに基づいた第１検出部１１による検出結果に基づいて検出されている。また、看板やガードレール等の路側物は、路面を検出可能な範囲に存在するため、ステレオカメラ３の画像データに基づいた第１検出部１１による検出結果に基づいて検出されている。これにより、ミリ波レーダ６では検出が難しい路側物の検出を高精度で行うことができる。
【００４２】
一方、図６及び図７の例では、先行車両は路面を検出不可能な範囲に存在するため、ステレオカメラ３の画像データに基づいた第１検出部１１による検出結果と合せて、図７に複数の検出点によって示すように、ミリ波レーダ６を用いた第２検出部１２による検出結果に基づいて検出されている。図７の例では、第１検出部１１による検出結果により先行車両である立体物が検出され、且つ第２検出部１２による検出結果により当該先行車両である立体物が検出されているため、検出制御部１３により、当該先行車両である立体物の存在が検出されている。
【００４３】
また、図８に示すように路面に急激な勾配の変化がある状況での立体物の検出結果を図９及び図１０に示す。図９の画像Ｉ２及び図１０の俯瞰した平面に示すように、路面に急激な勾配の変化が有り、路面の模様は路面を検出不可能な範囲に存在するため、第１検出部１１による検出結果では、路面を検出不可能な範囲の路面の模様を立体物Ｂｏであると誤って検出している。しかし、図１０に示すように、路面を検出不可能な範囲では、第１検出部１１による検出結果と合せて、ミリ波レーダ６を用いた第２検出部１２による検出結果に基づいて立体物が検出される。図１０の例では、第１検出部１１による検出結果では、路面の模様である立体物Ｂｏが検出されているが、第２検出部１２による検出結果では、路面の模様である立体物Ｂｏは検出されていないため、検出制御部１３により、路面の模様である立体物Ｂｏの存在は検出されない。これにより、誤検出を防止することができる。
【００４４】
図２に示すように、車両制御工程として、立体物検出装置１のＥＣＵ２の車両制御部１４により、検出制御部１３により検出された立体物の距離、位置、大きさ及び速度等に応じて、車両の加速、減速及び操舵のいずれかを制御する車両制御が実行される（Ｓ７）。例えば、立体物と車両との距離が所定の距離閾値以下になったときには、車両制御部１４により、アクチュエータ７のブレーキアクチュエータにより車両の減速が制御される。
【００４５】
本実施形態によれば、検出制御部１３により、第１検出部１１により路面を検出可能である範囲においては、路面が検出可能であるために信頼度が高い第１検出部１１による検出結果に基づいて立体物が検出されるため、立体物を高精度で検出することができる。また、検出制御部１３により、第１検出部１１により路面を検出不可能である範囲においては、路面が検出不可能であるために信頼度が低い第１検出部１１による検出結果と、信頼度が高いミリ波レーダ６による第２検出部１２による検出結果とに基づいて立体物が検出されるため、第１検出部１１により路面を検出不可能である範囲においても立体物を高精度で検出することができる。したがって、立体物の検出の信頼性を向上させることができる。
【００４６】
また、第１検出部１１により路面を検出不可能である範囲において第１検出部１１により検出されずに、第１検出部１１により路面を検出可能である範囲において連続して第１検出部１１により検出された回数が回数閾値を超えており、第１検出部１１による検出結果の信頼度が高いと考えられる立体物については、検出制御部１３により、第１検出部１１による検出結果に基づいて検出され、当該条件を満たさない立体物については、検出制御部１３により、第１検出部１１及び第２検出部１２による検出結果に基づいて検出されるため、第１検出部１１による誤った検出結果により立体物が検出されることを防止することができる。
【００４７】
また、車両制御部１４により、検出制御部１３により高信頼度で検出された立体物に応じて、車両の加速、減速及び操舵のいずれかを制御する車両制御が実行されるため、誤った検出結果に基づいたブレーキ作動等の車両制御が実行されることを防止することができる。
【００４８】
尚、本発明の実施形態の立体物検出装置及び立体物検出方法は、上記した実施の形態に限定されるものではなく、本発明の実施形態の要旨を逸脱しない範囲内において種々変更を加え得ることは勿論である。
【００４９】
例えば、上記実施形態において、第１検出部１１により路面を検出不可能である範囲において第１検出部１１により検出されずに、第１検出部１１により路面を検出可能である範囲において連続して第１検出部１１により検出された回数が閾値を超えているか否かを判定することなく、単に、検出制御部１３により、第１検出部１１により路面を検出可能である範囲においては第１検出部１１による検出結果に基づいて立体物が検出され、第１検出部１１により路面を検出不可能である範囲においては第２検出部１２による検出結果又は第１検出部１１及び第２検出部１２による検出結果に基づいて立体物が検出されてもよい。これにより、演算負荷を軽減することができる。また、上記実施形態において、検出制御部１３により検出された立体物に応じた車両制御は必ずしも実行されなくともよく、単に、立体物の検出のみが行われてもよい。
【符号の説明】
【００５０】
１…立体物検出装置、２…ＥＣＵ、３…ステレオカメラ、４…第１カメラ、５…第２カメラ、６…ミリ波レーダ、７…アクチュエータ、８…ＨＭＩ、１１…第１検出部、１２…第２検出部、１３…検出制御部、１４…車両制御部、Ｉ１，Ｉ２…画像、Ｂｉ，Ｂｏ…立体物。
【図１】
0006365385.tif 000002
【図２】
0006365385.tif 000003
【図３】
0006365385.tif 000004
【図４】
0006365385.tif 000005
【図５】
0006365385.tif 000006
【図６】
0006365385.tif 000007
【図７】
0006365385.tif 000008
【図８】
0006365385.tif 000009
【図９】
0006365385.tif 000010
【図１０】
0006365385.tif 000011