JP2021092837A - Automatic parking system - Google Patents
Automatic parking system Download PDFInfo
- Publication number
- JP2021092837A JP2021092837A JP2019221289A JP2019221289A JP2021092837A JP 2021092837 A JP2021092837 A JP 2021092837A JP 2019221289 A JP2019221289 A JP 2019221289A JP 2019221289 A JP2019221289 A JP 2019221289A JP 2021092837 A JP2021092837 A JP 2021092837A
- Authority
- JP
- Japan
- Prior art keywords
- vehicle
- parking lot
- autonomous driving
- driving vehicle
- node
- 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.)
- Granted
Links
- 238000001514 detection method Methods 0.000 claims abstract description 35
- 238000007726 management method Methods 0.000 description 87
- 238000000034 method Methods 0.000 description 42
- 230000008569 process Effects 0.000 description 40
- 230000001133 acceleration Effects 0.000 description 18
- 238000004891 communication Methods 0.000 description 18
- 230000004044 response Effects 0.000 description 9
- 238000004364 calculation method Methods 0.000 description 5
- 230000035945 sensitivity Effects 0.000 description 5
- 238000010586 diagram Methods 0.000 description 4
- 230000006870 function Effects 0.000 description 4
- 238000009434 installation Methods 0.000 description 4
- 238000003384 imaging method Methods 0.000 description 3
- 230000004807 localization Effects 0.000 description 2
- 238000012384 transportation and delivery Methods 0.000 description 2
- 230000002159 abnormal effect Effects 0.000 description 1
- 230000008859 change Effects 0.000 description 1
- 239000000446 fuel Substances 0.000 description 1
- 230000005484 gravity Effects 0.000 description 1
- 238000004519 manufacturing process Methods 0.000 description 1
- 238000012986 modification Methods 0.000 description 1
- 230000004048 modification Effects 0.000 description 1
- 238000013439 planning Methods 0.000 description 1
- 239000000126 substance Substances 0.000 description 1
- 230000007704 transition Effects 0.000 description 1
Images
Classifications
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B60—VEHICLES IN GENERAL
- B60W—CONJOINT CONTROL OF VEHICLE SUB-UNITS OF DIFFERENT TYPE OR DIFFERENT FUNCTION; CONTROL SYSTEMS SPECIALLY ADAPTED FOR HYBRID VEHICLES; ROAD VEHICLE DRIVE CONTROL SYSTEMS FOR PURPOSES NOT RELATED TO THE CONTROL OF A PARTICULAR SUB-UNIT
- B60W30/00—Purposes of road vehicle drive control systems not related to the control of a particular sub-unit, e.g. of systems using conjoint control of vehicle sub-units
- B60W30/06—Automatic manoeuvring for parking
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B62—LAND VEHICLES FOR TRAVELLING OTHERWISE THAN ON RAILS
- B62D—MOTOR VEHICLES; TRAILERS
- B62D15/00—Steering not otherwise provided for
- B62D15/02—Steering position indicators ; Steering position determination; Steering aids
- B62D15/027—Parking aids, e.g. instruction means
- B62D15/0285—Parking performed automatically
-
- G—PHYSICS
- G08—SIGNALLING
- G08G—TRAFFIC CONTROL SYSTEMS
- G08G1/00—Traffic control systems for road vehicles
- G08G1/14—Traffic control systems for road vehicles indicating individual free spaces in parking areas
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B60—VEHICLES IN GENERAL
- B60W—CONJOINT CONTROL OF VEHICLE SUB-UNITS OF DIFFERENT TYPE OR DIFFERENT FUNCTION; CONTROL SYSTEMS SPECIALLY ADAPTED FOR HYBRID VEHICLES; ROAD VEHICLE DRIVE CONTROL SYSTEMS FOR PURPOSES NOT RELATED TO THE CONTROL OF A PARTICULAR SUB-UNIT
- B60W50/00—Details of control systems for road vehicle drive control not related to the control of a particular sub-unit, e.g. process diagnostic or vehicle driver interfaces
- B60W50/02—Ensuring safety in case of control system failures, e.g. by diagnosing, circumventing or fixing failures
- B60W50/0205—Diagnosing or detecting failures; Failure detection models
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B60—VEHICLES IN GENERAL
- B60W—CONJOINT CONTROL OF VEHICLE SUB-UNITS OF DIFFERENT TYPE OR DIFFERENT FUNCTION; CONTROL SYSTEMS SPECIALLY ADAPTED FOR HYBRID VEHICLES; ROAD VEHICLE DRIVE CONTROL SYSTEMS FOR PURPOSES NOT RELATED TO THE CONTROL OF A PARTICULAR SUB-UNIT
- B60W50/00—Details of control systems for road vehicle drive control not related to the control of a particular sub-unit, e.g. process diagnostic or vehicle driver interfaces
- B60W50/02—Ensuring safety in case of control system failures, e.g. by diagnosing, circumventing or fixing failures
- B60W50/0225—Failure correction strategy
-
- G—PHYSICS
- G08—SIGNALLING
- G08G—TRAFFIC CONTROL SYSTEMS
- G08G1/00—Traffic control systems for road vehicles
- G08G1/123—Traffic control systems for road vehicles indicating the position of vehicles, e.g. scheduled vehicles; Managing passenger vehicles circulating according to a fixed timetable, e.g. buses, trains, trams
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B60—VEHICLES IN GENERAL
- B60W—CONJOINT CONTROL OF VEHICLE SUB-UNITS OF DIFFERENT TYPE OR DIFFERENT FUNCTION; CONTROL SYSTEMS SPECIALLY ADAPTED FOR HYBRID VEHICLES; ROAD VEHICLE DRIVE CONTROL SYSTEMS FOR PURPOSES NOT RELATED TO THE CONTROL OF A PARTICULAR SUB-UNIT
- B60W50/00—Details of control systems for road vehicle drive control not related to the control of a particular sub-unit, e.g. process diagnostic or vehicle driver interfaces
- B60W50/02—Ensuring safety in case of control system failures, e.g. by diagnosing, circumventing or fixing failures
- B60W50/0205—Diagnosing or detecting failures; Failure detection models
- B60W2050/021—Means for detecting failure or malfunction
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B60—VEHICLES IN GENERAL
- B60W—CONJOINT CONTROL OF VEHICLE SUB-UNITS OF DIFFERENT TYPE OR DIFFERENT FUNCTION; CONTROL SYSTEMS SPECIALLY ADAPTED FOR HYBRID VEHICLES; ROAD VEHICLE DRIVE CONTROL SYSTEMS FOR PURPOSES NOT RELATED TO THE CONTROL OF A PARTICULAR SUB-UNIT
- B60W50/00—Details of control systems for road vehicle drive control not related to the control of a particular sub-unit, e.g. process diagnostic or vehicle driver interfaces
- B60W50/02—Ensuring safety in case of control system failures, e.g. by diagnosing, circumventing or fixing failures
- B60W50/0205—Diagnosing or detecting failures; Failure detection models
- B60W2050/0215—Sensor drifts or sensor failures
Landscapes
- Engineering & Computer Science (AREA)
- Automation & Control Theory (AREA)
- Transportation (AREA)
- Mechanical Engineering (AREA)
- Human Computer Interaction (AREA)
- General Physics & Mathematics (AREA)
- Physics & Mathematics (AREA)
- Radar, Positioning & Navigation (AREA)
- Combustion & Propulsion (AREA)
- Chemical & Material Sciences (AREA)
- Remote Sensing (AREA)
- Traffic Control Systems (AREA)
- Navigation (AREA)
- Instructional Devices (AREA)
- Control Of Driving Devices And Active Controlling Of Vehicle (AREA)
Abstract
Description
本発明は、自動駐車システムに関する。 The present invention relates to an automatic parking system.
従来、自動運転車両に関する技術文献として、特開2018−21777号公報が知られている。この公報には、車両のカメラにより撮像されたランドマークの車両に対する相対位置と地図上のランドマークの位置情報とを用いて車両の地図上の位置である自車位置を推定することが記載されている。 Conventionally, Japanese Patent Application Laid-Open No. 2018-21777 is known as a technical document relating to an autonomous driving vehicle. This publication describes that the position of the own vehicle, which is the position on the map of the vehicle, is estimated by using the relative position of the landmark imaged by the camera of the vehicle with respect to the vehicle and the position information of the landmark on the map. ing.
自動運転車両による自動バレーパーキングでは、通常、自動運転車両の車載センサを用いて取得された車両位置が利用される。しかしながら、例えば車載センサの誤差等に起因して車両位置に誤差が生じると、問題が生じるおそれがある。 In automatic valet parking by an autonomous driving vehicle, a vehicle position acquired by using an in-vehicle sensor of the autonomous driving vehicle is usually used. However, if an error occurs in the vehicle position due to, for example, an error in the vehicle-mounted sensor, a problem may occur.
本発明の一態様は、駐車場内における自動運転車両に指示を行うことにより、駐車場の複数の通路に沿って自動運転させて駐車場内の目標駐車スペースに駐車させる自動駐車システムであって、自動運転車両の車載センサの検出結果と駐車場内の物標情報を含む駐車場地図情報とに基づいて、自動運転車両の駐車場地図上の位置である第1車両位置を取得する第1車両位置取得部と、駐車場内に設けられた施設センサの検出結果に基づいて、自動運転車両の駐車場地図上の位置である第2車両位置を取得する第2車両位置取得部と、第1車両位置及び第2車両位置に基づいて、第1車両位置に関する自動運転車両の位置フェールの有無を判定する位置フェール判定部と、を備え、第1車両位置は、通路の延在方向に沿う第1縦位置と、通路の幅方向に沿う第1横位置と、を含み、第2車両位置は、延在方向に沿う第2縦位置と、幅方向に沿う第2横位置と、を含み、位置フェール判定部は、第1縦位置と第2縦位置との差分が縦閾値以上、及び、第1横位置と第2横位置との差分が横閾値以上、の少なくとも何れかの場合に、位置フェールがあると判定し、縦閾値は、横閾値よりも小さい。 One aspect of the present invention is an automatic parking system in which an automatically driving vehicle in a parking lot is instructed to automatically drive along a plurality of passages in the parking lot and park in a target parking space in the parking lot. First vehicle position acquisition to acquire the first vehicle position, which is the position on the parking map of the automatically driven vehicle, based on the detection result of the in-vehicle sensor of the driving vehicle and the parking map information including the target information in the parking lot. The second vehicle position acquisition unit, the first vehicle position, and the second vehicle position acquisition unit, which acquires the second vehicle position, which is the position on the parking lot map of the automatically driven vehicle, based on the detection result of the facility sensor provided in the parking lot. A position fail determination unit for determining the presence or absence of a position failure of an automatically driven vehicle with respect to the first vehicle position based on the second vehicle position is provided, and the first vehicle position is a first vertical position along the extending direction of the passage. And the first horizontal position along the width direction of the passage, and the second vehicle position includes the second vertical position along the extending direction and the second horizontal position along the width direction to determine the position fail. The position failure is performed when the difference between the first vertical position and the second vertical position is equal to or greater than the vertical threshold and the difference between the first horizontal position and the second horizontal position is equal to or greater than the horizontal threshold. It is determined that there is, and the vertical threshold is smaller than the horizontal threshold.
本発明の一態様による自動駐車システムによれば、第1縦位置と第2縦位置との差分が縦閾値以上、及び、第1横位置と第2横位置との差分が横閾値以上、の少なくとも何れかの場合に、位置フェールがあると判定する。位置フェールの判定においては、横閾値よりも小さい縦閾値が用いられる。そのため、通路の延在方向について、自動運転車両の車載センサの検出結果に基づく車両位置に関する位置フェールの判定を適切に行うことができる。 According to the automatic parking system according to one aspect of the present invention, the difference between the first vertical position and the second vertical position is equal to or greater than the vertical threshold value, and the difference between the first horizontal position and the second horizontal position is equal to or greater than the horizontal threshold value. It is determined that there is a position failure in at least one of the cases. In determining the position fail, a vertical threshold value smaller than the horizontal threshold value is used. Therefore, regarding the extending direction of the passage, it is possible to appropriately determine the position fail regarding the vehicle position based on the detection result of the in-vehicle sensor of the autonomous driving vehicle.
本発明の一態様に係る自動駐車システムにおいて、駐車場地図情報は、通路の通路幅に関する通路幅情報を含み、位置フェール判定部は、自動運転車両が走行している通路の通路幅が通路幅閾値以上である場合、自動運転車両が走行している通路の通路幅が通路幅閾値未満である場合と比べて大きい横閾値を用いて、位置フェールの有無を判定してもよい。この場合、横位置についての位置フェールの判定を通路幅に応じて行うことができる。 In the automatic parking system according to one aspect of the present invention, the parking lot map information includes the passage width information regarding the passage width of the passage, and the position fail determination unit determines that the passage width of the passage in which the automatically driving vehicle is traveling is the passage width. When it is equal to or more than the threshold value, the presence or absence of a position failure may be determined by using a lateral threshold value larger than that when the passage width of the passage in which the automatically driven vehicle is traveling is less than the passage width threshold value. In this case, the position failure for the lateral position can be determined according to the width of the passage.
本発明の一態様に係る自動駐車システムにおいて、駐車場地図情報は、通路に対応して所定間隔で互いに離間するように予め設定された複数のノードに関するノード位置情報を含み、位置フェール判定部は、自動運転車両が走行している通路において隣り合うノードのノード間隔がノード間隔閾値以上である場合、ノード間隔がノード間隔閾値未満である場合と比べて大きい縦閾値を用いて、位置フェールの有無を判定してもよい。この場合、縦位置についての位置フェールの判定をノード間隔に応じて行うことができる。 In the automatic parking system according to one aspect of the present invention, the parking lot map information includes node position information regarding a plurality of nodes preset so as to be separated from each other at predetermined intervals corresponding to the passage, and the position fail determination unit is If the node spacing of adjacent nodes is greater than or equal to the node spacing threshold in the passage where the automatic driving vehicle is traveling, the presence or absence of position failure is performed using a vertical threshold that is larger than that when the node spacing is less than the node spacing threshold. May be determined. In this case, the position failure of the vertical position can be determined according to the node interval.
本発明の一態様に係る自動駐車システムにおいて、駐車場地図情報は、通路に対応して所定間隔で互いに離間するように予め設定された複数のノードに関するノード位置情報と、ノードの種別に関するノードラベル情報と、を更に含み、ノードラベル情報は、ノードが駐車区画付近に位置するとのノードの種別を含み、位置フェール判定部は、走行している自動運転車両の付近のノードが駐車区画付近に位置する場合、ノードが駐車区画付近に位置していない場合と比べて小さい縦閾値を用いて、位置フェールの有無を判定してもよい。この場合、ノードが駐車区画付近に位置するか否かに応じて、縦位置についての位置フェールの判定を行うことができる。 In the automatic parking system according to one aspect of the present invention, the parking lot map information includes node position information relating to a plurality of nodes preset so as to be separated from each other at predetermined intervals corresponding to passages, and node labels relating to node types. The node label information further includes information, and the node label information includes the type of node that the node is located near the parking lot, and the position fail determination unit indicates that the node near the running automatic driving vehicle is located near the parking lot. If so, the presence or absence of a position failure may be determined using a vertical threshold that is smaller than when the node is not located near the parking lot. In this case, it is possible to determine the position fail for the vertical position depending on whether or not the node is located near the parking lot.
本発明の一態様に係る自動駐車システムによれば、通路の延在方向について、自動運転車両の車載センサの検出結果に基づく車両位置に関する車両位置の位置フェールの判定を適切に行うことができる。 According to the automatic parking system according to one aspect of the present invention, it is possible to appropriately determine the position fail of the vehicle position with respect to the vehicle position based on the detection result of the in-vehicle sensor of the autonomous driving vehicle in the extending direction of the passage.
以下、本発明の実施形態について図面を参照して説明する。 Hereinafter, embodiments of the present invention will be described with reference to the drawings.
図1は一実施形態に係る自動駐車システム100を示すブロック図である。図1に示す自動駐車システム[AVPS:Automated Valet Parking System]100は、駐車場[Parking place]における自動運転車両2の自動バレーパーキング[Automated Valet Parking]を行うためのシステムである。
FIG. 1 is a block diagram showing an
自動バレーパーキングとは、駐車場における降車場でユーザ(乗員)が降りた無人の自動運転車両2を駐車場側からの指示によって目標ルートに沿って走行させ、駐車場内の目標駐車スペースに自動で駐車させるサービスである。目標駐車スペースとは、自動運転車両2の駐車位置として予め設定された駐車区画[Parking space]である。目標ルートとは、自動運転車両2が目標駐車スペースに到達するために走行する駐車場内のルートである。なお、出庫時における目標ルートは、後述する乗車用スペースに到達するために走行するルートとなる。
With automatic valet parking, an unmanned self-driving
駐車場は、自動バレーパーキング専用の駐車場であってもよく、自動バレーパーキングの対象外である一般車両用の駐車場を兼ねていてもよい。一般車両用の駐車場の一部を自動バレーパーキング専用のエリアとして用いてもよい。本実施形態では、自動バレーパーキング専用の駐車場を例として説明に用いる。 The parking lot may be a parking lot dedicated to automatic valet parking, or may also serve as a parking lot for general vehicles that are not subject to automatic valet parking. A part of the parking lot for general vehicles may be used as an area dedicated to automatic valet parking. In this embodiment, a parking lot dedicated to automatic valet parking is used as an example for explanation.
ここで、図2は、自動バレーパーキングが行われる駐車場の一例を示す平面図である。図2に、自動バレーパーキング用の駐車場50、駐車エリア[Parking area]51、降車場[Drop-off area]52、及び乗車場[Pick-up area]53を示す。駐車場50は、駐車エリア51、降車場52、及び乗車場53を含んでいる。なお、降車場52及び乗車場53は別々に設けられている必要はなく、一体の乗降場として設けられていてもよい。
Here, FIG. 2 is a plan view showing an example of a parking lot where automatic valet parking is performed. FIG. 2 shows a
駐車エリア51は、自動バレーパーキングにより自動運転車両2が駐車する駐車スペース(駐車枠)61が形成された場所である。駐車スペース61は、例えば図2に示されるように一方向(駐車車両の車幅方向)に並んで複数形成されている。降車場52は、駐車場50の出入口付近に設けられ、入庫前の自動運転車両2からユーザを含む乗員が降車するための場所である。降車場52には、乗員の降車時に自動運転車両2が停車するための降車用スペース62が形成されている。
The
乗車場53は、駐車場50の出入口付近に設けられ、出庫してきた自動運転車両2に乗員が乗車するための場所である。乗車場53には、乗員の乗車のために自動運転車両2が待機するための乗車用スペース63が形成されている。
The
自動駐車システム100では、例えば、駐車場50に入場[Entering]した自動運転車両2が降車用スペース62で乗員を降ろした後、自動運転車両2の指示権限を得て自動バレーパーキングを開始する。自動駐車システム100は、駐車エリア51内の目標駐車スペースに向かって自動運転車両2を走行させ、自動運転車両2を目標駐車スペースに駐車させる。自動駐車システム100は、出庫要求[Pick-up request]に応じて駐車中の自動運転車両2を乗車場53に向かって走行させ、乗車用スペース63で乗員の到着まで待機させる。
In the
自動駐車システム100では、自動バレーパーキングの実行中において、駐車エリア51内の目標駐車スペースに向かって自動運転車両2を走行させている場合、及び、乗車場53に向かって自動運転車両2を走行させている場合に、自動運転車両2の車載センサの検出結果と駐車場50内に設けられた駐車場センサ(施設センサ)4の検出結果とに基づいて、自動運転車両2の位置フェールの有無を判定する。
In the
[自動駐車システムの構成]
以下、自動駐車システム100の構成について図面を参照して説明する。図1に示されるように、自動駐車システム100は、駐車場管理サーバ1を備えている。駐車場管理サーバ1は、駐車場を管理するためのサーバである。
[Configuration of automatic parking system]
Hereinafter, the configuration of the
駐車場管理サーバ1は、自動運転車両2及びユーザ端末[User frontend]3と通信可能に構成されている。自動運転車両2及びユーザ端末3について詳しくは後述する。駐車場管理サーバ1は、駐車場に設けられていてもよく、駐車場から離れた施設に設けられていてもよい。駐車場管理サーバ1は、異なる場所に設けられた複数のコンピュータから構成されていてもよい。
The parking
駐車場管理サーバ1は、駐車場センサ4及び駐車場地図データベース5と接続されている。駐車場センサ4は、駐車場50内の状況を認識するために駐車場50内に設けられた駐車場施設センサ(インフラセンサ)である。駐車場センサ4には、各駐車スペースに駐車車両が存在するか否か(各駐車スペースが満車であるか空車であるか)を検出するための空車センサが含まれる。
The parking
空車センサは、駐車スペースごとに設けられてもよく、天井等に設けられて複数の駐車スペースを一台で監視可能に構成されていてもよい。空車センサの構成は特に限定されず、周知の構成を採用することができる。空車センサは、圧力センサであってもよく、電波を用いるレーダセンサ又はソナーセンサであってもよく、カメラであってもよい。空車センサは、駐車スペースにおける駐車車両の検出情報を駐車場管理サーバ1に送信する。
The empty vehicle sensor may be provided for each parking space, or may be provided on the ceiling or the like so that a plurality of parking spaces can be monitored by one unit. The configuration of the empty vehicle sensor is not particularly limited, and a well-known configuration can be adopted. The empty vehicle sensor may be a pressure sensor, a radar sensor or a sonar sensor using radio waves, or a camera. The vacant vehicle sensor transmits the detection information of the parked vehicle in the parking space to the parking
駐車場センサ4には、駐車場50の走行路を走行する自動運転車両2を検出するための監視カメラが含まれていてもよい。監視カメラは、駐車場50の天井や壁に設けられ、走行する自動運転車両2を撮像する。監視カメラは、撮像画像を駐車場管理サーバ1に送信する。
The
駐車場センサ4には、自動運転車両2の駐車場地図上の位置を取得するための車両位置検知センサが含まれる。車両位置検知センサは、カメラ及びレーダセンサの少なくとも一方を含む。カメラは、駐車場50において自動運転車両2を撮像する撮像機器である。カメラは、駐車場50における自動運転車両2の位置を取得できるように、例えば駐車場50の天井や壁に複数台設けられ、走行する自動運転車両2を撮像する。カメラは、上述の監視カメラで代用されてもよい。カメラは、撮像画像を駐車場管理サーバ1に送信する。レーダセンサは、電波(例えばミリ波)又は光を利用して自動運転車両2を検出する検出機器である。レーダセンサには、例えば、ミリ波レーダが含まれる。レーダセンサは、電波又は光を駐車場50の通路に送信し、自動運転車両2で反射された電波又は光を受信することで自動運転車両2を検出する。レーダセンサは、検出した自動運転車両2の情報を駐車場管理サーバ1へ送信する。レーダセンサには、ライダー[LIDAR:Light Detection and Ranging]が含まれてもよい。
The
駐車場地図データベース5は、駐車場地図情報を記憶するデータベースである。駐車場地図情報には、駐車場における駐車スペースの位置情報、降車用スペースの位置情報、乗車用スペースの位置情報、及び駐車場における走行路の情報が含まれている。また、駐車場地図情報には、駐車場内の複数の通路に対応して予め設定された複数のノードのノード位置情報、自動運転車両2の自動運転に用いる走行境界[driving boundaries]の位置情報、及び、自動運転車両2が位置認識に用いるランドマーク(物標)の位置情報(物標情報)が含まれている。
The parking
ここでの走行境界とは、自動運転車両2が自動運転で走行する際の走行可能範囲を規定し得る物体を意味する。走行境界としては、駐車場50に固定して設けられた物体上の位置を用いることができる。走行境界としては、自動運転車両2の通路と歩道との境界(例えば縁石、白線など)を用いることができる。走行境界としては、例えば駐車場50の柱の表面上の所定位置(例えば頂点)、駐車場50の壁面上の所定位置、ポールの設置位置、セーフティコーンの設置位置、路面鋲の設置位置等のうち少なくとも一つが用いられてもよい。ランドマークとは、駐車場50内における自動運転車両2の位置を認識するための相対位置の基準となる物体を意味する。ランドマークとしては、駐車場50に固定して設けられた物体を用いることができる。ランドマークには、例えば駐車場50の柱、駐車場50の壁、ポール、セーフティコーン、路面鋲等のうち少なくとも一つが用いられる。
The traveling boundary here means an object that can define a travelable range when the
駐車場地図情報は、駐車場50内の複数の通路に対応して所定間隔で互いに離間するように予め設定された複数のノードに関するノード位置情報を含んでいる。図2には、駐車場50内の複数の通路に対応して予め設定された複数のノードが白抜きの丸で示されている。図2の例では、一点鎖線で示されるように、駐車場50内の複数の通路に沿って延在する仮想線が想定されており、当該仮想線上に複数のノードが所定の間隔でノード位置が離間するように設定されている。
The parking lot map information includes node position information regarding a plurality of nodes preset so as to be separated from each other at predetermined intervals corresponding to a plurality of passages in the
例えば通路の直線区間では、直線区間の端点(始点及び終点)に一対のノードが設定されている。これらのノードは、直線区間を自動運転車両2が自動運転するために用いられる。なお、通路の直線区間の端点に挟まれる区間において、更にノードが設定されていてもよい。
For example, in a straight section of a passage, a pair of nodes are set at the end points (start point and end point) of the straight section. These nodes are used for the
通路の直線区間において、当該直線区間の端点に挟まれる区間に各駐車スペース61の入口が面している場合、各駐車スペース61の正面にノードが設定されると共に、駐車スペース61の入口に相当する枠線上にノードが設定されている。これらのノードは、自動運転車両2が駐車スペース61への自動駐車を行う際に、当該駐車スペース61の周辺の走行境界及びランドマークの情報を自動運転車両2に送信するために用いられる。なお、駐車スペース61の周辺に更にノードが設定されていてもよい。
In the straight section of the passage, when the entrance of each
また、通路のカーブ区間は、当該カーブ区間を挟むように互いに隣り合う直線区間の端点(当該カーブ区間側の端点)のノードによって規定されている。例えば、通路のカーブ区間の端点となる一対のノード(カーブの始点又は終点に相当するノード)は、上記互いに隣り合う直線区間の端点の各ノードと重複していてもよい。通路のカーブ区間では、上記仮想線がこれらのノードを結ぶ曲線と想定することができる。これらのノードは、カーブ区間を自動運転車両2が自動運転するために用いられる。なお、互いに隣り合う直線区間の端点の各ノードに挟まれる区間内(以下、単に「カーブ区間内」ともいう)において、更にノードが設定されていてもよい。
Further, the curve section of the passage is defined by the nodes of the end points (end points on the curve section side) of the straight sections adjacent to each other so as to sandwich the curve section. For example, a pair of nodes (nodes corresponding to the start point or the end point of the curve) that are the end points of the curve section of the passage may overlap with each node of the end points of the straight section adjacent to each other. In the curved section of the passage, the virtual line can be assumed to be a curve connecting these nodes. These nodes are used for the
駐車場地図情報は、ノードの種別に関するノードラベル情報を更に含んでいる。ノードラベル情報とは、ノードの種別をラベルとしてノードごとに付与した情報を意味する。ノードの種別とは、駐車場50におけるノードの位置の種類を意味する。ノードの種別には、例えば、ノードが駐車区画付近に位置するとの第1ノード種別、ノードがカーブ区間に位置するとの第2ノード種別、及び、ノードが直線区間に位置しているとの第3ノード種別が含まれる。
The parking lot map information further includes node label information regarding the type of node. The node label information means the information given to each node with the node type as a label. The node type means the type of the position of the node in the
ノード位置の所定の間隔は、駐車場50において必ずしも一定ではなく、ノードの位置に応じて予め設定されている。例えば、駐車区画付近に位置するノードの間隔(図2の距離L1)は、駐車区画付近に位置しないカーブ区間又は直線区間に位置するノードの間隔よりも短い。カーブ区間に位置するノードの間隔は、直線区間に位置するノードの間隔よりも短くてもよい。曲率半径が所定の閾値よりも大きいカーブ区間に位置するノードの間隔は、直線区間に位置するノードの間隔と同等でもよい。直線区間に位置するノードの間隔(図2の距離L2)は、直線区間において略一定でもよい。カーブ区間との境界付近に位置するノードの間隔は、当該境界付近に位置しないノードの間隔よりも短くてもよい。なお、「駐車区画付近に位置するノード」は、駐車区画付近に位置するノードであればよく、ノードが位置する通路の形状としてはカーブ又は直線の何れであってもよい。また、ノードの位置に関して、「カーブ区間」は、駐車区画付近に位置しないカーブ区間を意味し、「直線区間」は、駐車区画付近に位置しない直線区間を意味する。カーブ区間は、交差点における進行方向が変化する区間を含んでもよい。
The predetermined interval between the node positions is not always constant in the
駐車場地図情報は、駐車場50内の複数の通路の通路幅に関する通路幅情報を含んでいる。通路幅は、駐車場50において必ずしも一定ではなく、駐車場50の走行境界の配置に応じて予め設定されている。通路幅は、例えば、通路の略中央に延在する仮想線に直交する方向において、一対の走行境界で挟まれる路面上の距離とすることができる。通路幅情報は、駐車場50の構造に応じた走行境界の配置に応じて予め設定されている。図2では、通路を挟んで対向する駐車スペース61の脇に設けられた一対の柱が走行境界となる場合の通路幅W1が例示されている。また、直線区間となる通路を挟んで対向する壁及び柱が走行境界となる場合の通路幅W2が例示されている。ここでは、一例として、駐車スペース61の前方での自動運転車両2の切り返し動作を考慮して、通路幅W1が通路幅W2よりも大きい。なお、カーブ区間の通路幅は、直線区間の通路幅よりも大きくてもよい。
The parking lot map information includes passage width information regarding the passage widths of a plurality of passages in the
駐車場管理サーバ1のハードウェア構成について説明する。図3は、駐車場管理サーバのハードウェア構成の一例を示すブロック図である。図3に示されるように、駐車場管理サーバ1は、プロセッサ40、メモリ41、ストレージ42、通信インターフェイス43、及びユーザインターフェイス44を備えた一般的なコンピュータとして構成されている。
The hardware configuration of the parking
プロセッサ40は、各種オペレーティングシステムを動作させて駐車場管理サーバ1を制御する。プロセッサ40は、制御装置、演算装置、レジスタ等を含むCPU[Central Processing Unit]等の演算器である。プロセッサ40は、メモリ41、ストレージ42、通信インターフェイス43、及びユーザインターフェイス44を統括的に制御する。メモリ41は、ROM[Read Only Memory]、RAM[Random Access Memory]等の記録媒体である。ストレージ42は、HDD[Hard Disk Drive]等の記録媒体である。
The
通信インターフェイス43は、ネットワークを介した無線通信を行うための通信デバイスである。通信インターフェイス43には、ネットワークデバイス、ネットワークコントローラ、ネットワークカード等を用いることができる。駐車場管理サーバ1は、通信インターフェイス43を用いて自動運転車両2及びユーザ端末3と通信を行う。ユーザインターフェイス44は、駐車場管理サーバ1の管理者等に対する駐車場管理サーバ1の入出力部である。ユーザインターフェイス44は、ディスプレイ、スピーカ等の出力器、及び、タッチパネル等の入力器を含む。
The
次に、駐車場管理サーバ1の機能的構成について説明する。図1に示されるように、駐車場管理サーバ1は、車両情報取得部(第1車両位置取得部)11、車両状況認識部(第2車両位置取得部)12、位置誤差算出部13、位置フェール判定部14、及び車両指示部15を有している。
Next, the functional configuration of the parking
車両情報取得部11は、自動バレーパーキングの対象となる自動運転車両2との通信により自動運転車両2の車両情報を取得する。車両情報には、自動運転車両2の識別情報、及び、駐車場における自動運転車両2の第1車両位置情報が含まれる。第1車両位置情報は、自動運転車両2の外部センサ22の検出結果に基づいて自動運転車両2の車両位置認識部33によって認識された、自動運転車両2の駐車場地図上の位置である第1車両位置についての情報である。識別情報は、個々の自動運転車両2を特定できる情報であればよい。識別情報は、ID番号[Identification Number]であってもよく、車両番号であってもよく、自動バレーパーキングの予約番号等であってもよい。
The vehicle
車両情報には、自動運転車両2の車種が含まれていてもよく、識別情報とは別に車両番号が含まれていてもよい。車両情報には、入庫予約時刻等の入庫予約情報が含まれていてもよく、出庫予定時刻が含まれていてもよい。車両情報には、自動運転車両2の旋回半径、全長、車幅等の車体情報が含まれていてもよく、自動運転車両2の自動運転機能に関する情報が含まれていてもよい。自動運転機能に関する情報には自動運転のバージョン情報が含まれていてもよい。
The vehicle information may include the vehicle type of the
車両情報には、自動運転車両2の走行状態及び外部環境の認識結果が含まれていてもよい。走行状態及び外部環境の認識については後述する。車両情報には、自動運転車両2の残りの走行可能距離又は残燃料の情報が含まれていてもよい。
The vehicle information may include the running state of the
車両情報取得部11は、自動バレーパーキングの間、自動運転車両2から車両情報を継続的に取得する。車両情報取得部11は、自動バレーパーキングの間、指示に応じて自動運転中の特定の自動運転車両2からの車両情報を継続的に取得してもよい。車両情報取得部11は、当該自動運転車両2とは別の自動運転車両2が指示に応じて自動運転中である場合、当該別の自動運転車両2からの車両情報を継続的に取得してもよい。車両情報取得部11は、自動運転車両2が駐車中となった場合、車両情報の取得を中断してもよいし、定期的に車両情報を取得してもよい。
The vehicle
車両状況認識部12は、駐車場50内に設けられた駐車場センサ4の検出結果に基づいて、自動運転車両2の駐車場地図上の位置である第2車両位置を取得する。車両状況認識部12は、駐車場センサ4として車両位置検知センサの検出結果に基づいて、自動運転車両2の駐車場地図上の第2車両位置を取得する。第2車両位置は、自動運転車両2の外部センサ22が正常か異常かに関わらず、駐車場施設センサを用いて取得することができる。そこで、本開示では、第2車両位置は、自動運転車両2の外部センサ22を用いて検出される第1車両位置(後述)の誤差(位置誤差)を算出するための基準として用いられる。
The vehicle
第1車両位置は、通路の延在方向に沿う第1縦位置と、通路の幅方向に沿う第1横位置と、を含む。第1縦位置は、例えば、図2の駐車場50内の複数の通路に沿って延在する仮想線(一点鎖線)の延在方向に沿っての第1車両位置の成分とすることができる。第1横位置は、例えば、通路の略中央に延在する仮想線に直交する方向に沿っての第1車両位置の成分とすることができる。
The first vehicle position includes a first vertical position along the extending direction of the passage and a first horizontal position along the width direction of the passage. The first vertical position can be, for example, a component of the first vehicle position along the extending direction of the virtual line (dashed line) extending along the plurality of passages in the
第2車両位置は、通路の延在方向に沿う第2縦位置と、通路の幅方向に沿う第2横位置と、を含む。第2縦位置は、例えば、図2の駐車場50内の複数の通路に沿って延在する仮想線の延在方向に沿っての第2車両位置の成分とすることができる。第2横位置は、例えば、通路の略中央に延在する仮想線に直交する方向に沿っての第2車両位置の成分とすることができる。
The second vehicle position includes a second vertical position along the extending direction of the passage and a second horizontal position along the width direction of the passage. The second vertical position can be, for example, a component of the second vehicle position along the extending direction of the virtual line extending along the plurality of passages in the
車両状況認識部12は、車両情報取得部11の取得した車両情報に基づいて、自動バレーパーキング中の自動運転車両2の状況を認識してもよい。自動運転車両2の状況には、自動運転中の複数の自動運転車両2についての車両位置が含まれる。
The vehicle
位置誤差算出部13は、車両情報取得部11によって取得された第1車両位置と、車両状況認識部12によって取得された第2車両位置と、の位置誤差を算出する。位置誤差は、自動運転車両2の位置フェールを判定するための自動運転車両2の車両位置のズレを意味する。ここでの位置誤差には、通路の延在方向に沿う縦位置誤差と、通路の幅方向に沿う横位置誤差と、が含まれる。位置誤差算出部13は、取得された第1車両位置と第2車両位置とに基づいて、通路の延在方向に沿う第1縦位置と第2縦位置との差分である縦位置誤差と、通路の幅方向に沿う第1横位置と第2横位置との差分である横位置誤差と、を算出する。
The position
位置フェール判定部14は、第1車両位置及び第2車両位置に基づいて、位置フェールの有無を判定する。位置フェールとは、外部センサ22の検出結果に基づく第1車両位置に関する自動運転車両2の車両位置の認識失陥を意味する。位置フェールは、例えば、外部センサ22自体の故障、外部センサ22が異物等により物理的に遮蔽されての検出不良、ランドマークが汚れ等により物理的に遮蔽されての検出不良、外部センサ22から自動運転ECU20への通信エラー等によって発生し得る。
The position fail
位置フェール判定部14は、位置フェールの有無を判定するための判定閾値を設定する。ここでの判定閾値には、縦位置誤差に対して用いられる縦閾値と、横位置誤差に対して用いられる横閾値と、が含まれる。
The position fail
本開示では、縦閾値は、横閾値よりも小さい。例えば、駐車場50において走行する自動運転車両2は、一般道路等と比較して、駐車場50内で急に屈曲するカーブ区間(例えば約90°で交差する直線区間を繋ぐカーブ区間)に高頻度で遭遇し得る。このようなカーブ区間へ進入する際、自動運転車両2の外部センサ22に基づく第1車両位置に通路の延在方向に沿う位置誤差が大きく含まれていると、例えばカーブ区間へ進入する直前の直線区間において自動運転車両2の進行方向(直線区間の延長線に沿う方向)の位置誤差が大きいこととなる。その結果、自動運転車両2の進行方向前方に位置するカーブ区間の外側の壁と接触する可能性が高くなってしまう。また、駐車場50が立体駐車場である場合においても、同様に、スロープ部へ進入する直前の直線区間において自動運転車両2の進行方向(直線区間の延長線に沿う方向)の位置誤差が大きいこととなる。その結果、各階を接続するスロープ部を自動運転車両2が通行する際に自動運転車両2の進行方向前方に位置するスロープ部の外側の壁と接触する可能性が高くなってしまう。これらのような自動運転車両2と壁等との接触の可能性を低減するため、縦閾値が横閾値よりも小さくされることで、縦位置についての位置フェールの感度が高められ、自動運転車両2の自車位置推定における縦位置の誤差の拡大の早期検出が図られる。
In the present disclosure, the vertical threshold is smaller than the horizontal threshold. For example, the self-driving
位置フェール判定部14は、自動運転車両2が走行している通路の通路幅が通路幅閾値以上である場合、自動運転車両2が走行している通路の通路幅が通路幅閾値未満である場合と比べて大きい横閾値を用いて、位置フェールの有無を判定してもよい。通路幅閾値は、自動運転車両2が走行している通路の通路幅に応じて横閾値を変更するための閾値である。例えば、位置フェール判定部14は、自動運転車両2が走行している通路の通路幅が通路幅閾値以上であるか否かを判定する。位置フェール判定部14は、自動運転車両2が走行している通路の通路幅が通路幅閾値以上であると判定した場合、横閾値として横閾値ThLT1を設定する。位置フェール判定部14は、自動運転車両2が走行している通路の通路幅が通路幅閾値以上ではないと判定した場合、横閾値として横閾値ThLT2を設定する。
The position fail
横閾値ThLT1は、横閾値ThLT2と比べて大きい。通路幅の大きさは、自動運転車両2の幅方向の左右に位置する走行境界の間の距離に対応する。よって、通路幅が小さいと、自動運転車両2と走行境界との距離が狭くなり易い。そこで、横閾値ThLT2を、横閾値ThLT1と比べて小さくすることで、横位置についての位置フェールの感度が高められ、走行境界との接触の可能性を低減し得る。
The lateral threshold ThLT1 is larger than the lateral threshold ThLT2. The size of the passage width corresponds to the distance between the traveling boundaries located on the left and right in the width direction of the
位置フェール判定部14は、自動運転車両2が走行している通路において隣り合うノードのノード間隔がノード間隔閾値以上である場合、当該ノード間隔がノード間隔閾値未満である場合と比べて大きい縦閾値を用いて、位置フェールの有無を判定してもよい。ノード間隔閾値は、自動運転車両2が走行している通路において隣り合うノードのノード間隔に応じて縦閾値を変更するための閾値である。例えば、位置フェール判定部14は、自動運転車両2が走行している通路において隣り合うノードのノード間隔がノード間隔閾値以上であるか否かを判定する。位置フェール判定部14は、自動運転車両2が走行している通路において隣り合うノードのノード間隔がノード間隔閾値以上であると判定した場合、縦閾値として縦閾値ThLN1を設定する。位置フェール判定部14は、自動運転車両2が走行している通路において隣り合うノードのノード間隔がノード間隔閾値以上ではないと判定した場合、縦閾値として縦閾値ThLN2を設定する。
The position fail
縦閾値ThLN1は、縦閾値ThLN2と比べて大きい。一般的に、ノード間隔の大きさは、駐車場管理サーバ1による自動運転車両2の制御が可能となる車両進行方向の距離に対応する。よって、ノード間隔が小さいと、互いに近接している複数の自動運転車両2の車間距離が狭くなり易い。そこで、縦閾値ThLN2を、縦閾値ThLN1と比べて小さくすることで、縦位置についての位置フェールの感度が高められ、自動運転車両2同士の接触を抑制できる。なお、ノード間隔は、図2の仮想線に沿う方向の間隔に限定されず、自動運転車両2付近のノードの位置からの同心円状の距離を用いてもよい。
The vertical threshold ThLN1 is larger than the vertical threshold ThLN2. Generally, the size of the node spacing corresponds to the distance in the vehicle traveling direction in which the parking
位置フェール判定部14は、走行している自動運転車両2付近のノードの種別が第1ノード種別である場合(走行している自動運転車両2が駐車区画付近に位置している場合)、縦閾値として縦閾値ThLN3を設定する。位置フェール判定部14は、走行している自動運転車両2付近のノードの種別が第2ノード種別である場合(走行している自動運転車両2がカーブ区間に位置している場合)、縦閾値として縦閾値ThLN4を設定する。位置フェール判定部14は、走行している自動運転車両2付近のノードの種別が第3ノード種別である場合(走行している自動運転車両2が直線区間に位置している場合)、縦閾値として縦閾値ThLN5を設定する。
When the type of the node near the running
縦閾値ThLN3は、縦閾値ThLN4と比べて小さい。駐車区画付近では、上述したように、目標駐車スペースにおいて自動運転車両2が切り返し動作をする可能性があること等から、カーブ区間及び直線区間と比べて、自動運転車両2の前後方向において自動運転車両2と柱等の走行境界との距離が小さくなる可能性がある。そのため、自動運転車両2の縦位置ズレを低減することが重要となる。そこで、縦閾値ThLN3を、縦閾値ThLN4と比べて小さくすることで、縦位置についての位置フェールの感度が高められ、自動運転車両2の自車位置推定における縦位置の誤差の拡大の早期検出が図られる。
The vertical threshold ThLN3 is smaller than the vertical threshold ThLN4. In the vicinity of the parking zone, as described above, the
縦閾値ThLN4は、縦閾値ThLN5と比べて小さい。カーブ区間では、直線区間と異なり、自動運転車両2の前後方向(カーブ区間の接線方向)にはカーブ区間の外側の壁が存在する可能性がある。また、カーブ区間において他の自動運転車両2が対向車として走行してくる可能性がある。そのため、自動運転車両2の縦位置ズレを低減することが重要となる。そこで、縦閾値ThLN4を、縦閾値ThLN5と比べて小さくすることで、縦位置についての位置フェールの感度が高められ、走行境界との接触の可能性を低減し得る。
The vertical threshold ThLN4 is smaller than the vertical threshold ThLN5. In the curved section, unlike the straight section, there is a possibility that the outer wall of the curved section exists in the front-rear direction (tangential direction of the curved section) of the
なお、自動運転車両2の前後方向において他の自動運転車両2が存在する場合、相対車速が小さければ他の自動運転車両2に対する距離が略一定となるが、相対車速が一定以上に大きければ他の自動運転車両2に対する距離が縮まる可能性がある。そのため、自動運転車両2の縦位置ズレを低減することが重要となる。そこで、位置フェール判定部14は、自動運転車両2の前後を走行している他の自動運転車両2が存在する場合において、当該他の自動運転車両2に対する相対車速が所定の相対車速閾値以上である場合、当該相対車速が相対車速閾値未満である場合の縦閾値ThLN7と比べて小さい縦閾値ThLN6を用いて、位置フェールの有無を判定してもよい。当該他の自動運転車両2に対する相対車速は、他の自動運転車両2に対する距離が縮まる場合に正の値となる相対車速であってもよい。相対車速閾値は、自動運転車両2の前後を走行している他の自動運転車両2に対する相対車速に応じて縦閾値を切り替えるための、相対車速の閾値である。
When another
ちなみに、位置フェール判定部14は、走行している自動運転車両2が駐車区画付近に位置しているか否かとして、走行している自動運転車両2付近のノードの種別が第1ノード種別であるか否かを判定したが、これに代えて、走行している自動運転車両2の直近のノードから目標駐車スペースのノードまでの目標ルートに沿っての距離が所定の閾値以下であるか否かを判定してもよい。あるいは、走行している自動運転車両2の直近のノードから目標駐車スペースのノードまでの直線距離が所定の閾値以下であるか否か(直近のノードを中心とした所定の閾値を半径とする円に目標駐車スペースのノードが含まれるか否か)を判定してもよい。
By the way, in the position fail
位置フェール判定部14は、第1縦位置と第2縦位置との差分(縦位置誤差)が縦閾値以上、又は、第1横位置と第2横位置との差分(横位置誤差)が横閾値以上の場合、位置フェールがあると判定する。
In the position fail
一例として、位置フェール判定部14は、縦位置誤差縦閾値以上であるか否かを判定する。位置フェール判定部14は、横位置誤差が横閾値以上であるか否かを判定する。位置フェール判定部14は、縦位置誤差が縦閾値以上であると判定した場合、あるいは、横位置誤差が横閾値以上であると判定した場合、位置フェールがあると判定する。一方、位置フェール判定部14は、縦位置誤差が縦閾値以上であると判定せず、且つ、横位置誤差が横閾値以上であると判定しない場合、位置フェールがないとの判定を行う。
As an example, the position fail
車両指示部15は、自動バレーパーキングを行う自動運転車両2に対して指示を行う。車両指示部15は、自動運転車両2が自動バレーパーキングを開始する場合に、当該自動運転車両2の目標駐車スペースに至るための目標ルートを指示する。目標駐車スペースの決め方は特に限定されない。駐車場に入場した順に出口側から駐車スペースを割り当ててもよく、出庫予約時間が近い順に出口側から駐車スペースを割り当ててもよい。ユーザに目標駐車スペースを指定させてもよい。車両指示部15は、一度に、自動運転車両2の現在の位置から目標駐車スペースに至る目標ルートの全てを指示する必要はなく、部分的に目標ルートを指示する態様であってもよい。車両指示部15は、自動運転車両2の出庫時には乗車用スペース63に至るための目標ルートを指示する。
The
車両指示部15は、指示に応じて自動運転中の自動運転車両2の車両情報取得部11により取得された車両位置に基づいて、自動運転車両2の位置から目標駐車スペースに至るための目標ルートを算出する。車両指示部15は、例えば駐車場内の走行路に沿って最も短い走行距離で目標駐車スペースに到達できるルートを目標ルートとして算出する。車両指示部15は、他の自動運転車両2の目標ルートと交差しないように新たな自動運転車両2の目標ルートを算出してもよい。車両指示部15は、目標ルートを考慮して目標駐車スペースを決定してもよい。なお、車両指示部15は、目標ルートと合わせて駐車場内の上限車速を指示してもよい。車両指示部15は、上限加速度を指示してもよい。上限車速及び上限加速度は予め決められている。
The
車両指示部15は、車両状況認識部12の認識した他の自動運転車両2の状況に応じて停止指示及び進行指示を行う。停止指示とは、自動運転車両2を停止させる指示である。進行指示とは、停止している自動運転車両2を進行(発進)させる指示である。車両指示部15は、自動運転車両2の減速又は加速について指示してもよい。車両指示部15は、他の自動運転車両2の状況に応じて自動運転車両2の停止及び進行をコントロールすることにより、他の自動運転車両2との接近を避けながら自動運転車両2を目標駐車スペースまで走行させる。
The
車両指示部15は、位置フェール判定部14によって位置フェールがあると判定された場合、自動運転車両2に停止指示をしてもよい。車両指示部15は、位置フェール判定部14によって位置フェールがあると判定された場合、自動運転車両2に減速指示をしてもよい。車両指示部15は、位置フェール判定部14によって位置フェールがないと判定された場合、自動運転車両2に進行指示を許可してもよい。車両指示部15は、位置フェール判定部14によって位置フェールがないと判定された場合、自動運転車両2に加速指示を許可してもよい。
When the position fail
車両指示部15は、駐車場50の所定位置に駐車場センサ4としてライダーが設置されている場合において、位置フェール判定部14によって位置フェールがあると判定されたとき、自動運転車両2をライダーの設置位置付近に移動させるように指示してもよい。この場合、駐車場センサ4としてのライダーの検出結果を用いて、位置フェールの原因となった外部センサ22の検出結果(ランドマークの位置情報)を補正することで、自動運転車両2の車両位置認識部33による自車位置推定の推定結果を補正することができる。また、駐車スペース61の駐車枠ごとに設けられた空車センサの検出結果を用いて、駐車スペース61付近に位置する自動運転車両2に空車センサで検出した位置情報を送信することで、自動運転車両2の車両位置認識部33による自車位置推定の推定結果を補正することも可能である。
When the rider is installed as the
続いて、駐車場管理サーバ1と通信を行う自動運転車両2及びユーザ端末3について説明する。なお、本実施形態に係る自動駐車システム100は自動運転車両2及びユーザ端末3を含む必要はない。
Subsequently, the
図1に示されるように、自動運転車両2は、一例として、自動運転ECU20を有している。自動運転ECU20は、CPU、ROM、RAM等を有する電子制御ユニットである。自動運転ECU20では、例えば、ROMに記録されているプログラムをRAMにロードし、RAMにロードされたプログラムをCPUで実行することにより各種の機能を実現する。自動運転ECU20は、複数の電子ユニットから構成されていてもよい。
As shown in FIG. 1, the
自動運転ECU20は、通信部21、外部センサ(車載センサ)22、内部センサ23、及び、アクチュエータ24と接続されている。
The
通信部21は、自動運転車両2の外部との無線通信を制御する通信デバイスである。通信部21は、駐車場管理サーバ1との通信により各種情報の送信及び受信を行う。通信部21は、例えば、駐車場管理サーバ1に車両情報を送信すると共に、駐車場管理サーバ1から自動バレーパーキングのために必要な情報(例えば目標ルート沿いのランドマークの情報)を取得する。また、通信部21は、自動運転車両2と関連付けられたユーザ端末3との通信を行う。
The
外部センサ22は、自動運転車両2の外部環境を検出する車載センサである。外部センサ22は、車載カメラを少なくとも含む。車載カメラは、自動運転車両2の外部環境を撮像する撮像機器である。車載カメラは、例えば自動運転車両2のフロントガラスの裏側に設けられ、車両前方を撮像する。車載カメラは、自動運転車両2の外部環境に関する撮像情報を自動運転ECU20へ送信する。車載カメラは、単眼カメラであってもよく、ステレオカメラであってもよい。車載カメラは、複数台設けられていてもよく、自動運転車両2の前方の他、左右の側方及び後方を撮像してもよい。
The
外部センサ22は、車載レーダセンサを含んでもよい。車載レーダセンサは、電波又は光を自動運転車両2の周辺に送信し、物体で反射された電波又は光を受信することで物体を検出する。車載レーダセンサには、例えば、ミリ波レーダ又はライダーが含まれる。車載レーダセンサは、検出した物体情報を自動運転ECU20へ送信する。また、外部センサ22は、自動運転車両2の外部の音を検出するソナーセンサを含んでもよい。
The
内部センサ23は、自動運転車両2の走行状態を検出する車載センサである。内部センサ23は、車速センサ、加速度センサ、及びヨーレートセンサを含んでいる。車速センサは、自動運転車両2の速度を検出する検出器である。車速センサとしては、自動運転車両2の車輪又は車輪と一体に回転するドライブシャフト等に対して設けられ、各車輪の回転速度を検出する車輪速センサを用いることができる。車速センサは、検出した車速情報(車輪速情報)を自動運転ECU20に送信する。
The
加速度センサは、自動運転車両2の加速度を検出する検出器である。加速度センサは、例えば、自動運転車両2の前後方向の加速度を検出する前後加速度センサを含んでいる。加速度センサは、自動運転車両2の横加速度を検出する横加速度センサを含んでいてもよい。加速度センサは、例えば、自動運転車両2の加速度情報を自動運転ECU20に送信する。ヨーレートセンサは、自動運転車両2の重心の鉛直軸周りのヨーレート(回転角速度)を検出する検出器である。ヨーレートセンサとしては、例えばジャイロセンサを用いることができる。ヨーレートセンサは、検出した自動運転車両2のヨーレート情報を自動運転ECU20へ送信する。
The acceleration sensor is a detector that detects the acceleration of the
アクチュエータ24は、自動運転車両2の制御に用いられる機器である。アクチュエータ24は、駆動アクチュエータ、ブレーキアクチュエータ、及び操舵アクチュエータを少なくとも含む。駆動アクチュエータは、自動運転ECU20からの制御信号に応じてエンジンに対する空気の供給量(スロットル開度)を制御し、自動運転車両2の駆動力を制御する。なお、自動運転車両2がハイブリッド車である場合には、エンジンに対する空気の供給量の他に、動力源としてのモータに自動運転ECU20からの制御信号が入力されて当該駆動力が制御される。自動運転車両2が電気自動車である場合には、動力源としてのモータに自動運転ECU20からの制御信号が入力されて当該駆動力が制御される。これらの場合における動力源としてのモータは、アクチュエータ24を構成する。
The
ブレーキアクチュエータは、自動運転ECU20からの制御信号に応じてブレーキシステムを制御し、自動運転車両2の車輪へ付与する制動力を制御する。ブレーキシステムとしては、例えば、液圧ブレーキシステムを用いることができる。操舵アクチュエータは、電動パワーステアリングシステムのうち操舵トルクを制御するアシストモータの駆動を自動運転ECU20からの制御信号に応じて制御する。これにより、操舵アクチュエータは自動運転車両2の操舵トルクを制御する。
The brake actuator controls the brake system in response to the control signal from the
次に、自動運転ECU20の機能的構成の一例について説明する。自動運転ECU20は、外部環境認識部31、走行状態認識部32、車両位置認識部33、車両情報提供部34、及び車両制御部35を有している。
Next, an example of the functional configuration of the
外部環境認識部31は、外部センサ22(車載カメラの撮像画像又は車載レーダセンサの検出した物体情報)の検出結果に基づいて、自動運転車両2の外部環境を認識する。外部環境には、自動運転車両2に対する周囲の物体の相対位置が含まれる。外部環境には、自動運転車両2に対する周囲の物体の相対速度及び移動方向が含まれていてもよい。外部環境認識部31は、パターンマッチング等により、他車両及び駐車場の柱等の物体を認識する。外部環境認識部31は、駐車場のゲート、駐車場の壁、ポール、セーフティコーン等を認識してもよい。また、外部環境認識部31は、白線認識により駐車場における走行境界を認識してもよい。
The external
走行状態認識部32は、内部センサ23の検出結果に基づいて、自動運転車両2の走行状態を認識する。走行状態には、自動運転車両2の車速、自動運転車両2の加速度、自動運転車両2のヨーレートが含まれる。具体的に、走行状態認識部32は、車速センサの車速情報に基づいて、自動運転車両2の車速を認識する。走行状態認識部32は、加速度センサの車速情報に基づいて、自動運転車両2の加速度を認識する。走行状態認識部32は、ヨーレートセンサのヨーレート情報に基づいて、自動運転車両2の向きを認識する。
The traveling
車両位置認識部33は、自動運転車両2の外部センサ22の検出結果と駐車場50内のランドマークの位置情報を含む駐車場地図情報とに基づいて、自動運転車両2の駐車場地図上の位置である第1車両位置を取得する。車両位置認識部33は、第1車両位置の取得として、自動運転車両2の駐車場地図上の位置である自車位置の推定(自車位置推定、ローカライズ)[localization]を実施する。
The vehicle
ここでの自車位置推定とは、駐車場地図上のランドマークの位置情報を利用して自動運転車両2の駐車場地図上の自車位置を推定することである。車両位置認識部33は、周知の手法により、駐車場地図上の位置が予め定められているランドマークを外部センサ22で検出し、当該ランドマークを自車位置の推定に利用する。車両位置認識部33は、例えば、外部環境認識部31の認識した外部環境と通信部21を通じて駐車場管理サーバ1から取得したランドマークの位置情報とに基づいて、自動運転車両2に対するランドマークの相対位置を認識することで、第1車両位置を取得する。
The own vehicle position estimation here is to estimate the own vehicle position on the parking lot map of the
その他、車両位置認識部33は、内部センサ23の検出結果に基づいて、デッドレコニングにより自動運転車両2の位置を認識してもよい。また、車両位置認識部33は、駐車場に設けられたビーコンとの通信により自動運転車両2の位置を認識してもよい。
In addition, the vehicle
車両情報提供部34は、通信部21を通じて駐車場管理サーバ1に車両情報を提供する。車両情報提供部34は、例えば一定時間ごとに車両位置認識部33の認識した駐車場内における自動運転車両2の位置の情報を含む車両情報を駐車場管理サーバ1に提供する。
The vehicle
車両制御部35は、自動運転車両2の自動運転を実行する。自動運転では、駐車場管理サーバ1から指示された目標ルートに沿って自動運転車両2を自動で走行させる。車両制御部35は、例えば、目標ルート、自動運転車両2の位置、自動運転車両2の外部環境、及び自動運転車両2の走行状態に基づいて、自動運転車両2の進路[trajectory]を生成する。進路は自動運転の走行計画に相当する。進路には、自動運転で車両が走行する経路[path]と自動運転における車速計画とが含まれる。
The
経路は、目標ルート上において自動運転中の車両が走行する予定の軌跡である。経路は、例えば目標ルート上の位置に応じた自動運転車両2の操舵角変化のデータ(操舵角計画)とすることができる。目標ルート上の位置とは、例えば目標ルートの進行方向において所定間隔(例えば1m)毎に設定された設定縦位置である。操舵角計画とは、設定縦位置毎に目標操舵角が関連付けられたデータとなる。
The route is a trajectory on which the vehicle being automatically driven is scheduled to travel on the target route. The route can be, for example, data (steering angle planning) of the steering angle change of the
車両制御部35は、例えば目標ルートに沿って駐車場の走行路の中央を通るように進路を生成する。車両制御部35は、駐車場管理サーバ1から上限車速を指示されている場合、上限車速を超えない車速計画となるように進路を生成する。車両制御部35は、駐車場管理サーバ1との通信により取得した駐車場地図情報を用いて進路を生成してもよい。
The
車両制御部35は、駐車場管理サーバ1から停止指示を受けた場合、自動運転車両2を停止させる。車両制御部35は、駐車場管理サーバ1から進行指示を受けた場合、停止していた自動運転車両2を進行させる。車両制御部35は、例えば、車両縦制御[vehicle longitudinal control]及び車両横制御[vehicle lateral control]を実行することで、経路に沿って自動運転車両2を自動運転させる。以上、自動運転車両2の構成の一例について説明したが、自動運転車両2は自動バレーパーキングを実現可能な構成であれば上述の内容に限定されない。
When the
ユーザ端末3は、自動運転車両2と関連付けられたユーザの携帯情報端末である。ユーザ端末3は、例えば自動運転車両2の所有者の端末として自動運転車両2に登録されている。ユーザ端末3は、レンタルによる一時的な所有者、所有者からの指示権限の移譲によって、自動運転車両2に権限所持者として登録されたユーザの端末であってもよい。ユーザ端末3は、例えばCPU等のプロセッサと、ROM又はRAM等のメモリと、ディスプレイ兼タッチパネル等を含むユーザインターフェイスとを含むコンピュータにより構成されている。
The user terminal 3 is a user's mobile information terminal associated with the
ユーザ端末3は、駐車場管理サーバ1に対する入庫要求及び出庫要求を行う機能を有している。ユーザは、ユーザ端末3を操作することにより自動バレーパーキングの入庫要求及び出庫要求を行うことができる。ユーザは、例えば駐車場50の降車場52の降車用スペース62に自動運転車両2を停車して降車した後、ユーザ端末3を操作して入庫要求を完了させることで自動運転車両2に対する指示権限を駐車場管理サーバ1に与える。
The user terminal 3 has a function of making a warehousing request and a warehousing request to the parking
ユーザは、出庫要求を行うことにより駐車場管理サーバ1を介して駐車スペース61に駐車している自動運転車両2を乗車場53の乗車用スペース63まで走行させる。自動運転車両2は、乗車用スペース63でユーザを待つ。駐車場管理サーバ1は、例えば、自動運転車両2が乗車用スペース63に到着して停止した場合、自動運転車両2に対する指示権限を終了する。指示権限は、ユーザが自動運転車両2にドア開放又は発進の指示を出したときに終了してもよい。指示権限の終了は自動運転車両2が行ってもよい。なお、入庫要求及び出庫要求に伴う自動運転車両2の動作は上記の態様に限られない。駐車場管理サーバ1についても同様である。
By making a delivery request, the user causes the
[自動駐車システムの処理]
次に、自動駐車システム100の処理について図面を参照して説明する。図4は、横閾値設定処理の一例を示すフローチャートである。図4の横閾値設定処理は、例えば駐車場管理サーバ1と通信可能な自動運転車両2が駐車場に入場した場合等、自動バレーパーキングの開始後に実行される。
[Processing of automatic parking system]
Next, the processing of the
図4に示されるように、駐車場管理サーバ1は、S01において、位置フェール判定部14により、自動運転車両2が走行している通路の通路幅が通路幅閾値以上であるか否かの判定を行う。
As shown in FIG. 4, in S01, the parking
駐車場管理サーバ1は、自動運転車両2が走行している通路の通路幅が通路幅閾値以上であると位置フェール判定部14により判定された場合(S01:YES)、S02に移行する。駐車場管理サーバ1は、自動運転車両2が走行している通路の通路幅が通路幅閾値以上であると位置フェール判定部14により判定されなかった場合(S01:NO)、S03に移行する。
When the position fail
S02において、駐車場管理サーバ1は、位置フェール判定部14により、横閾値として、自動運転車両2が走行している通路の通路幅が通路幅閾値未満である場合の横閾値ThLT2と比べて大きい横閾値ThLT1を設定する。S03において、駐車場管理サーバ1は、位置フェール判定部14により、横閾値として、自動運転車両2が走行している通路の通路幅が通路幅閾値未満である場合の横閾値ThLT2を設定する。その後、今回の図4の処理を終了する。その後、駐車場管理サーバ1は、例えば所定時間経過後、図4の処理を繰り返し実行する。
In S02, the parking
図5は、縦閾値設定処理の一例を示すフローチャートである。図5の縦閾値設定処理は、例えば駐車場管理サーバ1と通信可能な自動運転車両2が駐車場に入場した場合等、自動バレーパーキングの開始後に実行される。
FIG. 5 is a flowchart showing an example of the vertical threshold value setting process. The vertical threshold setting process of FIG. 5 is executed after the start of automatic valet parking, for example, when the
図5に示されるように、駐車場管理サーバ1は、S11において、位置フェール判定部14により、自動運転車両2が走行している通路において隣り合うノードのノード間隔がノード間隔閾値以上であるか否かの判定を行う。
As shown in FIG. 5, in S11, the parking
駐車場管理サーバ1は、自動運転車両2が走行している通路において隣り合うノードのノード間隔がノード間隔閾値以上であると位置フェール判定部14により判定された場合(S11:YES)、S12に移行する。駐車場管理サーバ1は、自動運転車両2が走行している通路において隣り合うノードのノード間隔がノード間隔閾値以上であると位置フェール判定部14により判定されなかった場合(S11:NO)、S13に移行する。
When the position fail
S12において、駐車場管理サーバ1は、位置フェール判定部14により、縦閾値として、自動運転車両2が走行している通路において隣り合うノードのノード間隔がノード間隔閾値未満である場合の縦閾値ThLN2と比べて大きい縦閾値ThLN1を設定する。S13において、駐車場管理サーバ1は、位置フェール判定部14により、縦閾値として、自動運転車両2が走行している通路において隣り合うノードのノード間隔がノード間隔閾値未満である場合の縦閾値ThLN2を設定する。その後、今回の図5の処理を終了する。その後、駐車場管理サーバ1は、例えば所定時間経過後、図5の処理を繰り返し実行する。
In S12, the parking
縦閾値は、図6のようにして設定されてもよい。図6は、縦閾値設定処理の他の例を示すフローチャートである。図6の縦閾値設定処理は、例えば駐車場管理サーバ1と通信可能な自動運転車両2が駐車場に入場した場合等、自動バレーパーキングの開始後に実行される。
The vertical threshold value may be set as shown in FIG. FIG. 6 is a flowchart showing another example of the vertical threshold value setting process. The vertical threshold setting process of FIG. 6 is executed after the start of automatic valet parking, for example, when the
図6に示されるように、駐車場管理サーバ1は、S21において、位置フェール判定部14により、ノードラベルが第1ノード種別であるか否か(ノードが駐車区画付近に位置するか否か)を判定する。駐車場管理サーバ1は、ノードラベルが第1ノード種別であると位置フェール判定部14により判定された場合(S21:YES)、S22に移行する。S22において、駐車場管理サーバ1は、位置フェール判定部14により、縦閾値として、走行している自動運転車両2付近のノードの種別が第2ノード種別又は第3ノード種別である場合の縦閾値ThLN4,ThLN5と比べて小さい縦閾値ThLN3を設定する。その後、今回の図6の処理を終了する。その後、駐車場管理サーバ1は、例えば所定時間経過後、図6の処理を繰り返し実行する。
As shown in FIG. 6, in S21, the parking
一方、駐車場管理サーバ1は、ノードラベルが第1ノード種別ではないと位置フェール判定部14により判定された場合(S21:NO)、S23に移行する。駐車場管理サーバ1は、S23において、位置フェール判定部14により、ノードラベルが第2ノード種別であるか否か(ノードがカーブ区間に位置するか否か)を判定する。駐車場管理サーバ1は、ノードラベルが第2ノード種別であると位置フェール判定部14により判定された場合(S23:YES)、S24に移行する。S24において、駐車場管理サーバ1は、位置フェール判定部14により、縦閾値として、走行している自動運転車両2付近のノードの種別が第3ノード種別である場合の縦閾値ThLN5と比べて小さい縦閾値ThLN4を設定する。その後、今回の図6の処理を終了する。その後、駐車場管理サーバ1は、例えば所定時間経過後、図6の処理を繰り返し実行する。
On the other hand, when the position fail
一方、駐車場管理サーバ1は、ノードラベルが第2ノード種別ではないと位置フェール判定部14により判定された場合(S23:NO)、S25に移行する。S25において、駐車場管理サーバ1は、位置フェール判定部14により、縦閾値として、走行している自動運転車両2付近のノードの種別が第3ノード種別である場合の縦閾値ThLN5を設定する。その後、今回の図6の処理を終了する。その後、駐車場管理サーバ1は、例えば所定時間経過後、図6の処理を繰り返し実行する。
On the other hand, when the position fail
あるいは、縦閾値は、図7のようにして設定されてもよい。図7は、縦閾値設定処理の更に他の例を示すフローチャートである。図7の縦閾値設定処理は、例えば、自動バレーパーキングの開始後において、自動運転車両2の前後を走行している他の自動運転車両2が存在する場合に実行される。
Alternatively, the vertical threshold value may be set as shown in FIG. FIG. 7 is a flowchart showing still another example of the vertical threshold value setting process. The vertical threshold setting process of FIG. 7 is executed, for example, when there is another
図7に示されるように、駐車場管理サーバ1は、S31において、位置フェール判定部14により、他の自動運転車両2に対する相対車速が所定の相対車速閾値以上であるか否かの判定を行う。
As shown in FIG. 7, the parking
駐車場管理サーバ1は、他の自動運転車両2に対する相対車速が所定の相対車速閾値以上であると位置フェール判定部14により判定された場合(S31:YES)、S32に移行する。駐車場管理サーバ1は、他の自動運転車両2に対する相対車速が所定の相対車速閾値以上であると位置フェール判定部14により判定されなかった場合(S31:NO)、S33に移行する。
When the position fail
S32において、駐車場管理サーバ1は、位置フェール判定部14により、縦閾値として、他の自動運転車両2に対する相対車速が所定の相対車速閾値未満である場合の縦閾値ThLN7と比べて小さい縦閾値ThLN6を設定する。S33において、駐車場管理サーバ1は、位置フェール判定部14により、縦閾値として、他の自動運転車両2に対する相対車速が所定の相対車速閾値未満である場合の縦閾値ThLN7を設定する。その後、今回の図7の処理を終了する。その後、駐車場管理サーバ1は、例えば所定時間経過後、自動運転車両2の前後を走行している他の自動運転車両2が存在する場合に、図7の処理を繰り返し実行する。
In S32, the parking
図8は、位置フェール判定処理の一例を示すフローチャートである。位置フェール判定処理は、例えば駐車場管理サーバ1と通信可能な自動運転車両2が駐車場に入場した場合等、自動バレーパーキングの開始後に実行される。
FIG. 8 is a flowchart showing an example of the position fail determination process. The position fail determination process is executed after the start of automatic valet parking, for example, when the
図8に示されるように、駐車場管理サーバ1は、S41において、車両情報取得部11により、指示に応じて自動運転中の自動運転車両2の外部センサ22の検出結果に基づいて自動運転車両2の車両位置認識部33によって認識された、自動運転車両2の第1車両位置の取得を行う。駐車場管理サーバ1は、S42において、車両状況認識部12により、駐車場50内に設けられた駐車場センサ4の検出結果に基づいて、自動運転車両2の駐車場地図上の位置である第2車両位置を取得を行う。
As shown in FIG. 8, in S41, the parking
駐車場管理サーバ1は、S43において、位置誤差算出部13により、取得された第1車両位置と第2車両位置との位置誤差の算出を行う。位置誤差算出部13は、例えば、取得された第1車両位置と第2車両位置とに基づいて、通路の延在方向に沿う第1縦位置と第2縦位置との差分である縦位置誤差と、通路の幅方向に沿う第1横位置と第2横位置との差分である横位置誤差と、を算出する。
The parking
駐車場管理サーバ1は、S44において、位置フェール判定部14により、第1縦位置と第2縦位置との差分(縦位置誤差)が、横閾値よりも小さい縦閾値以上であるか否かの判定を行う。
In S44, the parking
駐車場管理サーバ1は、縦位置誤差が縦閾値以上であると位置フェール判定部14により判定されなかった場合(S44:NO)、S45に移行する。駐車場管理サーバ1は、S45において、位置フェール判定部14により、第1横位置と第2横位置との差分(横位置誤差)が、横閾値以上であるか否かの判定を行う。駐車場管理サーバ1は、横位置誤差が横閾値以上であると位置フェール判定部14により判定されなかった場合(S45:NO)、S46に移行する。駐車場管理サーバ1は、S46において、位置フェール判定部14により、位置フェールがないとの判定を行う。その後、今回の図8の処理を終了する。その後、駐車場管理サーバ1は、例えば所定時間経過後、図8の処理を繰り返し実行する。
When the position fail
一方、駐車場管理サーバ1は、縦位置誤差が縦閾値以上であると位置フェール判定部14により判定された場合(S44:YES)、あるいは、横位置誤差が横閾値以上であると位置フェール判定部14により判定された場合(S45:YES)、S47に移行する。駐車場管理サーバ1は、S47において、位置フェール判定部14により、位置フェールがあるとの判定を行う。その後、今回の図8の処理を終了する。その後、駐車場管理サーバ1は、例えば所定時間経過後、図8の処理を繰り返し実行する。
On the other hand, the parking
以上説明した本実施形態に係る自動駐車システム100によれば、第1縦位置と第2縦位置との差分が縦閾値以上、又は、第1横位置と第2横位置との差分が横閾値以上の場合に、位置フェールがあると判定する。位置フェールの判定においては、横閾値(ThLT1又はThLT2)よりも小さい縦閾値(ThLN1〜ThLN5の何れか)が用いられる。そのため、通路の延在方向について、第1車両位置の位置フェールの判定を適切に行うことができる。
According to the
また、自動駐車システム100によれば、駐車場地図情報は、通路の通路幅に関する通路幅情報を含んでいる。位置フェール判定部14は、自動運転車両2が走行している通路の通路幅が通路幅閾値以上である場合、自動運転車両2が走行している通路の通路幅が通路幅閾値未満である場合の横閾値ThLT2と比べて大きい横閾値ThLT1を用いて、位置フェールの有無を判定する。これにより、横位置についての位置フェールの判定を通路幅に応じて行うことができる。
Further, according to the
また、自動駐車システム100によれば、駐車場地図情報は、通路に対応して所定間隔で互いに離間するように予め設定された複数のノードに関するノード位置情報を含み、位置フェール判定部14は、自動運転車両2が走行している通路において隣り合うノードのノード間隔がノード間隔閾値以上である場合、ノード間隔がノード間隔閾値未満である場合の縦閾値ThLN2と比べて大きい縦閾値ThLN1を用いて、位置フェールの有無を判定する。これにより、縦位置についての位置フェールの判定をノード間隔に応じて行うことができる。
Further, according to the
また、自動駐車システム100によれば、駐車場地図情報は、通路に対応して所定間隔で互いに離間するように予め設定された複数のノードに関するノード位置情報と、ノードの種別に関するノードラベル情報と、を更に含んでおり、ノードラベル情報は、ノードが駐車区画付近に位置するとのノードの種別を含んでいる。位置フェール判定部14は、走行している自動運転車両2の付近のノードが駐車区画付近に位置する場合、ノードが駐車区画付近に位置していない場合の縦閾値ThLN4,5と比べて小さい縦閾値ThLN3を用いて、位置フェールの有無を判定する。これにより、ノードが駐車区画付近に位置するか否かに応じて、縦位置についての位置フェールの判定を行うことができる。
Further, according to the
以上、本発明の実施形態について説明したが、本発明は上述した実施形態に限定されるものではない。本発明は、上述した実施形態を始めとして、当業者の知識に基づいて種々の変更、改良を施した様々な形態で実施することができる。 Although the embodiments of the present invention have been described above, the present invention is not limited to the above-described embodiments. The present invention can be carried out in various forms having various modifications and improvements based on the knowledge of those skilled in the art, including the above-described embodiment.
駐車場管理サーバ1は、自動運転車両2と直接的に通信可能である必要はなく、他のサーバ等を介して通信する態様であってもよい。駐車場管理サーバ1は、例えば自動運転車両2のメーカー側の管理サーバ又はMaaS[Mobility as a Service]の運用サーバ等を経由して自動運転車両2と通信してもよい。
The parking
ノードの種別として、ノードが駐車区画付近に位置するとの第1ノード種別、ノードがカーブ区間に位置するとの第2ノード種別、及び、ノードの位置が駐車区画付近にもカーブ区間にも位置していないとの第3ノード種別を例示したが、これら3つの種別のうち1又は2の種別が省略されてもよいし、更にその他の種別が含まれていてもよい。あるいは、駐車場地図情報は、必ずしもノードの種別に関するノードラベル情報を含んでいなくてもよい。 As the node type, the first node type that the node is located near the parking lot, the second node type that the node is located in the curve section, and the node position is located near the parking lot and in the curve section. Although the third node type of "No" is illustrated, one or two of these three types may be omitted, and other types may be included. Alternatively, the parking lot map information does not necessarily have to include the node label information regarding the node type.
上記実施形態において、駐車場地図データベース5は、走行境界の位置情報及びランドマークの位置情報がノード情報としてノードに予め関連付けられて記憶されていたが、このようなノード情報が必ずしも駐車場地図データベース5に記憶されていなくてもよい。例えば、このようなノード情報は、駐車場地図データベース5とは異なる提供元(例えば地図データ制作会社等)から、走行境界の位置情報及びランドマークの位置情報がノード情報としてノードに予め関連付けられた状態で入手されて用いられる態様であってもよい。
In the above embodiment, in the parking
上記実施形態において、縦閾値は、図5〜図7の何れか1つの縦閾値設定処理により設定されたが、図5〜図7の縦閾値設定処理の少なくとも2つを組み合わせて用いて設定されてもよい。この場合、例えば、図6の縦閾値設定処理で設定された縦閾値に対して、図5の縦閾値設定処理で縦閾値を補正する態様としてもよい。これにより、走行している自動運転車両2付近のノードの種別が互いに同じ種別(つまり図6のS21及びS22の判定処理により特定された種別)である場合において、図5のS11で判定されたノード間隔の大小関係に応じて、より適切な縦閾値となるように縦閾値を補正することができる。同様に、例えば、図6の縦閾値設定処理で設定された縦閾値に対して、図7の縦閾値設定処理で縦閾値を補正する態様としてもよい。これにより、走行している自動運転車両2付近のノードの種別が互いに同じ種別(つまり図6のS21及びS22の判定処理により特定された種別)である場合において、図7のS31で判定された相対速度の大小関係に応じて、より適切な縦閾値となるように縦閾値を補正することができる。
In the above embodiment, the vertical threshold value is set by the vertical threshold value setting process of any one of FIGS. 5 to 7, but is set by using at least two of the vertical threshold value setting processes of FIGS. 5 to 7 in combination. You may. In this case, for example, the vertical threshold value may be corrected by the vertical threshold value setting process of FIG. 5 with respect to the vertical threshold value set by the vertical threshold value setting process of FIG. As a result, when the types of the nodes near the traveling
なお、縦閾値は、必ずしも通路幅、ノード種別、及び相対速度に応じて設定されなくてもよい。また、上記実施形態において、横閾値は、図4の横閾値設定処理により設定されたが、必ずしも通路幅に応じて設定されなくてもよい。要は、本開示では、いずれの場合においても、縦閾値は、横閾値よりも小さくされればよい。 The vertical threshold value does not necessarily have to be set according to the passage width, the node type, and the relative speed. Further, in the above embodiment, the lateral threshold value is set by the lateral threshold value setting process of FIG. 4, but it does not necessarily have to be set according to the passage width. In short, in the present disclosure, in any case, the vertical threshold value may be smaller than the horizontal threshold value.
上記実施形態において、位置フェール判定部14は、第1縦位置と第2縦位置との差分が縦閾値以上との条件と、第1横位置と第2横位置との差分が横閾値以上との条件と、の何れかが成立した場合に、位置フェールがあると判定したが、両方の条件が成立した場合に位置フェールがあると判定してもよい。つまり、位置フェール判定部14は、第1縦位置と第2縦位置との差分が縦閾値以上、及び、第1横位置と第2横位置との差分が横閾値以上、の少なくとも何れかの場合に、位置フェールがあると判定してもよい。
In the above embodiment, the position fail
2…自動運転車両、4…駐車場センサ(施設センサ)、11…車両情報取得部(第1車両位置取得部)、12…車両状況認識部(第2車両位置取得部)、14…位置フェール判定部、22…外部センサ(車載センサ)、50…駐車場、100…自動駐車システム。 2 ... Self-driving vehicle, 4 ... Parking lot sensor (facility sensor), 11 ... Vehicle information acquisition unit (first vehicle position acquisition unit), 12 ... Vehicle status recognition unit (second vehicle position acquisition unit), 14 ... Position fail Judgment unit, 22 ... External sensor (vehicle-mounted sensor), 50 ... Parking lot, 100 ... Automatic parking system.
Claims (4)
前記自動運転車両の車載センサの検出結果と前記駐車場内の物標情報を含む駐車場地図情報とに基づいて、前記自動運転車両の駐車場地図上の位置である第1車両位置を取得する第1車両位置取得部と、
前記駐車場内に設けられた施設センサの検出結果に基づいて、前記自動運転車両の駐車場地図上の位置である第2車両位置を取得する第2車両位置取得部と、
前記第1車両位置及び前記第2車両位置に基づいて、前記第1車両位置に関する前記自動運転車両の位置フェールの有無を判定する位置フェール判定部と、
を備え、
前記第1車両位置は、前記通路の延在方向に沿う第1縦位置と、前記通路の幅方向に沿う第1横位置と、を含み、
前記第2車両位置は、前記延在方向に沿う第2縦位置と、前記幅方向に沿う第2横位置と、を含み、
前記位置フェール判定部は、前記第1縦位置と前記第2縦位置との差分が縦閾値以上、及び、前記第1横位置と前記第2横位置との差分が横閾値以上、の少なくとも何れかの場合に、前記位置フェールがあると判定し、
前記縦閾値は、前記横閾値よりも小さい、
自動駐車システム。 An automatic parking system that automatically drives a vehicle in a parking lot along a plurality of passages in the parking lot and parks the vehicle in a target parking space in the parking lot by instructing the self-driving vehicle.
The first vehicle position, which is the position on the parking lot map of the autonomous driving vehicle, is acquired based on the detection result of the in-vehicle sensor of the autonomous driving vehicle and the parking lot map information including the target information in the parking lot. 1 Vehicle position acquisition unit and
Based on the detection result of the facility sensor provided in the parking lot, the second vehicle position acquisition unit that acquires the second vehicle position which is the position on the parking lot map of the autonomous driving vehicle, and the second vehicle position acquisition unit.
Based on the first vehicle position and the second vehicle position, a position fail determination unit that determines the presence or absence of a position fail of the autonomous driving vehicle with respect to the first vehicle position, and a position fail determination unit.
With
The first vehicle position includes a first vertical position along the extending direction of the passage and a first horizontal position along the width direction of the passage.
The second vehicle position includes a second vertical position along the extending direction and a second horizontal position along the width direction.
In the position fail determination unit, at least one of the difference between the first vertical position and the second vertical position is equal to or greater than the vertical threshold value, and the difference between the first horizontal position and the second horizontal position is equal to or greater than the horizontal threshold value. In that case, it is determined that there is the position failure, and
The vertical threshold is smaller than the horizontal threshold.
Automatic parking system.
前記位置フェール判定部は、前記自動運転車両が走行している前記通路の通路幅が通路幅閾値以上である場合、前記自動運転車両が走行している前記通路の通路幅が前記通路幅閾値未満である場合と比べて大きい前記横閾値を用いて、前記位置フェールの有無を判定する、請求項1に記載の自動駐車システム。 The parking lot map information includes aisle width information regarding the aisle width of the aisle.
When the passage width of the passage in which the autonomous driving vehicle is traveling is equal to or greater than the passage width threshold value, the position fail determination unit determines that the passage width of the passage in which the autonomous driving vehicle is traveling is less than the passage width threshold value. The automatic parking system according to claim 1, wherein the presence or absence of the position fail is determined by using the lateral threshold value that is larger than that in the case of.
前記位置フェール判定部は、前記自動運転車両が走行している前記通路において隣り合う前記ノードのノード間隔がノード間隔閾値以上である場合、前記ノード間隔が前記ノード間隔閾値未満である場合と比べて大きい前記縦閾値を用いて、前記位置フェールの有無を判定する、請求項1又は2に記載の自動駐車システム。 The parking lot map information includes node position information regarding a plurality of nodes preset so as to be separated from each other at predetermined intervals corresponding to the passage.
In the position fail determination unit, when the node distance between adjacent nodes in the passage where the autonomous driving vehicle is traveling is equal to or greater than the node interval threshold value, the position fail determination unit is compared with the case where the node interval is less than the node interval threshold value. The automatic parking system according to claim 1 or 2, wherein the presence or absence of the position fail is determined by using the large vertical threshold value.
前記ノードラベル情報は、前記ノードが駐車区画付近に位置するとの前記ノードの種別を含み、
前記位置フェール判定部は、走行している前記自動運転車両の付近の前記ノードが前記駐車区画付近に位置する場合、前記ノードが前記駐車区画付近に位置していない場合と比べて小さい前記縦閾値を用いて、前記位置フェールの有無を判定する、請求項1〜3の何れか一項に記載の自動駐車システム。 The parking lot map information further includes node position information regarding a plurality of nodes preset so as to be separated from each other at predetermined intervals corresponding to the passage, and node label information regarding the type of the node.
The node label information includes the type of the node that the node is located near the parking lot.
The position fail determination unit has a smaller vertical threshold value when the node near the autonomous driving vehicle is located near the parking zone than when the node is not located near the parking zone. The automatic parking system according to any one of claims 1 to 3, wherein the presence or absence of the position failure is determined by using.
Priority Applications (4)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP2019221289A JP7172973B2 (en) | 2019-12-06 | 2019-12-06 | automatic parking system |
US17/106,604 US11840215B2 (en) | 2019-12-06 | 2020-11-30 | Automated valet parking system |
CN202011393709.4A CN112927550B (en) | 2019-12-06 | 2020-12-03 | Automatic parking system |
DE102020132258.5A DE102020132258A1 (en) | 2019-12-06 | 2020-12-04 | Automated parking service system |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP2019221289A JP7172973B2 (en) | 2019-12-06 | 2019-12-06 | automatic parking system |
Publications (2)
Publication Number | Publication Date |
---|---|
JP2021092837A true JP2021092837A (en) | 2021-06-17 |
JP7172973B2 JP7172973B2 (en) | 2022-11-16 |
Family
ID=75962630
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
JP2019221289A Active JP7172973B2 (en) | 2019-12-06 | 2019-12-06 | automatic parking system |
Country Status (4)
Country | Link |
---|---|
US (1) | US11840215B2 (en) |
JP (1) | JP7172973B2 (en) |
CN (1) | CN112927550B (en) |
DE (1) | DE102020132258A1 (en) |
Families Citing this family (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP7095968B2 (en) * | 2017-10-02 | 2022-07-05 | トヨタ自動車株式会社 | Management device |
CN109212572B (en) * | 2018-08-31 | 2021-05-04 | 百度在线网络技术(北京)有限公司 | Positioning drift detection method, device and equipment and computer readable storage medium |
KR102651410B1 (en) * | 2018-12-28 | 2024-03-28 | 현대자동차주식회사 | Automated Valet Parking System, and infrastructure and vehicle thereof |
US11345360B1 (en) * | 2019-12-12 | 2022-05-31 | Zoox, Inc. | Localization error handling |
JP2021172275A (en) * | 2020-04-28 | 2021-11-01 | トヨタ自動車株式会社 | Management device of automatic valet parking service, service providing method and service utilization vehicle |
DE102022202739A1 (en) | 2022-03-21 | 2023-09-21 | Robert Bosch Gesellschaft mit beschränkter Haftung | Method for locating a motor vehicle |
Citations (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN104575079A (en) * | 2014-08-12 | 2015-04-29 | 深圳市旺龙软件技术有限公司 | Vehicle positioning method and vehicle finding method in parking lot |
JP2016057677A (en) * | 2014-09-05 | 2016-04-21 | 本田技研工業株式会社 | Travel support control device |
JP2017117188A (en) * | 2015-12-24 | 2017-06-29 | Kyb株式会社 | Vehicle guiding device and vehicle guiding system including vehicle guiding device |
US20180165960A1 (en) * | 2016-12-14 | 2018-06-14 | Hyundai Motor Company | Apparatus and method for estimating position of vehicle |
Family Cites Families (23)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP2623157B2 (en) | 1990-07-13 | 1997-06-25 | 株式会社イセキ開発工機 | Control device for moving objects |
US6363324B1 (en) * | 1999-11-12 | 2002-03-26 | David M Hildebrant | Vehicle location system |
DE10236475A1 (en) | 2001-08-09 | 2003-02-20 | Aisin Aw Co | Route guidance system for vehicle, has guidance output unit to output guidance limited to major guide point information, when transmission/reception unit is unable to receive guidance information from server |
JP3984112B2 (en) * | 2002-01-18 | 2007-10-03 | アルパイン株式会社 | Vehicle position correcting device and distance threshold setting method |
KR100713459B1 (en) * | 2004-08-31 | 2007-05-02 | 삼성전자주식회사 | Method for determinig deviation of the path of a mobile in navigation system and navigation system |
KR101610502B1 (en) * | 2014-09-02 | 2016-04-07 | 현대자동차주식회사 | Apparatus and method for recognizing driving enviroment for autonomous vehicle |
CN106441321B (en) * | 2015-08-07 | 2021-03-16 | 阿尔派株式会社 | Vehicle positioning device, vehicle positioning method and navigation device |
CN107238814A (en) | 2016-03-29 | 2017-10-10 | 茹景阳 | A kind of apparatus and method of vehicle location |
JP6776707B2 (en) | 2016-08-02 | 2020-10-28 | トヨタ自動車株式会社 | Own vehicle position estimation device |
DE102016122990A1 (en) * | 2016-11-29 | 2018-05-30 | Valeo Schalter Und Sensoren Gmbh | Method for the autonomous maneuvering of a motor vehicle on a parking area with determination of a position deviation, infrastructure device, driver assistance systems, motor vehicle and communication system |
WO2018163817A1 (en) | 2017-03-06 | 2018-09-13 | パナソニックIpマネジメント株式会社 | Vehicle travel control system for parking lot, and manufacturing method of vehicle travel control system for parking lot |
WO2019123587A1 (en) | 2017-12-20 | 2019-06-27 | 日産自動車株式会社 | Parking control method and parking control device |
DE102018102130A1 (en) | 2018-01-31 | 2019-08-01 | Vibracoustic Gmbh | Hydraulically damping bearing |
KR102553247B1 (en) | 2018-04-27 | 2023-07-07 | 주식회사 에이치엘클레무브 | Lane keep assist system and method for improving safety in forward vehicle follower longitudinal control |
US11099018B2 (en) | 2018-11-27 | 2021-08-24 | Caterpillar Inc. | Route planner for work machines |
DE102018221871B4 (en) | 2018-12-17 | 2022-06-15 | Volkswagen Aktiengesellschaft | Method for operating a parking assistance system of a vehicle with specification of a travel direction for a parking maneuver and parking assistance system |
JP7125369B2 (en) | 2019-03-29 | 2022-08-24 | 本田技研工業株式会社 | Parking lot management device, parking lot management method, and program |
JP2020194209A (en) | 2019-05-24 | 2020-12-03 | 本田技研工業株式会社 | Control device, boarding/alighting facility, control method, and program |
CN110304049B (en) | 2019-06-24 | 2020-11-24 | 浙江大学 | Environment active sensing type automatic parking system for parking lot |
CN114207688A (en) * | 2019-07-19 | 2022-03-18 | 株式会社电装 | Parking support system |
JP7127747B2 (en) | 2019-08-21 | 2022-08-30 | 株式会社デンソー | PARKING ASSIST DEVICE AND PARKING ASSIST SYSTEM |
JP7338342B2 (en) | 2019-09-17 | 2023-09-05 | トヨタ自動車株式会社 | automatic parking system |
JP7188372B2 (en) | 2019-12-06 | 2022-12-13 | トヨタ自動車株式会社 | automatic parking system |
-
2019
- 2019-12-06 JP JP2019221289A patent/JP7172973B2/en active Active
-
2020
- 2020-11-30 US US17/106,604 patent/US11840215B2/en active Active
- 2020-12-03 CN CN202011393709.4A patent/CN112927550B/en active Active
- 2020-12-04 DE DE102020132258.5A patent/DE102020132258A1/en active Pending
Patent Citations (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN104575079A (en) * | 2014-08-12 | 2015-04-29 | 深圳市旺龙软件技术有限公司 | Vehicle positioning method and vehicle finding method in parking lot |
JP2016057677A (en) * | 2014-09-05 | 2016-04-21 | 本田技研工業株式会社 | Travel support control device |
JP2017117188A (en) * | 2015-12-24 | 2017-06-29 | Kyb株式会社 | Vehicle guiding device and vehicle guiding system including vehicle guiding device |
US20180165960A1 (en) * | 2016-12-14 | 2018-06-14 | Hyundai Motor Company | Apparatus and method for estimating position of vehicle |
Also Published As
Publication number | Publication date |
---|---|
US11840215B2 (en) | 2023-12-12 |
US20210171020A1 (en) | 2021-06-10 |
DE102020132258A1 (en) | 2021-06-10 |
CN112927550A (en) | 2021-06-08 |
CN112927550B (en) | 2023-05-16 |
JP7172973B2 (en) | 2022-11-16 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
US11383737B2 (en) | Automatic parking system | |
JP7259698B2 (en) | automatic parking system | |
JP7188338B2 (en) | automatic parking system | |
JP7172973B2 (en) | automatic parking system | |
US11651687B2 (en) | Automated valet parking system | |
JP7188372B2 (en) | automatic parking system | |
US11458962B2 (en) | Automatic parking system | |
JP7207262B2 (en) | automatic parking system | |
JP7251445B2 (en) | automatic parking system | |
KR102666463B1 (en) | Automated valet parking system, control method of automated valet parking system, and autonomous driving vehicle | |
US20220258727A1 (en) | Automated valet parking system, control method of automated valet parking system, and autonomous driving vehicle | |
JP7380662B2 (en) | Automatic parking system and automatic parking system control method | |
CN115035707B (en) | Automatic parking system and control method thereof | |
JP2022061226A (en) | Automatic parking system |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
A621 | Written request for application examination |
Free format text: JAPANESE INTERMEDIATE CODE: A621 Effective date: 20211020 |
|
A977 | Report on retrieval |
Free format text: JAPANESE INTERMEDIATE CODE: A971007 Effective date: 20220916 |
|
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: 20221004 |
|
A61 | First payment of annual fees (during grant procedure) |
Free format text: JAPANESE INTERMEDIATE CODE: A61 Effective date: 20221017 |
|
R151 | Written notification of patent or utility model registration |
Ref document number: 7172973 Country of ref document: JP Free format text: JAPANESE INTERMEDIATE CODE: R151 |