JP6451858B2 - 段差検出装置及び段差検出方法 - Google Patents

Description

本発明は、路面上の段差を検出する段差検出装置及び段差検出方法に関するものである。

カメラ画像から路面の高さ情報を検出し、この高さ情報から縁石などの路側物により生じる路面の段差を検出する路側物検出装置が知られている（特許文献１参照）。

特開２０１４−００２６０８号公報

上記した路側物検出装置は、路面の高さ変化量が閾値以上であった場合に段差として認識する。よって、車道が傾斜している場合、車道の位置に応じて路面の高さが変化するため、車道の位置の取り方によって、路面の高さ変化量を正しく検出することができない場合がある。

本発明は、上記課題に鑑みて成されたものであり、その目的は、車道に傾斜があっても路面上の段差を精度良く検出することができる段差検出装置及び段差検出方法を提供することである。

本発明の一態様に係わる段差検出装置は、車両の周囲における路面の高さを検出する測距部を備え、路面の高さに基づいて、走行可能領域の車幅方向における路面の傾斜を曲線で近似し、曲線に対する測定点の高さの合致度と、走行可能領域を車幅方向に拡張した拡張領域における路面の傾斜を近似した曲線に対する測定点の高さの合致度とに基づいて、路面上の段差を検出する。

本発明の一態様によれば、曲線と測定点との合致度から路面高さの急激な変化、即ち、段差を検出することができる。よって、車道に傾斜があっても路面上の段差を精度良く検出することができる。

図１は、実施形態に係わる段差検出装置１の全体構成を示すブロック図である。 図２は、車両の周囲の路面に設定された線状の段差判定位置（Ｐａ）の例を示す斜視図である。 図３は、図２に対応する俯瞰図である。 図４は、段差判定位置（Ｐａ）における路面（Ｆroad）の高さ分布を示すグラフである。 図５は、路面（Ｆroad）を曲線近似する領域（Ｇ_１〜Ｇ_４）を所定範囲（Ｋｃ）ずつ段階的に広げていき、測定点（Ｉ_ｍ１〜Ｉ_ｍ７）と曲線（Ｃroad）との合致度の変化を判断する一連の処理サイクルを示す図である。 図６は、図１の段差検出装置１を用いた段差検出方法の一例を示すフローチャートである。 図７は、図６のステップＳ０９〜Ｓ１３の詳細な手順の一例を示すフローチャートである。 図８は、車両（Ｖｃ）の側部にステレオカメラを設置した場合の段差判定位置（Ｐａ）の例を示す斜視図である。 図９は、車両（Ｖｃ）のルーフ中央部にＬＲＦ（１２）を設定し、車両周囲の全体を照射範囲とする３６０度ＬＲＦの例を示す俯瞰図である。 図１０は、測距センサ１２としてレーザレンジファインダ（ＬＲＦ）を用いた場合の段差検出方法の一例を示すフローチャートである。 図１１は、第３及び第４変形例に係わる段差検出装置２の全体構成を示すブロック図である。

（第１実施形態）
次に、図面を参照して、実施形態を詳細に説明する。

図１を参照して、実施形態に係わる段差検出装置１の全体構成を説明する。段差検出装置１は、車両の周囲における道路の表面（以後、「路面」という）の高さを検出し、路面の傾斜を曲線で近似する。そして、近似した曲線と路面の測定点との合致度に基づいて、路面上の段差を検出する。

具体的に、段差検出装置１は、車両の周囲における路面の高さを検出する測距センサ１２と、測距センサ１２による測定点の高さデータから路面上の段差を検出する一連の情報処理を実行するマイクロコンピュータ１３とを備える。

測距センサ１２の一例は、車両の周囲にある物体を複数の異なる方向から同時に撮影することにより、車両の周囲にある物体の奥行き方向（センサ１２からの距離）の情報も記録することができるステレオカメラである。ステレオカメラにより得られたステレオ画像に対して所定の画像処理を施すことにより、車両の周囲にある物体のステレオ画像に映る物体の像に対する三次元情報を取得することができる。車両の周囲にある物体には、道路や縁石が含まれる。詳細は、後述する。

マイクロコンピュータ１３は、例えば、ＣＰＵ、メモリ、及び入出力部を備える汎用のマイクロコントローラからなり、予めインストールされたコンピュータプログラムを実行することにより、段差検出装置が備える複数の情報処理回路を構成する。マイクロコンピュータ１３は、測距センサ１２による測定データから路面上の段差を検出する一連の情報処理サイクルを所定の時間間隔で繰り返し実行する。マイクロコンピュータ１３は、車両にかかわる他の制御に用いる電子制御ユニット（ＥＣＵ）と兼用してもよい。

マイクロコンピュータ１３により構成される複数の情報処理回路には、演算回路１４と、段差判定位置回路１５と、走行可能領域回路１６と、路面傾斜回路１７と、段差検出回路１８とを含まれる。

演算回路１４は、測距センサ１２と共に測距部１１を構成し、ステレオカメラにより得られたステレオ画像から車両周囲の物体のステレオ画像に映る物体の像に対する三次元情報を取得する一連のステレオ画像処理を実施する。

例えば、演算回路１４は、ステレオ画像に対してレンズの歪みを補正するレンズ歪み補正処理を行い、ステレオ画像間の上下位置を補正する平行化補正処理（平行等位処理）を行う。そして、ステレオ画像間の各画素の対応付けを推定するステレオマッチング処理を行う。これにより、ステレオカメラの撮像面における物体の二次元座標のみならず、ステレオカメラの撮像面から物体までの距離を算出することができる。よって、車両周囲にある物体までの距離及び方位を検出することができる。

演算回路１４は、更に座標変換処理を施すことにより、測距データの座標上の車両周囲にある物体の三次元情報を取得することができる。車両周囲にある物体の三次元情報には、車両の周囲における路面の三次元情報も含まれる。よって、演算回路１４は、車両の周囲における路面の測定点の高さデータを取得することができる。

レンズ歪み補正処理は、例えば黒白の市松模様のパターンを表した平板を各カメラで撮影し、市松模様の格子点が矩形で構成される格子状となるようにレンズ歪みパラメータやカメラレンズ中心パラメータを推定する。ただし、本処理は、レンズ歪み補正を行う一般的な手法でよく、本実施形態では特に問わない。

平行化補正処理は、例えば黒白の市松模様のパターンを表した平板をステレオカメラの両カメラで撮影し、市松模様の格子点の位置が各カメラ画像上で同じ上下位置になるようにステレオカメラ間の空間位置パラメータ及び角度パラメータを推定する。ただし、本処理は、平行化補正処理を行う一般的な手法でよく、本実施形態では特に問わない。

ステレオマッチング処理は、例えば、左カメラ画像を基準として左カメラ画像の各画素が右カメラ画像のどの画素に対応付けされるかを算出するものである。例えば、左カメラ画像の各画素の輝度値と右カメラ画像の各画素の輝度値の絶対値を評価値として算出して、評価値が最小となる右カメラ画像の画素を対応付けされた画素として算出する。評価値の算出方法には、例えば、差分絶対値の和（ＳＡＤ：Ｓｕｍ ｏｆ Ａｂｓｏｌｕｔｅ Ｄｉｆｆｅｒｅｎｃｅｓ）や差分二乗値の和（ＳＳＤ：Ｓｕｍ ｏｆ Ｓｑｕａｒｅｄ Ｄｉｆｆｅｒｅｎｃｅｓ）を用いる方法や、評価値計算の範囲が各画素１点でなく各画素の周辺画素を含む方法がある。評価値の算出方法は、他の一般的な方式でもよく、本実施形態では特に問わない。

段差判定位置回路１５は、測距センサ１２で検出された測距データの座標上の車両の周囲の路面に車幅方向の線状の段差判定位置を設定する。例えば、図２及び図３に示すように、測距センサ１２から第１の所定方向（Ｄａ）に所定距離だけ離れ、第１の所定方向（Ｄａ）に直交する方向に延びる段差判定位置（Ｐａ）を測距データの座標上の路面に設定する。図２及び図３は、車両（Ｖｃ）の前部に測距センサ１２を設置し、車両（Ｖｃ）の進行方向を第１の所定方向（Ｄａ）とした例を示す。よって、車幅方向に延びる段差判定位置（Ｐａ）が、測距データの座標上の車両（Ｖｃ）の前方に設定される。なお、段差判定位置（Ｐａ）は、ステレオカメラの撮像範囲内において設定される。第１の所定方向（Ｄａ）は車両（Ｖｃ）の進行方向に限定されない。

図２及び図３に示す例で、車両（Ｖｃ）が走行可能な車道の車幅方向の端部である路肩には、路面の高さが非連続的に変化する段差（ＬＤ）が形成されている。そして、段差（ＬＤ）を境にして車道よりも外側には、車道よりも路面が一段高い段差部（例えば、歩道や路肩）が設けられている。このように、図２及び図３に示す例において、道路は、車道及び段差部（歩道や路肩）からなり、車道と段差部（歩道や路肩）の境界には、段差（ＬＤ）が形成されている。線状の段差判定位置（Ｐａ）は、車道、段差（ＬＤ）、及び段差部（歩道や路肩）を横断する方向に延びている。

上記した測距センサ１２に対する段差判定位置（Ｐａ）の位置関係は一例にすぎない。他の例は、図８及び図９を参照して後述する。

段差判定位置回路１５は、演算回路１４により取得された路面の高さから、段差判定位置（Ｐａ）における路面の測定点の高さデータ分布（測距データ）を算出する。図４の縦軸は路面（Ｆroad）の高さを示し、横軸は車幅方向に延びる段差判定位置（Ｐａ）を示す。

図４に示すように、車道（Ｒｒ）と段差部（Ｒｄ）との境界には、段差（ＬＤ）が形成されている。車道（Ｒｒ）の路面（Ｆroad）には、その高さが中央部から両端部である路肩に向けて低くなる傾斜（カント）が設けられている。これは、車道の水捌けを良くして車道に水が溜まらないような一般的な道路設計及び構造である。段差（ＬＤ）において、路面（Ｆroad）は急激に高くなり、段差部（Ｒｄ）の路面（Ｆroad）は、車道（Ｒｒ）よりも一段高い平坦な面を形成している。例えば、歩道などが設けられている。

走行可能領域回路１６は、車両（Ｖｃ）の速度に基づいて、段差判定位置（Ｐａ）における車両（Ｖｃ）の進行方向の走行可能領域（Ｇ_１）を推定する。走行可能領域（Ｇ_１）とは、車両（Ｖｃ）が走行することが可能な領域であって、車道の境界、例えば、段差を含まない領域を示す。走行可能領域回路１６は、図５に示すように、車両（Ｖｃ）の幅に対して所定の走行余裕領域を付加した領域を、車両（Ｖｃ）の進行方向の走行可能領域（Ｇ_１）として推定する。

所定の走行余裕領域は、車両の速度に応じて変化する。車両（Ｖｃ）の進行方向の速度が速いほど、所定の走行余裕領域を大きく設定することができる。即ち、走行可能領域回路１６は、車両（Ｖｃ）の進行方向の速度が速いほど、走行可能領域（Ｇ_１）を車幅方向に広く推定することができる。なお、車両（Ｖｃ）の速度は、ＣＡＮの車両速度情報、車輪速度パルス情報、またＧＰＳを用いて車両の位置情報を連続的に取得することにより得ることができる。

一例として、時速７０ｋｍで走行している場合、走行可能領域回路１６は、幹線道路を走行していると判断して、８ｍ幅の走行可能領域を設定する。また時速２０ｋｍで走行している場合、走行可能領域回路１６は、住宅地などの狭い道を走行していると判断して、４ｍ以下の幅の走行可能領域を設定する。

路面傾斜回路１７は、路面の高さに基づいて、走行可能領域（Ｇ_１）の車幅方向における路面（Ｆroad）の傾斜を曲線で近似する。近似曲線は、たとえば、二次曲線を用いる。このほか、一次曲線或いはスプライン曲線、又はこれらの組合せを用いることもできる。具体的に、路面傾斜回路１７は、図５に示すように、走行可能領域（Ｇ_１）内の段差判定位置（Ｐａ）上の複数の測定点（Ｉ_ｍ１、Ｉ_ｍ２、Ｉ_ｍ３）を選択する。測定点（Ｉ_ｍ１、Ｉ_ｍ２、Ｉ_ｍ３）の高さデータを用いて、車道（Ｒｒ）の車幅方向の路面（Ｆroad）の傾斜を曲線（Ｃroad）で近似する。測定点の数及び位置は任意に選択可能である。

ここで、走行可能領域（Ｇ_１）が実際の車道（Ｒｒ）の領域に比べて狭すぎた場合、走行可能領域（Ｇ_１）の端部から車道（Ｒｒ）の端部（路肩）までの距離が長くなる。このため、近似した曲線（Ｃroad）が実際の車道（Ｒｒ）の傾斜から遊離してしまい、段差（ＬＤ）を精度良く検出することが難しくなる。そこで、走行可能領域（Ｇ_１）を車幅方向に少しずつ広げて、曲線近似を繰り返すことで、曲線（Ｃroad）を実際の車道（Ｒｒ）の傾斜に近づけ、曲線（Ｃroad）と測定点との合致度の変化を精度良く検出することができる。曲線（Ｃroad）と測定点との合致度は、例えば、曲線（Ｃroad）と測定点との偏差又は標準偏差である。偏差又は標準偏差が小さくなるほど、合致度は高くなる。

或いは、（１）式に示すように、Ｒ−２乗誤差を用いて、合致度を求めることも可能である。ここで、ｙ_ｉは測定点、ｆ_ｉは曲線（Ｃroad）上の推定値、ｙ_ａｖは測定点の平均値である。この値が１に近いほど一致度が高いといえる。環境によって異なるが、この値（Ｒ^２）の減少量が０．１を超えた場合、段差が含まれたと判断することができる。

具体的に、路面傾斜回路１７は、段差判定位置（Ｐａ）において走行可能領域（Ｇ_１）を拡張した拡張領域（Ｇ_２、Ｇ_３、Ｇ_４、・・・）の車幅方向における路面（Ｆroad）の傾斜を曲線で近似する。段差検出回路１８は、曲線（Ｃroad）に対する走行可能領域（Ｇ_１）に設定された測定点（Ｉ_ｍ１、Ｉ_ｍ２、Ｉ_ｍ３）の高さの第１の合致度を算出する。そして、拡張領域（Ｇ_２、Ｇ_３、Ｇ_４、・・・）の車幅方向における路面（Ｆroad）の傾斜を近似した曲線に対する拡張領域（Ｇ_２、Ｇ_３、Ｇ_４、・・・）に設定された測定点（Ｉ_ｍ１、Ｉ_ｍ２、・・・、Ｉ_ｍ６、Ｉ_ｍ７）の高さデータの第２の合致度を算出する。そして、段差検出回路１８は、第１の合致度と第２の合致度とに基づいて、路面上の段差を検出する。

例えば、走行可能領域回路１６は、走行可能領域（Ｇ_１）を車幅方向に所定範囲（Ｋｃ）だけ広げた拡張領域（Ｇ_２）を設定する。路面傾斜回路１７は、拡張領域（Ｇ_２）の車幅方向において路面（Ｆroad）の傾斜を曲線で近似する。段差検出回路１８は、曲線に対する測定点（Ｉ_ｍ１、Ｉ_ｍ２、Ｉ_ｍ３、Ｉ_ｍ４）の高さデータの合致度を算出する。同様にして、走行可能領域回路１６は、拡張領域（Ｇ_２）を所定範囲（Ｋｃ）だけ車幅方向に広げた拡張領域（Ｇ_３）を設定する。路面傾斜回路１７は、拡張領域（Ｇ_３）の車幅方向において路面（Ｆroad）の傾斜を曲線で近似し、段差検出回路１８は、曲線に対する測定点（Ｉ_ｍ１、Ｉ_ｍ２、Ｉ_ｍ３、Ｉ_ｍ４、Ｉ_ｍ５）の高さデータの合致度を算出する。段差検出装置１は、この一連の処理サイクルを繰り返し実施する。そして、段差検出回路１８は、曲線と測定点との近似誤差（合致度の一例）が大きく変化する箇所に段差があると判断する。

拡張領域（Ｇ_４）には段差（ＬＤ）が含まれる。拡張領域（Ｇ_４）における近似曲線と測定点（Ｉ_ｍ１〜Ｉ_ｍ７）の高さデータの合致度は、その前の処理サイクルに比べて大きく変化する。なぜなら、拡張領域（Ｇ_３）と拡張領域（Ｇ_４）の差分である所定範囲（Ｋｃ）に、段差（ＬＤ）上に設定された測定点（Ｉ_ｍ６、Ｉ_ｍ７）が含まれるからである。このように、段差検出回路１８は、この一連の処理サイクルにより繰り返し算出される合致度に基づいて、段差を検出する。路面の曲線近似のための拡張領域を所定範囲（Ｋｃ）ずつ段階的に車幅方向に広げていき、合致度が下がるところまでの拡張領域（Ｇ_１〜Ｇ_３）を車道と見なすことができる。よって、段差の位置を精度良く求めることができる。車道を広く利用して曲線近似を行うことができるようになるため、段差の判定が正確にできるようになる。

図６を参照して図１の段差検出装置１を用いた段差検出方法の一例を説明する。まず、ステップＳ０１で、測距センサ１２の一例であるステレオカメラを用いて、ステレオ画像を取得する。

ステップＳ０３に進み、演算回路１４は、ステレオ画像に対してレンズの歪みを補正するレンズ歪み補正処理を行い、ステレオ画像間の上下位置を補正する平行化補正処理を行う。ステップＳ０５に進み、演算回路１４は、ステレオ画像間の各画素の対応付けを推定するステレオマッチング処理を行う。これにより、車両周囲にある物体までの距離及び方位を検出することができる。更に、演算回路１４は、座標変換処理を施すことにより、測距データの座標上の車両の周囲における路面の三次元情報を取得することができる。

ステップＳ０７に進み、段差判定位置回路１５は、例えば図２及び図３に示すように、測距センサ１２で検出された測距データの座標上の車両の周囲の路面に車幅方向の線状の段差判定位置（Ｐａ）を設定する。そして、段差判定位置回路１５は、演算回路１４により取得された路面の三次元情報から、図４に示すように、段差判定位置（Ｐａ）における路面の測定点の高さデータ（測距データ）を算出する。

ステップＳ０９に進み、走行可能領域回路１６は、図５に示すように、車両（Ｖｃ）の幅に対して所定の走行余裕領域を付加した領域を、段差判定位置（Ｐａ）における車両（Ｖｃ）の走行可能領域（Ｇ_１）として推定する。

ステップＳ１１に進み、路面傾斜回路１７は、図５に示すように、走行可能領域（Ｇ_１）内の段差判定位置（Ｐａ）上に複数の測定点（Ｉ_ｍ１、Ｉ_ｍ２、Ｉ_ｍ３）を設定する。測定点（Ｉ_ｍ１、Ｉ_ｍ２、Ｉ_ｍ３）の高さデータを用いて、路面（Ｆroad）の高さ方向の傾斜を曲線（Ｃroad）で近似する。そして、路面傾斜回路１７は、段差判定位置（Ｐａ）において走行可能領域（Ｇ_１）を拡張した拡張領域（Ｇ_２、Ｇ_３、Ｇ_４、・・・）の車幅方向における路面（Ｆroad）の傾斜を曲線で近似する。

ステップＳ１３に進み、段差検出回路１８は、曲線（Ｃroad）に対する走行可能領域（Ｇ_１）に設定された測定点（Ｉ_ｍ１、Ｉ_ｍ２、Ｉ_ｍ３）の高さデータの第１の合致度を算出する。そして、拡張領域（Ｇ_２、Ｇ_３、Ｇ_４、・・・）の車幅方向における路面（Ｆroad）の傾斜を近似した曲線に対する拡張領域（Ｇ_２、Ｇ_３、Ｇ_４、・・・）に設定された測定点（Ｉ_ｍ１、Ｉ_ｍ２、・・・、Ｉ_ｍ６、Ｉ_ｍ７）の高さデータの第２の合致度を算出する。そして、段差検出回路１８は、第１の合致度と第２の合致度とに基づいて、路面上の段差を検出する。

図７を参照して、図６のステップＳ０９〜Ｓ１３の詳細な手順の一例を説明する。先ずステップＳ１０１において、走行可能領域回路１６は、車幅方向の路面（Ｆroad）の曲線を近似する範囲の初期値である走行可能領域（Ｇ_１）を推定する。そして、走行可能領域（Ｇ_１）で車幅方向の路面の傾斜を曲線（Ｃroad）で近似し（Ｓ１０３）、曲線（Ｃroad）に対する測定点（Ｉ_ｍ１、Ｉ_ｍ２、Ｉ_ｍ３）の高さの合致度を算出する（Ｓ１０５）。段差検出回路１８は、合致度が所定の基準値以下であるか否かを判断する。合致度が所定の基準値以下で無ければ（Ｓ１０７でＮＯ）、走行可能領域（Ｇ_１）に、段差が含まれていないと判断できる。よって、ステップＳ１０９に進み、走行可能領域（Ｇ_１）を車幅方向に所定範囲（Ｋｃ）だけ広げた拡張領域（Ｇ_２）を設定する。なお、Ｓ１０７における所定の基準値としては、例えば１０ｃｍを設定することができる。

段差検出装置１は、拡張領域の広さに対して設定された上限値と拡張領域（Ｇ_２）とを比較する。拡張領域（Ｇ_２）が上限値を超えている場合（Ｓ１１１でＹＥＳ）、道路境界を成す段差の検出を断念して処理を終了する。拡張領域（Ｇ_２）が上限値を超えていない場合（Ｓ１１１でＮＯ）、ステップＳ１０３に戻り、合致度が所定の基準値以下となるまで、繰り返し、Ｓ１０３〜Ｓ１１１を実施する。

そして、合致度が所定の基準値以下となった場合（Ｓ１０７でＹＥＳ）、段差検出回路１８は、最後に実施したステップＳ１０９で追加した所定範囲（Ｋｃ）に、段差が存在すると判断する（Ｓ１１３）。

以上説明したように、実施形態によれば、以下の作用効果が得られる。

車道が傾斜している場合、車道の位置に応じて路面の高さが変化するため、車道の位置の取り方によって、路面の高さ変化量を正しく検出することができない場合がある。これにより、路面の高さ変化量を小さく見積もった場合には、段差が非検出となり、路面の高さ変化量を大きく見積もった場合には、段差を誤検出してしまう。そこで、車幅方向の路面の傾斜を曲線で近似し、この曲線に対する路面の高さの変位から路面上の段差を検出する。具体的には、走行可能領域における曲線と測定点との合致度に対して、走行可能領域を段差判定位置上で車幅方向に拡張した拡張領域における合致度が大きく変化した場合、拡張により増加した箇所に、路面高さの急激な変化、即ち、段差があると判断することができる。車道に傾斜（カント）があっても路面上の段差を精度良く検出することができる。

走行可能領域回路１６は、車両（Ｖｃ）の速度が速いほど、走行可能領域（Ｇ_１）を広く推定する。車速が高速であれば、高速道路、幹線道路などの広い車道を走行していることが推定される。一方、車速が低速である場合は、住宅街などの狭い車道を走行していることが推定される。よって、段差（ＬＤ）を含まない、車両が走行可能な領域を適切に設定することができるので、段差（ＬＤ）の検出精度が向上する。

段差検出装置１は、走行可能領域（Ｇ_１）を車幅方向に所定範囲（Ｋｃ）だけ広げ、所定範囲（Ｋｃ）だけ広げた拡張領域（Ｇ_２、Ｇ_３、Ｇ_４、・・・）の車幅方向において路面（Ｆroad）の傾斜を曲線で近似し、曲線に対する測定点（Ｉ_ｍ１、Ｉ_ｍ２、・・・）の高さの合致度を算出するサイクルを繰り返し実施する。段差検出回路１８は、繰り返し算出される合致度に基づいて、段差を検出する。路面（Ｆroad）の曲線近似のための拡張領域（Ｇ_２、Ｇ_３、Ｇ_４、・・・）を所定範囲（Ｋｃ）ずつ段階的に車幅方向に広げていき、合致度が下がるところまでの拡張領域（Ｇ_２、Ｇ_３、Ｇ_４、・・・）を車道と見なすことができる。よって、段差（ＬＤ）の位置を精度良く求めることができる。車道を広く利用して曲線近似を行うことができるようになるため、段差（ＬＤ）の判定が正確にできるようになる。所定範囲（Ｋｃ）を小さくすることにより、段差（ＬＤ）判定の位置精度が向上する。

上記のように、本発明の実施形態を記載したが、この開示の一部をなす論述及び図面はこの発明を限定するものであると理解すべきではない。この開示から当業者には様々な代替実施の形態、実施例及び運用技術が明らかとなろう。

（第１変形例）
測距センサ１２としてのステレオカメラを、車両（Ｖｃ）の前部ではなく、図８に示すように、車両（Ｖｃ）の側部に設置し、ステレオカメラの撮像範囲を車両（Ｖｃ）の側方としても構わない。この場合も、車両（Ｖｃ）の進行方向を第１の所定方向（Ｄａ）とする。これにより、段差判定位置回路１５は、車両の周囲（側方）の路面に、段差（ＬＤ）と交わる線状の段差判定位置（Ｐａ）を設定することができる。具体的には、測距センサ１２から第１の所定方向（Ｄａ）に所定距離だけ離れ、第１の所定方向（Ｄａ）に直交する方向に延びる段差判定位置（Ｐａ）を設定することができる。

（第２変形例）
測距センサ１２の他の例として、レーザレンジファインダ（ＬＲＦ）がある。ＬＲＦは、車両周囲の物体に向けてレーザーを照射し、物体に反射して戻ってきたレーザーを観測する。そして、ＬＲＦは、レーザーの照射方向に基づいて物体が位置する方位を計測すると共に、レーザーの照射から反射レーザーの観測までの時間に基づいて物体までの距離を計測する。ＬＲＦは、レーザースキャナとも呼ばれる。ＬＲＦの照射範囲は任意に設定可能である。図９は、車両（Ｖｃ）のルーフ中央部にＬＲＦ（１２）を設定し、周囲全体を照射範囲とする３６０度ＬＲＦの例を示す。段差判定位置回路１５は、測距センサ１２から第１の所定方向（Ｄａ）に所定距離だけ離れ、第１の所定方向（Ｄａ）に直交する方向に延びる段差判定位置（Ｐａ）を設定する。よって、車両（Ｖｃ）の前部に測距センサ１２を設置した図２の例と同様にして、車両（Ｖｃ）の進行方向を第１の所定方向（Ｄａ）とするので、車幅方向に延びる段差判定位置（Ｐａ）が、車両（Ｖｃ）の前方に設定される。

なお、俯角を付けてＬＲＦを搭載することで走行中に車両進行方向を広範囲にわたって調査することが可能となる。また、複数のレーザーを同時に照射可能なマルチレイヤー型のＬＲＦを用いることも可能である。

測距センサ１２としてレーザレンジファインダ（ＬＲＦ）を用いた場合の段差検出方法は、図６のＳ０１〜Ｓ０５の代わりに、次に示すステップＳ２１及びＳ２３を実施する点が相違する。その他のステップＳ０７〜Ｓ１３は、図６と同じであり、説明を省略する。

ステップＳ２１において、ＬＲＦ（１２）は、レーザーが照射された物体の方位と共に、物体までの距離を計測する。計測データは演算回路１４に送信される。ステップＳ２３に進み、演算回路１４は、ＬＲＦ（１２）を原点とした極座標系の計測データを、車両（Ｖｃ）を原点とした直交座標系に変換する。これにより、演算回路１４は、車両の周囲における路面の三次元情報を取得することができる。その後、ステップＳ０７へ進む。

（第３変形例）
実施形態で、走行可能領域回路１６は、車両（Ｖｃ）の速度に基づいて、走行可能領域（Ｇ_１）の広さを定めていた。車両（Ｖｃ）の速度に限らず、その他の基準を用いても、走行可能領域（Ｇ_１）の広さを定めることはできる。例えば、走行可能領域回路１６は、車両（Ｖｃ）が走行している車道（Ｒｒ）に関する情報（車道情報）に基づいて、走行可能領域（Ｇ_１）の広さを定めてもよい。例えば、実際の道路境界を含まないように、車道情報に含まれる幅情報よりも１ｍ狭い範囲で走行可能領域を設定することができる。

図１１に示すように、マイクロコンピュータ１３は車道情報取得回路１９を更に備える。車道情報取得回路１９は、ＧＰＳ２０及び地図データベース２１から、車両（Ｖｃ）が走行している車道（Ｒｒ）に関する情報を取得する。走行可能領域回路１６は、車道（Ｒｒ）に関する情報に基づいて、走行可能領域（Ｇ_１）の車幅方向の距離を設定することができる。車道（Ｒｒ）に関する情報を用いることにより、段差（ＬＤ）を含まない、車両（Ｖｃ）が走行可能な領域を適切に設定することができるので、段差（ＬＤ）の検出精度が向上する。

（第４変形例）
車道情報取得回路１９が取得する車道（Ｒｒ）に関する情報は、走行可能領域（Ｇ_１）の広さの基準としてのみならず、その他のパラメータを設定するための基準として用いることができる。例えば、段差検出装置２は、車道（Ｒｒ）に関する情報に基づいて、図７のＳ１１１において用いる上限値を設定する。例えば、ＬＲＦの場合、照射範囲は１０ｍ程度であるので、上限値を１０ｍと設定することができる。拡張領域の広さが上限値を超える場合には段差検出処理を終了することができる。よって、明確な段差のない道路においても一定時間で段差検出処理を終了することが可能となる。

１、２ 段差検出装置
１１ 測距部
１２ 測距センサ
１３ マイクロコンピュータ
１４ 演算回路
１５ 段差判定位置回路
１６ 走行可能領域回路
１７ 路面傾斜回路
１８ 段差検出回路
１９ 車道情報取得回路
２０ ＧＰＳ（グローバルポジショニングシステム）
２１ 地図データベース
Ｇ_１ 走行可能領域
Ｇ_２〜Ｇ_４ 拡張領域
Ｉ_ｍ１〜Ｉ_ｍ７ 測定点
Ｃroad 曲線
Ｆroad 路面
Ｋｃ 所定範囲
Ｐａ 段差判定位置
ＬＤ 段差

Claims (6)

1. 車両の周囲における路面の高さを検出する測距部と、
   前記車両の進行方向の走行可能領域を推定する走行可能領域回路と、
   前記測距部により検出された前記路面の高さに基づいて、前記走行可能領域の車幅方向における前記路面の傾斜を曲線で近似する路面傾斜回路と、
   前記曲線に対する前記走行可能領域に設定された測定点の高さの合致度と、前記走行可能領域を車幅方向に拡張した拡張領域における前記路面の傾斜を近似した曲線に対する前記拡張領域に設定された測定点の高さの合致度とに基づいて、前記路面上の段差を検出する段差検出回路と、
   を備えたことを特徴とする段差検出装置。
2. 前記走行可能領域回路は、前記車両の速度が速いほど、前記走行可能領域を車幅方向に広く推定することを特徴とする請求項１に記載の段差検出装置。
3. 前記車両が走行している車道に関する情報を取得する車道情報取得回路を更に備え、
   前記走行可能領域回路は、前記車道に関する情報に基づいて、前記走行可能領域の車幅方向の距離を設定する
   ことを特徴とする請求項１に記載の段差検出装置。
4. 前記段差検出装置は、前記走行可能領域を車幅方向に所定範囲だけ広げ、前記所定範囲だけ広げた拡張領域において前記路面の傾斜を曲線で近似し、前記曲線に対する前記測定点の高さの合致度を算出するサイクルを繰り返し実施し、
   前記段差検出回路は、繰り返し算出される前記合致度に基づいて、前記段差を検出する
   ことを特徴とする請求項１〜３の何れか一項に記載の段差検出装置。
5. 前記車両が走行している車道に関する情報を取得する車道情報取得回路を更に備え、
   前記段差検出装置は、前記車道に関する情報に基づいて、前記拡張領域の広さに上限値を設定する
   ことを特徴とする請求項４に記載の段差検出装置。
6. 車両の周囲における路面の高さを検出し、
   前記車両の進行方向の走行可能領域を推定し、
   前記路面の高さに基づいて、前記走行可能領域の車幅方向における前記路面の傾斜を曲線で近似し、
   前記曲線に対する前記走行可能領域に設定された測定点の高さの合致度と、前記走行可能領域を車幅方向に拡張した拡張領域における前記路面の傾斜を近似した曲線に対する前記拡張領域に設定された測定点の高さの合致度とに基づいて、前記路面上の段差を検出する
   ことを特徴とする段差検出方法。

Images