JP6167846B2 - Parking assistance device - Google Patents
Parking assistance device Download PDFInfo
- Publication number
- JP6167846B2 JP6167846B2 JP2013222374A JP2013222374A JP6167846B2 JP 6167846 B2 JP6167846 B2 JP 6167846B2 JP 2013222374 A JP2013222374 A JP 2013222374A JP 2013222374 A JP2013222374 A JP 2013222374A JP 6167846 B2 JP6167846 B2 JP 6167846B2
- Authority
- JP
- Japan
- Prior art keywords
- route
- parking
- vehicle
- marker
- unit
- Prior art date
- Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
- Active
Links
Images
Landscapes
- Control Of Driving Devices And Active Controlling Of Vehicle (AREA)
Description
本発明は、駐車支援装置に関する。 The present invention relates to a parking assistance device.
従来、車両の駐車経路を算出して駐車動作を支援する駐車支援装置が提案されている。例えば、下記の特許文献1に記載の駐車支援システムは、駐車の対象となる環境において目印となる指標を設定し、その指標との距離や方向に基づいて車両を誘導して駐車支援を行う。
2. Description of the Related Art Conventionally, a parking support device that supports a parking operation by calculating a parking path of a vehicle has been proposed. For example, the parking support system described in
特許文献1に記載の駐車支援システムでは、小石の存在、横風の発生、路面形状の経年劣化等の環境条件を原因として誘導中の車両の位置にズレが生じる可能性があり、ズレの生じ具合によっては指標を見失う可能性がある。その場合に、車両の位置を的確に検出できなくなることから駐車支援を適切に行うことができなくなってしまう可能性がある。
In the parking assistance system described in
そこで、本発明は、車両の位置を的確に検出できる経路を採用して駐車支援を適切に行うことができる駐車支援装置を提供することを目的とする。 Then, an object of this invention is to provide the parking assistance apparatus which employ | adopts the path | route which can detect the position of a vehicle exactly and can perform parking assistance appropriately.
上記目的を達成するために、本発明の一態様に係る駐車支援装置は、自車両を駐車位置に誘導する駐車支援を、当該駐車位置と異なるマーカーが予め設定されたマップ情報を用いて行うための駐車支援装置において、自車両の周辺状況を検出してマーカーを検出する周辺検出部と、周辺検出部によって検出されたマーカーと自車両との相対的な位置関係に基づいて自車両の現在位置を推定する位置推定部と、位置推定部によって推定された現在位置から駐車位置までの移動経路を算出する移動経路算出部と、移動経路算出部によって算出された移動経路上における自車両の進行方向と周辺検出部によるマーカー検出範囲とに基づいて、当該移動経路を進む自車両から周辺検出部によって検出可能なマーカーの個数を推定するマーカー推定部と、移動経路算出部によって算出された移動経路について、マーカー推定部によって推定されたマーカーの個数が規定数以上となる場合に、当該移動経路を駐車支援に用いる経路として採用する駐車支援部と、を備える。 In order to achieve the above object, the parking support apparatus according to one aspect of the present invention performs parking support for guiding the host vehicle to a parking position using map information in which a marker different from the parking position is set in advance. In the parking support apparatus, a surrounding detection unit that detects a surrounding situation of the own vehicle and detects a marker, and a current position of the own vehicle based on a relative positional relationship between the marker detected by the surrounding detection unit and the own vehicle A position estimation unit for estimating the travel route, a travel route calculation unit for calculating a travel route from the current position estimated by the position estimation unit to the parking position, and a traveling direction of the host vehicle on the travel route calculated by the travel route calculation unit And a marker estimation unit that estimates the number of markers that can be detected by the periphery detection unit from the vehicle traveling on the travel route based on the marker detection range by the periphery detection unit; For movement route calculated by the movement route calculating unit, when the number of markers estimated by the marker estimator becomes a specified value or more, the parking car support part you employed as a path using the moving path to the parking assist, Is provided.
この発明によれば、算出された移動経路上における自車両から検出可能なマーカーの個数に基づいて、算出された移動経路を駐車支援に用いる経路として採用するか否かを決定することにより、マーカーを見失う可能性の少ない移動経路が採用され易くなるため、車両の位置を的確に検出できる経路を採用して駐車支援を適切に行うことができる。 According to the present invention, the marker is determined based on the number of markers that can be detected from the host vehicle on the calculated moving route, by determining whether or not to adopt the calculated moving route as a route used for parking assistance. Since it is easy to adopt a travel route that has a low possibility of losing sight of the vehicle, it is possible to appropriately perform parking support by employing a route that can accurately detect the position of the vehicle.
また本発明の一態様に係る駐車支援装置において、位置推定部によって推定された現在位置に基づいて、自車両が駐車支援部によって採用された移動経路上に存在しないことが検出された場合に、当該自車両を当該移動経路上に誘導させるための修正経路を駐車支援に用いる経路として算出する修正経路算出部を更に備えてもよい。 Further, in the parking assistance device according to one aspect of the present invention, when it is detected that the host vehicle does not exist on the moving route adopted by the parking assistance unit based on the current position estimated by the position estimation unit, You may further provide the correction route calculation part which calculates the correction route for guiding the said own vehicle on the said movement route as a path | route used for parking assistance.
この場合、自車両が移動経路上に存在しないことが検出された場合に修正経路を算出することにより、自車両が移動経路上に存在しないことが検出されても、修正経路を用いて自車両を当該移動経路上に誘導させて駐車支援を適切に行うことができる。 In this case, even if it is detected that the host vehicle does not exist on the moving route by calculating the corrected route when it is detected that the own vehicle does not exist on the moving route, Can be guided on the moving route, and parking assistance can be appropriately performed.
また本発明の一態様に係る駐車支援装置において、マーカー推定部は、修正経路算出部によって算出された修正経路上における自車両の進行方向とマーカーを検出可能な範囲とに基づいて、当該修正経路を進む自車両から周辺検出部によって検出可能なマーカーの個数と、予め定められたマーカーの総数とに基づくマーカーの検出率を複数算出し、修正経路算出部は、修正経路に関して、マーカー推定部によって算出された全てのマーカーの検出率のうち最も低い値が所定の閾値より大きい修正経路を駐車支援に用いる経路として採用してもよい。 Further, in the parking assist device according to one aspect of the present invention, the marker estimation unit may perform the correction route based on the traveling direction of the host vehicle on the correction route calculated by the correction route calculation unit and the range in which the marker can be detected. A plurality of marker detection rates are calculated based on the number of markers that can be detected by the periphery detection unit from the vehicle traveling on the vehicle and a predetermined total number of markers. You may employ | adopt as a path | route used for parking assistance the correction path | route where the lowest value among the calculated detection rates of all the markers is larger than a predetermined threshold value.
この場合、修正経路を進む自車両から検出可能なマーカーの個数と予め定められたマーカーの総数とに基づくマーカーの検出率のうち最も低い値が所定の閾値より大きい修正経路を採用することにより、マーカーの検出率が所定の閾値以下であるためにマーカーを見失う可能性のある修正経路は採用されないようになるため、車両の位置を的確に検出できる経路を採用して駐車支援を適切に行うことができる。 In this case, by adopting a correction route in which the lowest value of the marker detection rate based on the number of markers that can be detected from the host vehicle traveling on the correction route and the predetermined total number of markers is greater than a predetermined threshold, Since the correction route that may cause the marker to be lost because the detection rate of the marker is below a predetermined threshold is not adopted, the route that can accurately detect the position of the vehicle is adopted and parking assistance is appropriately performed. Can do.
本発明によれば、車両の位置を的確に検出できる経路を採用して駐車支援を適切に行うことができる駐車支援装置を提供することができる。 ADVANTAGE OF THE INVENTION According to this invention, the parking assistance apparatus which employ | adopts the path | route which can detect the position of a vehicle exactly and can perform parking assistance appropriately can be provided.
以下、本発明の好適な実施形態について、図面を参照して詳細に説明する。なお、各図において同一又は相当部分には同一符号を付し、重複する説明を省略する。 DESCRIPTION OF EMBODIMENTS Hereinafter, preferred embodiments of the present invention will be described in detail with reference to the drawings. In addition, in each figure, the same code | symbol is attached | subjected to the same or an equivalent part, and the overlapping description is abbreviate | omitted.
図1に示されるように、本実施形態に係る駐車支援装置1は、自車両に備えられ、自車両を目的の駐車位置に誘導する駐車支援を実施するものである。駐車支援装置1は、一実施形態において、駐車位置と異なるマーカーが予め設定されたマップ情報(以下、駐車場マップ情報)を駐車場の入口等において取得し、目的の駐車位置までの移動経路を一又は複数算出する。そして、駐車支援装置1は、その移動経路上から検出可能なマーカーの個数に基づいて、算出されたその移動経路を採用するか否かを決定する。そして、駐車支援装置1は、採用が決定された移動経路に沿って自車両を誘導することによって駐車支援を実施する。なお、駐車支援装置1は、取得した駐車場マップ情報に対して改めてマーカーを設定することが可能である。また、駐車場マップ情報においては、自車両の駐車が可能な駐車位置が、予め示されていてもよく、駐車場マップ情報の取得後に設定されてもよい。また、目的の駐車位置は、自車両の駐車が可能な駐車位置の中から、ドライバによる選択が可能な構成としてもよく、駐車場マップ情報の取得時に既に決定されていてもよい。
As shown in FIG. 1, a
以下、駐車支援装置1の構成について説明する。図1に示されるように、駐車支援装置1は、装置を統括的に制御するECU[Electronic Control Unit]2を備えている。ECU2は、CPU[Central Processing Unit]、ROM[Read Only Memory]、RAM[Random Access Memory]などからなる電子制御ユニットである。ECU2では、ROMに記憶されているアプリケーションプログラムをRAMにロードし、CPUで実行することで、ACC[Adaptive Cruise Control]やブレーキアシスト等の走行制御に係る演算処理が行われる。ECU2は、通信部4、GPS[Global Positioning System]受信部5、周辺センサ6、及び車両センサ7と接続されている。また、ECU2は、車両制御部8及びHMI[Human Machine Interface]9と接続されている。
Hereinafter, the structure of the
通信部4は、例えば駐車場入口に設置された路側送受信機との間で無線通信を行う通信ユニットである。通信部4は、無線通信によって駐車場マップ情報を取得する。駐車場マップ情報は、例えば、駐車可能スペースの配置位置を示す配置状況、駐車場入口から駐車可能スペースまでの入庫通路、及び駐車可能スペースから駐車場出口までの出庫通路を示すマップ情報である。駐車可能スペースは、例えば、自車両の駐車が可能な位置として駐車場マップ情報において予め設定されている。駐車可能スペースには、自車両が実際に駐車しようとする目標の駐車位置が含まれている。通信部4は、取得した駐車場マップ情報をECU2に送信する。なお、通信部4は、駐車場マップ情報の取得後に、駐車可能スペースの配置位置を示す配置状況を無線通信によって別途取得することも可能である。
The
GPS受信部5は、複数のGPS衛星から送信されるGPS信号を受信することで、自車両の現在位置を検出するものである。GPS受信部5は、検出した自車両の現在位置に関する自車両位置情報をECU2に送信する。
The
周辺センサ6は、自車両の周辺状況を検出するセンサである。周辺センサ6は、ミリ波レーダや外部カメラ等の種々の機器から構成されている。周辺センサ6は、外部カメラにより駐車場の内部を逐次認識することで、自車両の現在地の推定に用いられる現在地情報を逐次取得する。また、周辺センサ6は、ミリ波レーダや外部カメラ等によって自車両Cの周囲に存在するマーカー及び駐車中の他車両を逐次認識することで、周辺情報を逐次取得する。自車両Cの正面前方を示す図2に示されるように、周辺センサ6は自車両Cの正面前方の略中央に設置される。そして、自車両Cを真上から見た俯瞰図を示す図3に示されるように、周辺センサ6は自車両Cの進行方向F前方の扇形状範囲のエリアAをセンシングして上述の現在地情報や周辺情報を取得することができる。図1に戻って、周辺センサ6は、取得した現在地情報や周辺情報の各種情報をECU2に送信する。周辺センサ6は、特許請求の範囲に記載の周辺検出部として機能する。
The surrounding
車両センサ7は、自車両Cの挙動を検出するセンサである。車両センサ7は、車速センサ、ブレーキセンサ、加速度センサ、操舵センサ、及びアクセルセンサ等から構成されている。車両センサ7は、各種センサによって自車両Cの挙動に関する自車両挙動情報を取得する。この自車両挙動情報には、自車両Cの速度変化に関する自車両速度変化情報が含まれる。車両センサ7は、取得した自車両挙動情報をECU2に送信する。
The
車両制御部8は、自車両Cの走行制御を実施する制御ユニットである。車両制御部8は、スロットルバルブアクチュエータ、ブレーキアクチュエータ、及びステアリングアクチュエータ等の各種アクチュエータを有している。車両制御部8は、ECU2からの駐車支援信号に応じて各種アクチュエータを駆動させ、自車両Cの走行制御を実施する。
The
HMI9は、自車両Cの運転者に対する情報提供を行う設備である。HMI9は、音声情報を出力するスピーカや映像情報を出力するモニタを備えている。HMI9は、ECU2からの駐車支援信号に応じて自車両Cの走行に利用される各種情報を運転者に提供する。
The
ECU2は、位置推定部11、移動経路算出部12、マーカー推定部13、駐車支援部14、及び修正経路算出部15を有している。
The
位置推定部11は、通信部4から送信された駐車場マップ情報と、GPS受信部5から送信された自車両位置情報と、周辺センサ6から送信された各種情報と、車両センサ7から送信された自車両挙動情報とに基づいて、自車両の現在位置を推定する。より詳しくは、位置推定部11は、まず、それら受信した情報に基づいて、駐車場入口から駐車可能スペースまでの入庫通路の両側、駐車可能スペースの周囲、及び駐車可能スペースから駐車場出口までの出庫通路の両側を含むマップに、マーカーを等間隔で複数設定する。各マーカーは、一意に識別可能なIDを有している。なお、マーカーは、マップ上に仮想的に設定されるものであってもよい。また、カラーコーン(登録商標)といった駐車場内で目印となり得る物体を、仮想的なマーカーとして設定してもよい。
The
そして、位置推定部11は、周辺センサ6から送信された各種情報に基づいて、自車両の現在位置から検出可能なマーカーを検出する。そして、位置推定部11は、自車両と自車両周辺で検出された一又は複数のマーカーとの相対的な位置関係及びその変化に基づいて、自車両の現在位置を逐次推定する。例えば、位置推定部11は、周辺センサ6から送信された駐車場入口付近の様子と、駐車場マップ情報における駐車場入口付近において設定されたマーカーが検出可能な位置が自車両の現在位置であるという情報とに基づいて、自車両の現在位置は駐車場入口付近であると推定する。位置推定部11は、特許請求の範囲に記載の周辺検出部及び位置推定部として機能する。
And the
移動経路算出部12は、位置推定部11により推定された現在位置から所定の駐車位置までの移動経路を車両モデルにより一又は複数算出する。車両モデルによる移動経路の算出とは、自車両の車体やタイヤのサイズといった自車両の特徴が考慮された仮想の車両をモデルとして移動経路を算出することである。所定の駐車位置は、他車両が駐車していない駐車スペースの位置である。所定の駐車位置は、通信部4から送信された駐車場マップ情報と、GPS受信部5から送信された自車両位置情報と、周辺センサ6から送信された各種情報と、車両センサ7から送信された自車両挙動情報とに基づいて、移動経路算出部12によって決定される。
The movement
マーカー推定部13は、移動経路算出部12によって算出された複数の移動経路のそれぞれに関して、移動経路上の各ポイントにおける自車両から実際に検出可能なマーカーの個数を推定する。マーカー推定部13は、移動経路算出部12によって算出された移動経路のそれぞれに関して、移動経路を進む自車両の進行方向と、現在位置からマーカーを検出可能な範囲である検出エリアとに基づいて、上記の推定処理を行う。例えば、自車両Cを真上から見た俯瞰図を示す図5に示されるように、移動経路R上に存在する自車両Cの現在位置から実際に検出可能なマーカーの個数は4であるとして推定される。
The
また、マーカー推定部13は、後述の修正経路算出部15によって算出された修正経路上の複数のポイントのそれぞれにおける、位置推定部11によって検出可能と推定されるマーカーの個数と、予め定められたマーカーの総数とに基づいて、後述のマーカーの検出率を各ポイントで算出することが可能である。マーカー推定部13は、自車両の進行方向と、マーカーを検出可能な範囲である検出エリアとに基づいて、後述のマーカーの検出率を算出する。例えば、自車両Cを真上から見た俯瞰図を示す図4に示されるように、後述のズレ修正位置Pから実際に検出可能なマーカーの個数は3であるとして推定される。予め定められたマーカーの総数とは、例えば、自車両が駐車しようとする駐車場に関して設定されたマーカーの総数であってもよく、自車両の現在位置から検出可能なマーカーの総数であってもよい。マーカーの検出率は、例えば、位置推定部11によって検出可能なマーカーの個数を、予め定められたマーカーの総数で除することによって得られる。通常、各修正経路の各ポイントにおけるマーカーの検出率は各ポイントにおいて異なるため、各修正経路におけるマーカーの検出率は最低値及び最高値を有することになる。
In addition, the
駐車支援部14は、移動経路算出部12によって算出された移動経路について、マーカー推定部13によって推定されたマーカーの個数に基づいて、その移動経路を駐車支援に用いる経路として採用するか否かを決定する。例えば、駐車支援部14は、マーカー推定部13によって推定されたマーカーの個数が規定数以上となる移動経路を、駐車支援に用いる経路として採用することが可能である。その規定数は、駐車支援部14に予め記憶されているが、ドライバ等による変更設定が可能である。そして、駐車支援部14は、採用することが決定された移動経路及び後述の修正経路算出部15によって採用することが決定された修正経路に基づいて駐車支援を実施する。
Based on the number of markers estimated by the
なお、駐車支援部14は、移動経路及び修正経路に沿って自車両を走行制御させるための駐車支援信号を車両制御部8やHMI9に送信することで、駐車支援を実施する。駐車支援としては、ACCやブレーキアシスト、モータ等のアクチュエータによる自車両Cの旋回及びそれに伴う加減速、運転者に対する情報提供等がある。例えば、自車両Cを真上から見た俯瞰図を示す図5に示されるように、位置推定部11によって上述のエリアA内のマーカーMと自車両Cとの相対的な位置関係に基づいて自車両Cの現在地が特定されると、駐車支援部14は、移動経路算出部12によって算出された移動経路Rに沿って、駐車位置としての駐車枠T1〜T7のうち他車両が駐車していない位置に自車両Cを移動制御して駐車支援を実施する。
In addition, the
修正経路算出部15は、通信部4から送信された駐車場マップ情報と、GPS受信部5から送信された自車両位置情報と、周辺センサ6から送信された各種情報と、車両センサ7から送信された自車両挙動情報と、位置推定部11によって推定された現在位置とに基づいて、自車両が、駐車支援部14によって採用された移動経路上に存在せず誤差としてのズレが生じていることが検出された場合に、自車両を移動経路上に誘導させるための修正経路を車両モデルにより一又は複数算出することが可能である。例えば、自車両Cを真上から見た俯瞰図を示す図4に示されるように、自車両Cが移動経路R上に存在せず誤差としてのズレが生じていることが検出された場合に、修正経路算出部15は、自車両Cを移動経路上に誘導させるための修正経路S1,S2を、駐車支援に用いる経路として算出する。
The correction
そして、修正経路算出部15は、各修正経路に関して、マーカー推定部13によって推定されたマーカーの検出率に基づいて、算出した一又は複数の修正経路のそれぞれを採用するか否かを決定する。例えば、修正経路算出部15は、各修正経路に関して、マーカー推定部13によって算出された全てのマーカーの検出率の最低値が所定の閾値より大きい修正経路を採用する。所定の閾値は、修正経路算出部15に予め記憶されているが、ドライバ等による変更設定が可能である。
And the correction path |
更に、修正経路算出部15は、移動経路算出部12によって算出された移動経路上の複数のポイントと、修正経路算出部15によって算出された各修正経路上の対応する複数のポイントとの距離に関するパラメータである誤差パラメータの全ポイントにおける合計値を算出することが可能である。その距離に関する誤差パラメータは、例えば、移動経路上の複数のポイントと、各修正経路上の対応する複数のポイントとの距離を示す数値であってもよい。そして、修正経路算出部15は、全ポイントにおける誤差パラメータの合計値が最小となる修正経路を採用することが可能である。ここで、移動経路算出部12によって算出された移動経路上の複数のポイントとは、例えば、その移動経路を所定数に等分に区切るためのポイントのことであり、修正経路算出部15によって算出された修正経路上の対応する複数のポイントとは、その修正経路をその所定数に等分に区切るためのポイントのことである。
Further, the corrected
例えば、自車両Cを真上から見た俯瞰図を示す図4に示されるように、自車両Cが移動経路R上に存在せず誤差としてのズレが生じていることが検出された時点におけるズレ修正位置Pからの修正経路として、修正経路S1,S2が算出されたとする。以下、上述の所定数は2であるとして説明する。修正経路S1は、始点をズレ修正位置Pとし、移動経路R上のポイントP12で移動経路Rと接しており、このポイントP12を修正経路S1終点とする。また、修正経路S2は、始点をズレ修正位置Pとし、移動経路R上のポイントP22で移動経路Rと接しており、このポイントP22を修正経路S2の終点とする。修正経路S1上にはポイントP12の他に修正経路S1の中点となるズレ修正位置P11(上述の等分に区切るためのポイント)が設定されており、修正経路S2上にはポイントP22の他に修正経路S2の中点となるズレ修正位置P21(上述の等分に区切るためのポイント)が設定されている。また、移動経路R上には、ズレ修正位置Pに最も近い(即ちズレ修正位置Pに対応する)ポイントP0と、ズレ修正位置P11に最も近い(即ちズレ修正位置P11に対応する)ポイントP1と、ズレ修正位置P21に最も近い(即ちズレ修正位置P21に対応する)ポイントP2とが設定されている。修正経路算出部15は、修正経路S1に関して、ズレ修正位置PとポイントP0との距離とズレ修正位置P11とポイントP1との距離との合計値SUM1を算出する。ズレ修正位置(例:ズレ修正位置P)とポイント(例:ポイントP0)との距離を示す誤差パラメータDは、下記式(1)により算出される。ここで、nは、上述の所定数(ズレ修正位置とポイントとの組み合わせの個数)から1を引いた数であり、xi及びyiは上述のポイントのx座標及びy座標であり、xnow及びynowは対応するズレ修正位置のx座標及びy座標である。
同様に、修正経路算出部15は、修正経路S2に関して、ズレ修正位置PとポイントP0との距離とズレ修正位置P21とポイントP2との距離との合計値SUM2を算出する。そして、修正経路算出部15は、合計値SUM1と合計値SUM2の中で最小となる合計値(ここでは合計値SUM1)の修正経路(ここでは修正経路S1)を採用する。
For example, as shown in FIG. 4 that shows an overhead view of the host vehicle C viewed from directly above, at the time when it is detected that the host vehicle C does not exist on the movement route R and a deviation as an error occurs. It is assumed that correction paths S1 and S2 are calculated as correction paths from the displacement correction position P. Hereinafter, description will be made assuming that the predetermined number is two. The correction route S1 has a start point as a displacement correction position P, is in contact with the movement route R at a point P12 on the movement route R, and this point P12 is an end point of the correction route S1. The correction route S2 has a start point as a displacement correction position P, is in contact with the movement route R at a point P22 on the movement route R, and this point P22 is an end point of the correction route S2. On the correction path S1, in addition to the point P12, a misalignment correction position P11 (a point for dividing into the above-mentioned equal parts) is set as the midpoint of the correction path S1, and other than the point P22 on the correction path S2. Is set to the misalignment correction position P21 (the point for dividing into the above-mentioned equal parts), which is the midpoint of the correction path S2. On the movement route R, a point P0 closest to the displacement correction position P (ie, corresponding to the displacement correction position P) and a point P1 closest to the displacement correction position P11 (ie, corresponding to the displacement correction position P11) The point P2 closest to the deviation correction position P21 (that is, corresponding to the deviation correction position P21) is set. The correction
Similarly, the correction
次に、上述したECU2の処理の流れについて図面を参照して説明する。
Next, the process flow of the
図6に示されるように、ECU2では、まず位置推定部11が、自車両の現在位置を推定し、移動経路算出部12が、現在位置から駐車位置までの移動経路を複数算出した後に、修正経路算出部15が、自車両が移動経路上に存在せず誤差としてのズレが発生している場合にそれを検知する(ステップS01)。そして、修正経路算出部15が、自車両を移動経路上に誘導させるための修正経路を一又は複数算出する(ステップS03)。
As shown in FIG. 6, in the
次に、マーカー推定部13が、修正経路のそれぞれに関して、修正経路上における自車両から実際に検出可能なマーカーの個数を推定し、修正経路上の複数のポイントのそれぞれにおける、検出可能なマーカーの個数と、予め定められたマーカーの総数とに基づいて、マーカーの検出率を算出する(ステップS05)。ここで、修正経路算出部15が、各修正経路に関して、マーカーの検出率の最低値が所定の閾値以下であるか否かを判定する(ステップS07)。マーカーの検出率の最低値が所定の閾値以下である修正経路が存在する場合、該当の修正経路は破棄され不採用になる(ステップS09)。
Next, the
一方、マーカーの検出率の最低値が所定の閾値より大きい修正経路が存在する場合、修正経路算出部15は、その残った修正経路のそれぞれに関して、全ポイントにおける誤差パラメータの合計値を算出する(ステップS11)。次に、修正経路算出部15が、全ポイントにおける誤差パラメータの合計値が最小となる修正経路を採用する(ステップS13)。そして、駐車支援部14が、採用することが決定された移動経路及び修正経路算出部15によって採用することが決定された修正経路に沿って自車両Cを制御することによって、駐車支援を実施する(ステップS15)。そして、一連の処理が終了する。
On the other hand, when there is a correction path having a minimum marker detection rate greater than a predetermined threshold, the correction
続いて、上述した駐車支援装置1の作用効果について説明する。
Then, the effect of the
例えば、自車両Cを真上から見た俯瞰図を示す図4に示されるように、強風や突風の発生、小石等の存在等の突発的な外乱によって自車両Cが移動経路R上に存在せず誤差としてのズレが生じていることが検出されたとする。ここで、検出可能なマーカーの個数を考慮せずにそのズレだけを考慮して修正された経路を走行させるライントレース制御が行われると、自車両Dを真上から見た俯瞰図を示す図7に示されるように、本来その位置で向くはずのない向きに自車両Dが向いてしまうことで、マーカー検出範囲としてのエリアAにマーカーMが含まれず、検出可能なマーカーMが無くなってしまうことがある(又は、マーカーMの検出精度が低くなってしまうことがある)。 For example, as shown in FIG. 4 which shows an overhead view of the host vehicle C as viewed from directly above, the host vehicle C exists on the moving route R due to sudden disturbance such as generation of strong winds, gusts, or pebbles. Suppose that a deviation as an error is detected. Here, a diagram showing an overhead view of the host vehicle D as viewed from directly above when line trace control is performed to travel a route that has been corrected in consideration of only the deviation without considering the number of detectable markers. As shown in FIG. 7, when the host vehicle D is oriented in a direction that should not be directed at the position, the marker M is not included in the area A as the marker detection range, and the detectable marker M is lost. (Or the detection accuracy of the marker M may be lowered).
ここで、上述のライントレース制御が更に行われると、自車両Dを真上から見た俯瞰図を示す図8に示されるように、マーカー検出範囲としてのエリアAにマーカーMが含まれず、検出可能なマーカーMが無くなってしまう状態になる。この状態で改めて駐車位置までの移動経路R2が算出されても、検出可能なマーカーMが無い状態が継続したままであるため、自車両Dの存在位置の検出精度が更に低くなってしまうことがある。また、自車両Dと同様の駐車支援が行われる他車両が同じ駐車場に存在する場合、自車両Dとその他車両とが接触してしまうおそれがある。 Here, when the above-described line trace control is further performed, the marker M is not included in the area A as the marker detection range, as shown in FIG. 8 showing an overhead view when the host vehicle D is viewed from directly above. The possible marker M is lost. Even if the movement route R2 to the parking position is calculated again in this state, the state where there is no detectable marker M continues, and the detection accuracy of the position where the host vehicle D is present may be further lowered. is there. Moreover, when the other vehicle in which the parking assistance similar to the own vehicle D is performed exists in the same parking lot, there exists a possibility that the own vehicle D and another vehicle may contact.
また、自車両Cを真上から見た俯瞰図を示す図9に示されるように、検出可能なマーカーの個数を考慮せずに移動経路Rに沿って駐車枠T3に自車両Cを移動制御させても、実際の走行経路は、移動経路Rが進行方向に対して前後方向(図9におけるY軸方向)にズレた経路W1を自車両Cが走行する、又は、移動経路Rが進行方向に対して左右方向(図9におけるX軸方向)にズレた経路W2を自車両Cが走行する状態が発生してしまうおそれがある。 Further, as shown in FIG. 9 showing an overhead view of the host vehicle C viewed from directly above, the host vehicle C is controlled to move along the moving path R in the parking frame T3 without considering the number of detectable markers. Even if it is made, the actual travel route is that the host vehicle C travels on the route W1 in which the travel route R is shifted in the front-rear direction (Y-axis direction in FIG. 9) with respect to the travel direction, or the travel route R is the travel direction. On the other hand, there is a possibility that the vehicle C may travel on a route W2 that is shifted in the left-right direction (X-axis direction in FIG. 9).
これに対して、本実施形態に係る駐車支援装置1によれば、算出された移動経路R上における自車両Cから検出可能なマーカーMの個数に基づいて、算出された移動経路Rを駐車支援に用いる経路として採用するか否かを決定することにより、自車両Cの位置によってはマーカーを見失う可能性の少ない移動経路Rが採用され易くなるため、自車両Cの位置を的確に検出できる移動経路Rを採用して駐車支援を適切に行うことができる。この結果、駅前等の地価の高い場所を避け、その地価の高い場所から離れた地価の安い駐車場において、多数の車両を接触させることなく安全に詰め込んだ状態で駐車させる細密充填駐車が容易になる。
On the other hand, according to the
また、本実施形態に係る駐車支援装置1では、多くの地物をマーカーとして実際に自車両Cの周囲に設置することを必要としないため、管理費や維持費をかけずに低コストで、車両の存在位置の検出精度を高めることができる。また、突起物をマーカーとして実際に自車両Cの周囲に設置することを必要としないため、突起物と接触するようなことなく車両の存在位置の検出精度を高めることができる。更に、広範囲の様子を的確に検知可能なセンサは通常高価であるが、本実施形態に係る駐車支援装置1では、そのようなセンサを必要としないため、低コストで車両の存在位置の検出精度を高めることができる。
Moreover, in the
また、この駐車支援装置1によれば、自車両Cが移動経路R上に存在しないことが検出された場合に修正経路S1を算出することにより、自車両Cが移動経路上に存在しないことが検出されても、修正経路を用いて自車両Cをその移動経路R上に誘導させて駐車支援を適切に行うことができる。
Moreover, according to this
また、この駐車支援装置1によれば、修正経路を進む自車両Cから検出可能なマーカーの個数と予め定められたマーカーの総数とに基づくマーカーの検出率のうち最も低い値が所定の閾値より大きい修正経路を採用することにより、マーカーの検出率が所定の閾値以下であるためにマーカーを見失う可能性のある修正経路は採用されないようになるため、自車両Cの位置を的確に検出できる経路を採用して駐車支援を適切に行うことができる。
Further, according to the parking assist
なお、上述した実施形態は本発明に係る駐車支援装置の実施形態を説明したものであり、本発明に係る駐車支援装置は本実施形態に記載したものに限定されるものではない。本発明に係る駐車支援装置は、各請求項に記載した要旨を変更しないように実施形態に係る駐車支援装置を変形し、又は他のものに適用したものであってもよい。 In addition, embodiment mentioned above demonstrated embodiment of the parking assistance apparatus which concerns on this invention, and the parking assistance apparatus which concerns on this invention is not limited to what was described in this embodiment. The parking assistance device according to the present invention may be modified from the parking assistance device according to the embodiment or applied to other devices without changing the gist described in each claim.
例えば、上述した実施形態では、図3に示されるように、周辺センサ6は自車両Cの進行方向F前方の扇形状範囲のエリアAをセンシングして現在地情報や周辺情報を取得する構成としたが、周辺センサは自車両Cの前後左右を含む全方向の範囲のエリアをセンシングして現在地情報や周辺情報を取得する構成としてもよい。
For example, in the above-described embodiment, as shown in FIG. 3, the surrounding
また、上述した実施形態では、通信部4は、例えば駐車場入口に設置された路側送受信機との間で無線通信を行う構成としたが、通信部4を、自車両周辺の他車両との車々間通信を行う通信ユニットとする構成としてもよい。
In the above-described embodiment, the
また、上述した実施形態では、検出可能なマーカーの個数に基づいて経路の採用可否を決定しているが、例えば検出可能なマーカーの検出量といったような数量に基づいて経路の採用可否を決定してもよい。 In the above-described embodiment, whether or not a route is adopted is determined based on the number of detectable markers. However, whether or not a route can be adopted is determined based on a quantity such as the detected amount of a detectable marker. May be.
また、上述した実施形態では、駐車支援部14は、マーカー推定部13によって推定されたマーカーの個数が規定数以上となる移動経路を採用することが可能であるとしているが、マーカー推定部13が移動経路に関して上述のマーカーの検出率を複数算出し、駐車支援部14がマーカー推定部13によって推定されたマーカーの検出率の最低値が所定の閾値より大きい移動経路を採用してもよい。
In the above-described embodiment, the
本発明によれば、車両の位置を的確に検出できる経路を採用して駐車支援を適切に行うことができる駐車支援装置を提供することができる。 ADVANTAGE OF THE INVENTION According to this invention, the parking assistance apparatus which employ | adopts the path | route which can detect the position of a vehicle exactly and can perform parking assistance appropriately can be provided.
1…駐車支援装置、4…通信部、5…GPS受信部、6…周辺センサ、7…車両センサ、8…車両制御部、9…HMI、11…位置推定部、12…移動経路算出部、13…マーカー推定部、14…駐車支援部、15…修正経路算出部、A…エリア、C,D…自車両、F…進行方向、M…マーカー、P,P11,P21…ズレ修正位置、P0,P1,P2,P12,P22…ポイント、R,R2…移動経路、S1,S2…修正経路、T1〜T7…駐車枠、W1,W2…経路。
DESCRIPTION OF
Claims (3)
前記自車両の周辺状況を検出して前記マーカーを検出する周辺検出部と、
前記周辺検出部によって検出された前記マーカーと前記自車両との相対的な位置関係に基づいて前記自車両の現在位置を推定する位置推定部と、
前記位置推定部によって推定された前記現在位置から前記駐車位置までの移動経路を算出する移動経路算出部と、
前記移動経路算出部によって算出された前記移動経路上における前記自車両の進行方向と前記周辺検出部によるマーカー検出範囲とに基づいて、当該移動経路を進む前記自車両から前記周辺検出部によって検出可能な前記マーカーの個数を推定するマーカー推定部と、
前記移動経路算出部によって算出された前記移動経路について、前記マーカー推定部によって推定された前記マーカーの個数が規定数以上となる場合に、当該移動経路を前記駐車支援に用いる経路として採用する駐車支援部と、を備えた駐車支援装置。 In the parking support device for performing parking support for guiding the host vehicle to the parking position using map information in which a marker different from the parking position is set in advance,
A surrounding detection unit that detects the surrounding situation of the host vehicle and detects the marker;
A position estimation unit that estimates a current position of the host vehicle based on a relative positional relationship between the marker detected by the periphery detection unit and the host vehicle;
A movement route calculation unit for calculating a movement route from the current position to the parking position estimated by the position estimation unit;
Based on the travel direction of the host vehicle on the travel route calculated by the travel route calculation unit and the marker detection range by the periphery detection unit, the periphery detection unit can detect the vehicle traveling along the travel route. A marker estimation unit for estimating the number of such markers,
For the moving path calculated by the movement route calculating unit, when the number of the markers estimated by said marker estimator becomes a specified value or more, stationed you employed as a path using the moving path in the parking assist A parking assistance device comprising a vehicle assistance unit.
前記修正経路算出部は、前記修正経路に関して、前記マーカー推定部によって算出された全ての前記マーカーの検出率のうち最も低い値が所定の閾値より大きい修正経路を前記駐車支援に用いる経路として採用する、請求項2に記載の駐車支援装置。 The marker estimation unit, based on a traveling direction of the host vehicle on the correction route calculated by the correction route calculation unit and a range in which the marker can be detected, from the host vehicle traveling on the correction route to the surroundings Calculating a plurality of detection rates of the marker based on the number of markers detectable by the detection unit and a predetermined total number of the markers;
The correction route calculation unit employs, as the route used for the parking assistance, a correction route in which the lowest value among the detection rates of all the markers calculated by the marker estimation unit is greater than a predetermined threshold with respect to the correction route. The parking assistance device according to claim 2.
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP2013222374A JP6167846B2 (en) | 2013-10-25 | 2013-10-25 | Parking assistance device |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP2013222374A JP6167846B2 (en) | 2013-10-25 | 2013-10-25 | Parking assistance device |
Publications (2)
Publication Number | Publication Date |
---|---|
JP2015083430A JP2015083430A (en) | 2015-04-30 |
JP6167846B2 true JP6167846B2 (en) | 2017-07-26 |
Family
ID=53047306
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
JP2013222374A Active JP6167846B2 (en) | 2013-10-25 | 2013-10-25 | Parking assistance device |
Country Status (1)
Country | Link |
---|---|
JP (1) | JP6167846B2 (en) |
Families Citing this family (9)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US9696720B2 (en) | 2015-08-27 | 2017-07-04 | Hyundai Motor Company | Apparatus and method for controlling autonomous navigation |
WO2017104163A1 (en) * | 2015-12-17 | 2017-06-22 | 日産自動車株式会社 | Parking support method and device |
KR102237229B1 (en) * | 2017-02-20 | 2021-04-07 | 현대자동차주식회사 | A vehicle and method for controlling the same |
WO2018173581A1 (en) | 2017-03-21 | 2018-09-27 | 株式会社デンソー | Driving assistance device |
JP6996246B2 (en) * | 2017-11-16 | 2022-01-17 | 株式会社アイシン | Vehicle control device |
US20210180954A1 (en) * | 2017-11-17 | 2021-06-17 | Aisin Aw Co., Ltd. | Vehicle position estimation device and vehicle control device |
JP6992563B2 (en) * | 2018-02-08 | 2022-01-13 | 株式会社デンソー | Parking support device |
JP7275520B2 (en) * | 2018-10-03 | 2023-05-18 | 株式会社アイシン | vehicle controller |
JP7243141B2 (en) * | 2018-11-16 | 2023-03-22 | 株式会社豊田中央研究所 | Movement route generation device, movement route generation method, and computer program |
Family Cites Families (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP3804161B2 (en) * | 1997-03-25 | 2006-08-02 | 日産自動車株式会社 | Automatic parking device and parking guidance device |
JP2001142532A (en) * | 1999-11-12 | 2001-05-25 | Nippon Signal Co Ltd:The | Position detection device for mobile object |
JP2006072431A (en) * | 2004-08-31 | 2006-03-16 | Matsushita Electric Ind Co Ltd | Automatic parking system |
JP2009208742A (en) * | 2008-03-06 | 2009-09-17 | Aisin Seiki Co Ltd | Parking assist device |
-
2013
- 2013-10-25 JP JP2013222374A patent/JP6167846B2/en active Active
Also Published As
Publication number | Publication date |
---|---|
JP2015083430A (en) | 2015-04-30 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
JP6167846B2 (en) | Parking assistance device | |
US10493984B2 (en) | Vehicle control method and vehicle control device | |
US20200241531A1 (en) | Automated driving apparatus | |
JP6219312B2 (en) | Method for determining the position of a vehicle in a lane traffic path of a road lane and a method for detecting alignment and collision risk between two vehicles | |
US20190072674A1 (en) | Host vehicle position estimation device | |
JP4295298B2 (en) | Vehicle driving support control device | |
WO2007132860A1 (en) | Object recognition device | |
KR20080037708A (en) | Vehicle positioning information update device | |
US20140032078A1 (en) | Apparatus and method for calculating inter-vehicle distance | |
CN104670208A (en) | Device and method for controlling speed of vehicle | |
JP2019026099A (en) | Traveling control system of vehicle | |
CN102822881A (en) | Vehicle collision judgment device | |
JP6941178B2 (en) | Automatic operation control device and method | |
CN110562233A (en) | driver assistance | |
KR102227845B1 (en) | System and method for controlling group driving based on v2v and das sensor | |
US20210061270A1 (en) | Method and apparatus for method for real time lateral control and steering actuation assessment | |
WO2017017705A1 (en) | Host-position estimation device and host-position estimation method | |
US11210953B2 (en) | Driving support device | |
JP6436235B2 (en) | Tracking control device and tracking control method | |
CA3031723A1 (en) | Self-position estimation method and self-position estimation device | |
CN111089985A (en) | Information processing system, nonvolatile storage medium storing program, and information processing method | |
WO2016126318A1 (en) | Method of automatically controlling an autonomous vehicle based on cellular telephone location information | |
CN113302105B (en) | Driving support method and driving support device | |
US10339395B2 (en) | Display device, vehicle controller, transmitter, and travelling assistance system | |
CN104176055A (en) | Apparatus and method for detecting a critical driving situation of a vehicle |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
A621 | Written request for application examination |
Free format text: JAPANESE INTERMEDIATE CODE: A621 Effective date: 20160301 |
|
A977 | Report on retrieval |
Free format text: JAPANESE INTERMEDIATE CODE: A971007 Effective date: 20161011 |
|
A131 | Notification of reasons for refusal |
Free format text: JAPANESE INTERMEDIATE CODE: A131 Effective date: 20161018 |
|
A521 | Request for written amendment filed |
Free format text: JAPANESE INTERMEDIATE CODE: A523 Effective date: 20161214 |
|
TRDD | Decision of grant or rejection written | ||
A01 | Written decision to grant a patent or to grant a registration (utility model) |
Free format text: JAPANESE INTERMEDIATE CODE: A01 Effective date: 20170530 |
|
A61 | First payment of annual fees (during grant procedure) |
Free format text: JAPANESE INTERMEDIATE CODE: A61 Effective date: 20170612 |
|
R151 | Written notification of patent or utility model registration |
Ref document number: 6167846 Country of ref document: JP Free format text: JAPANESE INTERMEDIATE CODE: R151 |