(57)【要約】  本発明は、駐車支援装置に関し、駐車を行う車両の周辺情報を検知し、車両が駐車可能な駐車空間を検知する周辺検知部と、車両の現在位置から周辺検知部で検知された駐車空間までの走行経路を生成する駐車経路生成部と、走行経路に沿って駐車空間まで車両を走行させる走行制御部と、車両の周辺の障害物を検知する障害物検知部と、走行制御部が走行経路に沿って駐車空間まで前記車両を走行させている際に、障害物検知部が走行経路上に障害物を検知した場合、車両と障害物との衝突を回避して、駐車空間に車両を駐車させる新たな走行経路を生成する駐車経路再生成部と、を備え、走行制御部は、新たな走行経路が生成された場合は該新たな走行経路に沿って車両を走行させる。
2020070822.tif 000002
【特許請求の範囲】
【請求項１】
駐車を行う車両の周辺情報を検知し、前記車両が駐車可能な駐車空間を検知する周辺検知部と、
前記車両の現在位置から前記周辺検知部で検知された前記駐車空間までの走行経路を生成する駐車経路生成部と、
前記走行経路に沿って前記駐車空間まで前記車両を走行させる走行制御部と、
前記車両の周辺の障害物を検知する障害物検知部と、
前記走行制御部が前記走行経路に沿って前記駐車空間まで前記車両を走行させている際に、前記障害物検知部が前記走行経路上に前記障害物を検知した場合、前記車両と前記障害物との衝突を回避して、前記駐車空間に前記車両を駐車させる新たな走行経路を生成する駐車経路再生成部と、を備え、
前記走行制御部は、前記新たな走行経路が生成された場合は、該新たな走行経路に沿って前記車両を走行させる、駐車支援装置。
【請求項２】
前記周辺検知部が複数の駐車空間を検知した場合または前記車両を複数台駐車可能な広い駐車空間を検知した場合であって、
前記走行制御部が前記走行経路に沿って前記駐車空間まで前記車両を走行させている際に、前記障害物検知部が前記走行経路上に前記障害物を検知した場合、
前記駐車経路再生成部は、
前記車両と前記障害物との衝突を回避して、前記複数の駐車空間または前記広い駐車空間に前記車両を駐車させる複数の走行経路を生成し、
前記駐車経路再生成部と前記走行制御部との間に設けられ、前記駐車経路再生成部で生成された前記複数の走行経路から前記新たな走行経路を決定する駐車経路決定部を備える、請求項１記載の駐車支援装置。
【請求項３】
前記複数の走行経路のそれぞれは、
前記車両と前記障害物との衝突を回避すると共に、前記複数の駐車空間または前記広い駐車空間に対して、目標舵角が小さくステアリングの据え切りが生じない走行経路として生成され、
前記駐車経路決定部は、
前記複数の走行経路から、目標舵角が最も小さい走行経路を選択することで前記新たな走行経路を決定する、請求項２記載の駐車支援装置。
【請求項４】
前記走行制御部は、
前記障害物検知部が前記障害物を検知した場合、前記障害物の手前で前記車両を停車させる、請求項１記載の駐車支援装置。
【請求項５】
前記駐車経路再生成部は、
前記障害物検知部が前記障害物を検知して前記車両が停車した後、予め定めた時間が経過した後に、前記周辺検知部で検知された前記周辺情報に基づいて前記新たな走行経路を生成する、請求項１記載の駐車支援装置。
【請求項６】
前記駐車経路再生成部は、
前記障害物検知部が前記障害物を検知して前記車両が停車した後、予め定めた時間が経過した後に、前記周辺検知部で検知された前記周辺情報に基づいて前記複数の走行経路を生成する、請求項２記載の駐車支援装置。
【請求項７】
前記駐車経路生成部で生成された前記走行経路および前記駐車経路再生成部で生成された前記新たな走行経路を表示する表示部をさらに備える、請求項１記載の駐車支援装置。
【請求項８】
前記駐車経路生成部で生成された前記走行経路および前記駐車経路決定部で決定された前記新たな走行経路を表示する表示部をさらに備える、請求項２記載の駐車支援装置。
【請求項９】
前記表示部は、
表示された前記走行経路の採用の可否を選択可能に構成される、請求項７または請求項８記載の駐車支援装置。
【請求項１０】
前記周辺検知部が複数の駐車空間を検知した場合または前記車両を複数台駐車可能な広い駐車空間を検知した場合に、駐車空間を選択可能とする駐車位置入力部をさらに備える、請求項１記載の駐車支援装置。
【請求項１１】
前記周辺検知部が前記複数の駐車空間を検知した場合または前記広い駐車空間を検知した場合に、駐車空間を選択可能とする駐車位置入力部をさらに備える、請求項２記載の駐車支援装置。
【請求項１２】
前記障害物検知部は、
前記車両から前記障害物までの距離に基づいて、路面上において前記障害物がどのように存在するかを、二次元グリッド状のマップを用いて検知する、請求項１記載の駐車支援装置。
【請求項１３】
（ａ）駐車を行う車両の周辺情報を検知し、前記車両が駐車可能な駐車空間を検知するステップ、
（ｂ）前記車両の現在位置から前記ステップ（ａ）で検知された前記駐車空間までの走行経路を生成するステップと、
（ｃ）前記走行経路に沿って前記駐車空間まで前記車両を走行させるステップと、
（ｄ）前記走行経路に沿って前記駐車空間まで前記車両を走行させている際に、前記走行経路上に障害物を検知したか否かを確認するステップと、
（ｅ）前記ステップ（ｄ）において前記走行経路上に前記障害物を検知した場合、前記車両と前記障害物との衝突を回避して、前記駐車空間に前記車両を駐車させる新たな走行経路を生成するステップと、
（ｆ）前記新たな走行経路が生成された場合は、該新たな走行経路に沿って前記車両を走行させるステップと、を備える駐車支援方法。
【請求項１４】
前記ステップ（ａ）において、複数の駐車空間を検知した場合または前記車両を複数台駐車可能な広い駐車空間を検知した場合であって、
前記ステップ（ｄ）において前記走行経路上に前記障害物を検知した場合、
前記ステップ（ｅ）は、
（ｅ−１）前記車両と前記障害物との衝突を回避すると共に、前記複数の駐車空間または前記広い駐車空間に前記車両を駐車させる複数の走行経路を生成するステップを含み、
前記ステップ（ｅ）の後、前記ステップ（ｆ）の前に、
（ｇ）前記複数の走行経路から前記新たな走行経路を決定するステップを備える、請求項１３記載の駐車支援方法。
【請求項１５】
前記ステップ（ｅ−１）は、
前記複数の走行経路のそれぞれを、
前記車両と前記障害物との衝突を回避すると共に、前記複数の駐車空間または前記広い駐車空間に対して、目標舵角が小さくステアリングの据え切りが生じない走行経路として生成するステップを含み、
前記ステップ（ｇ）は、
前記複数の走行経路から、目標舵角が最も小さい走行経路を選択することで前記新たな走行経路とするステップを含む、請求項１４記載の駐車支援方法。
【発明の詳細な説明】
【技術分野】
【０００１】
本発明は駐車支援装置に関し、特に、迅速な駐車を可能とする駐車支援装置に関する。
【背景技術】
【０００２】
例えば、特許文献１に開示される従来の駐車支援装置では、環境認識部が駐車しようとしている車両の周囲環境を認識する。次に、駐車経路生成部が環境認識部で認識された周囲環境に基づいて決定された駐車位置までの走行経路を生成する。そして、走行制御部が駐車経路生成部で生成された走行経路に沿って駐車位置まで車両を走行させる。【０００３】
特許文献１に開示される従来の駐車支援装置では、走行制御部が走行経路に沿って車両を走行させている過程において、例えば、衝突予測部が走行経路上に障害物を突然検知した場合、以下のように車両の駐車支援を行う。【０００４】
例えば、車両が走行経路の前進経路に沿って前方に直進している場合、衝突予測部は、車両の前進経路と歩行者の前進経路との交点で両者が衝突することを予想したとする。この予想に対し、従来の駐車支援装置の走行制御部は、当該交点から所定の余裕距離だけ手前の前進経路上の位置で、車両が停止するように車両の目標速度を低下させる。【０００５】
その後、衝突予測部が繰り返し歩行者と車両との衝突の有無を判断する。その判断の結果、車両と歩行者を含む障害物との衝突がない場合は、車両の走行制御部は自動駐車を再開する。
【先行技術文献】
【特許文献】
【０００６】
【特許文献１】特開２０１６−１８５７４５号公報
【発明の概要】
【発明が解決しようとする課題】
【０００７】
以上説明したように、従来の駐車支援装置では、走行制御部が走行経路に沿って車両を走行させている過程において、例えば、衝突予測部が走行経路上に障害物、例えば歩行者を突然検知した場合、障害物と車両との衝突回避を確認できるまで、車両は停止状態となり、車両の駐車完了までに時間を要すると言った問題があった。【０００８】
本発明は上記のような問題を解決するためになされたものであり、走行経路に沿って車両を走行させている過程において、車両の周辺に障害物を検知した場合、障害物と車両との衝突を回避すると共に、迅速に所定の駐車位置に車両を駐車させることが可能な駐車支援装置を提供することを目的とする。
【課題を解決するための手段】
【０００９】
本発明に係る駐車支援装置は、駐車を行う車両の周辺情報を検知し、前記車両が駐車可能な駐車空間を検知する周辺検知部と、前記車両の現在位置から前記周辺検知部で検知された前記駐車空間までの走行経路を生成する駐車経路生成部と、前記走行経路に沿って前記駐車空間まで前記車両を走行させる走行制御部と、前記車両の周辺の障害物を検知する障害物検知部と、前記走行制御部が前記走行経路に沿って前記駐車空間まで前記車両を走行させている際に、前記障害物検知部が前記走行経路上に前記障害物を検知した場合、前記車両と前記障害物との衝突を回避して、前記駐車空間に前記車両を駐車させる新たな走行経路を生成する駐車経路再生成部と、を備え、前記走行制御部は、前記新たな走行経路が生成された場合は該新たな走行経路に沿って車両を走行させる。
【発明の効果】
【００１０】
本発明に係る駐車支援装置によれば、走行経路に沿って車両を走行させている際に、走行経路上に障害物を検知した場合、車両と障害物との衝突を回避して、駐車空間に車両を駐車させる新たな走行経路を生成するので、迅速に駐車空間に車両を駐車させることが可能となる。
【図面の簡単な説明】
【００１１】
【図１】本発明に係る実施の形態１の駐車支援装置の構成を示す機能ブロック図である。
【図２】本発明に係る実施の形態１の駐車支援装置の駐車支援処理を示すフローチャートである。
【図３】複数の車両が横に並ぶように区切られた駐車場の１つの駐車空間に自車両に駐車する場合の自車両の走行経路を示す図である。
【図４】駐車支援中に、自車両の後方に障害物が突然に現れた状況を示す図である。
【図５】２つの障害物が存在している周辺状況を模式的に示す図である。
【図６】測距センサとして超音波センサを用いた場合の二次元グリッドマップの生成処理を模式的に示す図である。
【図７】自車両が左斜め後方に後退した状態の周辺状況を模式的に示す図である。
【図８】測距センサとして超音波センサを用いた場合の二次元グリッドマップの生成処理を模式的に示す図である。
【図９】障害物が移動した場合の周辺状況を模式的に示す図である。
【図１０】測距センサとして超音波センサを用いた場合の二次元グリッドマップの生成処理を模式的に示す図である。
【図１１】走行経路上に障害物がない場合の目標車速制御の一例を示す図である。
【図１２】走行経路上に障害物がある場合の目標車速制御の一例を示す図である。
【図１３】自車両の一時停止状態から障害物が走行経路上を離れた状態を示す図である。
【図１４】生成された新たな走行経路により駐車支援を行う状況を示す図である。
【図１５】本発明に係る実施の形態１の変形例１の駐車支援装置の構成を示す機能ブロック図である。
【図１６】本発明に係る実施の形態１の変形例２の駐車支援装置の構成を示す機能ブロック図である。
【図１７】本発明に係る実施の形態２の駐車支援装置の構成を示す機能ブロック図である。
【図１８】本発明に係る実施の形態２の駐車支援装置の駐車支援処理を示すフローチャートである。
【図１９】複数の車両が横に並ぶように区切られた駐車場の２つの駐車空間の１つに自車両に駐車する場合の自車両の走行経路を示す図である。
【図２０】駐車支援中に、自車両の後方に障害物が突然に現れた状況を示す図である。
【図２１】障害物が走行経路上に留まり自車両が停止状態を継続するような状態を示す図である。
【図２２】本発明に係る実施の形態２の変形例１の駐車支援装置の構成を示す機能ブロック図である。
【図２３】本発明に係る実施の形態２の変形例２の駐車支援装置の構成を示す機能ブロック図である。
【図２４】本発明に係る実施の形態１および２の駐車支援装置を実現するハードウェア構成を示す図である。
【図２５】本発明に係る実施の形態１および２の駐車支援装置を実現するハードウェア構成を示す図である。
【発明を実施するための形態】
【００１２】
＜実施の形態１＞
図１は、本発明に係る実施の形態１の駐車支援装置１００の構成を示す機能ブロック図である。図１に示されるように駐車支援装置１００は、周辺検知部１０、駐車経路生成部２０、走行制御部３０、障害物検知部４０および駐車経路再生成部５０を備えている。
【００１３】
周辺検知部１０は、図示されない自車両の周囲を撮像する画像センサ（単眼カメラ、ステレオカメラを含む周辺監視カメラ）、ミリ波レーダ、レーザーレーダおよび超音波センサなどの測距センサの何れかまたは複数による測定結果に基づいて周辺情報を検知し、周辺情報に基づいて自車両が駐車可能な領域、すなわち駐車空間を検知し、検知結果を駐車経路生成部２０および駐車経路再生成部５０に入力する。
【００１４】
駐車経路生成部２０は、周辺検知部１０が検知した駐車空間に基づいて、自車両の現在位置から駐車空間までの走行経路である駐車経路を生成する。
【００１５】
走行制御部３０は、運転者の駐車支援開始操作等を受け、自車両が駐車経路生成部２０が生成した走行経路に沿って走行するように、アクセル、ブレーキを制御する駆動制御およびステアリング装置を制御する操舵制御などの駐車支援制御を行う。
【００１６】
障害物検知部４０は、図示されない自車両の周囲を撮像する画像センサ、ミリ波レーダ、レーザーレーダおよび超音波センサなどの測距センサの何れかまたは複数による測定結果に基づいて自車両周辺の障害物を検知する。
【００１７】
駐車経路再生成部５０は、障害物検知部４０が自車両の走行経路上に障害物を検知した場合、自車両と障害物との衝突を回避すると共に、駐車空間に自車両を駐車させる新たな走行経路を、周辺検知部１０が検知した駐車空間に基づいて生成（再生成）する。
【００１８】
次に自車両を駐車場の駐車枠内に後ろ向きに駐車する駐車支援シーンを例に採って、本実施の形態１の駐車支援装置１００の動作について説明する。
【００１９】
図２は、駐車支援装置１００の駐車支援処理を示すフローチャートであり、以下、このフローに沿って説明する。また、図３は、複数の車両ＶＣが横に並ぶように駐車枠線１０２で区切られた駐車場の１つの駐車空間に自車両ＯＶを駐車する場合の自車両の走行経路を示す図である。
【００２０】
図３に矢印で示すように自車両ＯＶは、駐車枠線１０２内に並列に駐車された複数の車両ＶＣの配列に対して平行な位置のＡ地点から前方のＢ地点まで直進した後、左側にカーブした後に直進してＣ地点まで進み、Ｃ地点から緩い曲線を描くようにバックしながら駐車空間であるＤ地点に達するような走行経路を採るものとする。
【００２１】
駐車を望む運転者が所定の駐車支援開始操作をすることで駐車支援処理が開始されると、運転者の運転により図３に示すＡ地点からＢ地点まで走行する間に周辺検知部１０が、上述した各種センサの何れかまたは複数による測定結果に基づいて駐車空間を検知する（ステップＳ１０１）。
【００２２】
駐車空間の検知方法としては、例えば、特許第６３６２７３８号公報に開示されるような方法を採ることができる。すなわち、周辺検知部１０は、自車両の周囲を撮像する画像センサとして、例えば、車両の前後左右に取り付けられた周辺監視カメラで撮像された映像を、自車両を上方から見た平面に貼り付けるように座標変換した後、互いに結合する画像処理を行うことで車両周辺映像を取得する。
【００２３】
そして、周辺検知部１０は、取得した車両周辺映像を用いて駐車空間を検知する。具体的には、自車両が駐車できる大きさの駐車枠線１０２が地面に描かれている状態が、車両周辺映像に十分鮮明に映されていた場合、その駐車枠線１０２を駐車空間と認識する。あるいは、自車両が駐車できる間隔を開けるように他車両が駐車している状態が、車両周辺映像に十分鮮明に映されていた場合、その駐車車両の間を駐車区画と認識する。また、駐車空間を検知する方法としては、超音波センサによる測定結果を用いて検知する方法が、例えば特開２０１７−８８１１２号公報に開示されているが、駐車区画の検知方法は特に限定されるものではない。
【００２４】
運転者は周辺検知部１０で検知された駐車空間に後ろ向きに駐車すべくＢ地点からＣ地点まで進み、Ｃ地点で停車する。この時点で再び所定の駐車支援開始操作をすることで、Ｃ地点が駐車支援開始位置となり、駐車経路生成部２０は、周辺検知部１０が検知した駐車空間に基づいてＣ地点からＤ地点までの走行経路を生成する（ステップＳ１０２）。
【００２５】
ここで走行経路とは、図３のＣ地点からＤ地点までの軌跡（曲率）のことである。走行経路を生成する方法として公知の技術を利用でき、例えば特開２０１７−８８１１２号公報および特許第６１２４９７７号公報に開示の技術を利用して走行経路（曲率）を生成することができるが、走行経路の生成方法は特に限定されるものではない。
【００２６】
なお、走行経路の生成時には、障害物検知部４０によって自車両周辺の障害物の有無を検知し、障害物が検知された場合は、当該障害物との衝突を回避するように走行経路を生成する。なお、障害物検知部４０については後にさらに説明する。
【００２７】
駐車経路生成部２０において走行経路を生成した後、走行制御部３０が駐車経路生成部２０で生成された走行経路に沿うように自車両の駆動制御および操舵制御を行う（ステップＳ１０３）。
【００２８】
走行経路に沿った駆動制御および操舵制御を行いながら障害物検知部４０は、自車両周辺の障害物の有無を検知し、自車両の走行経路の障害物の有無を判断する（ステップＳ１０４）。障害物の検知するセンサとしては、先に説明したように、自車両の周囲を撮像する画像センサ、ミリ波レーダ、レーザーレーダ、超音波センサなどの測距センサが挙げられるが、これらに限定されるものではなく、自車両の走行経路に存在する障害物が検知できるセンサであれば良い。
【００２９】
そして、ステップＳ１０４で障害物検知部４０が自車両の走行経路上に障害物があることを検知した場合（Ｙｅｓの場合）は、駐車経路再生成部５０は、自車両と障害物との衝突を回避して駐車空間に自車両を駐車させる走行経路を、周辺検知部１０が検知した駐車空間に基づいて生成する（ステップＳ１０５）。
【００３０】
一方、ステップＳ１０４で障害物検知部４０が自車両の走行経路上の障害物を検知しなかった場合（Ｎｏの場合）は、ステップＳ１０６に進み、走行制御部３０が駐車経路生成部２０で生成された走行経路に沿うように自車両の駆動制御および操舵制御を行う。
【００３１】
なお、障害物検知部４０が自車両の走行経路上に障害物があることを検知した場合は、走行制御部３０が障害物検知部４０から障害物の位置、障害物までの距離等の情報を受け、自車両を停車させる。そして、走行制御部３０は、停車中に駐車経路再生成部５０から生成された新たな走行経路を取得し、新たな走行経路に沿うように自車両の駆動制御および操舵制御を行う（ステップＳ１０６）。
【００３２】
なお、上述したステップＳ１０４以下の処理は、自車両が駐車空間に駐車されるまで繰り返して実行される。
【００３３】
次に、図４〜図１４を用いて、障害物検知部４０、駐車経路再生成部５０および走行制御部３０による障害物の回避動作の一例について説明する。
【００３４】
図４は、図３に示したＣ地点からＤ地点までの駐車支援中に、自車両ＯＶの後方に障害物ＯＢが突然に現れた状況を示している。
【００３５】
障害物検知部４０は、測距センサによって得られた測距値、すなわち自車両ＯＶから障害物ＯＢまでの距離に基づいて、路面上において障害物がどのように存在するかを二次元グリッド状のマップ（以下、二次元グリッドマップと呼称）を用いて検知する。以下、二次元グリッドマップの生成処理の例を図５〜図１０を用いて説明する。
【００３６】
図５は２つの障害物ＯＢ１およびＯＢ２が存在している周辺状況を模式的に示す図であり、図６は図５の周辺状況において測距センサとして超音波センサを用いた場合の二次元グリッドマップの生成処理を模式的に示す図である。
【００３７】
図５に示すように、自車両ＯＶに並行して自車両ＯＶよりも長い障害物ＯＢ１が存在し、また、自車両ＯＶの後方に自車両ＯＶより小さな障害物ＯＢ２が存在している。そして、自車両ＯＶ、障害物ＯＢ１およびＯＢ２を含む処理領域はグリッドで区分されて、二次元グリッドマップとなっている。各グリッドには、後に説明する信頼度の数値が予め設定されている。
【００３８】
超音波センサは、検知対象である物体に送信波を照射し、物体までの最短距離に相当する物体上の反射点位置で反射した反射波を受信して、照射した送信波との時間差に基づいて信号処理を行い、物体までの距離を測距センサ検知距離としてする。なお、この場合、測距センサによって得られるのは物体までの距離のみであり、物体の方向は検出されない。
【００３９】
そのため、複数の超音波センサを車両の各部に配置し、測距センサ検知範囲を、図６に示すように測距センサの取り付け位置から扇形に拡がる範囲と仮定して二次元グリッドマップを生成することで、物体の二次元的な位置を検出する。
【００４０】
二次元グリッドマップの生成処理を以下に説明する。先に説明したように測距センサ検知距離は物体までの最短距離として得られるため、測距センサ検知距離を半径とした扇形の測距センサ検知範囲の円弧が接する二次元マップ上のグリッド、すなわち図６上の黒色のグリッドの信頼度を高くする。すなわち、各グリッドには、信頼度の数値、例えば４０が予め設定されており、その値を、例えば１００を上限として高くするように任意の値を加算する。
【００４１】
また、測距センサ検知距離未満には物体が存在しないと考えられるため、測距センサ検知範囲内のグリッド、すなわち図６上の砂地のハッチングを付したグリッドの信頼度を低くする。すなわち、各グリッドに予め設定された信頼度の数値、例えば４０を、０を下限として低くするように任意の値を減算する。
【００４２】
なお、図６では、障害物ＯＢ１およびＯＢ２の何れも検知しなかった測距センサの測距範囲も扇型の範囲で示しているが、その測距範囲の円弧は測距センサの最大検出距離を表している。
【００４３】
このように二次元グリッドマップの生成処理は、測距センサ検知距離に基づいて、各グリッドの信頼度の加算および減算を繰り返す処理である。この処理の結果、信頼度が所定のしきい値以上であれば障害物が存在するグリッドとし、しきい値未満であれば、障害物が存在しないグリッドとする。なお、このしきい値は任意に設定することができ、上述したように、信頼度の最大値が１００であるならば、しきい値は例えば８０とする。
【００４４】
このように二次元グリッドマップを使用することによって障害物の有無を判定する方法においては、グリッドに予め設定される信頼度の値、加算および減算する値、信頼度の上限値、下限値などは上記に限定されるものではなく、また、グリッドの信頼度の計算方法も加算および減算に限定されるものではない。障害物の有無を判定することができるのであれば、どのような方法を用いても良い。
【００４５】
図７は、図５に示した状態から自車両ＯＶが左斜め後方に後退した状態の周辺状況を模式的に示す図であり、図８は図７の周辺状況において測距センサとして超音波センサを用いた場合の二次元グリッドマップの生成処理を模式的に示す図である。
【００４６】
図８に示すように自車両ＯＶが位置および向きを変更した場合でも、二次元グリッドマップの各グリッドの信頼度を更新することにより、信頼度の高いグリッドを特定して障害物の検知が可能である。
【００４７】
また、二次元グリッドマップでは自車両だけでなく、障害物が移動した場合でも障害物の検知が可能である。図９は、図５に示した状態から障害物ＯＢ２が右斜め上方に移動した状態の周辺状況を模式的に示す図であり、図１０は図９の周辺状況において測距センサとして超音波センサを用いた場合の二次元グリッドマップの生成処理を模式的に示す図である。
【００４８】
図１０に示すように障害物ＯＢ２が位置および向きを変更した場合でも、二次元グリッドマップの各グリッドの信頼度を更新することにより、信頼度の高いグリッドを特定することにより障害物の移動を検知することが可能である。
【００４９】
走行制御部３０は走行経路上に障害物がないと障害物検知部４０が判断した場合、駐車経路生成部２０が生成した走行経路に沿って移動するように目標車速と目標舵角とを決定し、目標舵角を操舵装置に出力して操舵制御し、目標車速を駆動装置に出力して駆動制御する。
【００５０】
図１１は、自車両ＯＶの走行経路上に障害物がないと障害物検知部４０が判断した場合に走行制御部３０により実施される目標車速制御の一例を示す図である。
【００５１】
図１１の横軸は、走行経路に沿った位置（ｍ）を表し、縦軸はその位置での目標車速（ｋｍ／ｈ）を表す。横軸の左端は図３に示したＣ地点の駐車支援開始位置である。
【００５２】
走行制御部３０は、図３に示したＤ地点の停車位置までの距離に応じて目標車速を制御し、停車位置手前の減速開始位置から徐々に目標車速を低下させ、自車両ＯＶを停車位置で停止させる。この場合、減速開始位置は停車位置のＸｍ手前とするなど予め任意に設定した位置とすれば良い。また、Ｃ地点からＤ地点までの距離は、駐車経路生成部２０が、Ｃ地点からＤ地点までの走行経路を生成する段階で求められている値を使用すれば良い。
【００５３】
一方、走行制御部３０は図４に示すように走行経路ＴＲ上に障害物ＯＢが突然に表れ、障害物検知部４０が走行経路上に障害物があると判断した場合、図４に示すように、障害物ＯＢの所定距離だけ手前の一時停車位置に自車両ＯＶを停車させるので、障害物ＯＢとの衝突を回避することができる。
【００５４】
図１２は、自車両ＯＶの走行経路上に障害物が突然に表れた場合に走行制御部３０により実施される目標車速制御の一例を示す図である。
【００５５】
図１２の横軸は、走行経路に沿った位置（ｍ）を表し、縦軸はその位置での目標車速（ｋｍ／ｈ）を表す。横軸の左端は図１２に示したＣ地点の駐車支援開始位置である。
【００５６】
走行制御部３０は、障害物の位置から任意に設定された余裕距離だけ手前の一時停車位置で自車両ＯＶを停止させるように目標車速を低下させる。
【００５７】
図１３は、図４の自車両ＯＶの一時停止状態から障害物ＯＢが走行経路ＴＲ上を離れた状態を示す図である。図１３に示すように、障害物ＯＢが走行経路ＴＲ上を離れることで二次元グリッドマップが図１０に示されるように更新されると、障害物検知部４０は走行経路上に障害物がないと判断する。
【００５８】
走行制御部３０は走行経路上に障害物がないと障害物検知部４０が判断したことで、駐車経路生成部２０が生成した走行経路に沿って移動するように目標舵角を操舵装置に再出力し、目標車速を駆動装置に再出力することで駐車支援を再開する。
【００５９】
一方、障害物が走行経路上に留まり自車両が停止状態を継続するような場合は、駐車経路再生成部５０が、自車両の停止状態が予め定めた時間、例えば３秒経過後に、障害物を避けるような新たな走行経路を生成する処理に入るので、車両の駐車完了までに要する時間を短縮することができる。
【００６０】
図１４は、生成された新たな走行経路ＴＲ１により駐車支援を行う状況を示しており、図１４に示される新たな走行経路ＴＲ１は、障害物との衝突を回避し、かつ、乗り心地の観点から目標舵角が小さく、ステアリングの据え切りが生じないような走行経路となるように生成されている。
【００６１】
走行制御部３０は駐車経路再生成部５０が生成した走行経路に沿って移動するように目標舵角を操舵装置に出力し、目標車速を駆動装置に出力することで駐車支援を再開するので、迅速に駐車空間に車両を駐車させることが可能となる。
【００６２】
＜変形例１＞
図１５は、本発明に係る実施の形態１の変形例１の駐車支援装置１００Ａの構成を示す機能ブロック図である。なお、図１５においては、図１を用いて説明した駐車支援装置１００と同一の構成については同一の符号を付し、重複する説明は省略する。
【００６３】
図１５に示されるように駐車支援装置１００Ａは、図１を用いて説明した駐車支援装置１００の構成に加えて、駐車空間が選択可能である場合、例えば、駐車空間が複数箇所に存在する場合、あるいは複数台の車両が駐車可能な広い駐車空間が存在する場合は、ユーザが車両の駐車空間を選択できるように駐車位置入力部６０を備えている。
【００６４】
駐車位置入力部６０は、駐車経路生成部２０に接続され、駐車経路生成部２０は、走行経路の生成に際しては、駐車位置入力部６０を介して駐車空間が選択された場合は、当該駐車空間に基づいて、自車両の現在位置から駐車空間までの走行経路を生成する。
【００６５】
先に説明したように、周辺検知部１０が駐車空間を検知する際には、画像センサで取得された映像を用いて画像処理により自車両を上方から見た車両周辺映像を取得するので、当該車両周辺映像をＨＭＩ（Human Machine Interface）の機能を有する駐車位置入力部６０に設けられたタッチパネル機能付き表示装置などに表示することで、ユーザが表示された車両周辺映像の中から所望の駐車空間をタッチすることで、ユーザが車両の駐車空間を設定できる。このため、ユーザの好みに合った駐車空間を選択できるなど、ユーザの便宜を図ることができる。
【００６６】
なお、この操作は、自車両が図３に示したＣ地点まで移動し、ユーザ、例えば運転者が、所定の駐車支援開始操作をした際に駐車位置入力部６０に設けられたタッチパネル機能付き表示装置などに表示された段階で行うようにすれば良い。
【００６７】
なお、上記では駐車位置入力部６０がＨＭＩ機能を有しタッチパネルを操作することでユーザが車両の駐車空間を選択する構成としているが、駐車空間が選択できるのであれば駐車空間の選択方法はこれに限定されない。
【００６８】
＜変形例２＞
図１６は、本発明に係る実施の形態１の変形例２の駐車支援装置１００Ｂの構成を示す機能ブロック図である。なお、図１６においては、図１を用いて説明した駐車支援装置１００と同一の構成については同一の符号を付し、重複する説明は省略する。
【００６９】
図１６に示されるように駐車支援装置１００Ｂは、図１を用いて説明した駐車支援装置１００の構成に加えて、走行経路を表示する駐車経路表示部７０を備えている。駐車経路表示部７０は、駐車経路再生成部５０と駐車経路生成部２０に接続されている。
【００７０】
駐車経路再生成部５０で生成された新たな走行経路および駐車経路生成部２０で生成された走行経路を、ＨＭＩの機能を有する駐車経路表示部７０に設けられたタッチパネル機能付き表示装置などに表示することで、ユーザに知らせることが可能となる。
【００７１】
先に説明したように、周辺検知部１０が駐車空間を検知する際には、画像センサで取得された映像を用いて画像処理により自車両を上方から見た車両周辺映像を取得するので、当該車両周辺映像に重畳させて走行経路を表示することができる。ユーザ、例えば運転者は、当該走行経路を確認して、問題なければタッチパネルを介して承認を与えるなどの選択を行うことができ、安全性を高めることができる。
【００７２】
なお、上記では駐車経路表示部７０がＨＭＩ機能を有し、タッチパネルを操作することでユーザが走行経路の承認を与える構成としているが、走行経路を表示できるのであれば、ＨＭＩ機能を有していなくても良い。
【００７３】
なお、駐車経路表示部７０は、図１６を用いて説明した駐車位置入力部６０のタッチパネル機能付き表示装置と兼用しても良い。
【００７４】
＜実施の形態２＞
図１７は、本発明に係る実施の形態２の駐車支援装置２００の構成を示す機能ブロック図である。なお、図１７においては、図１を用いて説明した駐車支援装置１００と同一の構成については同一の符号を付し、重複する説明は省略する。
【００７５】
図１７に示されるように駐車支援装置２００は、図１を用いて説明した駐車支援装置１００の駐車経路再生成部５０に替えて、障害物検知部４０が自車両の走行経路上に障害物を検知した場合、自車両と障害物との衝突を回避すると共に、駐車空間が複数箇所に存在する場合、あるいは複数台の車両が駐車可能な広い駐車空間が存在する場合は、複数の駐車空間または広い駐車空間に対して、目標舵角が小さくステアリングの据え切りが生じないような複数の走行経路を生成する駐車経路再生成部９０を備えている。また、図１を用いて説明した駐車支援装置１００の構成に加えて、駐車経路再生成部９０で生成された複数の走行経路から、目標舵角が最も小さい走行経路を選択することで新たな走行経路を決定する駐車経路決定部８０を備えている。
【００７６】
次に自車両を駐車場の駐車枠内に後ろ向きに駐車する駐車支援シーンを例に採って、本実施の形態２の駐車支援装置２００の動作について説明する。
【００７７】
図１８は、駐車支援装置２００の駐車支援処理を示すフローチャートであり、以下、このフローに沿って説明する。また、図１９は、複数の車両ＶＣが横に並ぶように駐車枠線１０２で区切られた駐車場の２つの駐車空間の１つに自車両ＯＶを駐車する場合の自車両の走行経路を示す図である。
【００７８】
図１９に矢印で示すように自車両ＯＶは、駐車枠線１０２内に並列に駐車された複数の車両ＶＣの配列に対して平行な位置のＡ地点から前方のＢ地点まで直進した後、左側にカーブした後に直進してＣ地点まで進み、Ｃ地点から緩い曲線を描くようにバックしながら駐車空間であるＤ地点に達するような走行経路を採るものとする。
【００７９】
なお、図１８に示すフローチャートにおいては、ステップＳ２０１〜Ｓ２０４の動作は、図２に示した実施の形態１のフローチャートのステップＳ１０１〜Ｓ１０４の動作と基本的に同じであるので説明は省略する。ただし、ステップＳ２０１においては、周辺検知部１０が複数の駐車空間を検知し、ステップＳ２０２においては、駐車経路生成部２０は、周辺検知部１０が検知した複数の駐車空間のうち目標舵角が小さく容易に駐車できる走行経路を生成することとなる。
【００８０】
駐車を望む運転者が所定の駐車支援開始操作をすることで駐車支援処理が開始され、ステップＳ２０１〜Ｓ２０４を経た後、ステップＳ２０４で障害物検知部４０が自車両の走行経路上に障害物があることを検知した場合（Ｙｅｓの場合）は、駐車経路再生成部９０は、自車両と障害物との衝突を回避して駐車空間に自車両を駐車させる走行経路を、周辺検知部１０が検知した駐車空間に基づいて生成（再生性）する（ステップＳ２０５）。この場合、複数の駐車空間が検知されているので、周辺検知部１０が検知した複数の駐車空間に対して、目標舵角が小さくステアリングの据え切りが生じないような複数の走行経路を生成する。
【００８１】
駐車経路決定部８０は、駐車経路再生成部９０で生成された複数の走行経路のうち、目標舵角が最も小さい走行経路を選択することで新たな走行経路を決定する（ステップＳ２０６）。
【００８２】
一方、ステップＳ２０４で障害物検知部４０が自車両の走行経路上の障害物を検知しなかった場合（Ｎｏの場合）は、ステップＳ２０７に進み、走行制御部３０が駐車経路生成部２０で生成された走行経路に沿うように自車両の駆動制御および操舵制御を行う。
【００８３】
なお、障害物検知部４０が自車両の走行経路上に障害物があることを検知した場合は、走行制御部３０が障害物検知部４０から障害物の位置、障害物までの距離等の情報を受け、自車両を停車させる。そして、走行制御部３０は、停車中に駐車経路決定部８０から決定された新たな走行経路を取得し、新たな走行経路に沿うように自車両の駆動制御および操舵制御を行う（ステップＳ２０７）。
【００８４】
なお、上述したステップＳ２０４以下の処理は、自車両が駐車空間に駐車されるまで繰り返して実行される。
【００８５】
次に、図２０および図２１を用いて、障害物検知部４０、駐車経路決定部８０、駐車経路再生成部９０および走行制御部３０による障害物の回避動作の一例について説明する。
【００８６】
図２０は、図１９に示したＣ地点からＤ地点までの駐車支援中に、自車両ＯＶの後方に障害物ＯＢが突然に現れた状況を示している。
【００８７】
先に説明したように、障害物検知部４０は、測距センサによって得られた測距値、すなわち自車両ＯＶから障害物ＯＢまでの距離に基づいて、路面上において障害物がどのように存在するかを二次元グリッドマップを用いて検知する。
【００８８】
走行制御部３０は図１９に示すように走行経路ＴＲ上に障害物ＯＢが突然に表れ、障害物検知部４０が走行経路上に障害物があると判断した場合、図２０に示すように、障害物ＯＢの所定距離だけ手前で自車両ＯＶを停車させるので、障害物ＯＢとの衝突を回避することができる。この所定距離は、図１２を用いて説明したように、障害物の位置から任意に設定された余裕距離である。
【００８９】
図２１は、障害物ＯＢが走行経路ＴＲ上に留まり自車両ＯＶが停止状態を継続するような状態を示す図である。駐車経路再生成部９０は、自車両の停止状態が予め定めた時間、例えば３秒経過後に、障害物を避けるような走行経路を生成する処理に入るので、車両の駐車完了までに要する時間を短縮することができる。
【００９０】
この場合、複数の駐車空間が検知されているので、駐車経路再生成部９０は、周辺検知部１０が検知した複数の駐車空間に対して、目標舵角が小さくステアリングの据え切りが生じないような複数の走行経路を生成する。図２１には、一例として実線の走行経路ＴＲ１と破線の走行経路ＴＲ２が示されている。
【００９１】
駐車経路決定部８０は、駐車経路再生成部９０で生成された複数の走行経路のうち、目標舵角が最も小さい走行経路を選択して新たな走行経路として決定するので、図２１の走行経路ＴＲ１が新たな走行経路となる。
【００９２】
走行制御部３０は、停車中に駐車経路決定部８０から新たな走行経路を取得し、新たな走行経路に沿って移動するように目標舵角を操舵装置に出力し、目標車速を駆動装置に出力することで駐車支援を再開するので、駐車空間が複数箇所に存在する場合、あるいは複数台の車両が駐車可能な広い駐車空間が存在する場合でも迅速に駐車空間に車両を駐車させることが可能となる。
【００９３】
＜変形例１＞
図２２は、本発明に係る実施の形態２の変形例１の駐車支援装置２００Ａの構成を示す機能ブロック図である。なお、図２２においては、図１７を用いて説明した駐車支援装置２００と同一の構成については同一の符号を付し、重複する説明は省略する。
【００９４】
図２２に示されるように駐車支援装置２００Ａは、図１７を用いて説明した駐車支援装置２００の構成に加えて、ユーザが車両の駐車空間を選択できるように駐車位置入力部６０を備えている。
【００９５】
駐車位置入力部６０の構成および機能は、図１５を用いて説明した駐車支援装置１００Ａと同じであり説明は省略する。
【００９６】
ユーザが、駐車位置入力部６０に設けられたタッチパネル機能付き表示装置などに表示された車両周辺映像の中から所望の駐車空間をタッチすることで、ユーザが車両の駐車空間を設定できる。このため、ユーザの好みに合った駐車空間を選択できるなど、ユーザの便宜を図ることができる。
【００９７】
＜変形例２＞
図２３は、本発明に係る実施の形態２の変形例２の駐車支援装置２００Ｂの構成を示す機能ブロック図である。なお、図２３においては、図１７を用いて説明した駐車支援装置２００と同一の構成については同一の符号を付し、重複する説明は省略する。
【００９８】
図２３に示されるように駐車支援装置２００Ｂは、図１７を用いて説明した駐車支援装置２００の構成に加えて、走行経路を表示する駐車経路表示部７１を備えている。
【００９９】
駐車経路表示部７１は、駐車経路決定部８０と駐車経路生成部２０に接続され、駐車経路決定部８０で決定された新たな走行経路および駐車経路生成部２０で生成された走行経路を、ＨＭＩの機能を有する駐車経路表示部７１に設けられたタッチパネル機能付き表示装置などに表示することで、ユーザに知らせることが可能となる。
【０１００】
ユーザ、例えば運転者は、当該走行経路を確認して、問題なければタッチパネルを介して承認を与えるなどの選択を行うことができ、安全性を高めることができる。
【０１０１】
なお、駐車経路表示部７１は、図２２を用いて説明した駐車位置入力部６０のタッチパネル機能付き表示装置と兼用しても良い。
【０１０２】
以上説明した駐車支援装置１００および２００の構成はコンピュータを用いて構成することができ、これらの各構成はコンピュータがプログラムを実行することで実現される。すなわち、図１に示した駐車支援装置１００の周辺検知部１０、駐車経路生成部２０、走行制御部３０、障害物検知部４０および駐車経路再生成部５０、および図１７に示した駐車支援装置２００の周辺検知部１０、駐車経路生成部２０、走行制御部３０、障害物検知部４０、駐車経路決定部８０および駐車経路再生成部９０は、例えば図２４に示す処理回路１０００により実現される。処理回路１０００には、ＣＰＵ（Central Processing Unit）、ＤＳＰ（Digital Signal Processor）などのプロセッサが適用され、記憶装置に格納されるプログラムを実行することで上記各構成の機能が実現される。
【０１０３】
なお、処理回路１０００には専用のハードウェアが適用されても良い。処理回路１０００が専用のハードウェアである場合、処理回路１０００は、例えば、単一回路、複合回路、プログラム化したプロセッサ、並列プログラム化したプロセッサ、ＡＳＣＩ（Application Specific Integrated Circuit）、ＦＰＧＡ（Field Programmable Gate Array）またはこれらを組み合わせたものなどが該当する。
【０１０４】
また、図２５には、図１に示した駐車支援装置１００の各構成（周辺検知部１０、駐車経路生成部２０、走行制御部３０、障害物検知部４０および駐車経路再生成部５０）、および図１７に示した駐車支援装置２００の各構成（周辺検知部１０、駐車経路生成部２０、走行制御部３０、障害物検知部４０、駐車経路決定部８０および駐車経路再生成部９０）がプロセッサを用いて構成されている場合におけるハードウェア構成を示している。この場合、駐車支援装置１００および２００の各構成の機能は、ソフトウェア等（ソフトウェア、ファームウェア、またはソフトウェアとファームウェア）との組み合わせにより実現される。ソフトウェア等はプログラムとして記述され、メモリ１２０に格納される。処理回路１０００として機能するプロセッサ１１０は、メモリ１２０（記憶装置）に記憶されたプログラムを読み出して実行することにより、各部の機能を実現する。
【０１０５】
この発明は詳細に説明されたが、上記した説明は、すべての局面において、例示であって、この発明がそれに限定されるものではない。例示されていない無数の変形例が、この発明の範囲から外れることなく想定され得るものと解される。
【０１０６】
なお、本発明は、その発明の範囲内において、各実施の形態を自由に組み合わせたり、各実施の形態を適宜、変形、省略することが可能である。
【図１】
2020070822.tif 000003
【図２】
2020070822.tif 000004
【図３】
2020070822.tif 000005
【図４】
2020070822.tif 000006
【図５】
2020070822.tif 000007
【図６】
2020070822.tif 000008
【図７】
2020070822.tif 000009
【図８】
2020070822.tif 000010
【図９】
2020070822.tif 000011
【図１０】
2020070822.tif 000012
【図１１】
2020070822.tif 000013
【図１２】
2020070822.tif 000014
【図１３】
2020070822.tif 000015
【図１４】
2020070822.tif 000016
【図１５】
2020070822.tif 000017
【図１６】
2020070822.tif 000018
【図１７】
2020070822.tif 000019
【図１８】
2020070822.tif 000020
【図１９】
2020070822.tif 000021
【図２０】
2020070822.tif 000022
【図２１】
2020070822.tif 000023
【図２２】
2020070822.tif 000024
【図２３】
2020070822.tif 000025
【図２４】
2020070822.tif 000026
【図２５】
2020070822.tif 000027
【国際調査報告】
2020070822.tif 000028
2020070822.tif 000029
2020070822.tif 000030
2020070822.tif 000031