【０００１】
【発明の属する技術分野】
本発明は、障害物を回避して駐車する駐車支援装置に関するものである。
【０００２】
【従来の技術】
従来、この種の駐車支援装置として、例えば、駐車枠に対する所定の位置から、予め記憶された軌跡を辿る自動操舵により駐車を開始し、この自動操舵中に自車両と接触する可能性のある障害物を検出すると、自動操舵を逆再生して車両位置を戻してから、駐車をやり直すように構成された車両の自動操舵装置がある（特許文献１参照）。
【０００３】
【特許文献１】
特開平１０−１６７１０３号公報
【０００４】
【発明が解決しようとする課題】
しかしながら、上記従来例にあっては、障害物を検出したとき自動操舵の逆再生により車両位置を戻して障害物との接触を確実に回避することができるが、駐車位置に存在する輪止めが障害物となるときにも、わざわざ車両位置を戻して駐車をやり直したり、或いは、駐車の断念を強いられたりすると、乗員に煩わしさを与えてしまうという未解決の課題がある。
【０００５】
そこで、本発明は上記従来例の未解決の課題に着目してなされたものであり、駐車の際に、車体に接触してしまう輪止めを検出したとき、車両位置をわざわざ修正しなくとも、輪止への接触を回避した駐車を可能にして、乗員に与える煩わしさを軽減することができる駐車支援装置を提供することを目的としている。
【０００６】
【課題を解決するための手段】
上記目的を達成するために、本発明に係る駐車支援装置は、駐車予定位置に存在する輪止めを検出し、検出した輪止めに自車両の車体が接触するか否かを判断して、接触すると判断されるときに自車両の車高を制御して輪止めへの接触を回避することを特徴としている。
【０００７】
【発明の効果】
本発明に係る駐車支援装置によれば、駐車予定位置に存在する輪止めを検出し、検出した輪止めに自車両の車体が接触するか否かを判断して、接触すると判断されるときに自車両の車高を制御して輪止めへの接触を回避するように構成されているので、乗員に与える煩わしさを軽減することができるという効果が得られる。
【０００８】
【発明の実施の形態】
以下、本発明の実施形態を図面に基づいて説明する。
図１は本発明の一実施形態を示す概略構成図であり、図中、１は車両後方の画像を撮像する撮像装置である。この撮像装置１は、例えば、ＣＣＤカメラやＣＭＯＳカメラ等で構成されており、撮像した画像を画像処理装置２に伝送する。この画像処理装置２は、伝送された車両後方の画像をモノクロ濃淡画像情報として処理してから、ノイズ除去操作としてエッジ検出処理を実行し、水平エッジ（横エッジ）、及び垂直エッジ（縦エッジ）を検出する。次いで、エッジ検出処理された画像からハフ変換により直線パラメータを検出し、予め記憶された輪止めイメージと比較するモデルマッチング手法により、相関性の高い直線パラメータを抽出して、図２に示すように、駐車予定位置に存在する輪止めを認識する。
【０００９】
また、図示しないスタビライザーには、その回転角度を検出して各車輪位置に対応する車高Ｈを検出する車高センサ３が、また、図示しない変速機の出力側には、回転速度を検出する車速センサ４が、さらに、図示しないルーフ後方側の上面には、ルーフ上方に存在する物体との距離を検出するために、例えば、ソナーやレーダで構成された距離センサ５が設けられている。さらに、自車両には、セレクトレバー（図示省略）の選択位置を検出するインヒビタスイッチ６が設けられている。
【００１０】
これら、画像処理装置２、車高センサ３、車速センサ４、距離センサ５、及びインヒビタスイッチ６で検出される各種信号が、例えば、マイクロコンピュータで構成されたコントローラ７に入力される。このコントローラ７は、インヒビタスイッチ６がセレクトレバーのリバース位置へのセットを検出したときに、後述する駐車支援処理を実行して、車高制御装置８、警報装置９、ブレーキアクチュエータ１０を必要に応じて駆動制御する。
【００１１】
車高制御装置８は、図３に示すように、作動流体としてのオイルを貯容するリザーバ１１を備え、このリザーバ１１には、接続通路１２の一端、及び作動流体排出通路１３の一端が接続されている。接続通路１２の他端はエンジン１４により駆動されるポンプ１５の吸入側に接続されている。ポンプ１５は、例えば可変容量ポンプで構成され、その吐出側には作動流体供給通路１６の一端が接続されている。作動流体供給通路１６の他端、及び作動流体排出通路１３の他端は、圧力制御弁１７を構成するパイロット操作型の３ポート３ポジション切換式の切換制御弁１８におけるＰポート及びＲポートにそれぞれ連通接続されている。
【００１２】
作動流体排出通路１３における、他の車輪の作動流体排出通路が合流する連通接続部１３ａよりも圧力制御弁１７の側には、逆止弁１９が設けられている。このため、作動流体排出通路１３においては、この逆止弁１９により、圧力制御弁１７からリザーバ１１へ向かう流れのみが許容される。また、作動流体供給通路１６の途中には、フィルタ２０及びポンプ１５より圧力制御弁１７へ向かう作動流体の流れのみを許す逆止弁２１が設けられており、逆止弁２１より下流側の作動流体供給通路１６には、アキュムレータ２２が連通接続されている。
【００１３】
圧力制御弁１７は、切換制御弁１８と、作動流体供給通路１６から分岐してリザーバ１１に至る分岐通路２３と、この分岐通路２３の途中に設けられた固定絞り２４、及び分岐通路２３の実効通路断面積をソレノイド（図示省略）により変化させる可変絞り２５とを備えている。この可変絞り２５のソレノイドに対する電流制御により、固定絞り２４と可変絞り２５との間の分岐通路２３内の圧力Ｐｐを変更する。
【００１４】
切換制御弁１８のＡポートには、車両と車輪との間に介装され車両を懸架するアクチュエータ２６に至る接続通路２７が接続されている。この切換制御弁１８は、固定絞り２４、及び可変絞り２５を介した圧力Ｐｐと、絞り２８を介した接続通路２７内の圧力Ｐａとを、パイロット圧力として取り込むスプール弁であり、圧力Ｐｐと圧力Ｐａとの偏差によりオイルの流れの向きを切換る。すなわち、全ポートの連通を遮断する切換ポジション１８ｂと、ポートＲ及びポートＡを連通する切換ポジション１８ａと、ポートＰ及びポートＡを連通する切換ポジション１８ｃとの切換により、アクチュエータ２６へのオイルの給排を行なう。そして、接続通路２７の他端が、アクチュエータ２６の作動流体室２９に連通接続されている。
【００１５】
アクチュエータ２６は、一種のシリンダーピストン装置で構成され、車輪Ｗを支持するサスペンション部材と車体との間に配設されて車両を懸架している。したがって、コントローラ７は、可変絞り２５のソレノイドに対する電流値を制御することにより、作動流体室２９に対する作動流体の給排を調整して車高を制御する。
【００１６】
なお、作動流体室２９には、通路３０により気液ばね装置３１が接続されており、通路３０の途中には絞り３２が設けられている。この気液ばね装置３１はサスペンションスプリングまたは補助的なサスペンションスプリングとして作用し、絞り３２は減衰力を発生するようになっている。また、アクチュエータ２６には、作動流体室２９内のオイル圧力を検出する圧力センサ３３が設けられている。
【００１７】
そして、ブレーキアクチュエータ９は、コントローラ７から出力される制動指令に基づいて、自車両に制動力を発生させ、また警報装置９は、コントローラ３から出力される警報信号に基づいた警報をスピーカやディスプレイ等で報知するように、夫々構成されている。
次に、図４に示すような、輪止めを有する駐車枠に車両後方から並列駐車する際に、コントローラ７で実行する駐車支援処理を、図５のフローチャートに従って説明する。
【００１８】
この駐車支援処理は、インヒビタスイッチ６によりセレクトレバーがリバース位置にセットされたことを検出したときに開始され、先ず、ステップＳ１で、セレクトレバーがリバース位置に維持されているか否かを判定する。セレクトレバーがリバース位置以外にセットされると、この駐車支援処理を終了し、一方、セレクトレバーがリバース位置に維持されているときには、ステップＳ２に移行する。
【００１９】
ステップＳ２では、撮像装置１により車両後方を撮像すると共に、撮像される画像に基づいて画像処理装置２が輪止めを認識しているか否かを判定する。輪止めが認識されなければ、前記ステップＳ１に戻り、一方、輪止めが認識されたときには、ステップＳ３に移行する。
ステップＳ３では、ステップＳ２で認識された輪止めの高さｈｓ、及び輪止めまでの距離Ｌを算出する。
【００２０】
ここで、輪止めと、撮像装置１のレンズ及び撮像面との関係を図６に示すように、レンズに映る輪止めの高さをＡ、画像面に映る輪止めの高さをＢ、レンズから撮像面までの距離をｓ、レンズの焦点距離をｆとすると、画像の横倍率を求める式に基づいて、下記（１）式が導かれる。
また、レンズ法線ベクトルと地面との角度をθとすると、角度θとレンズに映る輪止めの高さＡとにより、実際の輪止めの高さｈｓを下記（２）式に従って算出することができる。
【００２１】
ｈｓ＝Ａ／ｃｏｓθ ・・・・・・（２）
したがって、上記（１）式、及び（２）式により、実際の輪止め高さｈｓを求める下記（３）式が導き出される。
ｈｓ＝Ｂｆ／（ｓ−ｆ）・ｃｏｓθ ・・・・・・（３）
さらに、地面からのレンズ中心の高さをｈとすると、レンズ中心から輪止めまでの距離Ｌは、下記（４）式で表すことができる。
【００２２】
Ｌ＝ｈ／ｔａｎθ ・・・・・・（４）
このように、輪止めの高さｈｓ、及び輪止めまでの距離Ｌを算出してから移行するステップＳ４では、算出された輪止めの高さｈｓから、車高センサ３で検出される車高Ｈを減じた値ｈｓ−Ｈが０（零）以上であるか否かを判定する。この判定結果がｈｓ−Ｈ＜０であるときは、輪止めに対する車体の接触はないと判断して、この駐車支援処理を終了する。一方、判定結果がｈｓ−Ｈ≧０であるときは、輪止めに車体が接触すると判断して、ステップＳ５に移行する。
【００２３】
ステップＳ５では、輪止めへの接触を回避するのに必要な車高上昇量ΔＨを、下記（５）式に従って算出する。なお、αは輪止めとの接触を、余裕をもって回避するための所定値であり、例えば５〜１０［ｃｍ］程度に設定されている。
ΔＨ＝ｈｓ−Ｈ＋α ・・・・・・（５）
次いで、ステップＳ６に移行して、距離センサ５により検出されるルーフ上方に存在する物体までの距離Ｈｒを読込み、ステップＳ７に移行する。
【００２４】
ステップＳ７では、前記車高上昇量ΔＨから、距離Ｈｒ及び所定値α’を減じた値が０（零）以上であるか否かを判定している。なお、α’は上方に存在する物体との接触を、余裕をもって回避するための所定値である。そして、判定結果がΔＨ−（Ｈｒ＋α’）＜０であるときには、車高をΔＨ上昇させてもルーフ上方に存在する物体には接触しないと判断して、ステップＳ８に移行し、一方、ΔＨ−（Ｈｒ＋α’）≧０であるときには、車高をΔＨ上昇させるとルーフが上方に存在する物体に接触すると判断して、ステップＳ９に移行する。
【００２５】
車高を上昇させてもルーフ上方に存在する物体との接触はないと判断されて移行するステップＳ８では、ΔＨだけ車高が上昇するように車高制御装置８における可変絞り２５を制御して、ΔＨ分の車高上昇が完了したとき、この駐車支援処理を終了する。
そして、車高の上昇によりルーフ上方に存在する物体に接触すると判断されて移行するステップＳ９では、輪止めとの接触を車高制御では避けられない旨を表す接触警報を警報装置９により運転者に報知して、ステップＳ１０に移行する。
【００２６】
ステップＳ１０では、インヒビタスイッチ６、及び車速センサ４の各検出信号に基づいて、車両が後退しているか否かを判定している。車両が停車又は前進しているときには、警報装置による接触警報を解除すると共に、この駐車支援処理を終了し、一方、車両が後退しているときには、ステップＳ１１に移行する。
ステップＳ１１では、前記ステップＳ３で算出された輪止めまでの距離Ｌが所定距離Ｌｓ未満であるか否かを判定している。この所定距離Ｌｓは、車両と輪止めとの間に、人が入れるような値に設定されており、例えば３０ｃｍ程度である。判定結果がＬ＞Ｌｓであるときには、輪止めに対する接近度合に余裕があると判断して、前記ステップＳ１０に戻る。一方、判定結果がＬ≦Ｌｓであるときには、車体が輪止めに接触する可能性があると判断して、ステップＳ１２に移行する。
【００２７】
ステップＳ１２では、ブレーキアクチュエータ１０に対する制動指令を出力して、車両を停車させ、ステップＳ１３に移行する。
ステップＳ１３では、輪止めの手前で停車させたことにより、自車両が駐車枠からはみ出している旨を表すはみ出し警報を警報装置９により運転者に報知してから、この駐車支援処理を終了する。
【００２８】
ここで、ステップＳ２、及びステップＳ３の処理、並びに撮像装置１、及び画像処理装置２が輪止め検出手段に対応し、ステップＳ４の処理が接触判断手段に対応し、ステップＳ７の処理が上部接触判断手段に対応し、ステップＳ８の処理、及び車高制御装置が車高制御手段に対応している。
次に、上記実施形態の動作を説明する。
【００２９】
今、運転者が、屋根付の駐車場に車両を後方側から並列駐車しようと、セレクトレバーをリバースギヤに切換えて後退を開始すると、撮像装置１が車両後方の撮像を開始すると共に、コントローラ７が駐車支援処理を開始する。その後、車両が輪止めに接近し、撮像装置１により輪止めが撮像されると、画像処理装置２による所定の画像処理により輪止めが認識さる（ステップＳ２の判定が“Ｙｅｓ”）。
【００３０】
このとき、可変絞り２５は、切換制御弁１８が全てのポートの連通を遮断する切換位置１９ｂをとるようソレノイドが制御されており、作動流体室２９内圧力である接続通路２７内の圧力Ｐａおよび分岐通路２３内の圧力Ｐｐは、基準圧力Ｐ０を維持しており、通常状態の車高Ｈを維持している。
そして、認識された輪止めの高さｈｓを前記（３）式に基づいて算出し（ステップＳ３）、更に車両の車高Ｈを車高センサ３で検出して、高さｈｓの輪止めに対して、車体が接触するか否かを判定する（ステップＳ４）。このとき、車高Ｈが、輪止めの高さｈｓよりも高ければ、輪止めとの接触はないと判断して駐車支援処理を終了する。
【００３１】
一方、図７（ａ）に示すように、輪止めの高さｈｓよりも車高Ｈが低いときには、輪止めとの接触を回避するのに必要な車高上昇量ΔＨを前記（５）式に基づいて算出し（ステップＳ５）、また距離センサ５により車両のルーフと天井までの距離Ｈｒを検出することにより（ステップＳ６）、輪止めを回避するために車高をΔＨ上昇させたときに、車両のルーフが天井に接触するか否かを判定する（ステップＳ７）。
【００３２】
そして、ルーフと天井との間に、車高をΔＨ上昇できるだけの十分な距離があると判断されるときは、図７（ｂ）に示すように、車高がＨｎからΔＨだけ上昇するように車高制御装置８を駆動制御する（ステップＳ８）。
すなわち、可変絞り２５のソレノイドを電流制御することにより、圧力Ｐｐを上昇させて切換制御弁１８をポートＲとポートＡとを連通接続する切換位置１９ａに切り換える。そして、作動流体室２９にポンプ１５からオイルが供給されることにより車高が上昇し、車高ＨがΔＨだけ上昇したときに、圧力Ｐｐを基準圧力Ｐ０に復帰させることで再び切換位置１９ｂに切換え、その後のオイルの供給を停止する。
【００３３】
こうして車高ＨをΔＨだけ上昇させてから、駐車支援処理を終了するので、運転者が後退を継続しても車体が輪止めに接触することなく、後輪が輪止めに接触する位置に車両を駐車することができる。したがって、輪止めのために、わざわざ車両位置を戻して駐車をやり直したり、或いは、駐車の断念を強いられたりすることがなく、乗員に与える煩わしさを軽減することができる。
【００３４】
一方、車高をΔＨ上昇させるとルーフが天井に接触してしまうと判断されるときは、輪止めとの接触を車高制御では避けられない旨を表す接触警報を警報装置９により運転者に報知する（ステップＳ１０）。
そして、運転者が、例えばセレクトレバーをリバース位置からドライブ位置に切換えたり、又はブレーキ操作を開始したりして、車両が停車又は前進するときには、輪止めへの接触はないと判断して、この駐車支援処理を終了する。しかし、運転者によるセレクトレバーの切換えやブレーキ操作がなく、車両の後退が継続され、車両が輪止めの所定距離Ｌｓ手前に達したときに、ブレーキアクチュエータ１０に対する制動指令を出力して車両を停車させる（ステップＳ１２）。
【００３５】
次いで、駐車枠からはみ出している旨を警報装置９により運転者に報知してから（ステップＳ１３）、この駐車支援装置を終了する。
因みに、輪止めとの接触を回避すべく、車高を上昇させて駐車している状態から車両が発進するときには、車両が所定距離（例えば、車両全長の半分程度）前進した後に、車高Ｈを通常状態に復帰させればよい。
【００３６】
すなわち、可変絞り２５のソレノイドを電流制御することにより、圧力Ｐｐを下降させて切換制御弁１８をポートＰとポートＡとを連通接続する切換位置１９ｃに切り換える。そして、作動流体室２９にポンプ１５からオイルが排出されることにより車高が下降し、車高Ｈが上昇していたΔＨだけ下降したときに、圧力Ｐｐを基準圧力Ｐ０に復帰させることで再び切換位置１９ｂに切換え、その後のオイルの排出を停止すればよい。
【００３７】
なお、上記実施形態では、車両から輪止めまでの距離Ｌを、前記（４）式に基づいて算出する場合について説明したが、これに限定されるものではない。すなわち、例えば、車両後部にバックソナーやレーザ装置を設けて、輪止めまでの距離Ｌｓを求めてもよい。
また、上記実施形態では、ステップＳ９で接触警報を報知した後に、ステップＳ１０で車両が停車、又は前進しているときに、駐車支援処理を終了する構成について説明したが、これに限定されるものではない。すなわち、例えば、運転者によるブレーキ操作があるとき、又はセレクトレバーがリバース位置以外にセットされるときには、運転者に、後退する意思はないと判断して、駐車支援処理を終了するように構成しても良い。
【００３８】
また、上記実施形態では、車高センサ４は、スタビライザーの回転角を検出する構成について説明したが、これに限定されるものではなく、車輪と車体との間に設けられたサスペンションリンクの角度を検出する構成でもよい。
さらに、上記実施形態では、輪止めとの接触を回避するために、車高制御装置８により、全車輪に対応する位置の車高を上昇させる構成について説明したが、これに限定されるものではない。すなわち、輪止めに接触する側の後輪側だけを上昇させてもよい。
【００３９】
さらに、上記実施形態では、駐車枠へ車両後方から駐車する場合について説明したが、これに限定されるものではなく、撮像装置１を車両前方側にも設けて、駐車枠に車両前方から駐車する場合にも適用することができる。
以上のように、上記実施形態によれば、駐車予定位置に存在する輪止めを検出し、検出した輪止めに自車両の車体が接触するか否かを判断して、接触すると判断されるときに自車両の車高を制御して輪止めへの接触を回避するように構成されているので、乗員に与える煩わしさを軽減することができるという効果が得られる。
【００４０】
また、上記実施形態によれば、車高制御装置８の車高制御により自車両のルーフが上方に存在する物体に接触するか否かを判定し、ルーフは上方の物体に接触しないと判断されるときに、車高制御装置８が車高を制御するように構成されているので、輪止めとの接触を車高制御で回避するときに、ルーフが上方の物体に接触することを確実に回避することができるという効果が得られる。
【図面の簡単な説明】
【図１】本発明の概略構成図である。
【図２】画像処理装置で認識される輪止めの画像である。
【図３】車高制御装置の概略構成図である。
【図４】駐車イメージである。
【図５】駐車支援処理の一例を示すフローチャートである。
【図６】輪止めとレンズと撮像面との関係を示す説明図である。
【図７】車高制御により輪止めを回避する説明図である。
【符号の説明】
１ 撮像装置
２ 画像処理装置
３ 車高センサ
４ 車速センサ
５ 距離センサ
６ セレクトバースイッチ
７ ブレーキ操作スイッチ
８ コントローラ
９ 車高制御装置
１０ 警報回路
１１ ブレーキアクチュエータ[0001]
TECHNICAL FIELD OF THE INVENTION
The present invention relates to a parking assist device that parks around an obstacle.
[0002]
[Prior art]
Conventionally, as a parking assist device of this type, for example, starting parking from a predetermined position with respect to a parking frame by automatic steering following a trajectory stored in advance, there is a possibility that the vehicle may come into contact with the host vehicle during the automatic steering. There is an automatic steering apparatus for a vehicle configured to reversely reproduce the automatic steering when an object is detected, return the vehicle position, and then restart parking (see Patent Document 1).
[0003]
[Patent Document 1]
JP 10-167103 A
[Problems to be solved by the invention]
However, in the above conventional example, when an obstacle is detected, the vehicle can be returned to the vehicle position by the reverse regeneration of the automatic steering and the contact with the obstacle can be reliably avoided. There is an unsolved problem that, even when the vehicle becomes an obstacle, if the vehicle is returned to the vehicle position and the vehicle is re-parked or the parking is forced, the occupant is troubled.
[0005]
Therefore, the present invention has been made focusing on the unsolved problems of the above conventional example, and when parking, when detecting a wheel stop that comes into contact with the vehicle body, without correcting the vehicle position, It is an object of the present invention to provide a parking assist device that enables parking while avoiding contact with a wheel stop and can reduce annoyance to an occupant.
[0006]
[Means for Solving the Problems]
In order to achieve the above object, a parking assistance device according to the present invention detects a wheelchair existing at a scheduled parking position, determines whether the vehicle body of the own vehicle contacts the detected wheelchair, When it is determined that the vehicle is in contact, the vehicle height of the host vehicle is controlled to avoid contact with the wheel stopper.
[0007]
【The invention's effect】
According to the parking assist device of the present invention, the wheelchair present at the scheduled parking position is detected, and it is determined whether or not the vehicle body of the own vehicle contacts the detected wheelchair. Since the configuration is such that the vehicle height of the host vehicle is controlled to avoid contact with the wheelchairs, an effect of reducing the burden on the occupant can be obtained.
[0008]
BEST MODE FOR CARRYING OUT THE INVENTION
Hereinafter, embodiments of the present invention will be described with reference to the drawings.
FIG. 1 is a schematic configuration diagram showing one embodiment of the present invention. In the drawing, reference numeral 1 denotes an imaging device for capturing an image behind a vehicle. The imaging device 1 is configured by, for example, a CCD camera, a CMOS camera, or the like, and transmits a captured image to the image processing device 2. The image processing device 2 processes the transmitted image behind the vehicle as monochrome grayscale image information, and then executes an edge detection process as a noise removal operation, and performs a horizontal edge (horizontal edge) and a vertical edge (vertical edge). Is detected. Next, a straight line parameter having a high correlation is extracted by a model matching method of detecting a straight line parameter from the image subjected to the edge detection processing by the Hough transform and comparing the straight line parameter with a pre-stored wheel stop image, as shown in FIG. Recognize a wheel chock that is present at the scheduled parking position.
[0009]
Further, a stabilizer (not shown) has a vehicle height sensor 3 for detecting a rotation angle thereof to detect a vehicle height H corresponding to each wheel position, and a rotation speed is detected on an output side of a transmission (not shown). The vehicle speed sensor 4 is further provided with a distance sensor 5 formed of, for example, a sonar or a radar on the upper surface on the roof rear side (not shown) in order to detect a distance from an object existing above the roof. Further, the own vehicle is provided with an inhibitor switch 6 for detecting a selected position of a select lever (not shown).
[0010]
Various signals detected by the image processing device 2, the vehicle height sensor 3, the vehicle speed sensor 4, the distance sensor 5, and the inhibitor switch 6 are input to a controller 7 constituted by a microcomputer, for example. When the inhibitor switch 6 detects that the selector lever is set to the reverse position, the controller 7 executes a parking assistance process described later, and controls the vehicle height control device 8, the alarm device 9, and the brake actuator 10 as necessary. Drive control.
[0011]
As shown in FIG. 3, the vehicle height control device 8 includes a reservoir 11 for storing oil as a working fluid, and one end of a connection passage 12 and one end of a working fluid discharge passage 13 are connected to the reservoir 11. ing. The other end of the connection passage 12 is connected to a suction side of a pump 15 driven by the engine 14. The pump 15 is constituted by, for example, a variable displacement pump, and one end of a working fluid supply passage 16 is connected to a discharge side thereof. The other end of the working fluid supply passage 16 and the other end of the working fluid discharge passage 13 are respectively connected to a P port and an R port of a pilot-operated 3-port 3-position switching control valve 18 constituting a pressure control valve 17. Communication is established.
[0012]
In the working fluid discharge passage 13, a check valve 19 is provided on the pressure control valve 17 side of the communication connection portion 13a where the working fluid discharge passages of the other wheels join. For this reason, in the working fluid discharge passage 13, only the flow from the pressure control valve 17 to the reservoir 11 is allowed by the check valve 19. A check valve 21 that allows only the flow of the working fluid from the filter 20 and the pump 15 toward the pressure control valve 17 is provided in the middle of the working fluid supply passage 16. An accumulator 22 is connected to the fluid supply passage 16.
[0013]
The pressure control valve 17 includes a switching control valve 18, a branch passage 23 branched from the working fluid supply passage 16 and reaching the reservoir 11, a fixed throttle 24 provided in the middle of the branch passage 23, and an effective passage of the branch passage 23. A variable throttle 25 for changing the passage cross-sectional area by a solenoid (not shown). By controlling the current of the solenoid of the variable throttle 25, the pressure Pp in the branch passage 23 between the fixed throttle 24 and the variable throttle 25 is changed.
[0014]
A connection passage 27 that is interposed between the vehicle and the wheels and that leads to an actuator 26 that suspends the vehicle is connected to the A port of the switching control valve 18. The switching control valve 18 is a spool valve that takes in the pressure Pp via the fixed throttle 24 and the variable throttle 25 and the pressure Pa in the connection passage 27 via the throttle 28 as pilot pressure. The direction of the oil flow is switched according to the deviation from Pa. That is, the oil supply to the actuator 26 is performed by switching between the switching position 18b for interrupting the communication of all ports, the switching position 18a for communicating the port R and the port A, and the switching position 18c for communicating the port P and the port A. Evacuate. The other end of the connection passage 27 is connected to the working fluid chamber 29 of the actuator 26 in communication.
[0015]
The actuator 26 is constituted by a kind of cylinder piston device, and is disposed between a suspension member that supports the wheel W and the vehicle body to suspend the vehicle. Therefore, the controller 7 controls the current value to the solenoid of the variable throttle 25 to adjust the supply and discharge of the working fluid to and from the working fluid chamber 29 to control the vehicle height.
[0016]
A gas-liquid spring device 31 is connected to the working fluid chamber 29 through a passage 30, and a throttle 32 is provided in the passage 30. The gas-liquid spring device 31 functions as a suspension spring or an auxiliary suspension spring, and the throttle 32 generates a damping force. Further, the actuator 26 is provided with a pressure sensor 33 for detecting an oil pressure in the working fluid chamber 29.
[0017]
The brake actuator 9 generates a braking force on the host vehicle based on a braking command output from the controller 7, and the alarm device 9 issues an alarm based on an alarm signal output from the controller 3 to a speaker or a display. And so on.
Next, a parking support process executed by the controller 7 when parking in parallel from behind the vehicle in a parking frame having a wheel stopper as shown in FIG. 4 will be described with reference to the flowchart of FIG.
[0018]
The parking assist process is started when it is detected by the inhibitor switch 6 that the select lever has been set to the reverse position. First, in step S1, it is determined whether or not the select lever is maintained at the reverse position. When the select lever is set to a position other than the reverse position, the parking assist process ends, and when the select lever is maintained at the reverse position, the process proceeds to step S2.
[0019]
In step S2, the rear of the vehicle is imaged by the imaging device 1, and it is determined whether or not the image processing device 2 recognizes the wheel stop based on the captured image. If a wheel stop is not recognized, the process returns to the step S1, and if a wheel stop is recognized, the process proceeds to a step S3.
In step S3, the height hs of the wheel chock recognized in step S2 and the distance L to the wheel chock are calculated.
[0020]
Here, as shown in FIG. 6, the relationship between the wheel stopper and the lens and the imaging surface of the imaging device 1 is A, the height of the wheel stopper reflected on the image is B, and the height of the wheel stopper reflected on the image surface is B. Assuming that the distance from to the imaging surface is s and the focal length of the lens is f, the following equation (1) is derived based on the equation for obtaining the lateral magnification of the image.
When the angle between the lens normal vector and the ground is θ, the actual hoop height hs can be calculated from the angle θ and the height A of the wheel stop reflected on the lens according to the following equation (2). it can.
[0021]
hs = A / cos θ (2)
Therefore, the following equation (3) for obtaining the actual wheel stopper height hs is derived from the above equations (1) and (2).
hs = Bf / (s−f) · cos θ (3)
Further, assuming that the height of the lens center from the ground is h, the distance L from the lens center to the wheel stopper can be expressed by the following equation (4).
[0022]
L = h / tan θ (4)
As described above, in step S4 to which the shift is performed after calculating the height hs of the wheel chocks and the distance L to the wheel chocks, the vehicle height detected by the vehicle height sensor 3 is calculated from the calculated height hs of the wheel chocks. It is determined whether the value hs-H obtained by subtracting H is equal to or greater than 0 (zero). If the result of this determination is hs-H <0, it is determined that there is no contact of the vehicle body with the wheel stopper, and this parking support process is terminated. On the other hand, when the determination result is hs-H ≧ 0, it is determined that the vehicle body comes into contact with the wheel stopper, and the process proceeds to step S5.
[0023]
In step S5, the vehicle height rise amount ΔH required to avoid contact with the wheel chock is calculated according to the following equation (5). Is a predetermined value for avoiding contact with the wheel stopper with a margin, and is set to, for example, about 5 to 10 [cm].
ΔH = hs−H + α (5)
Next, the process proceeds to step S6, where the distance Hr to the object located above the roof detected by the distance sensor 5 is read, and the process proceeds to step S7.
[0024]
In step S7, it is determined whether or not a value obtained by subtracting the distance Hr and the predetermined value α ′ from the vehicle height increase ΔH is equal to or greater than 0 (zero). Note that α ′ is a predetermined value for avoiding contact with an object existing above with a margin. If the result of the determination is ΔH− (Hr + α ′) <0, it is determined that the vehicle does not come into contact with an object existing above the roof even if the vehicle height is increased by ΔH, and the process proceeds to step S8. When (Hr + α ′) ≧ 0, it is determined that if the vehicle height is increased by ΔH, the roof contacts an object located above, and the process proceeds to step S9.
[0025]
In step S8 where it is determined that there is no contact with an object existing above the roof even when the vehicle height is increased, the variable throttle 25 in the vehicle height control device 8 is controlled so that the vehicle height is increased by ΔH in step S8. , ΔH, the parking support process is terminated.
In step S9, where it is determined that the vehicle is in contact with an object located above the roof due to an increase in the vehicle height and the process proceeds, a contact warning indicating that contact with a wheelchair cannot be avoided by vehicle height control is issued by the alarm device 9 to the driver. To step S10.
[0026]
In step S10, it is determined whether the vehicle is moving backward based on the detection signals from the inhibitor switch 6 and the vehicle speed sensor 4. When the vehicle is stopped or moving forward, the contact warning by the alarm device is released, and the parking assist process is terminated. On the other hand, when the vehicle is moving backward, the process proceeds to step S11.
In step S11, it is determined whether or not the distance L to the wheel stop calculated in step S3 is less than a predetermined distance Ls. The predetermined distance Ls is set to a value that allows a person to enter between the vehicle and the wheel stopper, and is, for example, about 30 cm. When the determination result is L> Ls, it is determined that there is a margin in the degree of approach to the wheel stopper, and the process returns to step S10. On the other hand, when the determination result is L ≦ Ls, it is determined that the vehicle body may come into contact with the wheel stopper, and the process proceeds to step S12.
[0027]
In step S12, a braking command is output to the brake actuator 10 to stop the vehicle, and the process proceeds to step S13.
In step S <b> 13, when the vehicle is stopped just before the wheel stop, the driver is notified by the alarm device 9 of a protruding warning indicating that the own vehicle is protruding from the parking frame, and the parking support process is ended.
[0028]
Here, the processing of steps S2 and S3, the imaging device 1 and the image processing device 2 correspond to the wheel stop detecting means, the processing of step S4 corresponds to the contact determining means, and the processing of step S7 corresponds to the upper contact. The processing in step S8 and the vehicle height control device correspond to the vehicle height control means.
Next, the operation of the above embodiment will be described.
[0029]
Now, when the driver switches the select lever to the reverse gear and starts retreating in order to park the vehicle in the parking lot with the roof from the rear side, the imaging device 1 starts imaging the rear of the vehicle and the controller 7. Starts the parking assistance process. Thereafter, when the vehicle approaches the wheelchair and the image capturing device 1 captures an image of the wheelchair, the wheelchair is recognized by the predetermined image processing by the image processing device 2 (the determination in step S2 is “Yes”).
[0030]
At this time, the solenoid of the variable throttle 25 is controlled so that the switching control valve 18 assumes a switching position 19b at which the communication of all ports is cut off, and the pressure Pa in the connection passage 27 which is the pressure in the working fluid chamber 29 and The pressure Pp in the branch passage 23 maintains the reference pressure P0, and maintains the vehicle height H in the normal state.
Then, the height hs of the recognized wheelchair is calculated based on the above equation (3) (step S3), and the vehicle height H is detected by the vehicle height sensor 3, and the wheelchair having the height hs is detected. On the other hand, it is determined whether or not the vehicle body comes into contact (step S4). At this time, if the vehicle height H is higher than the wheel stop height hs, it is determined that there is no contact with the wheel stop, and the parking assist process ends.
[0031]
On the other hand, as shown in FIG. 7A, when the vehicle height H is lower than the wheel stop height hs, the vehicle height increase amount ΔH required to avoid contact with the wheel stop is calculated by the equation (5). (Step S5), and by detecting the distance Hr between the roof and the ceiling of the vehicle by the distance sensor 5 (Step S6), when the vehicle height is increased by ΔH to avoid wheel stoppage. Then, it is determined whether the roof of the vehicle contacts the ceiling (step S7).
[0032]
When it is determined that there is a sufficient distance between the roof and the ceiling to raise the vehicle height by ΔH, as shown in FIG. 7B, the vehicle height is increased by ΔH from Hn. Drive control of the vehicle height control device 8 is performed (step S8).
That is, by controlling the current of the solenoid of the variable throttle 25, the pressure Pp is increased, and the switching control valve 18 is switched to the switching position 19a where the port R and the port A are connected. The oil height is increased by the supply of oil from the pump 15 to the working fluid chamber 29. When the vehicle height H increases by ΔH, the pressure Pp is returned to the reference pressure P0 to return to the switching position 19b. The operation is switched, and the supply of oil thereafter is stopped.
[0033]
After the vehicle height H is increased by ΔH, the parking assist process is terminated, so that even if the driver continues to retreat, the vehicle does not come into contact with the wheel stopper, and the vehicle is positioned at a position where the rear wheel contacts the wheel stopper. Can be parked. Therefore, it is possible to reduce the burden on the occupant without having to return to the vehicle position and re-park the vehicle, or to give up parking.
[0034]
On the other hand, when it is determined that the roof contacts the ceiling when the vehicle height is increased by ΔH, a contact alarm indicating to the driver that the contact with the wheelchair cannot be avoided by the vehicle height control is given to the driver by the alarm device 9. A notification is issued (step S10).
When the vehicle stops or moves forward, for example, by switching the select lever from the reverse position to the drive position or starting the brake operation, the driver determines that there is no contact with the wheel stop, The parking support processing ends. However, when the driver does not switch the select lever or perform the brake operation, the vehicle continues to retreat, and when the vehicle reaches a predetermined distance Ls before the wheel stop, outputs a braking command to the brake actuator 10 to stop the vehicle. (Step S12).
[0035]
Next, the driver is notified by the alarm device 9 that the vehicle is protruding from the parking frame (step S13), and the parking assist device is terminated.
Incidentally, in order to avoid contact with the wheelchair, when the vehicle starts moving from a state where the vehicle is parked at an increased height, after the vehicle has advanced a predetermined distance (for example, about half of the entire vehicle length), the vehicle height H May be returned to the normal state.
[0036]
That is, by controlling the current of the solenoid of the variable throttle 25, the pressure Pp is decreased, and the switching control valve 18 is switched to the switching position 19c where the port P and the port A are connected. When the oil is discharged from the pump 15 into the working fluid chamber 29, the vehicle height decreases, and when the vehicle height H decreases by the increased ΔH, the pressure Pp is returned to the reference pressure P0. It is sufficient to switch to the switching position 19b and stop the subsequent oil discharge.
[0037]
In the above embodiment, the case where the distance L from the vehicle to the wheel chock is calculated based on the above equation (4) has been described. However, the present invention is not limited to this. That is, for example, a back sonar or a laser device may be provided at the rear part of the vehicle, and the distance Ls to the wheel stopper may be obtained.
Further, in the above-described embodiment, the configuration has been described in which the parking support process is terminated when the vehicle stops or moves forward in step S10 after the contact warning is issued in step S9, but is not limited thereto. is not. That is, for example, when there is a brake operation by the driver or when the select lever is set to a position other than the reverse position, it is determined that the driver does not intend to retreat, and the parking assist process is terminated. May be.
[0038]
Further, in the above-described embodiment, the configuration in which the vehicle height sensor 4 detects the rotation angle of the stabilizer has been described. However, the configuration is not limited to this, and the angle of the suspension link provided between the wheel and the vehicle body is determined. A configuration for detection may be used.
Furthermore, in the above-described embodiment, the configuration has been described in which the vehicle height control device 8 raises the vehicle height at positions corresponding to all the wheels in order to avoid contact with the wheel stoppers. However, the present invention is not limited to this. Absent. That is, only the rear wheel side that contacts the wheel stopper may be raised.
[0039]
Further, in the above-described embodiment, the case where the vehicle is parked in the parking frame from the rear of the vehicle has been described. However, the present invention is not limited to this. The imaging device 1 is also provided on the vehicle front side to park in the parking frame from the front of the vehicle. The case can also be applied.
As described above, according to the above-described embodiment, the wheelchair present at the scheduled parking position is detected, and it is determined whether or not the vehicle body of the own vehicle contacts the detected wheelchair. In this case, the vehicle height of the vehicle is controlled to avoid contact with the wheel stoppers, so that the effect of reducing the inconvenience to the occupant can be obtained.
[0040]
Further, according to the above embodiment, it is determined by the vehicle height control of the vehicle height control device 8 whether or not the roof of the own vehicle comes into contact with an object existing above, and it is determined that the roof does not contact the object above. When the vehicle height control device 8 is configured to control the vehicle height when the vehicle is controlled, it is ensured that the roof will not come into contact with an object above when the contact with the wheelchair is avoided by vehicle height control. The effect that it can avoid is obtained.
[Brief description of the drawings]
FIG. 1 is a schematic configuration diagram of the present invention.
FIG. 2 is an image of a wheel stopper recognized by the image processing apparatus.
FIG. 3 is a schematic configuration diagram of a vehicle height control device.
FIG. 4 is a parking image.
FIG. 5 is a flowchart illustrating an example of a parking support process.
FIG. 6 is an explanatory diagram showing a relationship between a wheel stopper, a lens, and an imaging surface.
FIG. 7 is an explanatory diagram for avoiding wheel stoppage by vehicle height control.
[Explanation of symbols]
REFERENCE SIGNS LIST 1 imaging device 2 image processing device 3 vehicle height sensor 4 vehicle speed sensor 5 distance sensor 6 select bar switch 7 brake operation switch 8 controller 9 vehicle height control device 10 alarm circuit 11 brake actuator
