(57)【要約】【課題】斜め駐車の場合にドライバの意図する位置に正しい車両姿勢で車両を駐車させることができる駐車支援装置を得ること。【解決手段】本発明の駐車支援装置１は、駐車空間の情報と自車挙動の制約条件に基づいて自車両Ｖを駐車スペース２０から出庫させる出庫経路５１を演算する出庫経路演算部１１と、出庫経路５１上に複数の接続候補位置Ｐｎを設定する接続候補位置設定部１２と、自車両Ｖの初期位置Ｐ０から複数の接続候補位置Ｐｎのうちの一つに到達可能な到達可能経路５２を演算する到達可能経路演算部１３と、出庫経路５１と到達可能経路５２とを繋げて駐車経路とする駐車経路設定部を有し、出庫経路演算部１１は、斜め駐車である場合に、通路方位２５と駐車方位２６との間の傾斜角θ１に基づいて出庫経路５１の演算を行う。【選択図】図１
2018176910.tif 000002
【特許請求の範囲】
【請求項１】
自車両の駐車スペースへの駐車を支援する駐車支援装置であって、
駐車空間の情報と自車挙動の制約条件に基づいて前記自車両を前記駐車スペースから出庫させる出庫経路を演算する出庫経路演算部と、
該出庫経路演算部により演算された出庫経路上に複数の接続候補位置を設定する接続候補位置設定部と、
前記自車両の現在位置から前記複数の接続候補位置のうちの一つに到達可能な到達可能経路を演算する到達可能経路演算部と、
前記出庫経路と前記到達可能経路とを繋げて駐車経路とする駐車経路設定部とを有し、
前記出庫経路演算部は、前記駐車が通路から該通路に対して斜めに配置された前記駐車スペースに前記自車両を駐車する斜め駐車である場合に、前記通路の通路方位と前記駐車スペースの駐車方位との間の傾斜角に基づいて前記出庫経路の演算を行うことを特徴とする駐車支援装置。
【請求項２】
前記出庫経路演算部は、前記駐車スペースの駐車方位に対する前記出庫経路における前記自車両の向きが前記傾斜角以上となるまで前記出庫経路の演算を行うことを特徴とする請求項１に記載の駐車支援装置。
【請求項３】
前記接続候補位置設定部は、
前記自車両を前記出庫経路に沿って出庫する方向に移動させた場合に前記自車両の向きが所定の相対指定角度分だけ変化する位置を前記接続候補位置として設定することを特徴とする請求項２に記載の駐車支援装置。
【発明の詳細な説明】
【技術分野】
【０００１】
本発明は、車両の駐車支援装置に関する。
【背景技術】
【０００２】
特許文献１には、車両を駐車させるための切り返しを含む誘導経路を算出し、その誘導経路に沿って車両が目標位置に到達するように支援を行う駐車支援装置の技術が示されている。
【先行技術文献】
【特許文献】
【０００３】
【特許文献１】特開２０１０−２０８３９２号公報
【発明の概要】
【発明が解決しようとする課題】
【０００４】
特許文献１に示す技術では、駐車支援を開始する初期位置と駐車の目標位置との位置関係及び車両姿勢の関係に基づいて誘導経路を算出するようにしているので、例えば自車の初期位置が目標駐車位置に誘導できない場所である場合には、駐車支援を行うことができない。
また、通路の通路方位に対して駐車スペースの駐車方位が斜めに傾いている斜め駐車の場合、通路の通路方位に対して駐車スペースの駐車方位が直交する直交駐車とは、駐車経路が必要とする経路空間が異なっており、直交駐車に用いられている方法をそのまま適用することはできない。
【０００５】
本発明は、上記の点に鑑みてなされたものであり、その目的とするところは、斜め駐車の場合に、駐車支援を開始する初期位置や車両姿勢に依存せずに、駐車の目標位置に車両を誘導するための駐車経路を演算して、ドライバの意図する位置に正しい車両姿勢で車両を駐車させることができる駐車支援装置を提供することである。
【課題を解決するための手段】
【０００６】
上記課題を解決する本発明の駐車支援装置は、
自車両の駐車スペースへの駐車を支援する駐車支援装置であって、
駐車空間の情報と自車挙動の制約条件に基づいて前記自車両を前記駐車スペースから出庫させる出庫経路を演算する出庫経路演算部と、
該出庫経路演算部により演算された出庫経路上に複数の接続候補位置を設定する接続候補位置設定部と、
前記自車両の現在位置から前記複数の接続候補位置のうちの一つに到達可能な到達可能経路を演算する到達可能経路演算部と、
前記出庫経路と前記到達可能経路とを繋げて駐車経路とする駐車経路設定部とを有し、
前記出庫経路演算部は、前記駐車が通路から該通路に対して斜めに配置された前記駐車スペースに前記自車両を駐車する斜め駐車である場合に、前記通路の通路方位と前記駐車スペースの駐車方位との間の傾斜角に基づいて前記出庫経路の演算を行うことを特徴とする。
【発明の効果】
【０００７】
本発明によれば、斜め駐車の場合に、駐車支援を開始する開始位置や車両姿勢に依存せずに、駐車スペースに車両を誘導するための切り返しを含む駐車経路を演算して、ドライバの意図する位置に正しい車両姿勢で車両を駐車させることができる。なお、上記した以外の課題、構成及び効果は、以下の実施形態の説明により明らかにされる。
【０００８】
本発明に関連する更なる特徴は、本明細書の記述、添付図面から明らかになるものである。また、上記した以外の、課題、構成及び効果は、以下の実施形態の説明により明らかにされる。
【図面の簡単な説明】
【０００９】
【図１】本発明の実施形態に係わる駐車支援装置の機能ブロック図。
【図２Ａ】後ろ向き斜め駐車の駐車空間の一例を示す図。
【図２Ｂ】前向き斜め駐車の駐車空間の一例を示す図。
【図３Ａ】後ろ向き斜め駐車の一例を説明する図。
【図３Ｂ】後ろ向き斜め駐車の一例を説明する図。
【図４Ａ】前向き斜め駐車の一例を説明する図。
【図４Ｂ】前向き斜め駐車の一例を説明する図。
【図５Ａ】後ろ向き斜め駐車の出庫経路と接続候補位置を示す模式図。
【図５Ｂ】図５Ａに示す複数の接続候補位置から選択されたパークアウト位置を介して繋げられた駐車経路を示す模式図。
【図６Ａ】後ろ向き斜め駐車の出庫経路と接続候補位置を示す模式図。
【図６Ｂ】図６Ａに示す複数の接続候補位置から選択されたパークアウト位置を介して繋げられた駐車経路を示す模式図。
【図７Ａ】前向き斜め駐車の出庫経路と複数の接続候補位置を示す模式図。
【図７Ｂ】図７Ａに示す複数の接続候補位置から選択されたパークアウト位置を介して繋げられた駐車経路を示す模式図。
【図８Ａ】前向き斜め駐車の出庫経路と複数の接続候補位置を示す模式図。
【図８Ｂ】図８Ａに示す複数の接続候補位置から選択されたパークアウト位置を介して繋げられた駐車経路を示す模式図。
【図９】出庫経路上の接続候補位置を演算する方法を説明するフローチャート。
【図１０】到達可能判定の処理フロー。
【図１１Ａ】片側転舵による到達可能判定の一例を説明する図。
【図１１Ｂ】片側転舵による到達可能判定の一例を説明する図。
【図１１Ｃ】片側転舵による到達可能判定の一例を説明する図。
【図１１Ｄ】Ｓ字転舵による到達可能判定の一例を説明する図。
【図１１Ｅ】Ｓ字転舵による到達可能判定の一例を説明する図。
【図１２】片側転舵による到達可能経路の生成方法を説明する図。
【図１３】Ｓ字転舵による到達可能経路の生成方法を説明する図。
【図１４】Ｓ字転舵による到達可能経路の生成方法を説明する図。
【図１５】Ｓ字転舵による到達可能経路の生成方法を説明する図。
【発明を実施するための形態】
【００１０】
次に、本発明の実施形態について図面を用いて説明する。なお、以下の説明では、通路の左側に駐車スペースが設けられている場合を例に説明するが、本発明は、通路の右側に駐車スペースが設けられている場合についても同様に適用することができる。
【００１１】
図１は、本発明の実施形態に係わる駐車支援装置の機能ブロック図、図２Ａは、後ろ向き斜め駐車の駐車空間の一例を示す図、図２Ｂは、前向き斜め駐車の駐車空間の一例を示す図である。
【００１２】
本実施の形態における斜め駐車とは、通路から通路に対して斜めに配置された駐車スペースに自車両を駐車することであり、図２Ａに示すように、駐車スペース２０に対して後ろ向きに駐車する後ろ向き斜め駐車と、図２Ｂに示すように、駐車スペース３０に対して前向きに駐車する前向き斜め駐車がある。
【００１３】
例えば、後ろ向き斜め駐車の駐車空間の例としては、図２Ａに示すように、通路２１の通路方位２５と駐車スペース２０の駐車方位２６とが駐車スペース２０よりも通路２１の前方で交差するように、駐車スペース２０が通路２１の側方に斜めに配置されている。通路２１の通路方位２５に対する駐車スペース２０の駐車方位２６の傾きである傾斜角θ１は、０°よりも大きく９０°よりも小さい角度となっている。そして、通路２１の駐車スペース２０よりも通路前方及び通路後方には、他車両や他の駐車スペースなどの側方障害物２３、２４が配置され、通路２１の駐車スペース２０側とは反対側の側方には、通路２１の通路方位２５に沿って延在する壁や縁石、あるいは他車両などの障害物２２が配置されている。
【００１４】
また、前向き斜め駐車の駐車空間の例としては、図２Ｂに示すように、通路３１の通路方位３５と駐車スペース３０の駐車方位３６とが駐車スペース３０よりも通路３１の後方で交差するように、駐車スペース３０が通路３１の側方に斜めに配置されている。通路３１の通路方位３５に対する駐車スペース３０の駐車方位３６の傾きである傾斜角θ２は、０°よりも大きく９０°よりも小さい角度となっている。そして、通路３１の駐車スペース３０よりも通路前方及び通路後方には、他車両や他の駐車スペースなどの側方障害物３３、３４が配置され、通路３１の駐車スペース３０側とは反対側の側方には、通路３１の通路方位３５に沿って延在する壁などの障害物３２が配置されている。
【００１５】
図３Ａ及び図３Ｂは、後ろ向き斜め駐車の一例をそれぞれ説明する図である。例えば、図３Ａに示すように、通路の幅Ｗが狭い駐車空間における後ろ向き斜め駐車の場合、自車両Ｖは、以下の駐車経路をとることができる。まず、通路上の初期位置Ｐ０から、通路方位に沿って真っ直ぐ前進し（図３Ａ（１））、駐車スペース２０の前を通過した後に停止する（図３Ａ（２））。そして、曲がりながら後退して自車両Ｖの後部を駐車スペース２０に進入させ（図３Ａ（３））、目標駐車位置Ｐ１において自車両Ｖの向きが駐車方位に向くように配置させる（図３Ａ（４））。また、図３Ｂに示すように、通路の幅Ｗが比較的広い駐車空間における後ろ向き斜め駐車の場合には、図３Ａに示す駐車経路をとることもできるが、さらに、下記のような別の駐車経路をとることもできる。まず、通路上の初期位置Ｐ０から自車両Ｖを前進させて（図３Ｂ（１））、駐車スペース２０から離れる方向に曲がり、自車両Ｖの後部を駐車スペース２０に向ける（図３Ｂ（２））。そして、真っ直ぐ後退させて(図３Ｂ（３）)、自車両Ｖの後部から駐車スペース２０に進入させ、目標駐車位置Ｐ１において自車両Ｖの向きが駐車方位に向くように配置させる（図３Ｂ（４））。
【００１６】
図４Ａ及び図４Ｂは、前向き斜め駐車の一例をそれぞれ説明する図である。例えば、図４Ａに示すように、前向き斜め駐車の場合、自車両Ｖは、以下の駐車経路をとることができる。まず、通路２１上の初期位置Ｐ０から、駐車スペース３０に接近する方向に曲がりながら前進し（図４Ａ（１））、障害物３３の前で停止する（図３Ａ（２））。そして、真っ直ぐ後退して障害物３２の前で停止し、再び駐車スペース３０に向かって接近する方向に曲がりながら前進する（図３Ａ（３））。そして、駐車スペース３０内に自車両Ｖを進入させ、目標駐車位置Ｐ１において自車両Ｖの向きが駐車方位に向くように配置させる（図３Ａ（４））。また、図４Ｂに示すように、通路２１上の初期位置Ｐ０から前進して（図４Ｂ（１））、駐車スペース３０の前で停止し、駐車スペース３０とは反対側に前輪を転舵して曲がりながら後退し（図４Ｂ（２））、自車両Ｖの前部を駐車スペース３０に向ける（図４Ｂ（３））。そして、真っ直ぐ前進して、自車両Ｖの前部から駐車スペース３０に進入し、目標駐車位置Ｐ１において自車両Ｖの向きが駐車方位に向くように配置させることもできる（図４Ｂ（４））。
【００１７】
本実施例では、自車両Ｖが初期位置Ｐ０や目標駐車位置Ｐ１、後述する接続候補位置Ｐｎやパークアウト位置Ｐ２等の各位置に配置されているか否かは、自車両Ｖの左右の後輪の中間位置である基準点Ｖｏを基準に判断している。また、旋回は、例えばクロソイド曲線に沿って行われるものとする。
【００１８】
本発明の駐車支援装置１は、上述のような自車両Ｖの斜め駐車を支援するものであり、例えば少なくとも１回以上の前後方向の切り返しが必要とされるような斜め駐車の動作を支援するのに適したものである。駐車支援装置１では、自車両Ｖを誘導するための駐車経路を演算し、その演算した駐車経路に沿って自車両Ｖを移動させることによって通路脇の斜めの駐車スペースに駐車させることができる。駐車支援装置１から駐車経路の情報を出力して、自車両Ｖを自動または半自動で目標駐車位置Ｐ１に駐車するシステムとしてもよい。半自動では、例えばハンドル操作は自動制御により行われ、アクセル操作とブレーキ操作はドライバによって行われる。
【００１９】
駐車支援装置１は、自車両Ｖに搭載されており、マイクロコンピュータなどのハードウエアとソフトウエアプログラムの協働によって実現される。駐車支援装置１は、図１に示すように、出庫経路演算部１１と、接続候補位置設定部１２と、到達可能経路演算部１３と、駐車経路設定部１４を有している。
【００２０】
出庫経路演算部１１は、目標駐車空間の情報と自車挙動の制約条件に基づいて駐車スペースから自車両Ｖを出庫させる少なくとも一つ以上の出庫経路を演算する。接続候補位置設定部１２は、出庫経路上に複数の接続候補位置を設定する。到達可能経路演算部１３は、各接続候補位置に対して自車両Ｖの現在位置である初期位置Ｐ０から到達可能な少なくとも一つ以上の到達可能経路を演算する。駐車経路設定部１４は、出庫経路と到達可能経路とを繋げて自車両Ｖの駐車経路を設定し、駐車経路が複数ある場合には、その中から所定条件に基づいて最適な駐車経路を選択する。
【００２１】
駐車支援装置１には、図１に示すように、目標駐車空間情報１７１と、目標駐車位置情報１７２と、自車両情報１７３と、自車位置情報１７４が入力される。目標駐車空間情報１７１には、駐車スペースの周辺の障害物の位置や距離、通路の通路方位と駐車スペースの駐車方位との間の傾斜角θ１、θ２など、駐車スペースの制約条件となる情報が含まれている。
【００２２】
そして、目標駐車位置情報１７２には、駐車スペースの形状や自車両Ｖとの相対位置の情報等が含まれ、自車両情報１７３には、自車両の旋回半径などの自車挙動の制約条件となる情報が含まれている。そして、自車位置情報１７４として、車両の操舵角や速度、車輪の回転量から車両モデルによって演算されるデッドレコニングを利用し、また、ＧＰＳなどのセンサによって取得される位置情報や、路車間、車車間通信によって得られる自車位置情報を利用してもよい。
【００２３】
操作入力部１５は、例えばユーザが選択した駐車スペースの情報などを駐車支援装置１に入力する。経路表示部１６は、車内でドライバが見ることができる車載モニターであり、カメラからの映像に重ね合わせて目標となる駐車経路の切り返し位置を表示することができる。また、切り返し位置だけでなく、駐車経路全体を表示してもよい。ドライバは、車載モニターに表示される切り返し位置や駐車経路を見て、確認することができる。また、経路表示部１６には、駐車経路の表示に加えて、あるいは、単独で、斜め駐車の制御を行っている旨を表示してもよい。
【００２４】
＜出庫経路演算部＞
出庫経路演算部１１は、目標駐車空間情報１７１と、目標駐車位置情報１７２と、自車両情報１７３とに基づいて出庫経路を演算する。目標駐車空間情報１７１は、例えば自車両Ｖに搭載された超音波センサの検出信号や車載カメラからの画像から取得することができる。また、駐車場設備から出力されるインフラ情報を取得してもよい。出庫経路演算部１１は、駐車支援を行う駐車の種類が、目標駐車空間情報１７１に基づき斜め駐車であるか否かを判断し、斜め駐車であると判断すると、出庫経路が設定される経路空間を、通路方位に合わせて斜めに設定する。
【００２５】
出庫経路は、自車両Ｖを駐車スペース内の目標駐車位置Ｐ１に配置されている状態から出庫させる経路を推定した仮想的な移動経路である。出庫経路は、自車両Ｖの初期位置Ｐ０に拘束されることなく、全く無関係に演算される。出庫経路演算部１１では、出庫経路を演算する際に自車位置情報１７４を使用しない。出庫経路は、一つに限定されるものではなく、少なくとも一つ以上が演算される。
【００２６】
出庫経路は、目標駐車空間と自車挙動の制約条件に基づいて演算される。そして、後ろ向き斜め駐車では、目標駐車位置Ｐ１を原点としたときに初期位置Ｐ０における自車両Ｖの向きと同じ方向に出庫することを想定した経路が生成され、前向き斜め駐車では、目標駐車位置Ｐ１を原点としたときに初期位置Ｐ０における自車両Ｖの向きと反対方向に出庫することを想定した経路が生成される。
【００２７】
例えば、後ろ向き斜め駐車の場合、出庫経路として、目標駐車位置Ｐ１から駐車方位に沿って自車両Ｖを真っ直ぐ前進させ、自車両Ｖの基準点Ｖｏが駐車スペースから出る位置に至り、かかる位置で初期位置Ｐ０における自車両Ｖの向きと同一の方向に向かって出庫する方向に転舵して前進させる前進経路を演算する。前進経路は、自車両Ｖが前方の障害物に対する到達可能限界位置に至るまで演算される。
【００２８】
そして、自車両Ｖの前進により前方の障害物に対する到達可能限界位置に至った場合には、自車両Ｖをまっすぐに後退させる後退経路を演算する。後退経路は、自車両Ｖが後方の障害物に対する到達可能限界位置に至るまで演算される。そして、自車両Ｖの後退により後方の障害物に対する到達可能限界位置に至った場合には、再び自車両Ｖを初期位置Ｐ０における自車両Ｖの向きと同一の方向に向かって出庫する方向に転舵して前進させる前進経路を演算する。そして、自車両Ｖが前方の障害物に対する到達可能限界位置に至るまで前進経路を演算する。そして、所定の終了条件を満たす位置に至るまで、前進経路と後退経路を交互に演算する。後ろ向き斜め駐車の場合、駐車方位２６に対する自車両Ｖの向きの角度が傾斜角θ１以上になると、所定の終了条件を満たす位置に至ったとして、出庫経路の演算が終了する。
【００２９】
一方、前向き斜め駐車の場合、目標駐車位置Ｐ１から自車両Ｖを後退させ、自車両Ｖの基準点Ｖｏが駐車スペース３０から所定距離だけ離れる位置に至り、かかる位置で初期位置Ｐ０における自車両Ｖの向きと反対の方向に向かって出庫する方向に転舵して後退させる後退経路を演算する。後退経路は、自車両Ｖが後方の障害物に対する到達可能限界位置に至るまで演算される。
【００３０】
そして、自車両Ｖの後退により後方の障害物に対する到達可能限界位置に至った場合には、前輪を初期位置Ｐ０における自車両Ｖの向きと同一の方向に向かって出庫するように転舵して前進させる前進経路を演算する。前進経路は、自車両Ｖが前方の障害物に対する到達可能限界位置に至るまで演算される。そして、自車両Ｖの前進により前方の障害物に対する到達可能限界位置に至った場合には、再び自車両Ｖを初期位置Ｐ０における自車両Ｖの向きと反対の方向に向かって出庫する方向に転舵して後退させる後退経路を演算する。そして、自車両Ｖが後方の障害物に対する到達可能限界位置に至るまで後退経路を演算する。そして、所定の終了条件を満たすまで、後退経路と前進経路を交互に演算する出庫経路の演算を行う。前向き斜め駐車の場合、駐車方位２６に対する自車両Ｖの向きの角度が傾斜角θ２以上になると、所定の終了条件を満たす位置に至ったとして、出庫経路の演算が終了する。
【００３１】
出庫経路演算部１１は、所定の終了条件として、駐車スペース２０の駐車方位２６と自車両Ｖの向きとの間の角度が、通路２１の通路方位２５と駐車スペース２０の駐車方位との間の傾斜角θ１、θ２以上となる第１条件と、自車両が通路方位に沿って目標駐車位置Ｐ１から所定距離Ｈｍａｘだけ離れた地点に到達する第２条件と、出庫経路における切り返し回数が所定回数に達する第３条件の少なくとも一つを満たすまで出庫経路の演算を行う。
【００３２】
到達可能限界位置は、障害物との間に、所定の隙間を有して離れた位置を云う。所定の隙間は、障害物と接触しないように誤差等を考慮したマージンを持ったものであり、なるべく小さい方が好ましく、例えば１ｃｍ〜５０ｃｍくらいに設定されている。本実施形態では、自車両Ｖの外周に所定の隙間を持った仮想枠を設定し、仮想枠が障害物に接触した位置を到達可能限界位置と判断している。
【００３３】
出庫経路演算部１１は、後ろ向き斜め駐車の場合、通路の幅Ｗが広くなるのに応じて通路の幅方向に出庫経路の数を増加させる処理を行う。図５Ａ及び図６Ａは、後ろ向き斜め駐車の出庫経路と接続候補位置を示す模式図である。例えば、図５Ａに示すように、通路２１の幅Ｗが所定値よりも小さい場合には、駐車スペース２０から出てすぐに曲がる直近位置の出庫経路５１Ａを演算して設定する。一方、図６Ａに示すように、通路３１の幅Ｗが所定値以上である場合には、通路３１の幅方向に出庫経路の数を増加させている。
【００３４】
出庫経路演算部１１は、直近位置の出庫経路６１Ａを基準として、駐車方位２６に沿って延びる直線距離分６３を出庫経路６１Ａの経路途中に挿入することで、駐車スペース２０から最も離れた最遠位置の出庫経路６１Ｂを演算して設定する。
【００３５】
そして、直近位置の出庫経路６１Ａと最遠位置の出庫経路６１Ｂとの間の位置に中間位置の出庫経路６１Ｃを演算して設定する。中間位置の出庫経路６１Ｃは、直近位置の出庫経路６１Ａと最遠位置の出庫経路６１Ｂとの間を通路２１の幅Ｗに応じて予め設定された数で等分した位置に配置される。この等分する数は、通路２１の幅Ｗが増加するに応じて増加する。図６Ａに示す例では、直近位置の出庫経路６１Ａと最遠位置の出庫経路６１Ｂとの間を二等分する位置に中間位置の出庫経路６１Ｃが設定されている。中間位置の出庫経路６１Ｃは、直近位置の出庫経路６１Ａを基準として、直線距離分６３を二等分した長さの直線距離分６４を出庫経路６１Ａの経路途中に挿入することによって演算される。
【００３６】
なお、出庫経路演算部１１は、通路２１の幅Ｗが広くなるのに応じて出庫経路の数を増加させるのではなく、出庫経路６１Ａの位置を駐車方位２６に沿って駐車スペース２０から離れる側に移動させる処理を行ってもよい。例えば上述の処理では、直近位置の出庫経路６１Ａ及び最遠位置の出庫経路６１Ｂ及び中間位置の出庫経路６１Ｃの合計で３つの出庫経路を設定する場合を例に説明したが、直近の出庫経路６１Ａを移動させて最遠の出庫経路６１Ｂのみ、あるいは、中間の出庫経路６１Ｃのみを設定してもよい。
【００３７】
出庫経路演算部１１は、前向き斜め駐車の場合、図７Ａに示すように、駐車スペース２０から後退する後退経路７１ａと後方の到達可能限界位置から大きく曲がりながら前進する前進経路７１ｂを有する出庫経路７１と、図８Ａに示すように、大きく曲がりながら後退する後退経路８１ａと後方の到達可能限界位置から真っ直ぐ前進する前進経路８１ｂとを有する出庫経路８１の両方を演算することができる。
【００３８】
＜接続候補位置設定部＞
接続候補位置設定部１２は、出庫経路上に複数の接続候補位置Ｐｎを設定する。接続候補位置Ｐｎは、初期位置Ｐ０との間を到達可能経路で接続することができるか否かを判断するための候補位置である。接続候補位置Ｐｎは、出庫経路に沿って出庫方向に自車両Ｖを移動させた場合に、自車両Ｖの向きが所定の相対指定角度分だけ変化する毎（例えば５°［ｄｅｇ］毎）に設定される。接続候補位置設定部１２は、接続候補位置Ｐｎを設定し、かかる位置における自車両Ｖの向きの情報とリンクさせて記憶する処理を行う。
【００３９】
図９は、出庫経路上の接続候補位置を演算する方法を説明するフローチャートである。
まず、自車両Ｖを出庫経路に沿って仮想的に移動させ（Ｓ１０１）、到達可能限界位置に至るか否かが判断される（Ｓ１０２）。到達可能限界位置に至るか否かは、自車両Ｖの仮想枠が障害物と衝突するか否かによって判断され、自車両Ｖの仮想枠が障害物と衝突すると判断された場合に、到達可能限界位置Ｃに至ったと判断される。そして、到達可能限界位置に至ると判断した場合には（Ｓ１０２でＹＥＳ）、自車両ＶのシフトをＤレンジからＲレンジ、あるいはＲレンジからＤレンジに切り替えて、自車両Ｖの進行方向を前進から後退、あるいは後退から前進に切り返す（Ｓ１０７）。
【００４０】
一方、到達可能限界位置に至らないと判断した場合には（Ｓ１０２でＮＯ）、所定の接続候補位置に到達したか否かが判断される（Ｓ１０３）。ここでは、自車両Ｖの向きが所定の相対指定角度分だけ変化した場合に接続候補位置Ｐｎに到達したと判断して（Ｓ１０３でＹＥＳ）、かかる位置と自車両Ｖの向きの情報を記憶する（Ｓ１０８）。そして、駐車スペース２０の駐車方位２６に対する自車両Ｖの向きの角度が、後ろ向き斜め駐車では傾斜角θ１以上となったか、前向き斜め駐車では傾斜角θ２［ｄｅｇ］以上となったか否かが判断され(Ｓ１０４）、傾斜角θ１、θ２［ｄｅｇ］以上となっている場合には、終了条件の第１条件を満たすとして本ルーチンを終了する（Ｓ１０６）。
【００４１】
一方、駐車スペース２０の駐車方位２６に対する自車両Ｖの向きの角度が、傾斜角θ１、θ２［ｄｅｇ］未満の場合には（Ｓ１０４でＮＯ）、自車両Ｖが駐車スペースから通路の通路方位に沿って所定距離Ｈｍａｘ以上移動して離れたか否かが判断される（Ｓ１０５）。本実施例では、所定距離Ｈｍａｘは７メートルに設定されている。自車両Ｖが所定距離Ｈｍａｘ以上移動しているときは、第２条件を満たすとして本ルーチンを終了する。
【００４２】
接続候補位置Ｐｎは、図５Ａに示す例では、出庫経路５１Ａ上に沿って並ぶように設定され、図６Ａに示す例では、出庫経路６１Ａ、６１Ｂ、６１Ｃ上に沿って並ぶように設定される。そして、図７Ａに示す例では、出庫経路７１上に沿って並ぶように設定され、図８Ａに示す例では、出庫経路８１上に沿って並ぶように設定される。
【００４３】
＜到達可能経路演算部＞
到達可能経路演算部１３は、自車両Ｖの初期位置Ｐ０から複数の接続候補位置Ｐｎの少なくとも一つに到達可能な到達可能経路を演算する。到達可能経路とは、前進と後退を切り替えることなく、前進と後退のいずれか一方のみで自車両Ｖの初期位置Ｐ０から接続候補位置Ｐｎに到達可能な経路である。到達可能か否かは、自車両Ｖの位置及び向きに基づいて判断され、自車両Ｖの位置が接続候補位置に一致しかつ自車両Ｖの向きが、接続候補位置にリンクして記憶されている自車両Ｖの向きの情報に一致している場合に、到達可能と判断される。到達可能経路の演算は、自車位置情報と自車両Ｖの仕様情報に基づいて行われ、切り返し回数が少なく且つ自車両Ｖの初期位置Ｐ０に近い方の接続候補位置から順に演算される。
【００４４】
自車両Ｖを初期位置Ｐ０から移動させて接続候補位置Ｐｎに所定の向きで配置することができれば、後は、出庫経路を逆方向に辿ることによって、駐車スペース２０内の目標駐車位置Ｐ１に自車両Ｖを移動させることができる。したがって、到達可能経路演算部１３では、出庫経路上の複数の接続候補位置Ｐｎのうち、初期位置Ｐ０から所定の向きで自車両Ｖを配置することができる接続候補位置Ｐｎをパークアウト位置Ｐ２として設定し、初期位置Ｐ０からパークアウト位置Ｐ２までの到達可能経路を演算する。
【００４５】
図１０は、到達可能判定の処理フローである。
この処理フローは、接続候補位置の分だけループされ（Ｓ１１１）、まず、初期位置Ｐ０から接続候補位置Ｐｎまで片側転舵で到達可能か否かが判断される（Ｓ１１２）。片側転舵とは、自車両Ｖのステアリングを自車両Ｖの左右のいずれか一方の片側のみに転舵する操作である。そして、片側転舵では接続候補位置Ｐｎに到達できないと判断されたときは、Ｓ字転舵で到達可能か否かが判断される（Ｓ１１６）。Ｓ字転舵とは、自車両Ｖのステアリングを自車両Ｖの左右両側に転舵する操作である。
【００４６】
そして、片側転舵あるいはＳ字転舵により接続候補位置Ｐｎに到達可能であると判断された場合には、かかる接続候補位置をパークアウト位置Ｐ２として選択し、自車両Ｖの初期位置Ｐ０からパークアウト位置Ｐ２までの到達可能経路を生成する（Ｓ１１３）。
【００４７】
そして、到達可能経路において自車両Ｖが障害物に接触するか否かの判定を行い（Ｓ１１４）、接触しないと判断された場合には、接続ＯＫフラグをＯＮにして生成した到達可能経路を記憶手段に格納し、ループを終了する（Ｓ１１７）。一方、片側転舵とＳ字転舵では接続候補位置Ｐｎに到達できないと判断された場合（Ｓ１１２とＳ１１６でＮＯ）、あるいは、接触判定で接触すると判定された場合（Ｓ１１４でＹＥＳ）は、かかる接続候補位置Ｐｎに対する判断を終了し、残りの接続候補位置Ｐｎに対する判断を行う。そして、全ての接続候補位置Ｐｎに対して到達できないと判断された場合には、接続ＯＫフラグをＯＦＦにして（Ｓ１１５）、処理フローを終了する。
【００４８】
図１１Ａ〜図１１Ｃは、片側転舵による到達可能判定の一例を説明する図、図１１Ｄ、図１１Ｅは、Ｓ字転舵による到達可能判定の一例を説明する図である。
【００４９】
Ｓ１１２の片側転舵による到達可能判定では、以下の（ａ１）〜（ａ３）の条件が全て成立した場合に、到達可能と判定される（角度差と位置でも制限する）。
（ａ１）自車両Ｖの現在位置Ａ（初期位置Ｐ０）における軸線Ａ２と接続候補位置Ｅにおける軸線Ｅ２とが交差する。
（ａ２）現在位置Ａでの旋回円Ａ１と接続候補位置Ｅの軸線Ｅ２とが交差しない。
（ａ３）接続候補位置Ｅでの旋回円Ｅ１と現在位置Ａの軸線Ａ２とが交差しない。
なお、旋回円とは、クロソイドを考慮した旋回側の円弧（最小回転軌跡）とする。
【００５０】
図１１Ａに示す例では、軸線Ａ２とＥ２とが交差位置Ｆ１で交差しているので、上記（ａ１）の条件を満たしている。したがって、片側転舵により到達可能と判定される。一方、図１１Ｂでは、旋回円Ｅ１と軸線Ａ２とが交差しているので、上記（ａ３）の条件を満たしていない。そして、図１１Ｃに示す例では、旋回円Ａ１と軸線Ｅ２とが交差しているので、上記（ａ２）の条件を満たしていない。したがって、図１１Ｂ及び図１１Ｃに示す例では、片側転舵では到達不可能と判定され、Ｓ字転舵の利用が可能か否かの判定に移行する。
【００５１】
Ｓ１１６のＳ字転舵による到達可能判定では、以下の（ａ４）の条件が成立した場合に、到達可能と判定される（角度差と位置でも制限する）。
（ａ４）現在位置Ａでの旋回円Ａ１と接続候補位置Ｅの旋回円Ｅ１とが交差しない。
【００５２】
図１１Ｄに示す例では、旋回円Ａ１と旋回円Ｅ１とが交差していないので、上記（ａ４）の条件を満たしている。したがって、Ｓ字転舵により到達可能と判定される。一方、図１１Ｅに示す例では、旋回円Ａ１と旋回円Ｅ１とが交差しているので、上記（ａ４）の条件を満たしておらず、Ｓ字転舵による到達は不可能と判定される。
【００５３】
図１２は、片側転舵による到達可能経路の生成方法を説明する図である。
現在位置Ａから接続候補位置Ｅまでの片側転舵による経路を生成するには、まず、図１２（ａ）に示すように、軸線Ａ２と軸線Ｅ２との交点Ｋと現在位置Ａとの間の距離Ｌｓと、交点Ｋと接続候補位置Ｅとの間の距離Ｌｅをそれぞれ算出し、短い方の距離を選択する（図に示す例では、距離Ｌｅを選択）。そして、図１２（ｂ）に示すように、２本の軸線Ａ２、Ｅ２を共通接線に持ち、交点Ｋから短い方の距離だけ離れた位置を通る円を描き、幾何計算から下記の式（１）により半径Ｒを算出する。
【００５４】
【数１】
2018176910.tif 000003
【００５５】
以上により、直線と円弧を組み合わせた到達可能経路を生成することができる。
図１３は、Ｓ字転舵による到達可能経路の生成方法を説明する図であり、接続候補位置Ｅよりも後方で軸線Ｅ２が現在位置Ａの軸線Ａ２であるＸ軸と交わらない場合の生成方法を説明する図である。
【００５６】
ここでは、Ｓ字を描くための半径が同一の共通円の半径Ｒを算出する。円の接点を求めれば旋回円Ａ１の円弧と、旋回円Ｅ１の円弧とを組み合わせてＳ字の到達可能経路を生成することができる。
【００５７】
共通円の半径はそれぞれの円の中心座標が求まるので、中心座標間の距離から求まる。
【００５８】
【数２】
2018176910.tif 000004
【数３】
2018176910.tif 000005
ただし、θ＝０の場合は
【数４】
2018176910.tif 000006
【００５９】
図１３（ａ）に示す状態から図１３（ｂ）に示す交点Ｆ７の位置までが上記した計算式により算出可能である。
図１３（ｃ）に示す公式からＳ字のそれぞれの旋回角度φ１、φ２と、弧長ｂ１、ｂ２は以下の計算式により求められる。
【００６０】
【数５】
2018176910.tif 000007
【数６】
2018176910.tif 000008
【数７】
2018176910.tif 000009
【数８】
2018176910.tif 000010
【００６１】
図１４は、Ｓ字転舵による到達可能経路の生成方法を説明する図であり、接続候補位置Ｅよりも後方で軸線Ｅ２が現在位置Ａの軸線Ａ２であるＸ軸と交わる場合の生成方法を説明する図である。
【００６２】
ここでは、Ｓ字を描くための半径が同一となる共通の旋回円Ｅ１、Ａ１の半径Ｒを算出する。そして、円の接点を求めれば、旋回円Ａ１の円弧と、旋回円Ｅ１の円弧とを組み合わせてＳ字の到達可能経路を生成することができる。
共通円の半径はそれぞれの円の中心座標が求まるので、中心座標間の距離から求まる。
【００６３】
【数９】
2018176910.tif 000011
【数１０】
2018176910.tif 000012
【００６４】
図１３（ｃ）に示す公式からＳ字のそれぞれの旋回角度φ１、φ２と、弧長ｂ１、ｂ２は以下の計算式により求められる。
【００６５】
【数１１】
2018176910.tif 000013
【数１２】
2018176910.tif 000014
【数１３】
2018176910.tif 000015
【数１４】
2018176910.tif 000016
【００６６】
図１５は、Ｓ字転舵による到達可能経路の生成方法を説明する図であり、接続候補位置Ｅよりも後方で軸線Ｅ２が現在位置Ａの軸線Ａ２であるＸ軸と交わる場合の生成方法を説明する図である。
【００６７】
ここでは、Ｓ字を描くための半径が同一となる共通円Ｅ１、Ａ１の半径Ｒを算出する。そして、円の接点を求めれば、旋回円Ａ１の円弧と、旋回円Ｅ１の円弧とを組み合わせてＳ字の到達可能経路を生成することができる。
【００６８】
共通円の半径はそれぞれの円の中心座標が求まるので、中心座標間の距離から求まる。
【００６９】
【数１５】
2018176910.tif 000017
【数１６】
2018176910.tif 000018
【００７０】
図１３（ｃ）に示す公式からＳ字のそれぞれの旋回角度φ１、φ２と、弧長ｂ１、ｂ２は以下の計算式により求められる。
【００７１】
【数１７】
2018176910.tif 000019
【数１８】
2018176910.tif 000020
【数１９】
2018176910.tif 000021
【数２０】
2018176910.tif 000022
【００７２】
＜駐車経路設定部＞
駐車経路設定部１４は、目標駐車位置Ｐ１からパークアウト位置Ｐ２までの出庫経路の情報と、自車両Ｖの初期位置Ｐ０からパークアウト位置Ｐ２までの到達可能経路の情報を用いて駐車経路を設定する。駐車経路設定部１４は、図１０のステップＳ１１７で接続ＯＫフラグをＯＮにして生成された到達可能経路と、かかる到達可能経路が接続されているパークアウト位置Ｐ２を含む出庫経路とを繋いで駐車経路を形成する。
【００７３】
駐車経路は、複数設定できる場合に、駐車時間、後続車両の有無、駐車精度の高さ、通路の幅、または運転者の好みなど種々の評価値に応じて選択される。例えば駐車精度は、駐車スペースに曲がりながら進入するよりも、自車両Ｖの向きを駐車方位に合わせてから真っ直ぐに進入する方が精度が高い。したがって、駐車精度を優先する場合には、自車両の向きを駐車方位に合わせてから真っ直ぐに進入する駐車経路を選択する。
【００７４】
また、例えばパークアウト位置Ｐ２から駐車スペースに駐車する際に、前後の切り返しの回数や操舵量がなるべく少ない方が駐車に要する時間を短くすることができる。したがって、駐車に要する時間を短くする場合には、前後の切り返しの回数や操舵量がなるべく少なくなる駐車経路を選択する。
【００７５】
また、例えば駐車スペースから遠く離れた位置まで移動するよりも駐車スペースから離れない方が後続車両に駐車スペースへの駐車の意思を明確に示すことができる。したがって、通路上に後続車両が存在する場合には、駐車スペースから離れない駐車経路を選択する。
【００７６】
図５Ｂ、図６Ｂ、図７Ｂ、図８Ｂは、図５Ａ、図６Ａ、図７Ａ、図８Ａに示す複数の接続候補位置Ｐｎから選択されたパークアウト位置Ｐ２を介して出庫経路と到達可能経路が繋げられた駐車経路を示す図である。
【００７７】
駐車経路５０は、図５Ｂに示すように、パークアウト位置Ｐ２を介して出庫経路５１と到達可能経路５２を繋げることによって形成されており、パークアウト位置Ｐ２から曲がりながら後退して駐車スペース２０に進入する経路となっている。駐車経路５０の場合、パークアウト位置Ｐ２が駐車スペース２０から大きく離れず、パークアウト位置Ｐ２から目標駐車位置Ｐ１まで自車両Ｖをスムーズに移動させることができる。したがって、駐車に要する時間を短くすることができる。
【００７８】
駐車経路６０は、図６Ｂに示すように、パークアウト位置Ｐ２を介して出庫経路６１と到達可能経路６２を繋げることによって形成されており、パークアウト位置Ｐ２において自車両Ｖの向きが駐車方位２６とほぼ一致する経路となっている。したがって、駐車経路６０の場合、パークアウト位置Ｐ２からほぼ真っ直ぐに後退するだけで駐車スペース２０に自車両Ｖを進入させることができ、目標駐車位置Ｐ１に高い精度で駐車することができる。
【００７９】
駐車経路７０は、図７Ｂに示すように、パークアウト位置Ｐ２を介して出庫経路７１と到達可能経路７２を繋げることによって形成されている。出庫経路７１は、目標駐車位置Ｐ１とパークアウト位置Ｐ２との間に到達可能限界位置Ｐ３が設けられている。そして、パークアウト位置Ｐ２における自車両Ｖの向きが通路３１の通路方位と平行となるように設定されており、到達可能経路７２は緩やかなＳ字となる。したがって、自車両Ｖの乗員に違和感を与えることなく、スムーズに目標駐車位置Ｐ１に駐車することができる。
【００８０】
駐車経路８０は、図８Ｂに示すように、パークアウト位置Ｐ２を介して出庫経路８１と到達可能経路８２を繋げることによって形成されている。出庫経路８１は、目標駐車位置Ｐ１とパークアウト位置Ｐ２との間に到達可能限界位置Ｐ３が設けられている。そして、パークアウト位置Ｐ２から到達可能限界位置Ｐ３までほぼ真っ直ぐに後退する経路となっている。したがって、かかる経路を移動する際の誤差を小さくすることができ、目標駐車位置Ｐ１に精度よく駐車することができる。
【００８１】
本発明によれば、目標駐車位置Ｂから出庫経路を演算し、出庫経路上に設定された複数の接続候補位置のうち、自車の現在位置Ａから到達可能でかつ最も近い接続候補位置を接続候補位置Ｅとして選択し、目標駐車位置Ｂから接続候補位置Ｅまでの出庫経路と、自車両の現在位置Ａから接続候補位置Ｅまでの到達可能経路とを用いて駐車経路を設定するので、駐車支援を開始する開始位置や車両姿勢に依存せずに、目標駐車位置Ｂに自車両Ｖを誘導するための切り返しを含む駐車経路を演算して、ドライバの意図する位置に正しい車両姿勢で車両を駐車させることができる。
【００８２】
以上、本発明の実施形態について詳述したが、本発明は、前記の実施形態に限定されるものではなく、特許請求の範囲に記載された本発明の精神を逸脱しない範囲で、種々の設計変更を行うことができるものである。例えば、前記した実施の形態は本発明を分かりやすく説明するために詳細に説明したものであり、必ずしも説明した全ての構成を備えるものに限定されるものではない。また、ある実施形態の構成の一部を他の実施形態の構成に置き換えることが可能であり、また、ある実施形態の構成に他の実施形態の構成を加えることも可能である。さらに、各実施形態の構成の一部について、他の構成の追加・削除・置換をすることが可能である。
【符号の説明】
【００８３】
１  駐車支援装置
１１  出庫経路演算部
１２  接続候補位置設定部
１３  到達可能経路演算部
１４  駐車経路設定部
１５  操作入力部
１６  経路表示部
２０  駐車スペース
２１、３１  通路
２２、２３、２４、３２、３３、３４  障害物
２５、３５  通路方位
２６、３６  駐車方位
Ｖ  自車両
Ｖｏ  基準点
Ｐ０  初期位置
Ｐ１  目標駐車位置
Ｐ２  パークアウト位置
Ｐｎ  接続候補位置
【図１】
2018176910.tif 000023
【図２Ａ】
2018176910.tif 000024
【図２Ｂ】
2018176910.tif 000025
【図３Ａ】
2018176910.tif 000026
【図３Ｂ】
2018176910.tif 000027
【図４Ａ】
2018176910.tif 000028
【図４Ｂ】
2018176910.tif 000029
【図５Ａ】
2018176910.tif 000030
【図５Ｂ】
2018176910.tif 000031
【図６Ａ】
2018176910.tif 000032
【図６Ｂ】
2018176910.tif 000033
【図７Ａ】
2018176910.tif 000034
【図７Ｂ】
2018176910.tif 000035
【図８Ａ】
2018176910.tif 000036
【図８Ｂ】
2018176910.tif 000037
【図９】
2018176910.tif 000038
【図１０】
2018176910.tif 000039
【図１１Ａ】
2018176910.tif 000040
【図１１Ｂ】
2018176910.tif 000041
【図１１Ｃ】
2018176910.tif 000042
【図１１Ｄ】
2018176910.tif 000043
【図１１Ｅ】
2018176910.tif 000044
【図１２】
2018176910.tif 000045
【図１３】
2018176910.tif 000046
【図１４】
2018176910.tif 000047
【図１５】
2018176910.tif 000048