JPH10283462A - 車外監視装置 - Google Patents

Abstract

(57)【要約】 【課題】 検出した障害物の位置の変化や細部形状に関
する情報を取り入れ、自車両との接触可能性を正確且つ
精密に判断する。 【解決手段】 イメージプロセッサ２０からの距離画像
を画像処理用コンピュータ３０に読み込み、距離画像の
各区分毎に立体物の存在の有無と距離データとを求めた
後、区分毎の距離が接近しているものをグループとして
まとめ、各グループについて移動速度を算出する。そし
て、グループ内の全ての距離データを移動速度に応じて
移動させ、設定時間後の位置を推定するとともに、車速
センサ４及び舵角センサ５によって検知した自車両の走
行状態から自車両の走行軌跡を推定し、障害物の位置の
変化や細部形状に関する情報を取り入れて自車両との接
触可能性を正確且つ精密に判断する。

Description

【発明の詳細な説明】

【０００１】

【発明の属する技術分野】本発明は、車外の物体の距離
分布を示す疑似画像に基づいて車外の状況を認識する車
外監視装置に関し、特に、狭路通過時の自車両と障害物
との間の隙間を検出して安全を確保する車外監視装置に
関する。

【０００２】

【従来の技術】従来、自動車等の車両においては、塀、
ガードレール、電柱、駐車車両等が多数存在する狭路を
通過する際の運転者の操作感覚を補うものとして、例え
ば、実開平５−６８７４２号公報に開示されているよう
なコーナーポールや、棒状の部材が障害物に触れるとス
イッチがオンする接触式スイッチからなる触覚センサ等
を車体に取り付ける場合があり、これにより、車幅や左
右障害物との間の隙間を確認することができる。

【０００３】また、最近では、車両の側面や四隅に超音
波センサを取り付け、超音波を発射して障害物からの反
射波を受信することにより距離を計測し、計測した距離
を運転者に知らせて狭路を通過する際の負担を軽減しよ
うとする技術が開発されている。

【０００４】しかしながら、前述のコーナーポールのよ
うに車体外部に目印となるようなものを取り付ける場合
には、運転者の慣れを必要とするため、運転者の負担軽
減効果が少ない。また、触覚センサのような接触式のも
のでは、物体に接触するまで位置の確認ができず、障害
物に接触してからではハンドル操作が間に合わないとい
った事態が生じる。

【０００５】また、超音波を用いる技術では、空間分解
能が劣るため障害物の位置関係を知ることができないば
かりでなく、歩行者の衣服や滑らかな壁等からは発射し
た超音波が戻ってこないという物体依存性があり、道路
上に存在する様々な立体物に対処することは困難であ
る。

【０００６】これに対処するに、本出願人は、特開平７
−１９２１９９号において、車外の対象をステレオ撮像
し、撮像したステレオ画像対の対応位置のずれ量から三
角測量の原理によって画像全体に渡る距離分布を求め、
この距離分布の情報に対応する被写体の各部分の３次元
位置を計算し、これらの３次元位置の情報を用いて複数
の立体物を検出して、検出した複数の立体物の自車両側
の縁と自車両側部の延長線との間の最近接距離を隙間距
離として左右それぞれに算出し、この左右の隙間距離に
係わる情報を運転者に知らせる技術を提案している。

【０００７】

【発明が解決しようとする課題】先に本出願人が提案し
た技術では、検出した車両やガードレール等の障害物を
輪郭線や直線で近似し、それらとの隙間を算出してい
る。従って、近似処理の過程で無視される虞のある車両
やガードレール側面の突起等を考慮し、隙間距離にある
程度の余裕度を持たせる必要があった。

【０００８】また、先の技術では、障害物を検出した時
点での位置を前提として隙間距離の計算を行っており、
例えば、自車両の直前に先行車がいる状態で狭い道路を
通過しているような状況では、先行車と自車両との隙間
を検出してしまうことになる。従って、前方に先行車が
障害物として立ちふさがっているような状況では、左右
の障害物との隙間距離を検出することは困難であった。

【０００９】本発明は上記事情に鑑みてなされたもの
で、検出した障害物の位置の変化や細部形状に関する情
報を取り入れ、自車両との接触可能性を正確且つ精密に
判断することのできる車外監視装置を提供することを目
的としている。

【００１０】

【課題を解決するための手段】請求項１記載の発明は、
車外の物体の距離を計測して得られる距離分布の疑似画
像を複数の区分に分割し、各区分毎に立体物の有無と距
離データとを検出して車外の状況を認識する車外監視装
置において、上記距離データが互いに接近する各区分を
１つのグループにまとめ、このグループ毎の立体物の移
動速度を算出する手段と、上記グループ内の全ての距離
データを移動速度に応じて移動させ、設定時間後の上記
立体物の位置を推定する手段と、上記設定時間後の自車
両の輪郭が描く走行軌跡を推定する手段と、上記立体物
の推定位置と上記自車両の走行軌跡とを比較し、自車両
が立体物に接触するか否かを判定する手段と、上記立体
物の推定位置と上記自車両の走行軌跡とに基づいて、自
車両と立体物との間の最小隙間を算出する手段とを備え
たことを特徴とする。

【００１１】請求項２記載の発明は、請求項１記載の発
明において、前回の処理で検出されたグループ内の各距
離データと今回の処理で検出されたグループ内の各距離
データとを比較してグループ間の対応関係を調べ、対応
するグループ間の時間的な移動量から移動速度を算出す
ることを特徴とする。

【００１２】請求項３記載の発明は、請求項１記載の発
明において、道路上に静止している立体物の距離データ
を処理サイクル毎に保持し、当該立体物が検出範囲外に
逸脱したとき、前回の距離データと自車両の走行軌跡と
に基づいて当該立体物の位置を推定する手段を備えたこ
とを特徴とする。

【００１３】請求項４記載の発明は、請求項１記載の発
明において、上記疑似画像は、一組のカメラで撮像した
一対の画像の相関を求め、同一物体に対する視差から三
角測量の原理によって求めた三次元の距離分布を示すも
のであることを特徴とする。請求項５記載の発明は、請
求項１記載の発明において、上記疑似画像は、一組のカ
メラで撮像した一対の画像を処理して得られる二次元の
距離分布を示すものであることを特徴とする。

【００１４】請求項６記載の発明は、請求項１記載の発
明において、上記疑似画像は、レーザ光の投射・受光あ
るいは電波の発信・受信によって求めた二次元の距離分
布を示すものであることを特徴とする。

【００１５】すなわち、本発明の車外監視装置では、車
外の物体までの距離を計測して得られる距離分布の疑似
画像を複数の区分に分割し、各区分毎に立体物の有無と
距離データとを検出した後、距離データが互いに接近す
る各区分を１つのグループにまとめ、このグループ毎の
立体物の移動速度を算出すると、グループ内の全ての距
離データを移動速度に応じて移動させ、設定時間後の立
体物の位置を推定するとともに、設定時間後の自車両の
輪郭が描く走行軌跡を推定する。そして、立体物の推定
位置と自車両の走行軌跡とを比較して自車両が立体物に
接触するか否かを判定し、また、立体物の推定位置と自
車両の走行軌跡とに基づいて自車両と立体物との間の最
小隙間を算出する。

【００１６】この場合、立体物の移動速度は、前回の処
理で検出されたグループ内の各距離データと今回の処理
で検出されたグループ内の各距離データとを比較してグ
ループ間の対応関係を調べ、対応するグループ間の時間
的な移動量から算出することが望ましい。また、道路上
に静止している立体物に対しては、その距離データを処
理サイクル毎に保持しておき、当該立体物が検出範囲外
に逸脱したとき、前回の距離データと自車両の走行軌跡
とに基づいて当該立体物の位置を推定することが望まし
い。

【００１７】また、以上の処理は、一組のカメラで撮像
した一対の画像を処理し、互いの撮像画像の相関を求め
て同一物体に対する視差から三角測量の原理によって求
めた三次元の距離分布を示す疑似画像、一組のカメラで
撮像した一対の画像を処理して得られる二次元の距離分
布を示す擬似画像、さらには、レーザ光の投射・受光あ
るいは電波の発信・受信によって二次元の距離分布を求
めた疑似画像に基づいて行うことができる。

【００１８】

【発明の実施の形態】以下、図面を参照して本発明の実
施の形態を説明する。図１〜図２１は本発明の実施の第
１形態に係わり、図１は車外監視装置の全体構成図、図
２は車外監視装置の回路ブロック図、図３〜図６は立体
物検出処理のフローチャート、図７は隙間距離算出処理
のフローチャート、図８は車載のカメラで撮像した画像
の例を示す説明図、図９は距離画像の例を示す説明図、
図１０は距離画像の区分を示す説明図、図１１は検出対
象の状況例を示す説明図、図１２は区分毎の立体物の検
出距離の例を示す説明図、図１３は区分毎の立体物の検
出距離をグループ化した例を示す説明図、図１４は検出
した物体と側壁の結果を示す説明図、図１５は自車両輪
郭の近似を示す説明図、図１６は自車両の通過軌跡を示
す説明図、図１７は左右判定領域の説明図、図１８は設
定時間後の立体物の位置の推定結果を示す説明図、図１
９は視野外距離データの追跡を示す説明図、図２０は通
過軌跡と距離データとの隙間計測の説明図、図２１は自
車両と立体物との接触判定の説明図である。

【００１９】図１において、符号１は自動車等の車両で
あり、この車両１に、車外の設置範囲内の対象を撮像
し、撮像画像から車外の物体を認識して監視する車外監
視装置２が搭載されている。この車外監視装置２は、車
外の対象物を異なる位置から撮像するためのステレオ光
学系１０、このステレオ光学系１０で撮像した画像を処
理して三次元の距離分布情報を算出するイメージプロセ
ッサ２０、及び、このイメージプロセッサ２０からの距
離情報を処理する画像処理用コンピュータ３０等から構
成されている。また、上記画像処理コンピュータ３０に
は、車速センサ４、舵角センサ５等の現在の車両の走行
状態を検出するためのセンサが接続されている。

【００２０】上記ステレオ光学系１０は、例えば電荷結
合素子（ＣＣＤ）等の固体撮像素子を用いた左右１組の
ＣＣＤカメラ１０ａ，１０ｂからなり、上記イメージプ
ロセッサ２０では、ＣＣＤカメラ１０ａ，１０ｂで撮像
した１対の画像の相関を求め、同一物体に対する視差か
ら三角測量の原理により距離を求める、いわゆるステレ
オ法により画像全体に渡る３次元の距離分布を算出す
る。

【００２１】上記画像処理用コンピュータ３０では、上
記イメージプロセッサ２０からの距離分布情報を読み込
んで道路形状や複数の立体物（車両や障害物等）の３次
元位置を高速で検出し、これらの先行車や障害物の移動
に伴う位置の変化と自車両の走行軌跡とに基づいて自車
両との間の隙間を算出して接触判定を行うとともに、運
転者の前方に設置されたディスプレイ９に数値や警告表
示等の映像信号を送り、運転者に報知する。

【００２２】上記イメージプロセッサ２０及び上記画像
処理用コンピュータ３０は、詳細には、図２に示すハー
ドウエア構成となっており、上記イメージプロセッサ２
０は、上記ＣＣＤカメラ１０ａ，１０ｂで撮像した１組
みのステレオ画像対に対して所定の小領域毎に同一の物
体が写っている部分を探索し、対応する位置のずれ量を
求めて物体までの距離を算出し、三次元の距離分布情報
として出力する距離検出回路２０ａと、この距離検出回
路２０ａから出力される距離分布情報を記憶する距離画
像メモリ２０ｂとから構成されている。

【００２３】上記距離検出回路２０ａから出力される距
離分布情報は、画像のような形態をした疑似画像（距離
画像）であり、左右２台のＣＣＤカメラ１１ａ，１１ｂ
で撮影した画像、例えば図８に示すような画像（図８は
片方のカメラで撮像した画像を模式的に示す）を上記距
離検出回路２０ａで処理すると、図９のような距離画像
となる。

【００２４】図９に示す距離画像の例では、画像サイズ
は横６００画素×縦２００画素であり、距離データを持
っているのは黒点の部分で、これは図８の画像の各画素
のうち、左右方向に隣合う画素間で明暗変化が大きい部
分である。上記距離検出回路２０ａでは、この距離画像
を、１ブロックを４×４画素の小領域として横１５０×
縦５０のブロックからなる画像として扱い、各ブロック
毎に距離（画素ズレ数）の算出を行う。

【００２５】一方、上記画像処理用コンピュータ３０
は、道路形状等の検出処理を主とするマイクロプロセッ
サ３０ａと、検出した道路形状に基づいて個々の立体物
を検出する処理を主とするマイクロプロセッサ３０ｂ
と、検出した立体物の位置情報に基づいて先行車や障害
物を特定し、自車両との間の隙間を算出して接触危険性
を判断する処理を主とするマイクロプロセッサ３０ｃと
がシステムバス３１を介して並列に接続されたマルチマ
イクロプロセッサのシステム構成となっている。

【００２６】そして、上記システムバス３１には、上記
距離画像メモリ２０ｂに接続されるインターフェース回
路３２と、制御プログラムを格納するＲＯＭ３３と、計
算処理途中の各種パラメータを記憶するＲＡＭ３４と、
処理結果のパラメータを記憶する出力用メモリ３５と、
上記ディスプレイ（ＤＩＳＰ）９を制御するためのディ
スプレイコントローラ（ＤＩＳＰ．ＣＯＮＴ．）３６
と、上記車速センサ４、上記舵角センサ５等からの信号
を入力するＩ／Ｏインターフェース回路３７とが接続さ
れている。

【００２７】上記画像処理用コンピュータ３０では、画
素を単位とする距離画像上の座標系を、図９に示すよう
に、左下隅を原点として横方向をｉ座標軸，縦方向をｊ
座標軸として扱い、画素ズレ数をｄｐとする距離画像上
の点（ｉ，ｊ，ｄｐ）を実空間の座標系に変換し、道路
形状の認識や立体物の位置検出等の処理を行う。

【００２８】すなわち、実空間の三次元の座標系を、自
車（車両１）固定の座標系とし、Ｘ軸を車両１の進行方
向右側側方、Ｙ軸を車両１の上方、Ｚ軸を車両１の前
方、原点を２台のＣＣＤカメラ１０ａ，１０ｂの中央の
真下の道路面とすると、Ｘ−Ｚ平面（Ｙ＝０）は、道路
が平坦な場合、道路面と一致することになり、以下の
(1)〜(3)式により、距離画像上の点（ｉ，ｊ，ｄｐ）
を、実空間上の点（ｘ，ｙ，ｚ）に座標変換することが
できる。 ｘ＝ＣＤ／２＋ｚ・ＰＷ・（ｉ−ＩＶ） …(1) ｙ＝ＣＨ＋Ｚ・ＰＷ・（ｊ−ＪＶ） …(2) ｚ＝ＫＳ／ｄｐ …(3) 但し、ＣＤ ：ＣＣＤカメラ１０ａ，１０ｂの間隔 ＰＷ ：１画素当たりの視野角 ＣＨ ：ＣＣＤカメラ１０ａ，１０ｂの取付け高さ ＩV，ＪV：車両１の真正面の無限遠点の画像上の座標
（画素） ＫＳ ：距離係数（ＫＳ＝ＣＤ／ＰＷ） 尚、実空間上の点（ｘ，ｙ，ｚ）から画像上の点（ｉ，
ｊ，ｄｐ）を算出する式は、上記(1)〜(3)式を変形し、
次のようになる。

【００２９】 ｉ ＝（ｘ−ＣＤ／２）／（ｚ・ＰＷ）＋ＩＶ …(4) ｊ ＝（ｙ−ＣＨ）／（ｚ・ＰＷ）＋ＪＶ …(5) ｄｐ＝ＫＳ／ｚ …(6)

【００３０】次に、上記画像処理用コンピュータ３０に
おける個々の処理について説明する。まず、上記マイク
ロプロセッサ３０ａによる道路検出処理では、距離画像
メモリ２０ｂに記憶された距離画像からの３次元的な位
置情報を利用して実際の道路上の白線だけを分離して抽
出し、内蔵した道路モデルのパラメータを実際の道路形
状と合致するよう修正・変更して道路形状を認識する。

【００３１】上記道路モデルは、認識対象範囲までの道
路の自車線を、設定した距離によって複数個の区間に分
け、各区間毎に左右の白線を３次元の直線式で近似して
折れ線状に連結したものであり、実空間の座標系におけ
る水平方向の直線式のパラメータａ，ｂ、及び、垂直方
向の直線式のパラメータｃ，ｄを求め、以下の(7)式に
示す水平方向の直線式、及び、以下の(8)式に示す垂直
方向の直線式を得る。 ｘ＝ａ・ｚ＋ｂ …(7) ｙ＝ｃ・ｚ＋ｄ …(8)

【００３２】また、上記マイクロプロセッサ３０ｂによ
る立体物検出処理では、距離画像を格子状に所定の間隔
で区分し、各区分毎に、上記マイクロプロセッサ３０ａ
によって検出された道路形状に基づいて道路表面より上
のデータを立体物データとして抽出し、立体物までの距
離を算出する。そして、検出された立体物の位置が互い
に接近する各区分を１つのグループにまとめ、これらの
グループを分類して立体物の後部、側部、及び、ガード
レール等の道路に沿った構造物を検出し、その位置や速
度等を算出する。

【００３３】さらに、上記マイクロプロセッサ３０ｃに
よる隙間距離算出処理では、検出された立体物に含まれ
る区分毎の位置を立体物の速度に応じて移動するととも
に、車速センサ４及び舵角センサ５によって検知した自
車両の走行状態から自車両の走行軌跡を推定し、移動後
の立体物の位置と自車両の走行軌跡とを比較して最小と
なる隙間距離を算出する。

【００３４】尚、上記距離画像の生成、この距離画像か
ら道路形状を検出する処理については、本出願人によっ
て先に提出された特開平５−２６５５４７号公報や特開
平６−２６６８２８号公報等に詳述されている。

【００３５】以下、上記マイクロプロセッサ３０ｂによ
る立体物検出処理、及び、上記マイクロプロセッサによ
る隙間距離算出処理ついて、図３〜図７のフローチャー
トに従って説明する。

【００３６】まず、上記マイクロプロセッサ３０ｂによ
る立体物検出処理のプログラムについて説明する。この
プログラムでは、最初に、ステップS101〜ステップS114
の距離データ検出処理で、距離画像を所定間隔で格子状
に区分した各区分毎に、立体物の存在と、その距離の算
出を行う。すなわち、ステップS101で道路形状パラメー
タを読み込むと、ステップS102で、図１０に示すよう
に、距離画像を所定間隔（例えば、８〜２０画素間隔）
で格子状に区分し、ステップS103で、各区分毎に立体物
のデータを抽出し、その検出距離を算出するため、最初
の区分のデータを読み込む。

【００３７】次に、ステップS104へ進んで区分内の最初
のデータをセットすると、ステップS105で被写体の三次
元位置（ｘ，ｙ，ｚ）を前述の(1)〜(3)式によって求
め、ステップS106で、前述の道路形状の直線式(7),(8)
を使って距離ｚに於ける道路表面の高さｙｒを算出す
る。次に、ステップS107へ進み、以下の(9)式によって
算出した被写体の道路表面からの高さＨに基づいて、道
路面より上にあるデータを立体物データとして抽出す
る。 Ｈ＝ｙ−ｙｒ …(9)

【００３８】この場合、高さＨが０．１ｍ程度以下の被
写体は、道路上の白線や汚れ、影等と考えられるため、
この被写体のデータは棄却する。また、自車両１の高さ
より上にある被写体も、歩道橋や標識などと考えられる
ので棄却し、道路上の立体物と推定されるデータのみを
選別する。

【００３９】その後、ステップS108へ進んで最終データ
か否かを調べ、最終データでないときには、ステップS1
09で区分内の次のデータをセットして前述のステップS1
05へ戻り、同様の処理を繰り返して道路面より上にある
データを抽出する。そして、１つの区分内で最終データ
の処理が完了すると、ステップS108からステップS110へ
進み、抽出された立体物データに対し、予め設定された
距離Ｚの区間に含まれるデータの個数を数えて距離ｚを
横軸とするヒストグラムを作成する。

【００４０】続くステップS111では、ヒストグラムの度
数が判定値以上で、かつ最大値となる区間を検出し、該
当する区間があれば、ステップS112において、その区間
に立体物が存在すると判断し、その立体物までの距離を
検出する。

【００４１】上記ヒストグラムでは、入力される距離画
像中の距離データには誤って検出された値も存在し、実
際には物体の存在しない位置にも多少のデータが現れ
る。しかしながら、ある程度の大きさの物体があると、
その位置の度数は大きな値を示し、一方、物体が何も存
在しない場合には誤った距離データのみによって発生す
る度数は小さな値となる。従って、作成されたヒストグ
ラムの度数が、予め設定した判定値以上かつ最大値をと
る区間があれば、その区間に物体が存在すると判断し、
度数の最大値が判定値以下の場合は物体が存在しないと
判断しても差し支えなく、画像のデータに多少のノイズ
が含まれている場合においても、ノイズの影響を最小限
にして物体を検出できる。

【００４２】その後、上記ステップS112からステップS1
13へ進んで最終区分に達したか否かを調べる。そして、
最終区分に達していないときには、上記ステップS112か
らステップS114へ進んで次の区分のデータを読み込む
と、前述のステップS104へ戻り、道路面より上にあるデ
ータの抽出、ヒストグラムの作成、及び、各区分内での
立体物の検出と距離の算出を行う。以上の処理を繰り返
し、やがて、最終区分に達すると、上記ステップS113か
らステップS115以降へ進む。

【００４３】図１２は、図１１に示す検出対象の画像を
以上の距離データ検出処理によって検出し、区分毎の距
離をＸ−Ｚ平面上に示した例であり、検出した距離に多
少の誤差が含まれるため、黒点で示すように、立体物の
自車両に面した部分に多少のバラツキを持ったデータと
して検出される。

【００４４】これらの距離データは、ステップS115〜ス
テップS121の距離グループ検出処理により、距離が接近
しているグループに分けられる。この処理では、各区分
の立体物の検出距離を調べ、隣接する区分において立体
物までの検出距離の差異が判定値以下の場合は同一の立
体物と見なし、一方、判定値を超えている場合は別々の
立体物と見なしてグループ分けを行う。

【００４５】このため、ステップS115では、まず、最初
の区分（例えば左端）を調べ、立体物が検出されている
場合には、距離データを読み込んで、この区分Ｒ１を、
グループＳ１、距離Ｚ１に分類する。次に、ステップS1
16へ進んで右隣の区分Ｒ２を調べ、立体物が検出されて
いない場合には、グループＳ１は区分Ｒ１の内部とその
近辺に存在し、その距離はＺ１と判定し、一方、区分Ｒ
２で立体物が検出されており、その検出距離がＺ２であ
る場合には、区分Ｒ１の距離Ｚ１と右隣の区分Ｒ２の距
離Ｚ２の差を計算する。

【００４６】その後、ステップS117へ進んで右隣の区分
との距離の差が判定値以下か否かを調べ、距離の差が判
定値以下で互いに接近しているときには、ステップS118
で、区分Ｒ２で検出された立体物は、先に検出されたグ
ループＳ１に属すると判定して同一グループにラベル付
けを行い、その距離をＺ１とＺ２との平均値としてステ
ップS120へ進む。

【００４７】一方、右隣の区分との距離の差が判定値を
超えているときには、上記ステップS117からステップS1
19へ進み、区分Ｒ２で検出された立体物は、先に検出さ
れたグループＳ１とは異なると判定して新しいグループ
（グループＳ２、距離Ｚ２）にラベル付けを行い、ステ
ップS120へ進む。

【００４８】ステップS120では、最終区分に達したか否
かを調べ、最終区分に達していないときには、ステップ
S121で次の区分の距離を読み込み、上記ステップS116へ
戻っり、さらに右隣の領域を調べてゆく。また、最終区
分に達したときには、ステップS120からステップS122以
降へ進む。

【００４９】以上の距離グループ検出処理により、例え
ば、図１２に示す区分毎の距離データに対し、互いの距
離が接近している距離データがまとめられ、図１３に示
すようにグループ化される。このとき、各区分には、そ
の区分が所属するグループの番号が割り付けられ、記憶
される。図１３の例では、進行方向左側の植え込みの距
離データを有する区分が所属するグループに、グループ
１，２，３の番号が付けられ、先行車両の後部の距離デ
ータを有する区分が所属するグループにグループ４の番
号が付けられる。また、進行方向右側の自転車の距離デ
ータを有する区分が所属するグループにグループ６の番
号が付けられ、同じく右側の壁の距離データを有する区
分が所属するグループにグループ７の番号が付けられ
る。

【００５０】この場合、異なる立体物であっても互いに
距離が接近している区分は、同一のグループとして処理
される虞がある。このため、次のステップS122〜ステッ
プS132におけるグループ分割処理では、距離データのＸ
−Ｚ平面上での並び方向を調べ、並び方向がＺ軸に概ね
平行な部分とＸ軸に概ね平行な部分とでグループを分割
する。

【００５１】このグループ分割処理では、ステップS122
で、最初のグループのデータを読み込み、ステップS123
で、このグループ内の各区分の並び方向を算出すると、
ステップS124で各区分に“物体”、“側壁”のラベルを
付ける。具体的には、グループ内での左端の区分Ｋ１の
位置をＺ１，Ｘ１とし、Ｎ個だけ右側の区分の位置をＺ
ｐ，Ｘｐとすると、点Ｘ１，Ｚ１と点Ｘｐ，Ｚｐとの２
点を結ぶ直線のＺ軸に対する傾きＡ１を算出し、この直
線の傾きＡ１を設定値（例えば、４５°程度）と比較す
る。そして、直線の傾きＡ１が設定値以下でデータの並
びが略Ｚ軸方向の場合には、区分Ｋ１は“側壁”とラベ
ル付けし、上記直線の傾きＡ１が設定値を超え、データ
の並びが略Ｘ軸方向の場合には、“物体”とラベル付け
する。

【００５２】このラベル付けの際の区分の間隔Ｎは、Ｎ
＝２〜４区分程度とする。これは、Ｎ＝１すなわち右隣
の区分では、検出距離のバラツキのために並び方向が大
きくばらついてしまい、分割の判断が難しくなるためで
あり、少し離れた区分との並び方向を使うことにより、
方向の安定化を図る。そして、この“側壁”あるいは
“物体”のラベル付けを、グループ内の左端から順に、
右端からＮ個左側の区分まで行い、各区分にラベル付け
をする。

【００５３】以上により、各区分のラベル付けが完了す
ると、上記ステップS124からステップS125へ進んで左端
の区分のラベルを読み込み、さらに、ステップS126で右
隣の区分のラベルを読み込む。次いで、ステップS127へ
進み、左端のラベルと右隣のラベルが異なるか否かを調
べる。その結果、上記ステップS127において、ラベルが
同じときにはステップS129へジャンプし、ラベルが異な
るとき、ステップS128で“側壁”とラベル付けされた区
分と“物体”とラベル付けされた区分とを分割して別の
グループとし、ステップS129へ進む。分割する区分の位
置は、ラベルが“側壁”←→“物体”で変化する位置の
Ｎ／２区分だけ右側となる。

【００５４】この場合、距離データのバラツキ等により
部分的にラベルが変化する状況に対処するため、同じラ
ベルが判定値以上（例えば、３区分以上）連続して並ん
でいる場合にのみ分割を行い、判定値未満の場合には、
分割は行わない。例えば、図１３の例では、グループ６
（自転車）等の場合のように、形状が複雑なため、“物
体”とラベル付けされる区分と“側壁”とラベル付けさ
れる区分とが混在するグループでは、同種のラベルが３
区分以上に連続しないため、グループの分割は発生しな
い。

【００５５】ステップS129では、最終区分か否かを調
べ、最終区分でないとき、ステップS130で次の区分のラ
ベルを読み込んで上記ステップS126へ戻り、同様の処理
を繰り返す。そして、最終区分に達すると、上記ステッ
プS129からステップS131ヘ進み、最終グループに達した
か否かを調べる。その結果、最終グループに達していな
いときには、ステップS132で次のグループのデータを読
み込み、次のグループに対して同様にグループを分割す
る処理を行う。この処理を繰り返し、やがて、最終グル
ープに達すると、グループ分割処理を完了してステップ
S131からステップS133以降へ進む。

【００５６】次のステップS133〜ステップS138は、分割
された各グループに対し、側壁か物体かの分類を行って
各グループのパラメータを算出する処理であり、ステッ
プS133で最初のグループのデータを読み込むと、ステッ
プS135で、グループ内の各区分の位置（Ｘｉ，Ｚｉ）か
らハフ変換あるいは最小二乗法によって近似直線を求
め、グループ全体の傾きを算出する。

【００５７】次に、ステップS135へ進んで、グループ全
体の傾きから、Ｘ軸方向の傾きを有するグループを物
体、Ｚ軸方向の傾きを有するグループを側壁に分類し、
ステップS136で、各グループのパラメータを算出する。
このパラメータは、物体と分類されたグループでは、グ
ループ内の距離データから算出される平均距離や、左
端、右端のＸ座標等のパラメータであり、側壁と分類さ
れたグループでは、並びの方向（Ｚ軸との傾き）や前後
端の位置（Ｚ，Ｘ座標）等のパラメータである。

【００５８】尚、グループの分類は、前述のグループ分
割処理で付けられた各区分の“側壁”あるいは“物体”
のラベルによって行っても良い。

【００５９】そして、上記ステップS136からステップS1
37へ進んで最終グループに達したか否かを調べ、最終グ
ループでないときには、ステップS138で次のグループの
データを読み込んで上記ステップS134へ戻り、最終グル
ープに達すると、ステップS139以降の処理へ進む。

【００６０】ここで、立体物の１個の面、例えば連続し
たガードレール等では、区分毎の距離データのバラツキ
の影響を強く受けることがあり、先の距離グループ検出
処理あるいはグループ分割処理で複数のグループに分割
されてしまい、立体物の１つの面を誤って分割して検出
する虞がある。

【００６１】この対策として、以下のステップS139〜ス
テップS147のグループ結合処理において、先のグループ
パラメータ算出処理で算出されたグループパラメータに
よって各グループの相互の位置関係を調べ、同種類のグ
ループで端点の位置が接近し、且つ、並び方向がほぼ等
しい場合には、同一物体の同一の面であると判断し、そ
れらのグループを１個のグループに統合する。そして、
統合したグループとしての各種パラメータをグループパ
ラメータ算出処理と同様にして再計算する。

【００６２】このため、ステップS139で、最初のグルー
プのパラメータを読み込み、ステップS140で、次のグル
ープのパラメータを読み込むと、ステップS141で、各グ
ループの端点の距離の差、及び、各グループの傾きの差
を算出する。そして、ステップS142で、各グループの端
点の距離の差、及び、各グループの傾きの差が、それぞ
れの判定値以内か否かを調べ、共に判定値以内のとき、
ステップS143へ進んで同一物体のグループとしてグルー
プを結合し、再度、改めてグループのパラメータを算出
してステップS146へ進む。

【００６３】一方、上記ステップS142で、各グループの
端点の距離の差、あるいは、各グループの傾きの差が判
定値以内でないときには、上記ステップS142からステッ
プS144へ進んで最終グループか否かを調べ、最終グルー
プでないときには、ステップS145で次のグループのパラ
メータを読み込んでステップS141へ戻り、最終グループ
のとき、ステップS146へ進む。

【００６４】ステップS146では、最終グループか否かを
調べ、最終グループでないとき、ステップS147で次のグ
ループのパラメータを読み込んで上記ステップS140へ戻
り、最終グループのとき、ステップS148以降へ進む。

【００６５】以上のグループ結合処理の後、同一立体物
の後部と側面で別のグループに分離されているものに対
し、下のステップS148〜ステップS157の処理により、同
一の立体物であることを検出し、１個の立体物を、“物
体”と“側壁”との組み合わせ（後部は“物体”、側面
は“側壁”とする）として認識する。

【００６６】この処理では、まず、ステップS148で、物
体と分類された最初のグループのパラメータを読み込
み、ステップS149で、側壁と分類された最初のグループ
のパラメータを読み込む。次いで、ステップS150へ進
み、物体と分類されたグループの端点の位置と、側壁と
分類されたグループの端点の位置との差を算出する。こ
の場合、各端点の位置は、“物体”が自動車の正面（Ｚ
軸に相当）より右側にある場合には、“物体”の左端の
位置と“側壁”の手前側の端点の位置との差を算出し、
“物体”が自車両の正面より左側にある場合には、“物
体”の右端の位置と“側壁”の手前側の端点の位置との
差を算出する。

【００６７】そして、ステップS151で、各グループの端
点の位置の差が判定値（例えば、１ｍ程度）以内で、互
いに接近しているか否かを調べ、判定値を超えていると
きには、ステップS152へ分岐して最終側壁か否かを調
べ、最終側壁でないときには、ステップS153で側壁と分
類された次のグループのパラメータを読み込んで上記ス
テップS150へ戻り、最終側壁のとき、ステップS156へ進
む。

【００６８】一方、上記ステップS151で、各グループの
端点の位置の差が判定値以内のときには、上記ステップ
S151からステップS154へ進んで同一立体物であると判定
する。すなわち、１個の立体物の後部と側面とが同時に
見える場合、その２つの面が作るコーナーは手前に凸と
なっているため、“物体”の左端の位置と“側壁”の手
前側の端点の位置、あるいは、“物体”の右端の位置と
“側壁”の手前側の端点の位置とは、本来、一致してい
る。従って、２つのグループの位置の差が上記判定値以
内にあるとき、この２つのグループは１個の立体物を分
けて検出した対であると判断することができる。

【００６９】その後、上記ステップS154からステップS1
55へ進み、同一の立体物と判断された“物体”と“側
壁”との対に対し、それぞれの近似直線を延長して交差
する点を立体物のコーナー点の位置として算出すると、
各端点の位置を、このコーナー点の位置に変更する。そ
して、ステップS156で、“物体”の最終グループか否か
を調べ、“物体”の最終グループでないときには、ステ
ップS157で、“物体”と分類された次のグループのパラ
メータを読み込み、上記ステップS149へ戻って同様の処
理を繰り返す。一方、ステップS156で“物体”の最終の
グループのときには、次のステップS158以降の処理へ進
む。

【００７０】図１４は、図１１に示す検出対象例に対
し、“物体”及び“側壁”の検出結果を、Ｘ−Ｚ平面で
示したものであり、この例では、上述のグループの結合
や“物体”と“側壁”の組み合わせと判定されるグルー
プはなく、“物体”は太線の実線で示され、“側壁”は
太線の破線で示される。

【００７１】次に、ステップS158以降は、所定の時間間
隔（例えば、０．１ｓｅｃ）の処理サイクル毎に検出さ
れる“物体”や“側壁“の位置の変化から、これらの移
動速度を算出する速度算出処理であり、まず、ステップ
S158で、最初のグループのパラメータを読み込み、ステ
ップS159で同一立体物の対となっているか否かを調べ
る。

【００７２】そして、同一立体物の対となっていないと
きには、上記ステップS159からステップS160へ進み、
“物体”では左右端の中央、“側壁”では前後端の中央
を中心点の位置として、この中心点の位置の時間変化量
を算出すると、ステップS161で、前後方向の速度すなわ
ちＺ方向の速度Ｖｚを、中心点のＺ座標の時間変化量か
ら算出するともに、左右方向の速度すなわちＸ方向の速
度を、中心点のＸ座標の時間変化量から算出し、ステッ
プS164へジャンプする。

【００７３】ステップS164では、最終グループか否かを
調べ、最終グループでないときには、ステップS165で次
のグループのパラメータを読み込み、ステップS159へ戻
って同一立体物の対か否かを調べる。その結果、同一立
体物の対でないときには、前述のステップS160,S161を
経て中心点の位置に時間変化から前後・左右方向の速度
を算出し、最終グループか否かを調べるステップS164へ
戻る。

【００７４】一方、上記ステップS159で同一立体物の対
であるときには、上記ステップS159からステップS162へ
進んで、対応する“物体”又は“側壁”のパラメータを
読み込み、ステップS163で、“物体”から前後方向の速
度（Ｚ軸方向の速度Ｖｚ）を算出するとともに、“側
壁”から左右方向の速度（Ｘ軸方向の速度Ｖｘ）を算出
し、これらの速度Ｖｚ，Ｖｘを、同一立体物におけるＺ
軸方向、Ｘ軸方向の速度とする。そして、ステップS164
で、最終グループか否かを調べ、最終グループでないと
きには、以上の処理を繰り返し、最終グループのとき、
ステップS164からステップS166へ進んで、各グループの
パラメータをメモリに書き込み、立体物検出処理の全体
のプログラムを終了する。

【００７５】すなわち、“物体”では、Ｚ軸方向の位置
は複数の区分の距離の平均値的な値となり、速度Ｖｚは
安定しているが、Ｘ方向の位置は左右端のＸ座標のバラ
ツキの影響を受け、速度Ｖｘはバラツキが大きい傾向に
ある。一方、“側壁”では、Ｘ方向の位置は複数の区分
のＸ座標の平均値的な値となり、速度Ｖｘは安定してい
るが、Ｚ方向の位置は前後端のＺ座標のバラツキの影響
を受け、速度Ｖｚはバラツキが大きくなる傾向にある。
従って、両方の安定した速度のみを用いて同一立体物の
速度とするのである。

【００７６】この場合、前回の処理で検出された距離デ
ータと、今回の処理で検出された距離データとでは、同
一の立体物の同一部分を検出している距離データの対応
関係を求めることは困難であり、個々の距離データから
対象物の速度を求めることは困難である。しかしなが
ら、本発明においては、個々の距離データを立体物毎に
グループ化し、グループ毎に直線状に近似して、その中
心点を求めているため、前回処理時に検出されたグルー
プと今回の処理で検出されたグループとの対応関係を求
めることは容易であり、中心点の移動量から対象物の速
度を算出することができる。

【００７７】以上の処理によって検出された物体や側壁
のデータは、マイクロプロセッサ３０ｃによる隙間距離
算出処理のプログラムに渡され、予測時間ｔ後の立体物
の位置と自車両の走行領域とに基づいて接触危険性が判
断されるとともに、自車両と立体物との隙間距離が算出
される。

【００７８】この隙間距離算出処理のプログラムでは、
ステップS201で、自車両の通過軌跡を推定する。この自
車両の通過軌跡は、自車両の輪郭をｎ個の頂点からなる
多角形で直線近似した内蔵モデルを利用して推定するよ
うにしており、図１５（ａ）に示すような自車両の輪郭
を、図１５（ｂ）に示すように、後車軸中心を原点とし
た頂点ｎの座標Ｐｎ＝[Ｐxn,Ｐzn]^Tで近似し、予測時間
ｔ（例えば、１、２秒）後の頂点ｎの座標Ｐｎ'＝[Ｐ'x
n,Ｐ'zn]^Tを求めることで、自車両の通過軌跡を推定す
る。

【００７９】このため、まず、車速センサ４から得た車
速と舵角センサ５から得た操舵角とから、予測時間ｔに
おける後車軸中心を基準とした空走距離Ｌ及び旋回半径
Ｒを求める。この空走距離Ｌは、自車両の速度に比例す
る距離と最低限走行する距離（例えば、〜１ｍ程度）か
らなり、また、旋回半径Ｒの中心は後車軸延長線上に重
なるものとする。そして、旋回中心の座標をＯ＝[Ｏx,
Ｏz]^Tとし、旋回角度をθとすると、この旋回角度θ
は、以下の(10)式によって与えられ、予測時間ｔ後の頂
点ｎの座標は、以下の(11)式で与えられる。 θ＝Ｌ／Ｒ …(10)

【００８０】また、各頂点の旋回半径ｒnは、以下の(1
2)式で求めることができるため、これを用い、旋回半径
が最大の（最も外側を通る）頂点番号ｎoと最小の（最
も内側を通る）頂点番号ｎiを求める。そして、頂点番
号ｎoの現在の座標Ｐｎoと予測時間ｔ後の座標Ｐ'ｎoと
を、(12)式を適用して求めた最大旋回半径ｒnoの円弧で
繋ぐとともに、頂点番号ｎiの現在の座標Ｐｎiと予測時
間ｔ後の座標Ｐ'ｎiとを、(12)式を適用して求めた最小
旋回半径ｒniの円弧で繋ぎ、残った頂点を、それぞれ隣
り合う頂点と直線で繋ぐことにより、図１６に示すよう
に、自車両の通過軌跡を得ることができる。 ｒn＝((Ｐxn−Ｏx)²＋(Ｐzn−Ｏz)²)^1/2 …(12)

【００８１】この場合、舵角０すなわち旋回半径無限大
のときには、計算実行が不可能になるため、予測時間ｔ
後の頂点ｎの座標は、以下の(13)式で求め、左右それぞ
れに最も張り出した頂点を直線で繋いで推定通過軌跡と
する。

【００８２】そして、自車両の通過軌跡を推定した後、
上記ステップS201からステップS202へ進み、後述する接
触判定及び隙間計測のため、自車両の輪郭モデル（図１
５参照）の先端中央Ｃｆ＝[Ｃxf,Ｃzf]^Tと後端中央Ｃｒ
＝[Ｃxr,Ｃzr]^Tとを、各頂点と同様に予測時間ｔ後の位
置Ｃ'ｆ，Ｃ'ｒを算出し、図１７に示すように、通過軌
跡による走行領域を右側の判定領域と左側の判定領域と
に分割する。

【００８３】続くステップS203では、先の立体物検出処
理で得られた各グループの速度Ｖｘ，Ｖｚから、予測時
間ｔにおける立体物のＸ方向移動量ｄｘ、Ｚ方向移動量
ｄｚを以下の(14),(15)式によって求め、各距離データ
をＸ方向移動量ｄｘ、Ｚ方向移動量ｄｚだけ移動させ、
予測時間ｔ後の立体物の位置を推定する。 ｄｘ＝Ｖｘ・ｔ …(14) ｄｚ＝Ｖｚ・ｔ …(15)

【００８４】図１３に示す立体物の位置の検出結果をグ
ループ化した例では、植え込みを検出したグループ１，
２，３、及び、右の壁を検出したグループ７ではＸ方
向、Ｚ方向ともに速度は略０と検出されるため、予測時
間ｔ後の位置は検出位置から変化しない。また、先行車
両を検出したグループ４では、例えば、速度Ｖｘ＝０、
Ｖｚ＝４．０ｍ／ｓｅｃと検出されたものとし、ｔ＝
１．５ｓｅｃと仮定すると、グループ４の移動量はｄｘ
＝０．０ｍ、ｄｚ＝６．０ｍとなる。また、自転車を検
出したグループ６は、例えば、Ｖｘ＝−０．１ｍ／ｓｅ
ｃ、Ｖｚ＝−１．０ｍ／ｓｅｃと検出されたとすると、
移動量は、ｄｘ＝−０．１５ｍ、ｄｚ＝−１．５ｍとな
る。図１８は、各距離データを、Ｘ方向移動量ｄｘ、Ｚ
方向移動量ｄｚだけ移動させた予測時間ｔ後の推定位置
を示している。

【００８５】その後、ステップS204へ進み、ステレオカ
メラの視野外となった立体物について、距離データの追
跡を行う。Ｘ方向及びＺ方向とも速度略０と検出された
距離データのグループは道路上に静止している立体物と
し、その距離データが各処理サイクル毎に保持されてい
る。

【００８６】ｋ番目の処理サイクルとｋ−１番目の処理
サイクル間の走行軌跡は、車速センサ４及び舵角センサ
５により、走行軌跡Ｌ'、旋回半径Ｒ'として得ることが
できる。このとき、走行距離Ｌ'は、ｋ番目の処理サイ
クルでの位置を基準にするため、Ｌ'＜０となり、旋回
中心の座標をＯ'＝[Ｏ'x,Ｏ'z]^Tとし、旋回角度をαと
すると、この旋回角度αは、以下の(16)式によって与え
られる。 α＝Ｌ'／Ｒ' …(16)

【００８７】従って、ｋ−１番目の処理サイクルでの距
離データをＤ＝[Ｄx,Ｄz]^Tとすると、ｋ番目の処理サイ
クルでの距離データＤ'は、以下の(17)式によって求め
ることができ、これを処理サイクル毎に更新してゆくこ
とにより、図１９に示すように、ステレオカメラの視野
外に逸脱してしまった距離データを追跡することができ
る。

【００８８】その後、上記視野外に逸脱してしまった立
体物の追跡データを含め、自車両通過軌跡と立体物の接
触判定を行うため、ステップS205で、予測時間ｔ後の位
置を推定した距離データの中から最初のデータを読み込
むと、ステップS206で、その推定距離データが右側判定
領域内にあるか否かを調べる。

【００８９】そして、推定距離データが右側判定領域内
にない場合には、上記ステップS206からステップS208へ
進み、右側判定領域内にある場合、自車両と接触する可
能性があると判断して上記ステップS206からステップS2
07へ進んで右側の接触を示す右側接触フラグをＯＮし、
ステップS208へ進む。

【００９０】ステップS208では、推定距離データが左側
判定領域内にあるか否かを調べ、左側判定領域内にない
場合、ステップS210へ進み、推定距離データが左側判定
領域内にある場合、ステップS211で左側の接触を示す左
側接触フラグをＯＮし、ステップS210へ進む。

【００９１】ステップS210では、右側あるいは左側の接
触フラグがＯＮされたか否かを調べ、いずれかの側の接
触フラグがＯＮされたときには、ステップS211で警報を
発生し、ディスプレイ９への警告表示、あるいは、ラン
プ、ブザー等による警告を行い、運転者に知らせる。

【００９２】一方、上記ステップS210で、左右の接触フ
ラグがＯＮされていないときには、上記ステップS210か
らステップS212へ進み、接触判定領域外の推定距離デー
タを、通過軌跡前面より前方にあるデータを除いて車体
中心線左右にグループに振り分ける。次に、ステップS2
13で、接触判定領域外の推定距離データと自車両の通過
軌跡との間の隙間距離を算出する。この隙間距離は、図
２０に示すように、左グループの場合は自車両左側面の
通過軌跡に対して、右グループの場合は自車両右側面の
通過軌跡に対して法線を引き、この長さを“隙間距離”
とし、その値を記憶する。

【００９３】その後、ステップS214へ進んで最終の推定
距離データか否かを調べ、最終の推定距離データに達し
ていないときには、ステップS215で次の推定距離データ
を読み込んで上記ステップS206へ戻り、以上の処理を繰
り返す。そして全ての推定距離データについて接触判定
を完了すると、上記ステップS214からステップS216へ進
み、左右各グループ毎に隙間距離の最小値を算出して保
持し、ステップS217で、数値表示あるいは算出した隙間
距離の最小値に応じて注意を喚起するための表示信号を
ディスプレイ９に出力し、運転者に報知する。

【００９４】図２１は、図１８に示す予測時間ｔ後の各
距離データの推定位置に対し、自車両の走行領域を記入
したものであり、この例では、先行車両の現在の検出位
置は自車両の走行領域に入っているが、立体物の速度と
自車両の走行軌跡とを考慮し、設定時間後の推定位置に
対して接触判定を行うため、先行車両とは接触しないと
正しく判定することができる。

【００９５】また、図２１における自転車のように複雑
な対象物に対しても、グループ内の個々の距離データを
グループの速度に応じて移動させるため、検出される対
象物の凹凸がそのまま保持され、接触判定を精密に行う
ことができる。図２１の例では、自転車に接触する危険
があると正しく判定され、思わぬ事故を未然に回避する
ことができる。図２１においては、植え込みのように、
静止している立体物に対しても同様である。

【００９６】しかも、この場合、自車両の輪郭が描く走
行軌跡を、自車両の速度及び舵角に応じて推定するた
め、対象物の凹凸を考慮することに合わせ、自車両の凹
凸も考慮され、接触判定、隙間計測の精度を向上するこ
とができるばかりでなく、運転者の注視する領域と接触
判定領域とを近づけることができ、違和感の少ない警報
を発することができる。

【００９７】さらに、検出範囲外に逸脱してしまった対
象物に対しても距離データの追跡を行うため、自車両の
すぐ横の立体物に対しても、接触判定、隙間計測を行う
ことができ、特に、内輪差の影響による接触事故防止に
大きな効果を発揮することができる。

【００９８】図２２及び図２３は本発明の実施の第２形
態に係わり、図２２は立体物検出処理の部分フローチャ
ート、図２３はグループの対応関係を示す説明図であ
る。

【００９９】前述の第１形態では、立体物の移動速度を
検出するため、検出したグループを“物体”又は“側
壁”として直線状に近似し、その中心点を求める処理を
行っている。これに対し、本形態では、前回処理で検出
したグループ内の個々の距離データと今回処理で検出し
たグループ内の個々の距離データとを比較し、グループ
としての移動量を求め、速度を算出するものである。

【０１００】このため、本形態では、画像処理用コンピ
ュータ３０のマイクロプロセッサ３０ｂによる立体物検
出処理の一部を変更する。本形態の立体物検出処理は、
第１形態の図３〜図６のプログラムにおいて、ステップ
S101〜S114の距離データ検出処理、ステップS115〜S121
の距離グループ検出処理、ステップS122〜S132のグルー
プ分割処理までは同じであり、このグループ分割処理以
降を変更する。

【０１０１】すなわち、本形態では、ステップS122〜S1
32のグループ分割処理を完了すると、ステップS132から
図２２のステップS170へ進み、ステップS170〜S174で、
前回処理で検出された複数のグループの中から今回の処
理で検出されたグループと、同一の立体物を検出してい
るグループを検索してグループの対応関係を求める処理
を行った後、ステップS175以降で、今回処理で検出され
たグループと対応関係にある前回検出のグループとの間
の移動量からグループの速度を求める。

【０１０２】このため、まず、ステップS170で今回検出
の最初のグループのデータを読み込むと、ステップS171
で、グループ内の距離データの重心点（Ｘｃ，Ｚｃ）を
求める。この重心点（Ｘｃ，Ｚｃ）は、グループ内のｉ
番目の距離データの位置をｘi、ｚiとし、ｎをグループ
に所属する距離データの個数とすると、以下の(18),(1
9)式によって求めることができる。但し、Σはｉ＝１〜
ｎの総和を求めるものとする。 Ｘｃ＝（Σｘi）／ｎ …(18) Ｚｃ＝（Σｚi）／ｎ …(19)

【０１０３】次に、ステップS172へ進み、前回処理で検
出されたグループの重心点を読み出し、この前回検出の
グループの重心点と今回検出のグループの重心点との間
の距離（重心点の移動量）を算出すると、ステップS173
で、各グループの重心点間の距離が判定値以下か否かを
調べる。そして、前回処理で検出されたグループの重心
点と今回検出のグループの重心点との間の距離が判定値
を超えているときには、これらのグループは同一立体物
を検出したものではないと判断してステップS174へ進
み、前回検出の次のグループの重心点を読み出して上記
ステップS172へ戻る。

【０１０４】一方、上記ステップS173で、各グループの
重心点間の距離が判定値以下のときには、これらのグル
ープは同一立体物を検出した対応関係にあると判断して
上記ステップS173からステップS175へ進み、前回検出の
グループ内の各距離データを移動させてグループ間のズ
レ量が最小となる修正量を算出する。

【０１０５】例えば、図２３に示すように、前回検出の
グループＦと今回検出のグループＧが対応関係にあると
すると、まず、前回検出のグループＦの各距離データ
を、今回検出のグループＧの重心点ＰGと前回検出のグ
ループＦの重心点ＰFとが一致するように移動する。

【０１０６】次に、この移動後のグループＦ１の各距離
データｉF1について、今回検出のグループＧ内で最も距
離が近い距離データｉGを求め、各距離データｉF1,ｉG
間の距離ｄｉF1を求める。これを移動後のグループＦ１
内の全ての距離データについて行い、距離ｄｉF1の二乗
和ＳＤＫ1（ズレ量）を、以下の(20)式によって求め
る。 ＳＤＫ1＝ΣｄｉF1² …(20)

【０１０７】さらに、グループＦ１の全体の位置を、Ｚ
方向及びＸ方向に微小量Δｚ，Δｘだけ移動し、この移
動後のグループＦ２と今回検出のグループＧとの間のズ
レ量ＳＤＫ2を、上記と同様に算出する。そして、この
処理を、Δｚ，Δｘを変化させて繰り返し、各ずれ量Ｓ
ＤＫ1,ＳＤＫ2,ＳＤＫ3,…の中で最小値が得られる微小
量Δｚ，Δｘの値を、グループ間のズレ量が最小となる
修正量とする。

【０１０８】以上により、グループ間のズレ量が最小と
なる修正量を求めると、次に、ステップS176へ進み、対
応関係にあるグループ間の重心点の移動量に上記修正量
を加えた値をグループ間の移動量とし、ステップS177
で、この移動量を処理サイクル毎の時間間隔で割り算し
てグループの速度Ｖｚ，Ｖｘを算出する。次いで、ステ
ップS178で最終グループか否かを調べ、最終グループで
ないときには、ステップS179で次のグループのデータを
読み込んでステップS171へ戻り、以上の処理を繰り返
す。尚、簡易的には、上記ステップS172で算出した重心
点の移動量を処理サイクル毎の時間間隔で割り算し、グ
ループの速度としても良い。

【０１０９】そして、上記ステップS178で最終グループ
となって最終グループの処理が完了したとき、上記ステ
ップS178からステップS180へ進んで各グループの位置や
速度等のパラメータをメモリに書き込み、立体物検出処
理の全体のプログラムを終了する。この立体部検出処理
のデータを用いる以降の隙間距離算出処理は、前述の第
１形態と同じである。

【０１１０】本形態では、前述の第１形態に対し、立体
物の移動速度を高い精度で検出することができ、接触判
定や隙間距離の精度をより一層向上することができる。

【０１１１】図２４〜図２７は本発明の第３形態に係
り、図２４は車外監視装置の全体構成図、図２５は車外
監視装置の回路ブロック図、図２６は画像の例を示す説
明図、図２７は立体物の二次元分布の例を示す説明図で
ある。

【０１１２】本形態の車外監視装置５０は、図２４に示
すように、上下２台のカメラからなるステレオ光学系６
０からの画像を処理して立体物の二次元的な位置分布を
認識する通路パターン認識装置７０を採用し、この通路
パターン認識装置７０に第１形態と同様の画像処理用コ
ンピュータ３０を接続したものであり、通路パターン認
識装置７０によって得られる立体物の二次元分布の位置
情報を前述の第１形態と同様の方法で処理するものであ
る。

【０１１３】上記通路パターン認識装置７０は、周知の
装置を適用することができ、例えば、計測自動制御学会
論文集Ｖｏｌ．２１，Ｎｏ．２（昭和６０年２月）「障
害物の２次元的な分布の認識手法」に記載されている通
路パターン認識装置等を適用することができる。尚、上
記通路パターン認識装置７０は、前述の第１形態と同様
に２台のカメラの画像を処理して被写体までの距離分布
を検出するものであるが、装置内部のデータ処理方法が
異なるため立体物の情報のみが出力され、第１形態のよ
うな白線による道路形状の検出はできない。

【０１１４】上記ステレオ光学系６０は、車両４０の前
部に上下一定の間隔をもって取り付けられる２台のＣＣ
Ｄカメラ６０ａ，６０ｂで構成されており、また、上記
通路パターン認識装置７０は、図２５に示すように、上
記ステレオ光学系６０からの上下２枚の画像信号を入力
し、立体物の距離及び位置の二次元分布を算出する距離
検出回路６０ａ、この距離検出回路６０ａからの二次元
分布情報を記憶する二次元分布メモリ６０ｂ等から構成
されている。

【０１１５】本形態では、ステレオ光学系６０で撮像し
た画像、例えば、図２６に示すような画像を通路パター
ン認識装置７０で処理すると、図２７に示すような立体
物の二次元分布パターンが出力される。これは、前述の
第１形態における区分毎の距離データに相当するもので
あり、この立体物の二次元分布パターンに対し、前述の
第１形態と同様の処理を行うことにより、立体物検出、
接触判定、隙間距離計測を行うことができる。

【０１１６】本形態では、側壁の有無や位置を、直線式
のパラメータや前後端の座標といった簡素なデータ形態
に変換するため、利用側でのデータの取扱いや処理が容
易となる。

【０１１７】図２８〜図３２は本発明の実施の第４形態
に係わり、図２８は車外監視装置の全体構成図、図２９
は車外監視装置の回路ブロック図、図３０はレーザビー
ムの走査方法を側面から示す説明図、図３１はレーザビ
ームの走査方法を上面から示す説明図、図３２はレーザ
レーダ測距装置で計測される立体物の二次元分布の例を
示す説明図である。

【０１１８】前述の各形態ではカメラの撮像画像を処理
して車外の物体を検出するようにしているが、これに対
し、本形態は、レーザビームの走査によって車外の物体
を検出するものである。すなわち、図２８に示すよう
に、本形態の車両８０に搭載される車外監視装置９０
は、レーザビームによるレーザレーダ測距装置１００を
採用し、このレーザレーダ測距装置１００に画像処理用
コンピュータ３０を接続したものである。

【０１１９】上記レーザレーダ測距装置１００は、レー
ザビームを投射し、このレーザビームが物体に当たって
反射してくる光を受光し、この所要時間から物体までの
距離を測定するものであり、本形態の車外監視装置９０
には周知のレーザレーダ測距装置を適用することができ
る。

【０１２０】本形態の車外監視装置９０では、レーザビ
ームの投射・受光と左右方向への走査機能を有するレー
ザ投光ユニット１０１が車両の前部に取り付けられてお
り、図２９に示すように、レーザレーダ測距装置１００
には、レーザービームの投光受光の所要時間から物体ま
での距離を計算し、また、レーザビームを走査する方向
から物体の二次元の位置を計算する距離検出回路１００
ａ、検出された物体の二次元の位置を書き込む二次元分
布メモリ１００ｂ等から構成されている。

【０１２１】図３０に示すように、レーザ投光ユニット
１０１からはレーザビームが水平に投射され、道路表面
より高い位置にある立体物のみが検出される。また、図
３１に示すように、レーザビームは左右方向に走査さ
れ、所定の走査範囲で一定の間隔毎にレーザビームが投
光・受光されて距離を検出する動作が繰り返され、立体
物の二次元分布が計測される。

【０１２２】例えば、前方左側にガードレール、右前方
に他の車両がある状況を上記レーザレーダ測距装置１０
０で計測すると、図３２に示すような立体物の二次元分
布の情報が得られる。これは、前述の第１形態における
区分毎の立体物の距離データと同様である。

【０１２３】従って、レーザレーダ測距装置１００の出
力である立体物の二次元分布に対し、第１形態と同様の
処理を行なうことにより、物体や壁面を検出することが
できる。本形態では、立体物のデータを処理が容易な形
態で得ることができ、計算処理量を低減することが可能
である。

【０１２４】

【発明の効果】以上説明したように本発明によれば、車
外の物体までの距離を計測して得られる距離分布の疑似
画像を複数の区分に分割し、各区分毎に立体物の有無と
距離データとを検出した後、距離データが互いに接近す
る各区分を１つのグループにまとめ、このグループ毎の
立体物の移動速度を算出してグループ内の全ての距離デ
ータを移動速度に応じて移動させ、設定時間後の立体物
の位置と自車両の輪郭が描く走行軌跡とを推定し、立体
物の推定位置と自車両の走行軌跡とを比較して自車両が
立体物に接触するか否かを判定し、また、立体物の推定
位置と自車両の走行軌跡とに基づいて自車両と立体物と
の間の最小隙間を算出するため、検出した障害物の位置
の変化や細部形状に関する情報を取り入れて自車両との
接触可能性を正確且つ精密に判断することができる等優
れた効果が得られる。

【図面の簡単な説明】

【図１】本発明の実施の第１形態に係わり、車外監視装
置の全体構成図

【図２】同上、車外監視装置の回路ブロック図

【図３】同上、立体物検出処理のフローチャート（その
１）

【図４】同上、立体物検出処理のフローチャート（その
２）

【図５】同上、立体物検出処理のフローチャート（その
３）

【図６】同上、立体物検出処理のフローチャート（その
４）

【図７】同上、隙間距離算出処理のフローチャート

【図８】同上、車載のカメラで撮像した画像の例を示す
説明図

【図９】同上、距離画像の例を示す説明図

【図１０】同上、距離画像の区分を示す説明図

【図１１】同上、検出対象の状況例を示す説明図

【図１２】同上、区分毎の立体物の検出距離の例を示す
説明図

【図１３】同上、区分毎の立体物の検出距離をグループ
化した例を示す説明図

【図１４】同上、検出した物体と側壁の結果を示す説明
図

【図１５】同上、自車両輪郭の近似を示す説明図

【図１６】同上、自車両の通過軌跡を示す説明図

【図１７】同上、左右判定領域の説明図

【図１８】同上、設定時間後の立体物の位置の推定結果
を示す説明図

【図１９】同上、視野外距離データの追跡を示す説明図

【図２０】同上、通過軌跡と距離データとの隙間計測の
説明図

【図２１】同上、自車両と立体物との接触判定の説明図

【図２２】本発明の実施の第２形態に係わり、立体物検
出処理の部分フローチャート

【図２３】同上、グループの対応関係を示す説明図

【図２４】本発明の第３形態に係り、車外監視装置の全
体構成図、

【図２５】同上、車外監視装置の回路ブロック図

【図２６】同上、画像の例を示す説明図

【図２７】同上、立体物の二次元分布の例を示す説明図

【図２８】本発明の実施の第４形態に係わり、車外監視
装置の全体構成図

【図２９】同上、車外監視装置の回路ブロック図

【図３０】同上、レーザビームの走査方法を側面から示
す説明図

【図３１】同上、レーザビームの走査方法を上面から示
す説明図

【図３２】同上、レーザレーダ測距装置で計測される立
体物の二次元分布の例を示す説明図

【符号の説明】

１ …車外監視装置 １０ａ，１０ｂ…ＣＣＤカメラ ２０…イメージプロセッサ ３０…画像処理用コンピュータ

Claims (6)

【特許請求の範囲】
1. 【請求項１】 車外の物体の距離を計測して得られる距
   離分布の疑似画像を複数の区分に分割し、各区分毎に立
   体物の有無と距離データとを検出して車外の状況を認識
   する車外監視装置において、 上記距離データが互いに接近する各区分を１つのグルー
   プにまとめ、このグループ毎の立体物の移動速度を算出
   する手段と、 上記グループ内の全ての距離データを移動速度に応じて
   移動させ、設定時間後の上記立体物の位置を推定する手
   段と、 上記設定時間後の自車両の輪郭が描く走行軌跡を推定す
   る手段と、 上記立体物の推定位置と上記自車両の走行軌跡とを比較
   し、自車両が立体物に接触するか否かを判定する手段
   と、 上記立体物の推定位置と上記自車両の走行軌跡とに基づ
   いて、自車両と立体物との間の最小隙間を算出する手段
   とを備えたことを特徴とする車外監視装置。
2. 【請求項２】 前回の処理で検出されたグループ内の各
   距離データと今回の処理で検出されたグループ内の各距
   離データとを比較してグループ間の対応関係を調べ、対
   応するグループ間の時間的な移動量から移動速度を算出
   することを特徴とする請求項１記載の車外監視装置。
3. 【請求項３】 道路上に静止している立体物の距離デー
   タを処理サイクル毎に保持し、当該立体物が検出範囲外
   に逸脱したとき、前回の距離データと自車両の走行軌跡
   とに基づいて当該立体物の位置を推定する手段を備えた
   ことを特徴とする請求項１記載の車外監視装置。
4. 【請求項４】 上記疑似画像は、一組のカメラで撮像し
   た一対の画像の相関を求め、同一物体に対する視差から
   三角測量の原理によって求めた三次元の距離分布を示す
   ものであることを特徴とする請求項１記載の車外監視装
   置。
5. 【請求項５】 上記疑似画像は、一組のカメラで撮像し
   た一対の画像を処理して得られる二次元の距離分布を示
   すものであることを特徴とする請求項１記載の車外監視
   装置。
6. 【請求項６】 上記疑似画像は、レーザ光の投射・受光
   あるいは電波の発信・受信によって求めた二次元の距離
   分布を示すものであることを特徴とする請求項１記載の
   車外監視装置。