JP6295524B2 - 光軸補正装置 - Google Patents

Description

本発明は、光軸補正装置に関する。

特許文献１に記載された光軸補正装置では、車載カメラで撮像した自車前方の道路画像から左右白線の近似曲線を算出し、近似曲線と白線候補点との偏差から道路の曲がり具合を判断し、直線路であるときに消失点を算出可能であると判断して左右の近似曲線の交点を仮想消失点としている。そして、仮想消失点の検出頻度ヒストグラムを作成し、その最頻値によって光軸方向を推定し、車載カメラの光軸補正を行っている。

特開2000-242899号公報

しかしながら、上記従来技術にあっては、各処理周期で個別に消失点が算出可能であるか否かを判断しているため、光軸方向を推定するにあたり、取得した消失点のばらつきが大きく、精度良く消失点を推定できないという問題があった。
本発明の目的は、高精度な光軸補正を実現できる光軸補正装置を提供することにある。

本発明では、道路形状の近似直線の結果および道路パラメータを直近の所定時間範囲で過去履歴として記録しておき、過去履歴を用いて、消失点を算出可能な条件である自車両が直線路を道路に沿って直進し、かつ、撮像状態が良好であるか否かを判断し、消失点を算出可能な条件であることを満たすと判断された過去履歴から、消失点を精度良く算出できるタイミングを選別し、選別したタイミングで消失点を算出し、算出した消失点から光軸方向を推定して光軸方向の設定値を補正する。

よって、ばらつきが少なく精度の良い消失点のみから光軸方向を推定するため、高精度な光軸補正を実現できる。

実施例１の車線逸脱警報システムを示す概略ブロック図である。 レーン認識装置1の機能ブロック図である。 白線エッジ検出および道路形状の直線近似のイメージ図である。 直線路判断のイメージ図である。 実施例１の光軸補正処理を示すフローチャートである。 実施例２の車線走行支援システムを示す概略ブロック図である。 実施例２のレーン認識装置1の機能ブロック図である。 実施例２の光軸補正処理を示すフローチャートである。

〔実施例１〕
［システム構成］
図１は、実施例１の車線逸脱警報システムを示す概略ブロック図である。
実施例１の車線逸脱警報システムは、レーン認識装置1と、車線逸脱警報回路7と、車速センサ8と、ブザー9とを有する。
レーン認識装置1は、自車走行路を認識し、車線に対する車両位置と車両姿勢を検出する装置である。レーン認識装置1は、前方カメラ（以下、カメラ）2と、カメラ2の撮像画像に基づいて白線候補点を検出する白線候補点検出部3と、白線候補検出結果からレーン認識を行うレーン認識部4と、直近の所定の時間範囲(1[sec])で過去履歴を記録しておく過去履歴記録部5と、光軸方向を推定し光軸補正を行う光軸補正部6とを有している。

カメラ2は、車両室内天井の前方中央部に車両前方を撮像するように取り付けられ、フロントガラスを通して車両前方の走行路を撮像する。ただし、上記カメラの取付方法は、レーン認識を行うカメラの一般例であり、自車走行路を撮像するカメラであればこれに限定しない。例えば、バックビューカメラのように車両後方にカメラを取り付けた場合や、車両前端に取り付けた場合でも良く、またカメラの視野内に消失点が映らない場合でも構わない。
車線逸脱警報回路7は、レーン認識装置1で検出した車線に対する車両位置と車両姿勢と、車速センサ8からの自車速とを用いて、自車両の車線逸脱を検知し、ブザー9を用いてドライバーに警告する。

図２は、レーン認識装置1の機能ブロック図である。
白線候補点検出部3は、図３に示すように、カメラ2から自車走行路を撮像した画像を取得し、画像処理を行うことで白線エッジを検出する。本実施例での画像処理の流れとしては、取得した画像の左右に位置する車線区分線に対し、レーン認識装置1内部で記録している道路パラメータより画像処理枠の位置を設定する。次に、設定された画像処理枠に対して、例えばSobelフィルタによる一次空間微分を施して、白線と路面との境界のエッジを強調した後、白線エッジを抽出する。

レーン認識部4は、道路形状を直線近似する道路形状算出部41と、道路形状およびこの道路に対する車両姿勢を推定する道路パラメータ推定部42とを有する。
道路形状算出部41は、図３に示すように、白線候補点検出部3により抽出した白線エッジの強度が所定値以上の画素を、所定値以上通過し、かつ検出領域の上辺の１点と下辺の１点を結ぶ直線を、ハフ変換により抽出することにより道路形状の近似直線を算出する。また、図４に示すように遠方と近傍と２つの領域で道路形状を直線近似結果から、道路形状の曲がり具合（曲率）を算出する。
道路パラメータ推定部42は、道路形状算出部41により検出した道路形状の近似直線から、道路モデル式として次に示す式(1)を用いて、道路パラメータ（道路形状およびこの道路に対する車両姿勢）を推定する。ただし、式(1)は道路モデルを現す式の一般例であり、走行路を推定するにあたっては、この式に限定しない。

式(1)におけるパラメータ、A,B,C,D,Hは、道路パラメータ推定部42において推定する道路パラメータ、車両状態量となり、自車両の車線に対する横変位(A)、道路曲率(B)、自車両の車線に対するヨー角(C)、自車両のピッチ角(D)、および路面からのカメラ2の高さ(H)である。また、Wは車線幅（左右白線の内側間の距離）を示す定数，fはカメラ透視変換定数、jを左右の白線を区別するパラメータとし、左白線のときj=0、右白線のときj=1とする。また、(x,y)は、左または右白線内端上の任意の点の道路画像上の座標であり、道路画像左上を原点に取り、右方向がx軸正方向、下方向がy軸正方向とする。
過去履歴記録部5は、直近の所定の時間範囲だけ過去履歴を保持する。本実施例で過去履歴として記録するデータは、道路形状算出部41で算出される直線近似結果、道路形状（曲がり具合）と、道路パラメータ推定部42で算出される道路パラメータとなる。

光軸補正部6は、消失点を精度良く算出可能な条件が整っていることを判断する消失点算出判断部61と、過去履歴から消失点を算出する消失点算出部62と、算出した消失点から光軸方向を推定しレーン認識装置で記録している光軸設定値を補正する光軸方向補正部63とを有する。
消失点算出判断部61は、過去履歴記録部5で記録している直近の所定の時間範囲において、同記録部に記録されている道路形状の近似直線、道路形状の曲がり具合、道路パラメータを用いて、消失点を算出可能な条件（自車両が直線路を道路に沿って直進し、撮像状態が良好かつ車両挙動が安定している）が整っていることを判断する。
消失点算出部62は、消失点算出判断部61で消失点を算出可能な条件が整っていると判断されている場合、過去履歴の中で直線度、直進度が良好で精度良く消失点を算出できるタイミングに限定して、道路形状算出部41で算出された道路形状の近似直線を用いて消失点を算出する。ただし、消失点を算出した回数が所定値以下であった場合は過去履歴の状態が信頼できない状態として、算出した消失点を破棄する。
光軸方向補正部63は、消失点算出部62により算出された消失点から光軸方向を算出し、レーン認識装置1で記録している光軸方向と比較することで、光軸方向のずれを判断する。左記で光軸方向のずれがあった場合、レーン認識装置1で記録している光軸方向の設定値を補正する。具体的には、レーン認識装置1で記録している光軸方向の設定値と、消失点から算出した光軸方向との偏差を算出し、ループ処理ごとに偏差を積分していく。消失点の算出回数が所定値に達したときに、偏差の積分値が所定値を越えている場合は、レーン認識装置1で記録している光軸方向の設定を、過去履歴から推定した光軸方向の値に変更することで光軸を補正する。また、算出回数が所定値に達した場合は、光軸方向の偏差の積分値と、算出回数のカウントをリセットする。

［光軸補正処理］
図５は、実施例１の光軸補正処理を示すフローチャートである。この処理は、レーン認識装置１が作動している間、カメラ2の画像取得周期に同期してループする。
ステップS101では、カメラ2において、撮像した自車走行路の道路画像を取得し、ステップS102へ移行する。
ステップS102では、白線候補点検出部3において、ステップS101で取得した道路画像に画像処理を施して白線のエッジ画像を生成し、ステップS103へ移行する。
ステップS103では、道路形状算出部41において、ステップS102で抽出した白線エッジ画像を用いて、遠方と近傍の２つの領域において道路形状を直線近似し、ステップS104へ移行する。この処理では、車両を中心として左右の領域に分割し、それぞれの領域について道路形状の近似直線式を算出する。

ステップS104では、道路形状算出部41においてステップS103で算出した近傍、遠方の道路形状の近似直線を用いて、道路形状の曲がり具合を算出し、ステップS105へ移行する。
ステップS105では、道路パラメータ推定部42において、ステップS103で算出した道路形状の近似直線を用いて、道路パラメータを推定し、ステップS106へ移行する。
ステップS106では、過去履歴記録部5において、ステップS103で算出した道路形状の近似直線と道路形状の曲がり具合（曲率）、ステップS105で算出した道路パラメータの過去履歴を直近の所定の時間範囲(1[sec])だけ保持し、ステップS107へ移行する。

ステップS107では、消失点算出判断部61において、ステップS103で算出された直線近似結果、ステップS104で算出された道路形状（曲がり具合）、ステップS105で算出される道路パラメータから、消失点を算出可能な条件(1.直線路、2.直進状態、3.車両挙動が安定、4.撮像状態が良好)が整っているか否か（消失点を算出可能であるか否か）を判断し、ステップS108へ移行する。ここで、車両挙動が安定しているか否かは、道路パラメータの車両状態量（ヨー角、ピッチ角、カメラ2の高さ）の上下限値の差が所定値以下であるか否かにより判断する。また、撮像状態が良好か否かは、レーンマーカーを遠方から近傍まで連続して（途切れなく）検出できているか否かにより判断する。
ステップS108では、ステップS107で消失点を算出可能な条件が整っているか否かを判断し、YESの場合はステップS109へ移行し、NOの場合はループ処理を終了する。
ステップS109では、消失点算出部62において、ステップS107で消失点を算出可能な条件が整っていると判断された過去履歴を個別に精査し、精度良く算出できるタイミングを選別し、ステップS110へ移行する。
ステップS110では、消失点算出部62において、ステップS109で選別されたタイミングでのみ、ステップS103で算出した道路形状の左右近似直線から消失点を算出し、ステップS111へ移行する。

ステップS111では、消失点算出部62において、ステップS110で算出された消失点の数が所定値以上であるか否かを判断し、YESの場合はステップS111へ移行し、NOの場合はループ処理を終了する。
ステップS112では、ステップS110で算出した消失点から算出される光軸方向と、レーン認識装置1に記録されている光軸方向との偏差を積分し、ステップS113へ移行する。
ステップS113では、消失点を算出した回数が所定値に達したか否かを判断し、YESの場合はステップS114へ移行し、NOの場合はループ処理を終了する。
ステップS114では、光軸方向補正部63において、ステップS112で算出した積分値が所定値以上となっている場合は、レーン認識装置1で記録している光軸方向の設定値を、過去履歴から算出した光軸方向の推定値に変更し、積分値をリセットする。

次に、作用を説明する。
［光軸補正作用］
消失点算出判断部61は、消失点を算出可能な条件が整っているか否かを判断し、消失点算出部62は、消失点を算出可能な条件が整っていると判断された過去履歴を個別に精査して精度良く算出できるタイミングを選別し、選別されたタイミングでのみ、道路形状の左右近似直線から消失点を算出する。従来の光軸補正装置では、各処理周期で個別に消失点が算出可能であるか否かを判断しているため、光軸方向を推定するにあたり、取得した消失点のばらつきが大きく、精度良く消失点を推定できないという問題があった。また、大量の消失点を取得しヒストグラムによって消失点の値を検出しているため、ヒストグラムの分布が綺麗な正規分布とならない場合（多数のピークが現れた場合）には、誤った消失点を算出する可能性がある。これに対し、実施例１では、消失点を算出可能な過去履歴から、精度良く算出できている消失点を選別しているため、上記従来技術と比較して、よりばらつきが少なく精度の高い消失点を取得できる。よって、算出した消失点を用いて光軸方向の設定値を補正することにより、高精度な光軸補正を実現できる。
過去履歴記録部5は、所定の時間範囲(1[sec])のみの過去履歴を記録し、消失点算出判断部61は、所定の時間範囲(1[sec])において、1.直線路、2直進状態、4撮像状態の条件が整った場合、消失点を算出可能な条件が整っていると判断する。車両の応答時間は、0.2〜0.3[sec]程度であるため、1[sec]程度の時間範囲を監視することで、道路形状、車両状態、撮像状態を十分正確に判断できる。処理周期１回分の短い時間では、道路形状、車両状態、撮像状態を精度良く判断できないのに対し、正確に判断できる時間幅(1[sec])をもって消失点を算出可能な条件が整っていることを確かめることで、高精度な光軸補正を実現できる。また、記録する過去履歴の長さを1[sec]とすることで、メモリ領域を最小限に抑えることができる。

消失点算出判断部61は、レーンマーカーを遠方から近傍まで連続、かつ、直線上に検出できている場合、自車両が直線路を走行し、かつ、レーンマーカーの撮像状態が良好であると判断する。レーンマーカーが直線である（曲がり具合が小さい）場合、直線路と判断できる。また、レーンマーカーが遠方から近傍まで途切れなく検出できている場合には、レーンマーカーの撮像状態が良好であり、直線路の判断が正確であることを確認できる。よって、レーンマーカーを遠方から近傍まで連続、かつ、直線上に検出できている場合にのみ消失点を算出することで、消失点を高精度に算出できる。
消失点算出判断部61は、自車両のヨー角、ピッチ、ロールおよびバウンスから所定の時間範囲(1[sec])において、3.車両挙動が安定しているか否かを判断し、車両挙動が安定している場合、消失点を算出可能な条件が整っていると判断する。ヨー、ピッチ、ロール、バウンス等、算出する消失点のばらつきに繋がる車両挙動が無いことを確認できたときにのみ消失点を算出することで、消失点を高精度に算出できる。

消失点算出判断部61は、カメラ2の撮像画像から得られる車両状態量（ヨー角、ピッチ角、カメラ2の高さ）の上下限値の差が所定値以下である場合に車両挙動が安定していると判断する。すなわち、カメラ2の撮像画像から得られる状態量の過去履歴における上下限値の差を監視し、車両挙動の安定（上記差が小さい状態）を確認できたときにのみ消失点を算出することで、消失点を高精度に算出できる。
消失点算出部62は、消失点算出判断部61により消失点が算出可能な条件が整っていると判断された過去履歴を個別に精査し、ばらつきが少なく精度の良い消失点を検出できるタイミングを選別する。すなわち、消失点算出判断部61でかたまりのデータをもって消失点算出の条件が整っていることを正確に判断し、さらに消失点算出部62でばらつきが無く精度の良い消失点を検出できるタイミングのみを選別することで、精度の良い消失点のみを取得できる。
光軸方向補正部63は、消失点算出部62により算出された消失点の数が所定数未満である場合、光軸方向の設定値の補正を行わない。消失点算出部62で消失点を算出できる状態と判断した場合であっても、選別した消失点の数が少ない場合、消失点の精度を信頼できないため、この場合は光軸補正を実施しない。換言すると、信頼できる消失点のみを用いることで、光軸補正の誤差を抑制できる。

以上説明したように、実施例１にあっては以下に列挙する効果を奏する。
(1) 自車走行路を検出するカメラ（環境認識手段）2と、カメラ2の検出値を過去履歴として記録しておく過去履歴記録部（過去履歴記録手段）5と、過去履歴記録部5で記録されている過去履歴において、自車両が直線路を道路に沿って直進し、かつ、撮像状態が良好である場合に、消失点を算出可能であると判断する消失点算出判断部（消失点算出判断手段）61と、消失点算出判断部61により消失点を算出可能であると判断された過去履歴から消失点を精度良く算出できるタイミングを選別する消失点算出タイミング選別手段（ステップS109）と、消失点算出タイミング選別手段によって選別されたタイミングでの消失点を算出する消失点算出手段（ステップS110）と、消失点算出手段より算出された消失点から光軸方向を推定し、カメラ2の光軸方向の設定値を補正する光軸方向補正部（光軸方向補正手段）63と、を備える。
よって、高精度な光軸補正を実現できる。

(2) 過去履歴記録部5は、直近の所定の時間範囲のみの過去履歴を記録しておく。
よって、メモリ領域を最小限に抑えつつ、道路形状、車両状態、撮像状態を十分正確に判断できる過去履歴を記録できる。

(3) 消失点算出判断部61は、所定の時間範囲(1[sec])において、自車両が直線路を道路に沿って直進し、かつ、レーンマーカーの撮像状態が良好である場合、消失点を算出可能であると判断する。
よって、メモリ領域を最小限に抑えつつ、消失点を高精度に算出できる。

(4) 消失点算出判断部61は、レーンマーカーを遠方から近傍まで連続、かつ、直線上に検出できている場合、自車両が直線路を走行し、かつ、レーンマーカーの撮像状態が良好であると判断する。
よって、直線路の判断精度を高めることができ、消失点を高精度に算出できる。

(5) 消失点算出判断部61は、自車両の車線に対するヨー角、ピッチ、ロールおよびバウンスから車両挙動が安定しているか否かを判断し、車両挙動が安定している場合、消失点を算出可能であると判断する。
よって、消失点のばらつきに繋がる車両挙動が無いことを確認できたときにのみ消失点を算出することで、消失点を高精度に算出できる。

(6) 消失点算出判断部61は、カメラ2によって得られる自車両の状態量（ヨー角、ピッチ角、カメラ2の高さ）の上下限値の差から車両挙動の安定を判断する。
よって、車両挙動の安定（上下限値の差が小さい状態）を確認できたときにのみ消失点を算出することで、消失点を高精度に算出できる。

(7) 消失点算出タイミング選別手段（ステップS109）は、消失点算出判断部61により消失点が算出可能であると判断された過去履歴を個別に精査し、ばらつきが少なく精度の良い消失点を検出できるタイミングを選別する。
よって、ばらつきが無く精度の良い消失点を検出できるタイミングのみを選別することで、精度の良い消失点のみを取得できる。

(8) 光軸方向補正部63は、消失点算出手段（ステップS110）により算出された消失点の数が所定数未満である場合、光軸方向の設定値の補正を行わない。
よって、消失点の精度を信頼できない場合には、光軸補正を行わないことで、光軸補正の誤差を抑制できる。

〔実施例２〕
［システム構成］
実施例１では、カメラのみを用いた車線逸脱警報システムの構成を示したが、実施例１の構成にステアリングアクチュエーターと車両センサを加えて、車線走行支援を行うシステムがある。この構成では、車両センサとしてヨーレートセンサや加速度センサを用いることができるため、カメラによる直線路判断、直進判断に加えて、ヨーレートや横加速度を用いた直進判断を行うことができる。

図６は、実施例２の車線走行支援システムを示す概略ブロック図である。実施例１と同一の構成については、同一の名称、同一の符号を付して説明を省略する。
実施例２の車線走行支援システムは、レーン認識装置1と、車速センサ8と、操舵支援回路10と、加速度センサ11と、ヨーレートセンサ12と、操舵角センサ13と、ステアリング装置14とを有する。
操舵支援回路10は、レーン認識装置1で推定した道路パラメータと、車速センサ8、加速度センサ11、ヨーレートセンサ12および操舵角センサ13から取得した自車両状態の検出値（車速、横加速度、ヨーレート、操舵角）を用いて、操舵支援を行うようにステアリング装置14を制御する。
図７は、実施例２のレーン認識装置1の機能ブロック図である。
過去履歴記録部5には、直線近似結果、道路形状（曲がり具合）、道路パラメータに加え、車速センサ8、加速度センサ11、ヨーレートセンサ12および操舵角センサ13の各センサ値が記録される。また、消失点算出判断部61において消失点を精度良く算出可能な条件が整っていることを判断する際にも、各センサ値が用いられる。

［光軸補正処理］
図８は、実施例２の光軸補正処理を示すフローチャートである。図５に示した実施例１と同一の処理を行うステップには、同一のステップ番号を付して説明を省略する。
ステップS201では、車速センサ8、加速度センサ11、ヨーレートセンサ12および操舵角センサ13の各センサ値を取得し、ステップS202へ移行する。
ステップS202では、過去履歴記録部5において、ステップS103で算出した道路形状の近似直線と道路形状の曲がり具合（曲率）、ステップS105で算出した道路パラメータの過去履歴、ステップS201で取得した各センサ値を直近の所定の時間範囲だけ保持し、ステップS107へ移行する。
ステップS203では、消失点算出判断部61において、ステップS103で算出された直線近似結果、ステップS104で算出された道路形状（曲がり具合）、ステップS105で算出される道路パラメータ、各センサ値から、消失点を検出できる条件(1.直線路、2.直進状態、3.車両挙動が安定、4.撮像状態が良好)が整っているか否かを判断し、ステップS108へ移行する。ここで、実施例２では、車両挙動が安定しているか否かを、道路パラメータの車両状態量（ヨー角、ピッチ角、カメラ2の高さ）の上下限値の差に加え、車速センサ8、加速度センサ11、ヨーレートセンサ12および操舵角センサ13の各センサ値の上下限値の差が所定値以下であるか否かにより判断する。

次に、作用を説明する。
［光軸補正作用］
実施例２では、消失点算出判断部61において、カメラ2の撮像画像から得られる車両状態量（ヨー角、ピッチ角、カメラ2の高さ）の上下限値の差に加え、車速センサ8、加速度センサ11、ヨーレートセンサ12および操舵角センサ13の各センサ値の上下限値の差が所定値以下である場合に車両挙動が安定していると判断する。すなわち、カメラ2の撮像画像から得られる状態量の過去履歴における上下限値の差に加え、車両状態量を検出する各センサにより検出されたセンサ値の過去履歴における上下限値の差を監視することで、車両挙動が安定しているか否かを精度良く判定できる。そして、車両挙動の安定を確認できたときにのみ消失点を算出することで、消失点を精度良く算出できる。

以上説明したように、実施例２にあっては、実施例１の効果(1)〜(8)に加え、以下の効果を奏する。
(9) 消失点算出判断部61は、車速センサ8、加速度センサ11、ヨーレートセンサ12および操舵角センサ13の各センサ値の上下限値の差から車両挙動の安定を判断する。
よって、車両挙動が安定しているか否かをより精度良く判定できる。

（他の実施例）
以上、本発明を実施するための形態を、実施例に基づいて説明したが、本発明の具体的な構成は、実施例に限定されるものではなく、発明の要旨を逸脱しない範囲の設計変更等があっても本発明に含まれる。

1 レーン認識装置
2 カメラ
3 白線候補点検出部
4 レーン認識部
5 過去履歴記録部
6 光軸補正部
7 車線逸脱警報回路
8 車速センサ
9 ブザー
10 操舵支援回路
11 加速度センサ
12 ヨーレートセンサ
13 操舵角センサ
14 ステアリング装置
41 道路形状算出部
42 道路パラメータ推定部
61 消失点算出判断部
62 消失点算出部
63 光軸方向補正部

Claims (8)

1. 自車両の走行路を検出する環境認識手段と、
   前記環境認識手段の検出結果から、道路形状の近似直線を算出する道路形状算出手段と、
   前記道路形状算出手段により算出された道路形状に対する車両姿勢を表す道路パラメータを推定する道路パラメータ推定手段と、
   前記道路形状算出手段により算出された道路形状の近似直線の結果および前記道路パラメータ推定手段により推定された道路パラメータを直近の所定時間範囲で過去履歴として記録しておく過去履歴記録手段と、
   前記過去履歴記録手段で記録されている過去履歴を用いて、消失点を算出可能な条件である自車両が直線路を道路に沿って直進し、かつ、撮像状態が良好であるか否かを判断する消失点算出判断手段と、
   前記消失点算出判断手段によって消失点を算出可能な条件であることを満たすと判断された過去履歴から、消失点を精度良く算出できるタイミングを選別する消失点算出タイミング選出手段と、
   前記消失点算出タイミング選出手段によって選別されたタイミングで消失点を算出する消失点算出手段と、
   前記消失点算出手段より算出された消失点から光軸方向を推定し、前記環境認識手段の光軸方向の設定値を補正する光軸方向補正手段と、
   を備えることを特徴とする光軸補正装置。
2. 請求項１に記載の光軸補正装置において、
   前記消失点算出判断手段は、自車両が直線路を道路に沿って直進し、かつ、レーンマーカーの撮像状態が良好である場合、消失点を算出可能な条件を満たすと判断することを特徴とする光軸補正装置。
3. 請求項２に記載の光軸補正装置において、
   前記消失点算出判断手段は、レーンマーカーを遠方から近傍まで連続、かつ、直線上に検出できている場合、自車両が直線路を走行し、かつ、レーンマーカーの撮像状態が良好であると判断することを特徴とする光軸補正装置。
4. 請求項１ないし３のいずれか１項に記載の光軸補正装置において、
   前記消失点算出判断手段は、自車両の車線に対するヨー角、ピッチ、ロールおよびバウンスから車両挙動が安定しているか否かを判断し、車両挙動が安定している場合、消失点を算出可能な条件を満たすと判断することを特徴とする光軸補正装置。
5. 請求項４に記載の光軸補正装置において、
   前記消失点算出判断手段は、前記環境認識手段によって得られる自車両の状態量の上下限値の差から車両挙動の安定を判断することを特徴とする光軸補正装置。
6. 請求項４または５に記載の光軸補正装置において、
   前記消失点算出判断手段は、自車両の状態量を検出するセンサの検出値の上下限値の差から車両挙動の安定を判断することを特徴とする光軸補正装置。
7. 請求項１ないし６のいずれか１項に記載の光軸補正装置において、
   前記消失点算出タイミング選出手段は、前記消失点算出判断手段により消失点を算出可能な条件を満たすと判断された過去履歴を個別に精査し、ばらつきが少なく精度の良い消失点を検出できるタイミングを選別することを特徴とする光軸補正装置。
8. 請求項１ないし７のいずれか１項に記載の光軸補正装置において、
   前記光軸方向補正手段は、前記消失点算出手段により算出された消失点の数が所定数未満である場合、光軸方向の設定値の補正を行わないことを特徴とする光軸補正装置。

Images