(57)【特許請求の範囲】
【請求項１】
車両に搭載された、走行路面を撮影するステレオカメラと、
前記ステレオカメラから得られる画像をウィンドウに区分し、ウィンドウごとに対象物までの距離を計測する計測手段と、
前記ステレオカメラによって撮像された路面の距離に基づいて路面の車両に対する相対的な傾きを推定する推定手段と
前記推定された路面の傾きに基づいてウィンドウ毎に撮像対象が障害物か路面上の文字やマークであるか判別する判別手段と、
前記判別手段による判別結果に基づいて対象物の認識を行う認識手段と、
を備える物体認識装置
【請求項２】
車両に搭載された、走行路面を撮影するステレオカメラと、
前記ステレオカメラから得られる画像をウィンドウに区分し、ウィンドウごとに対象物までの距離を計測する計測手段と、
前記ステレオカメラによって撮像された路面の距離に基づいて路面の車両に対する相対的な傾きを推定する推定手段と
前記推定された路面の傾きに基づいてカメラの取り付け誤差を補正する補正手段と、
前記補正されたカメラの傾きに基づいてウィンドウ毎に撮像対象が障害物か路面上の文字やマークであるか判別する判別手段と、
前記判別手段による判別結果に基づいて対象物の認識を行う認識手段と、
を備える物体認識装置
【発明の詳細な説明】
【０００１】
【発明の属する技術分野】
この発明は、自動車などの車両に搭載されたステレオカメラを用いて、前方の物体を検出する光学式の物体認識装置に関し、より具体的には、撮像された画像における複数のウィンドウを用いて、物体を認識する物体認識装置に関する。
【０００２】
【従来の技術】
近年、車両走行の安全性を向上させるため、自車両の前方にある物体の距離や大きさを判別し、これに応じて車両を適切に制御する装置が提案されている。
【０００３】
二つの光学素子からなる光学式距離計測装置を使用し、距離検出された被写体が物体か道路領域（路面上の文字／白線を含む）かを判別する手法に関連するものとして、特開平７−２２５１２６号公報には、車両前方の物体を正しく認識することができる路上物体判定装置が記載されている。この装置は、車両の走行路面上を撮像するステレオカメラを備え、カメラで得られた画像を複数のウィンドウに分割して、ウィンドウごとに被写体までの距離を算出する。この被写体までの距離と、ウィンドウの行レンジごとに決まる基準距離とを比較して車両前方の物体を認識する。
【０００４】
【発明が解決しようとする課題】
特開平７−２２５１２６号公報のものでは、路面が自車両の前に水平に存在しているものとして、カメラで撮像した被写体が物体か道路領域かの判断を行うので、自車両がピッチングやローリングで傾いたり、坂道を走行する場合、あるいはカメラの取り付け位置や角度が規定からずれてしまった場合には、車両が路面に平行な状態にあることを前提としてカメラの取り付け位置や俯角等の規定値によって決まる推定される路面と実際の路面との間にずれが生じ、計測された距離値が路面までの距離値かどうか正確に判断することができず、誤って物体を判定することがあった。
【０００５】
そこでこの発明は自車両がピッチングやローリングで傾いたり、坂道を登坂する場合、あるいはカメラが規定からずれて取り付けられてしまった場合においても正確に前方にある物体を認識することのできる装置を提供することを目的とする。
【０００６】
【課題を解決するための手段】
上記の課題を解決するため、請求項１の発明の物体認識装置は、車両に搭載された、走行路面を撮影するステレオカメラと、ステレオカメラから得られる画像をウィンドウに区分し、ウィンドウごとに対象物までの距離を計測する計測手段と、ステレオカメラによって撮像された路面の距離に基づいて路面の車両に対する相対的な傾きを推定する推定手段と、推定された路面の傾きに基づいてウィンドウ毎に撮像対象が障害物か路面上の文字やマークであるか判別する判別手段と、判別手段による判別結果に基づいて対象物の認識を行う認識手段と、を備える。
【０００７】
請求項１の発明によると、自車が加速、減速などで車両の前後方向の傾き、すなわちピッチングを生じたとき、カーブを走行するときなどに自車に横方向の傾きすなわちローリングを生じるとき、坂道を走行するとき、あるいはバンクのある道路を走行するときでも、路面と車両との相対的な傾きを推定し、推定された傾きに基づいて撮像対象物が障害物か路面上の文字やマークなどであるかが判別されるので、適正に対象物の認識を行うことができる。
【０００８】
また、請求項２の物体認識装置は、車両に搭載された、走行路面を撮影するステレオカメラと、ステレオカメラから得られる画像をウィンドウに区分し、ウィンドウごとに対象物までの距離を計測する計測手段と、ステレオカメラによって撮像された路面の距離に基づいて路面の車両に対する相対的な傾きを推定する推定手段と、推定された路面の傾きに基づいてカメラの取り付け誤差を補正する補正手段と、補正されたカメラの傾きに基づいてウィンドウ毎に撮像対象が障害物か路面上の文字やマークであるか判別する判別手段と、判別手段による判別結果に基づいて対象物の認識を行う認識手段と、を備える。
【０００９】
請求項2の発明によると、カメラが規定からずれて取り付けられてしまった場合や、ある程度長期にわたって規定通りに取り付けられた場合でも経年変化により規定値からずれてしまった場合に、推定路面と実際のカメラから路面までの距離のずれが観測され、そのずれ量により推定されるカメラの取り付け誤差に応じて推定距離が補正されるので、適正に対象物を認識することができる。
【００１０】
【発明の実施の形態】
次に図面を参照してこの発明の実施の形態を説明する。図１は、この発明の一実施例における物体認識装置の全体的なブロック図である。図２は、この実施例で用いる三角計測法による距離の計測原理を説明する図である。まず図２を参照して一対の撮像装置を用いた距離の測定方法を説明する。
【００１１】
ステレオカメラにおける一対の撮像装置の一方を構成するラインセンサ２１及びレンズ２３は、他方の撮像装置を構成するラインセンサ２２及びレンズ２４と所定の間隔すなわち基線長Bだけ左右方向に間隔を置いて配置されている。ラインセンサ２１および２２は、典型的には1次元のＣＣＤであり、直線的に配列されたフォトセンサのアレイであってよい。この場合、レンズ２３、２４の前に赤外線透過性のフィルタを置き、赤外線の光源を用いて一定の周期で対象物２０を照射し、対象物２０から反射する赤外線をラインセンサ２１,２２が感知するようにするのが良い。
【００１２】
ラインセンサ２１、２２は、それぞれレンズ２３、２４の焦点距離ｆに配置されている。レンズ２３、２４のある平面から距離ａにある対象物の像が、ラインセンサ２１ではレンズ２３の光軸からX１ずれた位置に形成され、ラインセンサ２２ではレンズ２４の光軸からX2だけずれた位置に形成するとすると、レンズ２３、２４の面から対象物２０までの距離ａは、三角計測法の原理により、ａ＝Ｂ・ｆ／（Ｘ１＋Ｘ２）で求められる。
【００１３】
この実施例では画像はデジタル化されるので、距離（Ｘ１＋Ｘ２）はデジタル的に算出される。ラインセンサ２１および２２で得られる画像の片方または両方をシフトさせながら両画像のそれぞれ対応する画素の輝度を示すデジタル値の差の絶対値の総和を求め、これを相関値とする。相関値が最小値になるときの画像のシフト量が両画像の間の位置ずれ、すなわち（Ｘ１＋Ｘ２）を示す。観念的には図２に示すようにラインセンサ２１および２２から得られる２つの画像を重なり合わせるために２つの画像を相対的に移動させねばならない距離が（Ｘ１＋Ｘ２）である。
【００１４】
ここでは、簡単のため撮像装置が１次元のラインセンサ２１，２２であるものとして説明したが、以下に述べるようにこの発明の一実施例では２次元のＣＣＤまたは２次元のフォトセンサ・アレイを撮像装置として使用する。この場合２つの撮像装置から得られる２次元の画像を相対的にシフトさせて上述したのと同様の相関計算を行い、相関値が最小となるときのシフト量を求めると、このシフト量が（Ｘ１＋Ｘ２）に相当する。
【００１５】
図１の撮像手段３は図２のレンズ２３およびラインセンサ２１からなる一方の撮像手段に対応し、撮像手段３’は、図２のレンズ２４およびラインセンサ２２からなる他方の撮像手段に対応する。この実施例では、図３の（ｂ）に示すように撮像領域を複数のウィンドウ（小領域）W１１、W１２、・・・に分割し、ウィンドウごとに距離の計測を行うので、対象物全体の2次元の画像が必要になる。このため撮像手段３、３’は、2次元のCCDアレイまたは2次元のフォトセンサ・アレイで構成される。
【００１６】
図３の（ａ）は、撮像手段３または３’により自車両の前方を走行する他車両を撮像した画像の例を示し、図３の（ｂ）は、図３の（ａ）の画像を概念的に複数のウィンドウに分割したものを示す。図３の（ｂ）は、縦方向に行および横方向に列をとり、簡単のため８行×１４列のウィンドウに分割して示す。それぞれのウィンドウには番号が付されており、たとえばW１２は、１行２列にあるウィンドウを示す。
【００１７】
撮像手段３、３’で撮像された対象物の画像はアナログ・デジタル変換機（Ａ／Ｄ変換機）４，４’でデジタルデータに変換され、画像メモリ５，５’に格納される。ウィンドウ切り出し部１３によって、ウィンドウW１１に対応する画像部分が画像メモリ５および５’からそれぞれ切り出されて相関計算部６に送られる。相関計算部６は、切り出された２つの画像を所定の単位ずつシフトさせて前述した相関計算を行い相関値が最小になるときのシフト量を求めると、このシフト量が（Ｘ１＋Ｘ２）である。相関計算部６は、こうして求めた（Ｘ１＋Ｘ２）の値を距離計算部７に送る。
【００１８】
距離計算部７は、前述したａ＝Ｂ・ｆ／（Ｘ１＋Ｘ２）の式を用いて、ウィンドウW１１にある対象物までの距離ａ１１を求める。こうして求められた距離ａ１１は、距離記憶部８に記憶される。同様の計算処理がそれぞれのウィンドウについて順次実行され、距離ａ１１、ａ１１、・・・が距離記憶部８に記憶される。以下、あるウィンドウについて計算された対象物までの距離を、そのウィンドウの計測距離という。
【００１９】
上の相関演算で用いる画像データは、撮像素子アレイの素子のピッチによって分解能が定まるので、フォトセンサ・アレイ等比較的ピッチの大きい受光素子を用いるときは、ピッチ間の補間計算を行って画像データの密度を高める処理を行い、こうして密度を高められた画像データについて相関計算を行うのが好ましい。また、ウィンドウは互いに重なりをもつように定めることもできる。
【００２０】
推定距離記憶部３２は、ウィンドウごとに推定される路面までの距離（以下、推定距離という）を格納している。路面除去部３１は、ウィンドウごとの推定距離と上記のようにして実際に計測された対応するウィンドウごとの距離とを比較し、推定距離に近い値の計測距離をもつウィンドウ、すなわち路面までの距離にほぼ等しい計測距離を持つウィンドウ、および推定距離以上の計測距離を持つウィンドウ、すなわち路面よりも遠い計測距離をもつウィンドウについての計測距離値をウィンドウごとに路面距離記憶部５１に記憶し、距離記憶部8から削除する。こうして路面上にある標識文字や白線が距離記憶部８から路面距離記憶部５１に移され、距離記憶部８から削除される。
【００２１】
推定距離記憶部３２に格納される推定距離は後述する処理によって動的に変化するが、初期値としては、車両が傾くことなく水平な路面に平行な状態にある場合の車両から路面までの距離とすることができ、CCDカメラの取り付け位置、俯角、基線長、焦点距離およびCCDサイズと、画像におけるウィンドウ位置とにより予め算出され、ウィンドウごとに推定距離記憶部３２に記憶されている。
【００２２】
上の例では路面と判定されたウィンドウの計測距離を路面距離記憶部５１に移し、路面記憶部８から削除したが、これらのデータを削除することなく、たとえば路面と判定されたことを識別するフラグを使用し、路面と判定されたウィンドウに識別フラグをたてて距離距離記憶部８に記憶し、路面距離記憶部５１の機能を兼ねることもできる。
【００２３】
3次元変換部５２は路面距離記憶部５１に記憶されたウィンドウの位置とそのウィンドウにおける距離値を、カメラの取り付け位置を原点とし、鉛直下方向をY軸、自車両が直進する方向をZ軸、Y軸とZ軸に垂直な方向、すなわち車幅方向をX軸とする３次元位置に変換し、3次元路面憶部５３に記憶する。
【００２４】
路面ピッチ推定部９は自車の加速によって車両後部が沈み込んだり、減速によって車両前部が沈むなどの原因で車両に前後方向の傾き、すなわちピッチングを生じたときや、坂道を走行する場合の、カメラと路面の相対的な傾きを３次元路面記憶部５３に記憶された３次元位置から推定する。
【００２５】
図４は車両が減速によって前部が沈み込むピッチングを生じたときの推定路面cと実際の路面bの関係を示している。実際の路面bは、車両が水平に保たれれているとした場合の相対的な路面であり、車両にその前部が沈み込むピッチングを生じた状態では、相対的に登り勾配の路面として現れる。
【００２６】
図４（Ａ）において破線aは、推定路面cから所定の距離、たとえば１０ｃｍ、だけ上にある仮想路面で、これより下の領域に相当する距離値が算出されたウィンドウは、路面を撮像しているものとして、前述の路面除去部３１によってウィンドウ位置と距離値が路面距離記憶部５１に記憶される。3次元変換部５２がこのウィンドウ位置および距離値を3次元位置に変換し、3次元路面記憶部５３に記憶させる。
【００２７】
図４（Ｂ）は、このとき、3次元路面記憶部５３に記憶された3次元位置をZ−Y平面に投影したグラフである。路面ピッチ推定部９は、3次元路面記憶部５３に記憶されている位置のうちZ値がたとえば１５ｍ以下のものだけをサンプルとし、サンプル数がたとえば２００以上のときはZ−Y平面に投影したサンプルを最も良く表わす直線を式（１）によって決定し、この直線の傾き、Y軸切片およびサンプル数を路面ピッチ記憶部５４に記憶する。サンプル数が200に満たないときは記憶内容を更新せずに、路面ピッチ記憶部５４の記憶内容を保持する。直線の傾きは図４（Ａ）における路面の前後方向の傾きを表わし、Y軸切片ｈｐはカメラの路面からの高さを表わす。
【００２８】
【数１】
0003995846.tif 000002
ここでYi、Ziはi番目のサンプルの3次元位置を、ｎはサンプル数をそれぞれ表わし、tanθ、ｈｐはそれぞれ直線の傾きとＹ軸切片を表わしている。
【００２９】
路面ロール推定部１０は自車が旋回することにより自車の左右部のいずれかが沈み込むことなどによる左右方向の傾き、すなわちローリングを生じたときや、バンクのある道を走行する場合の、カメラから相対的な路面の傾きを3次元路面記憶部５３に記憶された3次元位置から推定する。
【００３０】
図５（Ａ）は車両が旋回により右部が沈み込むローリングを生じたときの推定路面cと実際の路面bの関係を示している。実際の路面bは、車両が水平に保たれているとした場合の、相対的な路面であり、ローリングで車両の右部が沈み込んだ場合、右上がりの傾斜として現れる。図５（Ａ）において破線aは、推定路面cから所定の距離、たとえば１０ｃｍ、だけ上にある仮想路面で、これから下の領域に相当する距離値が算出されたウィンドウについて、前述の路面除去部３１によってウィンドウ位置と距離値が路面距離記憶部５１に記憶され、3次元変換部５２によって3次元位置に変換され3次元路面記憶部５３に記憶される。
【００３１】
図５（Ｂ）は、このとき、3次元路面記憶部５３に記憶された3次元位置をX−Y平面に投影したグラフである。路面ロール推定部１０は3次元路面記憶部５３に記憶されている位置のうちZ値がたとえば１５ｍ以下のものだけをサンプルとし、サンプル数がたとえば２００以上のときはX−Y平面に投影したサンプルを最も良く表わす直線を式（２）によって決定し、直線の傾き、Y軸切片およびサンプル数を路面ロール記憶部５５に記憶する。サンプル数が200に満たないときは記憶内容を更新せずに、路面ロール記憶部５５の記憶内容を保持する。直線の傾きは路面の左右方向の傾きを表わし、Y軸切片はカメラの路面からの高さを表わす。
【００３２】
【数２】
0003995846.tif 000003
ここでXi、Yiはi番目のサンプルの3次元位置を、ｎはサンプル数をそれぞれ表わし、tanα、ｈｒはそれぞれ直線の傾きとＹ軸切片を表わしている。
【００３３】
路面ピッチ推定部９および路面ロール推定部１０でZ値が１５ｍ以下のもののみサンプルとしてとしているのは、遠距離ほど位置の精度が落ちることと、遠距離ほど推定路面と実際の路面とのずれが大きくなり、路面以外の物体を表わしている可能性があるので、サンプルに加えることによって推定に誤りが生じるのを防ぐ為である。また、サンプル数が２００に満たないときに傾きの推定を行わないのはサンプル数が少ないと推定値の信頼性が低い為である。
【００３４】
推定距離補正部１１は路面ピッチ記憶部５４および路面ロール記憶部５５に記憶されている路面の前後、左右の傾きとカメラの路面からの高さからより良く路面までの距離を表わすように推定距離記憶部３２の記憶内容を修正する。
【００３５】
ローリングやピッチングが生じているとき、あるいは坂道やバンクのある道を走行するときは次式によって路面が撮像されるCCD面上の位置（ｘ、ｙ）と路面までの距離（ｄ）の関係を推定することができる。
【００３６】
【数３】
0003995846.tif 000004
【００３７】
ここでtanθは路面ピッチ記憶部に記憶されている直線の傾き、tanαは路面ロール記憶部に記憶されている直線の傾き、ｈｐは路面ピッチ記憶部に記憶されている直線のY軸切片、ｈｒは路面ロール記憶部に記憶されている直線のY軸切片、FはCCDの焦点距離である。また、d=0はウィンドウが路面を撮像しないことを表わすものとする。
【００３８】
図６に示したように、路面ピッチ記憶部５４に記憶されている直線の傾きと切片および路面ロール記憶部５５に記憶されている直線の傾きと切片は合わせて一つの平面を推定しており、この平面がCCD面に投影される位置とCCDからこの平面までの距離の関係として上式が得られる。ここで、CCD面上の座標は図７のようにとるものとする。
【００３９】
推定路面補正部１１はウィンドウごとにその位置から上式の関係を用いてdを求め、記憶している推定距離記憶部３２に記憶されている内容をｄで置換する。
【００４０】
上の例では推定路面補正部１１で推定距離記憶部３２に記憶されている内容をdで置換したが、dで置換するのではなく、推定路面距離記憶部３２に記憶されている内容とdとの加重平均をとって変動を緩和し、測定誤差をフィルタする効果を得たり、あるいは路面ピッチ記憶部５４および路面ロール記憶部５５において、記憶内容をある程度過去に算出されたものも保持するものとし、時系列情報から現在の路面の傾きと高さを推定することもできる。
【００４１】
また、路面距離記憶部３２に記憶されている内容が変化する時定数を大きくとることによってピッチングやローリングなどの短い周期の車両の挙動に対応するのではなく、カメラの取り付け誤差や経年変化による規定の取り付け角度からのずれを学習し、補正する請求項２の装置として利用することができる。これは、車両は長い時間で見れば概ね水平な路面を走行するので、路面ピッチ記憶部５４および路面ロール記憶部５５に記憶される路面の傾きと路面からカメラまでの高さから実際の取り付け角度とカメラの取り付け位置を推定することができるからである。このとき、カメラの位置と角度の規定値からのずれを推定するカメラ角度推定部６１と推定内容を記憶するカメラ角度記憶部６２を別途設けることもできる。カメラ角度推定部６１は路面ピッチ記憶部５４と路面ロール記憶部５５に記憶されたある程度長期間の記憶内容についてたとえば移動平均を取ることで平均的な路面の傾きと路面からカメラまでの高さを推定し、カメラ角度記憶部６２に記録する。
【００４２】
また、上の例ではサンプル数が２００に満たないときは路面ピッチ記憶部および路面ロール記憶部５５の記憶内容は保持されるものとしたが、保持するのではなく推定距離記憶部３２の記憶内容が初期値に近づくように変化させたり、カメラ角度推定部６１およびカメラ角度記憶部６２を設けている場合にはカメラ角度記憶部に記憶されているカメラの位置と角度から推定される路面の距離に近づくように変化させることによって推定距離記憶部３２の記憶内容が発散してしまうのを防ぐことができる。
【００４３】
推定距離補正部１１は以上のようにして路面ピッチ記憶部５４および路面ロール記憶部５５の記憶内容に応じて、推定距離記憶部３２に記憶されている推定距離を修正する。この修正処理は、ハードウェア構成によって路面ピッチ推定部９または路面ロール推定部１０から修正を要するレベルの記憶内容の変化が路面ピッチ記憶部５４または路面ロール記憶部５５において発生したことを示す信号に応答して実行されるよううにすることができる。または、ソフトウェア構成により、物体認識装置を制御する中央演算装置（CPU）がたとえば６７ミリ秒毎に修正処理ルーチンを実行して修正を行うようにすることもできる。
【００４４】
路面除去部３１は、距離記憶部８から得られるウィンドウごとの計測距離と推定距離記憶部３２から得られるウィンドウごとに修正された推定距離とを比較し、計測距離が修正された推定距離から所定のしきい値（たとえば１０ｃｍ）を引いた値に等しいかこれより大きいウィンドウを路面を撮像しているウィンドウと判断し、計測距離が修正された推定距離から上記所定しきい値を引いた値以下のウィンドウを路面以外の物体を撮像しているウィンドウと判断する。
【００４５】
こうして、路面除去部３１は、路面以外の物体を撮像しているウィンドウのデータを物体認識部３８に送る。物体認識部３８は、路面以外の物体を撮像している複数のウィンドウのデータに基づいて1つ又は複数の物体の認識を行う。物体認識処理は、CPUが物体認識ルーチンをたとえば６７ミリ秒毎に実行することによって実行される。物体の認識は、2サイクルから3サイクルの認識処理の結果を総合して行うことにより、認識の信頼性を向上させることができる。
【００４６】
物体記憶部３９は、物体認識部３８で認識された物体についての距離、位置、大きさなどの情報を記憶する。物体認識部３８は、今回認識された物体（車）の距離情報と、前回認識された同じ物体についての距離情報からこの物体と自車との相対速度を計算し、今回認識された物体のデータの一部として物体記憶部３９に記憶させる。
【００４７】
車両制御部４５は、物体記憶部３９から送られる物体についての情報を読み出し、その内容に基づいて、警報装置を駆動して前方車両に近づきすぎていることを示す警報を発したり、エンジンの電子制御装置（Electronic Control Unit：ECU）またはブレーキ制御ユニットに信号を送って強制制動処理を実行させるなどの働きをする。その際、車両制御部４５は、自車速度検出装置４６から自車速度のデータを、ヨーレート検出装置４７からヨーレートを示す信号を受け取り、自車の走行領域を判断し、物体との距離が適切な範囲になるよう自車を制御する。
【００４８】
図１に示した相関演算部６、距離計算部７、距離記憶部８、ウィンドウ切り出し部１３、路面除去部３１、推定距離記憶部３２、物体認識部３８、物体記憶部３９、画像メモリ５，５’、路面距離記憶部５１、3次元変換部５２、3次元路面記憶部５３、路面ピッチ推定部９、路面ロール推定部１０、路面ピッチ記憶部５４、路面ロール記憶部５５、カメラ角度推定部６１、カメラ角度記憶部６２および車両制御部４５は、中央演算処理装置（CPU）、制御プログラムおよび制御データを格納する読み出し専用メモリ、CPUの演算作業領域を提供し、様々なデータを一時記憶することができるランダムアクセスメモリ（RAM）で構成することができる。距離記憶部８、推定距離記憶部３２、および物体記憶部３９は、１つのRAMのそれぞれ異なる記憶領域を使用して実現することができる。また、各種の演算で必要となるデータの一時記憶領域も同じRAMの一部を使用して実現することができる。
【００４９】
また、この発明の物体認識装置をエンジンの電子制御ユニット（ECU）、ブレーキ制御ECUその他のECUとLAN接続して物体認識装置からの出力を車両の全体的な制御に利用することができる。
【００５０】
【発明の効果】
請求項１の発明によると、車両のピッチングやローリングあるいは坂道はバンクのある道を走行することによりカメラ画像上での路面が撮像される領域が変動しても正しく認識することができる。請求項２の発明によると、当該物体認識装置の生産の際、あるいは経年変化により、カメラ取り付け位置および角度が規定値からずれてしまった場合にも正しく対象物を認識することができる。
【図面の簡単な説明】
【図１】この発明の一実施例の全体的な構成を示すブロック図。
【図２】三角計測法による距離の計測原理を説明する為の図。
【図３】この発明による、（ａ）撮像された画像、（ｂ）距離および道路領域判定のための小領域（ウィンドウ）に分割された画像を示す図。
【図４】（Ａ）は、ピッチングが発生した場合の実際の路面、推定路面および路面除去範囲を示す図、（Ｂ）は、ピッチングが発生した場合の3次元路面記憶部の内容をZ−Y平面にプロットした図。
【図５】（Ａ）は、ローリングが発生した場合の実際の路面、推定路面および路面除去範囲を示す図、（Ｂ）は、ローリングが発生した場合の3次元路面記憶部の内容をＸ−Ｙ平面にプロットした図。
【図６】路面ピッチ記憶部と路面ロール記憶部の内容から推定される路面を示す図。
【図７】ＣＣＤ面上の位置と推定路面までの距離の関係を示す式におけるＣＣＤ面上の座標系を示す図。
【符号の説明】
３，３’撮像部（ステレオカメラ）
７     距離計算部
８     距離記憶部
３１   路面除去部
【図１】
0003995846.tif 000005
【図２】
0003995846.tif 000006
【図３】
0003995846.tif 000007
【図４】
0003995846.tif 000008
【図５】
0003995846.tif 000009
【図６】
0003995846.tif 000010
【図７】
0003995846.tif 000011