JP3575279B2 - 駐車補助装置 - Google Patents

Description

【０００１】
【発明の属する技術分野】
本発明は車両の縦列駐車や車庫入れ等の駐車を補助する駐車補助装置に関するものであり、特に、後方画像をカメラにより撮影し車内のモニタディスプレィに後方画像を表示させて駐車時の操作を補助する駐車補助装置に係わる。
【０００２】
【従来の技術】
従来、縦列駐車や車庫入れ等の駐車に不慣れな初心者を駐車操作時に補助する方法が知られている。例えば、特開平７−１７３２８号公報では車体の周囲にＣＣＤカメラや距離測定を行う距離センサを設け、車両の周辺の様子を探知し、車両の室内に設けられたディスプレィ上に車両周辺の周辺画像を鳥瞰図的に表示してドライバに周囲の状況を提供している。
【０００３】
また、特開昭５９−２０１０８２号公報においては、ステアリング舵角をステアリングセンサにより検出し、ステアリング操舵角を計算して簡易なディスプレィにより出力し、また、特開平８−２３５７号公報に示されるものでは車両の後方に設けられた物体検知用の測距センサにより、障害物（特に、駐車しようとする駐車スペースの隣りに駐車している車等）との距離をはかり、その距離に応じて最大舵角による転舵開始位置を検出し、転舵開始位置をドライバに報知する方法が知られている。
【０００４】
【本発明が解決しようとする課題】
しかしながら、上記した従来の方法では様々なセンシング技術を用いて、車両の周辺の障害物を検知することが前提となっており、その処理のためのシステムが複雑になってしまう。また、測距センサ等により近くにある障害物との距離をはかり報知する方法では、駐車スペースの隣りに駐車している車がない場合や人や物等の急な飛び出しに対しての対応が困難で適切に駐車を補助するものではない。
【０００５】
そこで、本発明は上記の問題点に鑑みてなされたものであり、簡易な方法により駐車を補助し、縦列駐車や車庫入れ等の駐車に対して有用な情報を適切に提供することを技術的課題とする。
【０００６】
【課題を解決するための手段】
上記の課題を解決するために講じた技術的手段は、車両の後方をカメラにより検出し、カメラからの映像を車内に設けられた表示器に後方画像として表示すると共に、ステアリング角度を検出するステアリングセンサを設け、該ステアリングセンサからのステアリング角度により車両の走行する走行予想軌跡を求めて、前記車両の進む方向へと延び車幅に対応した左右一対の走行予想軌跡を表示器に表示することにより運転者の駐車時の操作を補助する駐車補助装置において、駐車時の操作を補助する駐車スイッチを設け、後方画像と、後方画像に対してステアリング角度の応じて可変となり、前記走行予想軌跡の前記車両から進む方向へと延びる長さが制限され、前記車両から延びる長さ制限された前記走行予想軌跡の前記車両から遠ざかった位置に表示される左右先端が互いに結ばれた走行予想軌跡が重ねて表示される画像とを駐車スイッチにより切り換えが行えるものとしたことである。
【０００７】
上記の技術的手段により、駐車時の操作を補助する駐車スイッチを設けて、前記後方画像と、前記後方画像に対してステアリング角度の応じて可変となり前記走行予想軌跡の左右先端が結ばれた走行予想軌跡が重ねて表示される画像とを駐車スイッチにより切り換えが行えるようにしたので、駐車スイッチのスイッチ操作により、駐車操作時に補助が必要な場合には、後方画像にステアリング角度の応じて可変となり、車両から進む方向へと延びる長さが制限され、車両から遠ざかった位置に表示される左右先端が互いに結ばれた走行予想軌跡を重ねて表示させることが可能となる。これは、後方画像に対して走行予想軌跡を重ねて表示させることが必要な場合には、駐車スイッチを操作すれば、後方画像に対して走行予想軌跡が重ねて表示され、簡単な方法により駐車操作が補助され、ドライバは縦列駐車や車庫入れ等の駐車に対して、ステアリング角度に対応した走行予想軌跡を表示器で視覚的に見る事が可能となり、有用な情報が提供される。しかも、車両の後方がどこの位置を通るかといった状態をドライバは予想軌跡を確認しながら、駐車操作時の視認性を確保しつつ、ドライバに対して駐車の補助が行える。
【００１０】
走行予想軌跡はタイヤの通過地点がわかる車両の予想轍、車両周辺との接触が判断できる車幅状の帯、距離認識可能なはしご状表示のいずれかにより表示されるようにすれば、駐車操作時に距離感がわかり視認性が向上する。
【００１１】
走行予想軌跡は、表現方法において操舵状態により表示色を変化させるようにすれば、ステアリングが中立状態にあることを表示色で識別できるようになる。
【００１２】
【発明の実施の形態】
以下、本発明の実施形態を図面を参照して説明する。
【００１３】
図１は、駐車補助装置１のシステム構成図である。この図において、駐車補助装置１を制御するコントローラ１６には車両の後方を撮影するＣＣＤカメラ（以下、カメラと称す）１７、ステアリングホイール（以下、ステアリングと称す）２１の操舵角を検出するステアリングセンサ２、トランスミッションのシフトレバーのリバース（後退）状態を検出するシフトレバーリバーススイッチ３、駐車操作時に駐車アシスト機能を動作させる駐車スイッチ４、および、従動輪の左右の車輪速度を検出する車輪速センサ５，６からの信号が入力されており、これらの信号を基にコントローラ１６はディスプレィ１３上に、車両の後方画像と後述する走行予想軌跡２０を表示できるようになっており、また、音声合成回路７により音声合成出力がスピーカ８からドライバに対して、音声が発せられるようになっている。
【００１４】
コントローラ１６の内部には制御を司るＣＰＵ１１、ディスプレィ１３にグラフィックスを描画するグラフィックス描画回路１２、グラフィックス信号とカメラ１７からの後方画像を重ね合わせるスーパーインポーズ回路９、カメラ画像から同期信号を抽出してグラフィックス描画回路１２へ供給する同期分離回路１０、カメラ１７からの信号を受けて駐車区画の画像認識を行う駐車区画検出用の画像認識装置１５が設けられている。尚、画像認識装置１５はコントローラ１６に別体で設けることも可能である。
【００１５】
ディスプレィ１３上にはステアリングの舵角状態により点灯状態が変化する舵角状態表示（表示マーカー）１４が設けられ、ステアリング舵角の状態により表示マーカー１４は左右、中央のいずれかが点灯し、ステアリング２１がどちらに転舵されているかが、後方画像と一緒にわかるようになっている。
【００１６】
図２は、駐車補助装置１を車両に取り付けた場合の取付図を示す。後方を撮像するカメラ１７は車両後方のナンバープレートの上中央付近に取り付けられ、光軸を下方に向けて設置される。具体的には、図３に示されるように、車両後方の中央に下方（約３０度）に向けて取り付けられ、カメラ自体は広角レンズにより左右１４０度の視野を確保し、後方８ｍ程度までの領域を撮影できるようになっている。
【００１７】
また、車両の室内のセンターコンソールにはパネル面にディスプレィ１３が備え付けられており、グローブボックス上方にはコントローラ１６が内部に設けられている。更に、駐車を補助する要求を出す駐車スイッチ４は、ドライバが操作し易いセンターコンソール近傍に設けられている。
【００１８】
ここで、ステアリングセンサ２について、図４を参照して説明する。このステアリングセンサ２は市販のものを用い、ステアリング２１の舵角を検出するものである。これは、ステアリングコラムシャフト２３と一体回転するようにスリット板２ａが取付けられており、９０°の位相差がついた２組のフォトインタラプタ２ｃ，２ｂが取付けられている。この構成において、ディスク板２ａに円周状に設けられた複数のスリットの回転により、光を通過または遮断してフォトトランジスタをオン／オフさせることにより、Ａ相、Ｂ相の２つの信号パルスを出力している。これは、ステアリング２１の回転方向によりＡ相に対し、Ｂ相は９０°位相が遅れるか、または、進んで出力されるようになっており、ここでは、ステアリング角度が１°／パルスのものを用いている。
【００１９】
次に、図５を参照してコントローラ１６の処理について説明する。コントローラ１６は電源オン（アクセサリスイッチがオン）で図５に示すプログラムはスタートするようになっている。
【００２０】
ステップＳ１０１ではこの処理に必要なメモリに各種初期値を設定する。その後、ステップＳ１０２でシフトリバーススイッチ３の状態をチャックし、オフ（リバースでない）ならば、ディスプレィ１３の表示をステップＳ１１１で止め、ステップＳ１０２に戻る。一方、シフトリバーススイッチ３がオン（リバースレバーの状態）になるとステップＳ１０３を行う。ステップＳ１０３ではディスプレィ１３をカメラ画像モードに切り換えて、車両後方の画像を生画像として表示できるモードにする。つまり、通常のバックモニタカメラである。
【００２１】
次に、ステップＳ１０４において駐車操作時に駐車を補助する駐車スイッチ４をチェックする。ここで、駐車スイッチ４の状態がオフ（駐車補助要求がない状態）であれば、ディスプレィ１３のグラフィック画面をステップＳ１１２でクリヤし、ディスプレィ１３には後方の生画像表示のみとし、ステップＳ１０２に戻る。一方、ステップＳ１０４において駐車スイッチ４がオン（駐車補助要求がある状態）であるならば、ステップＳ１０５に進み、音声合成回路７に予め決められた音声信号出力をし、スピーカ８より音声出力を行う。即ち、状況に応じて「駐車アシストします。軌跡を希望の位置に合わせて、周囲に注意しながらバックして下さい。」、「ただいまより、駐車ガイドを開始いたします。画面の緑（走行予想軌跡）の表示の先端が、駐車区画に向かうように、ハンドルを回して下さい。」、「右（左）にご注意下さい。」等の予め決められた音声メッセージで、ドライバに対して音声により案内を行う。
【００２２】
次に、ステップＳ１０６においてステアリングセンサ２からステアリングセンサ値Ｎを読み込み、その値を基に駐車操作時の現在の旋回半径Ｒの算出を行う。具体的には、ステアリングセンサ２の読み込みをＡ相信号の立ち上がりエッジ検出時にメインプログラムに割り込みを発生させ、図６に示す割り込み処理を実行する。つまり、図６のステップＳ２０１においてＢ相信号の状態をチェックし、Ｂ相信号がハイ（Ｈ：高電位）なら、ステップＳ２０２においてステアリングカウント値Ｎをインクリメントし、ロー（Ｌ：低電位）ならデクリメントしてその値をメモリに記憶する。この場合、ステアリングカウント値Ｎは、１パルスが１°のため、θ＝Ｎとなる。
【００２３】
しかし、上記に示すステアリング値Ｎのカウントのみではステアリング２１の絶対舵角が不定となってしまうため、図７に示す方法によりステアリング舵角の中立点を検出し、Ｎ＝０として中立点を決める。
【００２４】
そこで、図７を参照して中立点決定について説明する。この処理では１秒周期のタイマ割り込みで実行される。ここでは、通常、車輪に備えつけられている公知の左右の車輪速センサ５，６からの信号により車体速度も算出する。ステップＳ３０１，ステップＳ３０２では左右の車輪速センサ５，６からの信号（パルス）はコントローラ内部のＣＰＵ１１に内蔵されたハードウェアカウンタによりカウントされ、このタイマ割り込みルーチンで左右の車輪速が読み出され、車輪速センサ値が記憶されるメモリのＮＲ，ＮＬに記憶される。読み出しの後、カウンタ自体はクリアされ、ＮＲ，ＮＬは１秒毎のパルス数を示すものとなる。
【００２５】
次のステップＳ３０３においてＮＲ，ＮＬからその平均値（ＮＲ＋ＮＬ）／２を演算し、この値にタイヤの周長を乗算し、公知の方法により容易に車速Ｖが求められる。次に、ステアリングセンサ２の基準設定であるが、ステップＳ３０４からステップＳ３０６では車速Ｖ、所定速度（１０Ｋｍ／ｈ）以上の時に左右の車輪速センサ５，６のパルス差がほとんどない状態をもって車両が直進状態であるとみなし、ステップＳ３０６でステアリングカウンタＮを零にしてリセットすることで、ステアリング舵角の中立点が求められる。
【００２６】
一方、図５のメインルーチンでは、ステップＳ１０７において走行予想軌跡２０のパラメータ演算を行い、ステップＳ１０８において後述の方法により求められる走行予想軌跡２０をディスプレィ１３に後方画像と重ねてグラフィック描画する。ステップＳ１０９においては、再度、駐車スイッチ４をチェックし、駐車スイッチ４がオフ（駐車補助要求なし）の場合にはステップＳ１０２に戻りステップＳ１０２からの同じ処理を繰り返すが、オン（駐車補助要求あり）の場合にはステップＳ１１０において、今度はシフトリバーススイッチ３をチェックして、リバース（後進）でない場合にはステップＳ１０２に戻るが、リバース状態の場合にはステップＳ１０６からステップＳ１１０までの同じ処理を繰り返す。つまり、駐車スイッチ４により駐車を補助する要求が出ていれば、繰り返し走行予想軌跡２０が算出され、後方画面に走行予想軌跡２０をステアリング舵角に応じてリアルタイムで可変表示させる（図１３参照）。
【００２７】
次に、走行予想軌跡２０の求め方について説明する。これは、図８に示されるように低速時（ここでは、１０Ｋｍ／ｈ以下とする）の旋回中心Ｏは車両後方の車軸の延長線上に存在し、幾何学的関係によりステアリング操舵角（ステアリング角度）θとホイールベースＬとから、旋回半径Ｒは、Ｒ＝Ｌ／ｔａｎθという関係式により導かれる。尚、この場合、ステアリング舵角θ＝０の場合には、車両は直進している状態であり、Ｒ＝∞となる。
【００２８】
図１０ではカメラ上でのグラフィックス表示座標（ｘ，ｙ）を示し、図示の座標系を使用し、座標変換の方法を図１２に示す。カメラ１７は図１１に示されるように路面から上方Ｈｃの高さで光軸を水平状態から下方にθだけ傾けて取り付けられており、カメラ１７のレンズは広角で焦点深度が深くとられて、路面の画像をＣＣＤデバイスに描画するように構成されている。このため、路面座標系（Ｘ，Ｚ）とディスプレィ上での座標系（ｘ，ｙ）には以下に示すような写像関係が成立するものとなる。
【００２９】
具体的には、（Ｘ，Ｙ，Ｚ）：路面座標、（ｘ，ｙ）：ＣＣＤ素子面のカメラ座標、ｆ：カメラのレンズ焦点距離、（ｘ’，ｙ’，ｚ’）：レンズ座標、θ：カメラ取付け角度、Ｈｃ：路面からの取付け高さとすると、
ｘ＝ｆ・ｘ’／ｚ’，ｙ＝ｆ・ｙ’／ｚ’・・・（１）
ｘ’＝Ｘ として、
ｙ’＝Ｚｓｉｎθ＋（Ｙ−Ｈｃ）ｃｏｓθ｝ ・・・（２）
ｚ’＝Ｚｃｏｓθ−（Ｙ−Ｈｃ）ｓｉｎθ ・・・（３）
という関係式が成立する。ここで、路面上の座標のみに限定すれば、Ｙ＝０となり、ｘ，ｙを上記の関係式により求めれば、

となる。つまり、路面上の点（Ｘ，Ｚ）をカメラ１７で撮影した場合のディスプレィ上でのグラフィックス画面上での座標（ｘ，ｙ）を（４），（５）の関係式より求めることができる。
【００３０】
上記の方法により求めた（ｘ，ｙ）の走行予想軌跡２０をディスプレィ上に表示する場合、その表示方法は、図９に示されるように各種の方法が考えられる。つまり、（ａ）では車両の左右輪が通過する予想轍による表示する方法、（ｂ）では駐車時に車両が走行する走行エリアをベクトル表示する方法、（ｃ）は一定距離間隔（はしご間隔：５０ｃｍ）がわかるようにしたはしご状に表示する方法等があり、ここでは（ｃ）を用いて、駐車操作時に距離感や各位置での車体の角度が分かり易い方法を採用している。尚、この場合、車両予想軌跡２０の長さｌは固定長（例えば、３ｍ）にしたり、一定の角度分とし、旋回状態（緑色とする）と直進状態（青色とする）で色を変化させたり、更には、予想軌跡先端部のみを区別し易い表示にしたりする方法をとることもできる。
【００３１】
図１３はディスプレィ１３上での表示画面の例であり、ステアリング舵角により走行予想軌跡が変化する状態を示したものであり、これは車両の後方の実画像に駐車スイッチ４がオンしている（駐車補助要求ありの状態）場合にのみ、ステアリング舵角に応じてはしご状になった走行予定軌跡２０が重なり合って表示させるようにしている。この場合、後方画像に走行予想軌跡を表示させることで、ステアリング舵角をどれだけ転舵しているかわかるようにディスプレィ１３の一部に舵角状態を表示する表示マーカー１４を一緒に表示させれば、実際にどれだけ転舵しているかがわかる。
【００３２】
本発明の駐車補助装置１では後方画像に走行予想軌跡２０が表示されるため、ドライバはディスプレィ１３または後方を目視しながらステアリング２１を操舵し、適切な位置に保持しバックすれば良い。その後、駐車スペースの駐車区画内に水平に入った段階でステアリングをまっすぐにし、最後端までバックすれば正しく駐車区画に入ることができ、駐車操作時の適切な補助を行うことができる。
【００３３】
【効果】
本発明によれば、ステアリングセンサからのステアリング角度により車両の走行予想軌跡を求め、左右先端が結ばれた走行予想軌跡をステアリング舵角に応じて表示器に可変表示するようにしたので、ドライバはステアリング舵角に対応し、左右先端が結ばれた走行予想軌跡を表示器で常に確認しながら駐車が行えるため、表示器を見ればステアリング舵角に対応する走行予想軌跡がわかる。これは、駐車を補助する駐車スイッチを設け、走行予想軌跡はカメラからの後方画像と、後方画像に走行予想軌跡の左右先端が結ばれた走行予想軌跡が重ねて表示された画像とを駐車スイッチのスイッチ操作により切り換えれば、駐車操作時に必要な場合のみ、後方画像に走行予想軌跡を重ねて表示させることができ、駐車スイッチをドライバが操作するという簡単な表示方法で縦列駐車や車庫入れ等の駐車に対して有用な情報が提供できる。
【００３４】
この場合、左右先端が結ばれた走行予想軌跡はカメラからの後方画像に重ねて表示されるので、後方画像にステアリング角度による走行予想軌跡を重ね合わせて状態を確認できる。また、車両が後方のどこの位置を通るかといった左右先端が結ばれた走行予想軌跡によってドライバは同時に確認できるので、駐車操作時の視認性が向上し、駐車操作時の適切な補助ができる。
【００３６】
走行予想軌跡は車両の予想轍、車幅状の帯、距離認識可能なはしご状表示のいずれかにより表示されるようにすれば、駐車操作時に距離感がわかる等の視認性が向上する。
【００３７】
走行予想軌跡は、操舵状態により表示色を変化させるようにすれば、ステアリングの操舵状態が表示色によりわかる。
【図面の簡単な説明】
【図１】本発明の一実施形態における駐車補助装置のシステム構成図である。
【図２】本発明の一実施形態における駐車補助装置を車両へ取付けた場合の取付図である。
【図３】本発明の一実施形態におけるカメラの検出範囲を示した図である。
【図４】本発明の一実施形態におけるステアリングセンサを示し、（ａ）はステアリングコラムシャフトへ取り付けた場合のステアリングセンサの平面図、（ｂ）はステアリングセンサのスリット板とフォトインタラプタの概要を示した斜視図、（ｃ）はステアリングセンサのＡ相とＢ相の出力を示す図である。
【図５】本発明の一実施形態におけるコントローラの処理を示すフローチャートである。
【図６】本発明の一実施形態におけるコントローラのステアリングセンサ信号処理を示すフローチャートである。
【図７】本発明の一実施形態におけるコントローラのステアリングセンサの中立点処理を示すフローチャートである。
【図８】本発明の一実施形態における走行予想軌跡の算出に用いる説明図である。
【図９】本発明の一実施形態における走行予想軌跡の表示例を示した図であり、（ａ）は予想轍による表示、（ｂ）は車幅分の走行エリアベルト表示、（ｃ）ははしご状表示を示す図である。
【図１０】本発明の一実施形態におけるカメラおよびディスプレィのグラフィックス表示座標である。
【図１１】本発明の一実施形態における駐車補助装置のカメラを車両へ取り付けた場合の取り付け状態を示した図である。
【図１２】本発明の一実施形態における駐車補助装置の座標変換方法を説明する説明図である。
【図１３】本発明の一実施形態におけるディスプレィの表示画面例である。
【符号の説明】
１ 駐車補助装置
２ ステアリングセンサ
３ シフトレバーリバーススイッチ
４ 駐車スイッチ
５ 右車輪速センサ
６ 左車輪速センサ
１３ ディスプレィ（表示器）
１４ 舵角状態表示（マーカー表示）
１７ ＣＣＤカメラ（カメラ）
２０ 走行予想軌跡

Claims (3)

1. 車両の後方をカメラにより検出し、該カメラからの映像を車内に設けられた表示器に後方画像として表示すると共に、ステアリング角度を検出するステアリングセンサを設け、該ステアリングセンサからのステアリング角度により車両の走行する走行予想軌跡を求めて、前記車両の進む方向へと延び車幅に対応した左右一対の走行予想軌跡を前記表示器に表示することにより運転者の駐車時の操作を補助する駐車補助装置において、
   駐車時の操作を補助する駐車スイッチを設け、前記後方画像と、前記後方画像に対してステアリング角度に応じて可変となり、前記走行予想軌跡の前記車両から進む方向へと延びる長さが制限され、前記車両から延びる長さ制限された前記走行予想軌跡の前記車両から遠ざかった位置に表示される左右先端が互いに結ばれた走行予想軌跡が重ねて表示される画像とを前記駐車スイッチにより切り換えが行えることを特徴とする駐車補助装置。
2. 前記走行予想軌跡は、車両の走行する予想轍、車幅状の帯、距離認識可能なはしご状表示のいずれかにより表示されることを特徴とする請求項１に記載の駐車補助装置。
3. 前記走行予想軌跡は、ステアリング角度に応じて表示色を変化させる請求項１または請求項２に記載の駐車補助装置。

Images