JP7346129B2 - 駐車支援装置及び駐車支援装置の制御方法 - Google Patents
駐車支援装置及び駐車支援装置の制御方法 Download PDFInfo
- Publication number
- JP7346129B2 JP7346129B2 JP2019138541A JP2019138541A JP7346129B2 JP 7346129 B2 JP7346129 B2 JP 7346129B2 JP 2019138541 A JP2019138541 A JP 2019138541A JP 2019138541 A JP2019138541 A JP 2019138541A JP 7346129 B2 JP7346129 B2 JP 7346129B2
- Authority
- JP
- Japan
- Prior art keywords
- parking
- detection range
- obstacle
- vehicle
- orientation
- 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
- 238000000034 method Methods 0.000 title claims description 23
- 238000001514 detection method Methods 0.000 claims description 349
- 230000015654 memory Effects 0.000 description 34
- 238000012545 processing Methods 0.000 description 20
- 238000010586 diagram Methods 0.000 description 17
- 238000003384 imaging method Methods 0.000 description 15
- 230000000875 corresponding effect Effects 0.000 description 10
- 230000006870 function Effects 0.000 description 6
- 230000001276 controlling effect Effects 0.000 description 4
- 230000005540 biological transmission Effects 0.000 description 2
- 230000005484 gravity Effects 0.000 description 2
- 239000004065 semiconductor Substances 0.000 description 2
- 238000006243 chemical reaction Methods 0.000 description 1
- 238000004891 communication Methods 0.000 description 1
- 230000000295 complement effect Effects 0.000 description 1
- 230000002596 correlated effect Effects 0.000 description 1
- 235000021189 garnishes Nutrition 0.000 description 1
- 230000007246 mechanism Effects 0.000 description 1
- 230000003287 optical effect Effects 0.000 description 1
- 238000012827 research and development Methods 0.000 description 1
- 239000007787 solid Substances 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, or advanced driver assistance systems for ensuring comfort, stability and safety or drive control systems for propelling or retarding the vehicle
- B60W30/06—Automatic manoeuvring for parking
-
- 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
- B60W40/00—Estimation or calculation of non-directly measurable driving parameters for road vehicle drive control systems not related to the control of a particular sub unit, e.g. by using mathematical models
-
- 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
- G06—COMPUTING; CALCULATING OR COUNTING
- G06V—IMAGE OR VIDEO RECOGNITION OR UNDERSTANDING
- G06V20/00—Scenes; Scene-specific elements
- G06V20/50—Context or environment of the image
- G06V20/56—Context or environment of the image exterior to a vehicle by using sensors mounted on the vehicle
- G06V20/58—Recognition of moving objects or obstacles, e.g. vehicles or pedestrians; Recognition of traffic objects, e.g. traffic signs, traffic lights or roads
- G06V20/586—Recognition of moving objects or obstacles, e.g. vehicles or pedestrians; Recognition of traffic objects, e.g. traffic signs, traffic lights or roads of parking space
-
- G—PHYSICS
- G08—SIGNALLING
- G08G—TRAFFIC CONTROL SYSTEMS
- G08G1/00—Traffic control systems for road vehicles
- G08G1/09—Arrangements for giving variable traffic instructions
- G08G1/0962—Arrangements for giving variable traffic instructions having an indicator mounted inside the vehicle, e.g. giving voice messages
- G08G1/0967—Systems involving transmission of highway information, e.g. weather, speed limits
-
- 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
- G08G1/141—Traffic control systems for road vehicles indicating individual free spaces in parking areas with means giving the indication of available parking spaces
- G08G1/143—Traffic control systems for road vehicles indicating individual free spaces in parking areas with means giving the indication of available parking spaces inside the vehicles
-
- 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
- G08G1/145—Traffic control systems for road vehicles indicating individual free spaces in parking areas where the indication depends on the parking areas
- G08G1/147—Traffic control systems for road vehicles indicating individual free spaces in parking areas where the indication depends on the parking areas where the parking area is within an open public zone, e.g. city centre
-
- G—PHYSICS
- G08—SIGNALLING
- G08G—TRAFFIC CONTROL SYSTEMS
- G08G1/00—Traffic control systems for road vehicles
- G08G1/16—Anti-collision systems
- G08G1/165—Anti-collision systems for passive traffic, e.g. including static obstacles, trees
-
- G—PHYSICS
- G08—SIGNALLING
- G08G—TRAFFIC CONTROL SYSTEMS
- G08G1/00—Traffic control systems for road vehicles
- G08G1/16—Anti-collision systems
- G08G1/168—Driving aids for parking, e.g. acoustic or visual feedback on parking space
-
- 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
- B60W2420/00—Indexing codes relating to the type of sensors based on the principle of their operation
- B60W2420/40—Photo or light sensitive means, e.g. infrared sensors
- B60W2420/403—Image sensing, e.g. optical camera
-
- 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
- B60W2420/00—Indexing codes relating to the type of sensors based on the principle of their operation
- B60W2420/54—Audio sensitive means, e.g. ultrasound
-
- 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
- B60W2554/00—Input parameters relating to objects
- B60W2554/40—Dynamic objects, e.g. animals, windblown objects
- B60W2554/404—Characteristics
- B60W2554/4044—Direction of movement, e.g. backwards
-
- 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
- B60W2554/00—Input parameters relating to objects
- B60W2554/80—Spatial relation or speed relative to objects
- B60W2554/801—Lateral distance
-
- 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
- B60W2554/00—Input parameters relating to objects
- B60W2554/80—Spatial relation or speed relative to objects
- B60W2554/802—Longitudinal distance
Description
図1は、車載装置1の構成を示すブロック図である。
車載装置1は、車両に搭載される装置であり、車載装置1を搭載した車両の走行を制御する。以下、車載装置1を搭載した車両を自車両5と表記し、自車両5以外の車両を他車両7と表記して自車両5と区別する。
センサ部10は、複数の超音波ソナーを備える。超音波ソナーを以下、簡単にソナーと表記する。本実施形態のセンサ部10は、ソナー15a~15fの6つのソナーを備える。
駐車支援装置100は、メモリ110と、プロセッサ130とを備えたコンピュータ装置であるECU(Electronic Control Unit)によって構成される。
不揮発性記憶装置は、制御プログラム115を記憶する。また、揮発性記憶装置は、センサ部10の検出情報や、撮像部30が生成した撮像画像等を記憶する。
障害物検出部132は、センサ部10の検出情報や、変換画像を解析して、自車両5の周囲に存在する障害物の距離や方位を示すデータをマップ200に記録する。マップ200は、例えば、メモリ110が備える揮発性記憶装置の記憶領域に生成される。マップ200には、自車両5の中心、例えば、前輪車軸中心や車の重心等を原点とし、自車両5の前後方向をY軸、左右方向をX軸とする座標系が設定される。すなわち、マップ200の座標系は、世界座標系に対応する。
駐車方向特定部134は、自車両5と他車両7とが図4に示す位置関係にあり、駐車種別が縦列駐車であると判定すると、駐車方向を、自車両5の前後軸8の方向に平行な方向と判定する。駐車方向とは、駐車領域300に駐車させた場合に、自車両5の前後軸8が向く方向を、図4に示す現在位置での自車両5の前後軸8の方向又は幅方向9により特定したものである。縦列駐車の場合、駐車領域300に自車両5を駐車させると、図6に示すように、移動前の自車両5の前後軸8の方向と、駐車領域300に移動後の自車両5の前後軸8の方向とは略平行な方向となる。なお、図6には、移動前の自車両5を破線で示し、移動後の自車両5を図6に実線で示す。この場合、駐車方向特定部134は、駐車方向を、自車両5の前後軸8に平行な方向と判定する。
また、駐車方向特定部134は、自車両5と他車両7とが図5に示す位置関係にあり、駐車種別が並列駐車であると判定すると、駐車方向を、自車両5の幅方向9に平行な方向と判定する。並列駐車の場合、駐車領域300に自車両5を駐車させると、図7に示すように、移動前の自車両5の幅方向9と、駐車領域300に移動後の自車両5の前後軸8の方向とは略平行な方向となる。なお、図7には移動前の自車両5を破線で示し、移動後の自車両5を実線で示す。この場合、駐車方向特定部134は、駐車方向を、自車両5の幅方向9に平行な方向と判定する。
仮駐車枠設定部135は、マップ200上に設定した駐車領域300内に仮駐車枠310を設定する。仮駐車枠310は、駐車領域300に自車両5を駐車させる場合の仮の駐車位置を示す。例えば、図8に示すように、駐車領域300の長手方向(自車両5の前後軸8の方向)の両側に、他車両7A、7Bが駐車している場合、仮駐車枠設定部135は、駐車領域300の長手方向における仮駐車枠310の位置を、他車両7Aと他車両7Bとの中間の位置に設定する。また、駐車領域300の長手方向の片側に、他車両7が駐車している場合、仮駐車枠設定部135は、他車両7との距離が予め設定された距離となるように駐車領域300の長手方向における仮駐車枠310の位置を設定する。
例えば、仮駐車枠設定部135は、他車両7A及び7Bの側面を検出し、検出した側面の自車両5の前後軸8との距離に基づいて仮駐車枠310の幅方向における位置を設定する。例えば、仮駐車枠設定部135は、他車両7Aの前輪と後輪との間を他車両7Aの側面Sとし、この側面S上の選択した複数の点と、自車両5の前後軸8との距離をそれぞれ求める。また、仮駐車枠設定部135は、他車両7Bの前輪と後輪との間を他車両7Bの側面Tとし、この側面T上の選択した複数の点と、自車両5の前後軸8との距離をそれぞれ求める。仮駐車枠設定部135は、求めた側面S及びTの複数の点の前後軸8との距離の平均値を算出し、算出した平均値を自車両5の幅方向における仮駐車枠310の位置に設定する。
検出範囲設定部136は、自車両5の現在位置に基づき、マップ200に検出範囲350を設定する。検出範囲350は、他車両7や、縁石やガードレール、塀、柵等の障害物を検出する範囲である。図9では説明の便宜のため、自車両5や他車両7に重ねて検出範囲350を示すが、実際には、検出範囲設定部136は、マップ200に検出範囲350を設定する。図10は、マップ200に検出範囲350が設定された状態を示す。図10には、検出範囲350を実線で示すが、検出範囲350を示すデータをマップ200に記録する必要はなく、検出範囲350に対応するマップ200の座標等をメモリ110に記録しておけばよい。なお、図10には、自車両5と検出範囲350との位置関係を明確にするため、自車両5の位置を破線で示す。
自車両5の前後軸8の方向における第2検出範囲370及び第3検出範囲380の長さは、例えば、車両の全長を検出可能なサイズに基づいて設定される。また、例えば、撮像部30の撮像画像により、他車両7がバスやトラックであることが検出された場合、バスやトラックに対応して第2検出範囲370や第3検出範囲380の長手方向の長さを変更してもよい。
分割部137は、検出範囲設定部136が設定した検出範囲350を分割して複数の分割範囲を生成する。分割部137は、駐車方向特定部134が駐車方向を自車両5の前後軸8の方向に平行な方向と判定した場合、検出範囲350の分割方向を、自車両5の前後軸8の方向に直交する方向と判定する。「自車両5の前後軸8の方向に直交する方向」は、駐車方向が自車両5の前後軸8の方向に平行な方向であると判定された場合に対応づけられた方向である。また、分割部137は、駐車方向特定部134が駐車方向を自車両5の幅方向9に平行な方向と判定した場合、検出範囲350の分割方向を、自車両5の幅方向9に直交する方向と判定する。「自車両5の幅方向9に直交する方向」は、駐車方向が自車両5の幅方向9に平行な方向であると判定された場合に対応づけられた方向である。
第1検出範囲360は、分割範囲361、分割範囲362、分割範囲363、分割範囲364、分割範囲365、分割範囲366、分割範囲367及び分割範囲368の8つの領域に分割される。
第2検出範囲370は、分割範囲371、分割範囲372、分割範囲373、分割範囲374、分割範囲375、分割範囲376、分割範囲377及び分割範囲378の8つの領域に分割される。
第3検出範囲380は、分割範囲381、分割範囲382、分割範囲383、分割範囲384、分割範囲385、分割範囲386、分割範囲387及び分割範囲388の8つの領域に分割される。
例えば、第1検出範囲360の分割範囲361を例にして説明すると、方位算出部138は、分割範囲361に対応するマップ200の領域を参照して、障害物が検出されたことを示すデータ210が記録されたマップ200の画素を特定する。方位算出部138は、分割範囲361において、データ210が記録された画素が少なくとも2以上検出された場合、最小二乗法に基づき、モデル関数とデータ210が記録された画素の座標値との二乗誤差が最小になるように、モデル関数の係数を算出して分割範囲361における障害物の方位を検出する。マップ200には、自車両5に面した障害物の側面との距離が記録されている。このため、データ210が記録された画素が少なくとも2以上検出された場合、最小二乗法に基づいて障害物の方位を検出することで、自車両5に面した障害物の側面の方位が特定される。
方位算出部138は、分割範囲361~368の障害物の方位のうち、仮駐車枠310の方位との差がしきい値よりも小さい方位を、メモリ110に記憶させ、仮駐車枠310の方位との差がしきい値以上の方位を、メモリ110に記憶させずに消去する。他車両7の前端部や後端部は、例えば、バンパー等の曲線によって構成される場合がある。この曲線部分を障害物の方位として検出し、検出した方位を用いて他車両7の方位を算出した場合、他車両7の方位に誤差が含まれ、好ましい方位とはならない場合がある。このため、方位算出部138は、仮駐車枠310の方位との差が予め設定されたしきい値以上ある分割範囲361~368での方位を、平均値の算出対象から除外する。
同様に、方位算出部138は、第3検出範囲380の分割範囲である分割範囲381~388の各々で算出した障害物の方位についても、仮駐車枠310の方位との比較を行う。方位算出部138は、分割範囲381~388における障害物の方位のうち、仮駐車枠310の方位との差がしきい値よりも小さい方位を、メモリ110に記憶させ、仮駐車枠310の方位との差がしきい値以上の方位を、メモリ110に記憶させずに消去する。
図12には、他車両7A及び7Bが道路の路肩に沿って駐車した状態を示す。道路は大きく屈曲しており、第2検出範囲370で検出される他車両7Aの側面の方位と、第3検出範囲380で検出される他車両7Bの側面の方位との方向が大きく異なる。このような場合に、第2検出範囲370において検出した障害物の方位と、第3検出範囲380において検出した障害物の方位との平均値を、仮駐車枠310の方位に設定した場合、駐車領域300に駐車させた自車両5の方位が好ましい方位にならない場合がある。そこで、本実施形態では、第2検出範囲370の分割範囲である分割範囲371~378における障害物の方位のうち、仮駐車枠310の方位との差がしきい値以上の方位を、メモリ110に記憶させずに消去する。同様に、第3検出範囲380の分割範囲である分割範囲381~388における障害物の方位のうち、仮駐車枠310の方位との差がしきい値以上の方位を、メモリ110に記憶させずに消去する。
同様に、方位算出部138は、分割範囲381~388における障害物の方位をメモリ110から取得する。分割範囲381~388のうち、メモリ110に記憶させずに消去した方位については、方位算出部138が取得することはない。方位算出部138は、分割範囲381~388に対応する障害物の方位を取得すると、取得した障害物の方位の平均値を求める。求めた障害物の方位は、第3検出範囲380における障害物の方位としてメモリ110に記憶される。
駐車方向特定部134は、自車両5の駐車種別が並列駐車である場合、駐車方向を、自車両5の幅方向9に平行な方向と判定する。分割部137は、自車両5の駐車方向が幅方向9に平行な方向である場合、この駐車方向に対応づけられた方向として、幅方向9に直交する方向に第1検出範囲360、第2検出範囲370及び第3検出範囲380を分割する。そして、方位算出部138は、第1検出範囲360、第2検出範囲370及び第3検出範囲380を分割した分割範囲361~368、371~378、381~388の各々において検出される障害物の方位を算出する。その後、方位算出部138は、分割範囲361~368における障害物の方位の平均値を、第1検出範囲360における障害物の方位として算出する。同様に、方位算出部138は、分割範囲371~378における障害物の方位の平均値を、第2検出範囲370における障害物の方位として算出し、分割範囲381~388における障害物の方位の平均値を、第3検出範囲380における障害物の方位として算出する。
図14に示すフローチャートを参照しながら本実施形態の動作を説明する。
まず、駐車支援装置100は、センサ部10の検出情報や、撮像部30の撮像画像をメモリ110から取得する(ステップS1)。
駐車支援装置100は、取得したセンサ部10の検出情報や、変換画像を解析して自車両5の周囲に存在する障害物を検出する。駐車支援装置100は、検出した障害物の距離や方位に対応するマップ200の位置に、障害物が存在することを示すデータ210を記録してマップ200を生成する(ステップS2)。ステップS2は、本発明の「障害物検出ステップ」に相当する。
まず、駐車支援装置100は、自車両5の現在位置を含む地図データ75をナビゲーション装置50から取得する。駐車支援装置100は、マップ200を参照して、自車両5を駐車可能な広さを有し、自車両5を駐車させたときに他車両7の走行の妨げにならない領域を検出する。駐車支援装置100は、検出した領域が、駐停車禁止路側帯、歩行者専用路側帯、駐停車禁止場所、停車禁止場所等の駐車や停車が禁止された場所であるか否かを、地図データ75を参照して判定する。駐車支援装置100は、検出した領域が駐車や停車が禁止されていない場合、この検出した領域を駐車領域と判定する。
例えば、駐車支援装置100は、左サイドカメラ33や、右サイドカメラ35の撮像画像から他車両7の側面が検出された場合、駐車領域300の駐車種別を縦列駐車と判定する。また、駐車支援装置100は、左サイドカメラ33や、右サイドカメラ35の撮像画像から他車両7の前面又は後面が検出された場合、駐車領域300の駐車種別を並列駐車と判定する。駐車支援装置100は、駐車種別を縦列駐車と判定した場合、駐車方向を、自車両5の前後軸8の方向に平行な方向と特定する。また、駐車方向特定部134は、駐車種別が並列駐車である場合、駐車方向を、自車両5の幅方向9に平行な方向と特定する。
例えば、図8に示すように駐車領域300の長手方向の両端部に、他車両7A、7Bが駐車している場合、仮駐車枠設定部135は、自車両5の前後軸8の方向における仮駐車枠310の位置を、他車両7A及び他車両7Bから等距離の位置に設定する。
また、駐車支援装置100は、分割範囲での障害物の方位と、仮駐車枠310の方位との差がしきい値よりも小さい場合(ステップS12/NO)、分割範囲での障害物の方位をメモリ110に記憶させる(ステップS13)。
駐車領域検出部133は、駐車支援装置100を搭載した自車両5が駐車可能な駐車領域300を検出する。
駐車方向特定部134は、駐車領域300に自車両5を駐車させる場合の駐車方向を特定する。
障害物検出部132は、自車両5の周囲に存在する障害物を検出する。
検出範囲設定部136は、駐車領域300と、駐車領域300に隣接する領域とを含む領域を、障害物の方位を検出する検出範囲350に設定する。
分割部137は、検出範囲350を、駐車方向特定部134が特定した駐車方向に対応づけられた方向に分割して複数の分割範囲361~368、371~378、381~388を生成する。
方位算出部138は、障害物検出部132により検出された障害物の方位であって、駐車方向に延伸する障害物の側面の方位を分割範囲361~368、371~378、381~388ごとに算出する。方位算出部138は、分割範囲361~368、371~378、381~388の各々で算出された障害物の方位の平均値を算出する。
駐車位置設定部139は、障害物の方位の平均値に基づいて駐車領域300に自車両5を駐車させる場合の駐車位置を設定する。
従って、本実施形態によれば、駐車位置の方位を、分割範囲361~368、371~378、381~388の各々で算出した障害物の方位の平均値に設定することができる。例えば、障害物として他車両7を検出した場合、自車両5を駐車させるときの方位を、分割範囲ごとの他車両7の側面の方位の平均値に設定することができる。このため、他車両7の方位に合わせて自車両5を駐車させることができる。
分割部137は、第1検出範囲360、第2検出範囲370及び第3検出範囲380の各々を複数に分割して分割範囲361~368、371~378、381~388を生成する。
方位算出部138は、第1検出範囲360、第2検出範囲370及び第3検出範囲380の検出範囲ごとに障害物の方位の平均値を算出する。また、方位算出部138は、第1検出範囲360を分割した分割範囲361~368で障害物の方位が算出された場合、算出された分割範囲361~368における障害物の方位の平均値を方位として出力する。
従って、駐車領域を含む第1検出範囲360で障害物が検出された場合に、駐車位置における自車両5の方位を、第1検出範囲360で検出された障害物の方位に合わせることができる。駐車領域300を含む第1検出範囲360で検出される障害物は、ガードレールや縁石、柵等であるため、これらの障害物の延伸方向に沿って自車両5を駐車させることができる。
方位算出部138は、算出した第2検出範囲370における障害物の方位の平均値と、第3検出範囲380における障害物の方位の平均値との平均値を方位として出力する。
従って、駐車領域を含む第1検出範囲360で障害物が検出されなかった場合に、駐車位置における自車両5の方位を、第2検出範囲370及び第3検出範囲380において検出された障害物の方位の平均値に設定することができる。このため、駐車位置における自車両5の方位を、駐車領域300に隣接する領域に駐車した他車両7の方位に合わせることができる。
従って、分割範囲361~368、371~378、381~388ごとに算出した障害物の方位のうち、仮駐車枠310の方位との差が、予め設定されたしきい値以上である方位を除外することができる。このため、第1検出範囲360、第2検出範囲370及び第3検出範囲380における障害物の方位の検出精度を高めることができる。
また、分割部137は、駐車方向特定部134が特定した駐車方向が、車両の幅方向9に平行な方向である場合、駐車方向に対応づけられた方向として、幅方向9に直交する方向に第1検出範囲360、第2検出範囲370及び第3検出範囲380を分割する。
従って、駐車領域300において自車両5を駐車方向に駐車させる場合に、障害物の方位を検出可能な最適な方向に、第1検出範囲360、第2検出範囲370及び第3検出範囲380を分割することができる。
例えば、図1には、センサ部10が備えるセンサとしてソナー15a~15fを例示したが、センサはソナーに限定されない。センサは、例えば、ミリ波レーダ、LIDAR(Light Detection and Ranging/Laser Imaging Detection and Ranging)であってもよい。
5 自車両
7 他車両
7A 他車両
7B 他車両
8 前後軸
9 幅方向
10 センサ部
15a~15f ソナー
30 撮像部
31 フロントカメラ
33 左サイドカメラ
35 右サイドカメラ
37 リアカメラ
50 ナビゲーション装置
70 記憶部
75 地図データ
90 車両制御ユニット
100 駐車支援装置
110 メモリ
115 制御プログラム
130 プロセッサ
131 画像処理部
132 障害物検出部
133 駐車領域検出部
134 駐車方向特定部
135 仮駐車枠設定部
136 検出範囲設定部
137 分割部
138 方位算出部
139 駐車位置設定部
140 駐車経路算出部
200 マップ
210 データ
300 駐車領域
310 仮駐車枠
350 検出範囲
360 第1検出範囲
361~368 分割範囲
370 第2検出範囲
371~378 分割範囲
380 第3検出範囲
381~388 分割範囲
Claims (8)
- 駐車支援装置であって、
前記駐車支援装置を搭載した車両が駐車可能な駐車領域を検出する駐車領域検出部と、
前記駐車領域に前記車両を駐車させる場合の駐車方向を特定する駐車方向特定部と、
前記車両の周囲に存在する障害物を検出する障害物検出部と、
前記駐車領域と、前記駐車領域に隣接する領域とを含む領域を、前記障害物の方位を検出する検出範囲に設定する検出範囲設定部と、
前記検出範囲を、前記駐車方向特定部が特定した前記駐車方向に対応づけられた方向に分割して複数の分割範囲を生成する分割部と、
前記障害物検出部により検出された前記障害物の方位であって、前記駐車方向に延伸する前記障害物の側面の方位を前記分割範囲ごとに算出し、前記分割範囲の各々で算出された前記障害物の方位の平均値を算出する方位算出部と、
前記方位算出部が算出した前記方位の平均値に基づいて前記駐車領域に前記車両を駐車させる場合の駐車位置を設定する駐車位置設定部と、を備え、
前記検出範囲は、前記駐車領域を含む第1検出範囲と、前記第1検出範囲に隣接する第2検出範囲及び第3検出範囲と、を含み、
前記分割部は、第1検出範囲、第2検出範囲及び第3検出範囲の各々を複数に分割して前記分割範囲を生成し、
前記方位算出部は、前記第1検出範囲、前記第2検出範囲及び前記第3検出範囲の検出範囲ごとに前記障害物の方位の平均値を算出し、
前記第1検出範囲を分割した前記分割範囲で前記障害物の方位が算出された場合、前記第1検出範囲における前記障害物の方位の平均値を出力する、ことを特徴とする駐車支援装置。 - 前記方位算出部は、前記第1検出範囲を分割した前記分割範囲で前記障害物の方位が算出されなかった場合、前記第2検出範囲を分割した前記分割範囲で算出された前記障害物の方位の平均値と、前記第3検出範囲を分割した前記分割範囲で算出された前記障害物の方位の平均値と、をそれぞれ算出し、
算出した前記第2検出範囲における前記障害物の方位の平均値と、前記第3検出範囲における前記障害物の方位の平均値と、の平均値を出力する、ことを特徴とする請求項1記載の駐車支援装置。 - 前記車両を駐車させる仮駐車枠を前記駐車領域に設定する仮駐車枠設定部を備え、
前記方位算出部は、前記仮駐車枠設定部が設定した前記仮駐車枠の方位を求め、
前記分割範囲ごとに算出した前記障害物の方位のうち、前記仮駐車枠の方位との差が、予め設定されたしきい値以上である方位を除外して、前記第1検出範囲、前記第2検出範囲及び前記第3検出範囲の検出範囲ごとに前記障害物の方位を算出する、ことを特徴とする請求項1又は2記載の駐車支援装置。 - 駐車支援装置であって、
前記駐車支援装置を搭載した車両が駐車可能な駐車領域を検出する駐車領域検出部と、
前記駐車領域に前記車両を駐車させる場合の駐車方向を特定する駐車方向特定部と、
前記車両の周囲に存在する障害物を検出する障害物検出部と、
前記駐車領域と、前記駐車領域に隣接する領域とを含む領域を、前記障害物の方位を検出する検出範囲に設定する検出範囲設定部と、
前記検出範囲を、前記駐車方向特定部が特定した前記駐車方向に対応づけられた方向に分割して複数の分割範囲を生成する分割部と、
前記障害物検出部により検出された前記障害物の方位であって、前記駐車方向に延伸する前記障害物の側面の方位を前記分割範囲ごとに算出し、前記分割範囲の各々で算出された前記障害物の方位の平均値を算出する方位算出部と、
前記方位算出部が算出した前記方位の平均値に基づいて前記駐車領域に前記車両を駐車させる場合の駐車位置を設定する駐車位置設定部と、を備え、
前記分割部は、
前記駐車方向特定部が特定した前記駐車方向が、前記車両の前後軸方向に平行な方向である場合、前記駐車方向に対応づけられた方向として、前記前後軸方向に直交する方向に前記検出範囲を分割し、
前記駐車方向特定部が特定した前記駐車方向が、前記車両の幅方向に平行な方向である場合、前記駐車方向に対応づけられた方向として、前記幅方向に直交する方向に前記検出範囲を分割する、ことを特徴とする駐車支援装置。 - 駐車支援装置の制御方法であって、
前記駐車支援装置を搭載した車両が駐車可能な駐車領域を検出する駐車領域検出ステップと、
前記駐車領域に前記車両を駐車させる場合の駐車方向を特定する駐車方向特定ステップと、
前記車両の周囲に存在する障害物を検出する障害物検出ステップと、
前記駐車領域と、前記駐車領域に隣接する領域とを含む領域を、前記障害物の方位を検出する検出範囲に設定する検出範囲設定ステップと、
前記検出範囲を、前記駐車方向特定ステップにより特定した前記駐車方向に対応づけられた方向に分割して複数の分割範囲を生成する分割ステップと、
前記障害物検出ステップにより検出された障害物の方位であって、前記駐車方向に延伸する前記障害物の側面の方位を前記分割範囲ごとに算出し、前記分割範囲の各々で算出された前記障害物の方位の平均値を算出する方位算出ステップと、
前記方位算出ステップにより算出された前記方位の平均値に基づいて前記駐車領域に前記車両を駐車させる場合の駐車位置を設定する駐車位置設定ステップと、を有し、
前記検出範囲は、前記駐車領域を含む第1検出範囲と、前記第1検出範囲に隣接する第2検出範囲及び第3検出範囲と、を含み、
前記分割ステップは、第1検出範囲、第2検出範囲及び第3検出範囲の各々を複数に分割して前記分割範囲を生成し、
前記方位算出ステップは、前記第1検出範囲、前記第2検出範囲及び前記第3検出範囲の検出範囲ごとに前記障害物の方位の平均値を算出し、
前記第1検出範囲を分割した前記分割範囲で前記障害物の方位が算出された場合、前記第1検出範囲における前記障害物の方位の平均値を出力する、ことを特徴とする駐車支援装置の制御方法。 - 前記方位算出ステップは、前記第1検出範囲を分割した前記分割範囲で前記障害物の方位が算出されなかった場合、前記第2検出範囲を分割した前記分割範囲で算出された前記障害物の方位の平均値と、前記第3検出範囲を分割した前記分割範囲で算出された前記障害物の方位の平均値と、をそれぞれ算出し、
算出した前記第2検出範囲における前記障害物の方位の平均値と、前記第3検出範囲における前記障害物の方位の平均値と、の平均値を出力する、ことを特徴とする請求項5記載の駐車支援装置の制御方法。 - 前記車両を駐車させる仮駐車枠を前記駐車領域に設定する仮駐車枠設定ステップを有し、
前記方位算出ステップは、前記仮駐車枠設定ステップにより設定された前記仮駐車枠の方位を求め、
前記分割範囲ごとに算出した前記障害物の方位のうち、前記仮駐車枠の方位との差が、予め設定されたしきい値以上である方位を除外して、前記第1検出範囲、前記第2検出範囲及び前記第3検出範囲の検出範囲ごとに前記障害物の方位を算出する、ことを特徴とする請求項5又は6記載の駐車支援装置の制御方法。 - 駐車支援装置の制御方法であって、
前記駐車支援装置を搭載した車両が駐車可能な駐車領域を検出する駐車領域検出ステップと、
前記駐車領域に前記車両を駐車させる場合の駐車方向を特定する駐車方向特定ステップと、
前記車両の周囲に存在する障害物を検出する障害物検出ステップと、
前記駐車領域と、前記駐車領域に隣接する領域とを含む領域を、前記障害物の方位を検出する検出範囲に設定する検出範囲設定ステップと、
前記検出範囲を、前記駐車方向特定ステップにより特定した前記駐車方向に対応づけられた方向に分割して複数の分割範囲を生成する分割ステップと、
前記障害物検出ステップにより検出された障害物の方位であって、前記駐車方向に延伸する前記障害物の側面の方位を前記分割範囲ごとに算出し、前記分割範囲の各々で算出された前記障害物の方位の平均値を算出する方位算出ステップと、
前記方位算出ステップにより算出された前記方位の平均値に基づいて前記駐車領域に前記車両を駐車させる場合の駐車位置を設定する駐車位置設定ステップと、を有し、
前記分割ステップは、
前記駐車方向特定ステップにより特定された前記駐車方向が、前記車両の前後軸方向に平行な方向である場合、前記駐車方向に対応づけられた方向として、前記前後軸方向に直交する方向に前記検出範囲を分割し、
前記駐車方向特定ステップにより特定された前記駐車方向が、前記車両の幅方向に平行な方向である場合、前記駐車方向に対応づけられた方向として、前記幅方向に直交する方向に前記検出範囲を分割する、ことを特徴とする駐車支援装置の制御方法。
Priority Applications (4)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP2019138541A JP7346129B2 (ja) | 2019-07-29 | 2019-07-29 | 駐車支援装置及び駐車支援装置の制御方法 |
US16/912,765 US11465613B2 (en) | 2019-07-29 | 2020-06-26 | Parking assistance device and control method of parking assistance device |
CN202010728310.0A CN112298166B (zh) | 2019-07-29 | 2020-07-24 | 驻车支援装置以及驻车支援装置的控制方法 |
EP20187762.8A EP3771620B1 (en) | 2019-07-29 | 2020-07-24 | Parking assistance device and control method of parking assistance device |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP2019138541A JP7346129B2 (ja) | 2019-07-29 | 2019-07-29 | 駐車支援装置及び駐車支援装置の制御方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
JP2021020571A JP2021020571A (ja) | 2021-02-18 |
JP7346129B2 true JP7346129B2 (ja) | 2023-09-19 |
Family
ID=71894595
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
JP2019138541A Active JP7346129B2 (ja) | 2019-07-29 | 2019-07-29 | 駐車支援装置及び駐車支援装置の制御方法 |
Country Status (4)
Country | Link |
---|---|
US (1) | US11465613B2 (ja) |
EP (1) | EP3771620B1 (ja) |
JP (1) | JP7346129B2 (ja) |
CN (1) | CN112298166B (ja) |
Families Citing this family (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US20220013012A1 (en) * | 2020-07-10 | 2022-01-13 | Toyota Motor Engineering & Manufacturing North America, Inc. | Vehicle parking assistance |
CN113096436B (zh) * | 2021-03-25 | 2022-12-23 | 建信金融科技有限责任公司 | 一种室内泊车方法和装置 |
Citations (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP2006193011A (ja) | 2005-01-12 | 2006-07-27 | Toyota Motor Corp | 駐車支援装置 |
JP2013220745A (ja) | 2012-04-17 | 2013-10-28 | Nippon Soken Inc | 駐車空間検知装置 |
Family Cites Families (25)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP4723703B2 (ja) * | 1999-06-25 | 2011-07-13 | 富士通テン株式会社 | 車両の運転支援装置 |
US7366595B1 (en) * | 1999-06-25 | 2008-04-29 | Seiko Epson Corporation | Vehicle drive assist system |
JP4323010B2 (ja) * | 1999-07-07 | 2009-09-02 | 株式会社東海理化電機製作所 | 車両における走行路認識方法及び走行路認識装置 |
JP2007176244A (ja) * | 2005-12-27 | 2007-07-12 | Aisin Seiki Co Ltd | 駐車支援装置 |
DE102006003489A1 (de) * | 2006-01-25 | 2007-07-26 | Robert Bosch Gmbh | Vorrichtung und Verfahren zur Unterstützung eines Einparkvorgangs eines Fahrzeugs |
DE102006061390B4 (de) * | 2006-12-23 | 2019-05-16 | Volkswagen Ag | Umfelderfassungssystem und Umfelderfassungsverfahren eines Kraftfahrzeugs |
WO2014091858A1 (ja) * | 2012-12-12 | 2014-06-19 | 本田技研工業株式会社 | 駐車スペース検出装置 |
EP2990273A4 (en) * | 2013-04-26 | 2016-04-06 | Toyota Motor Co Ltd | PARK ASSIST |
KR101521842B1 (ko) * | 2014-08-27 | 2015-05-20 | 현대모비스 주식회사 | 주차 공간 탐색 장치 및 그 탐색 방법 |
JP5995931B2 (ja) * | 2014-09-12 | 2016-09-21 | アイシン精機株式会社 | 駐車支援装置、駐車支援方法及び制御プログラム |
JP6275006B2 (ja) * | 2014-09-12 | 2018-02-07 | アイシン精機株式会社 | 駐車支援装置 |
JP6573795B2 (ja) * | 2015-07-31 | 2019-09-11 | アイシン精機株式会社 | 駐車支援装置、方法及びプログラム |
JP6547495B2 (ja) * | 2015-07-31 | 2019-07-24 | アイシン精機株式会社 | 駐車支援装置 |
WO2017060975A1 (ja) | 2015-10-06 | 2017-04-13 | 三菱電機株式会社 | 駐車形態判定装置 |
KR101745152B1 (ko) * | 2015-10-13 | 2017-06-08 | 현대자동차주식회사 | 전자동 주차 시스템 및 그 동작 방법 |
RU2713960C2 (ru) * | 2015-12-17 | 2020-02-11 | Ниссан Мотор Ко., Лтд. | Способ и устройство содействия при парковке |
KR101965834B1 (ko) * | 2016-10-12 | 2019-08-13 | 엘지전자 주식회사 | 자동주차 보조장치 및 이를 포함하는 차량 |
KR20180044605A (ko) * | 2016-10-24 | 2018-05-03 | 엘에스오토모티브테크놀로지스 주식회사 | 장애물의 감지영역을 가변하는 주차 보조 장치 및 방법 |
JP6773540B2 (ja) * | 2016-12-07 | 2020-10-21 | クラリオン株式会社 | 車載用画像処理装置 |
JP6836189B2 (ja) * | 2017-08-30 | 2021-02-24 | トヨタ自動車株式会社 | 操舵支援装置 |
JP6859906B2 (ja) * | 2017-09-06 | 2021-04-14 | トヨタ自動車株式会社 | 駐車支援装置 |
DE102017120765A1 (de) * | 2017-09-08 | 2019-03-14 | Valeo Schalter Und Sensoren Gmbh | Verfahren zum Charakterisieren einer von zwei Objekten begrenzten Parklücke für ein Kraftfahrzeug, Parkassistenzsystem sowie Kraftfahrzeug |
JP6825529B2 (ja) * | 2017-09-28 | 2021-02-03 | トヨタ自動車株式会社 | 走行支援装置 |
JP6989333B2 (ja) * | 2017-09-29 | 2022-01-05 | フォルシアクラリオン・エレクトロニクス株式会社 | 駐車支援装置 |
US11137256B2 (en) * | 2018-06-29 | 2021-10-05 | Robert Bosch Gmbh | Parking area map refinement using occupancy behavior anomaly detector |
-
2019
- 2019-07-29 JP JP2019138541A patent/JP7346129B2/ja active Active
-
2020
- 2020-06-26 US US16/912,765 patent/US11465613B2/en active Active
- 2020-07-24 CN CN202010728310.0A patent/CN112298166B/zh active Active
- 2020-07-24 EP EP20187762.8A patent/EP3771620B1/en active Active
Patent Citations (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP2006193011A (ja) | 2005-01-12 | 2006-07-27 | Toyota Motor Corp | 駐車支援装置 |
JP2013220745A (ja) | 2012-04-17 | 2013-10-28 | Nippon Soken Inc | 駐車空間検知装置 |
Also Published As
Publication number | Publication date |
---|---|
US11465613B2 (en) | 2022-10-11 |
EP3771620B1 (en) | 2022-04-27 |
US20210031755A1 (en) | 2021-02-04 |
EP3771620A1 (en) | 2021-02-03 |
JP2021020571A (ja) | 2021-02-18 |
CN112298166A (zh) | 2021-02-02 |
CN112298166B (zh) | 2024-03-08 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
JP7398196B2 (ja) | 駐車支援装置及び駐車支援方法 | |
CN111028534B (zh) | 一种泊车位检测方法及装置 | |
US20210316721A1 (en) | Vehicle and method of controlling the same | |
CN112771591B (zh) | 用于评价运输工具的环境中的对象对运输工具的行驶机动动作的影响的方法 | |
JP7346129B2 (ja) | 駐車支援装置及び駐車支援装置の制御方法 | |
US11498552B2 (en) | Parking assistance device and control method of parking assistance device | |
EP4046883A1 (en) | Automated valet parking system, control method of automated valet parking system, and autonomous driving vehicle | |
JP7149060B2 (ja) | 移動物体認識装置 | |
US11326898B2 (en) | Parking assist apparatus and parking assist method | |
US11900694B2 (en) | Parking assist system | |
US20220379877A1 (en) | Parking Assist System and Parking Assist Method | |
US11772676B2 (en) | Driving support device | |
US20220196422A1 (en) | Parking assistance device and parking assistance method | |
WO2024069689A1 (ja) | 運転支援方法及び運転支援装置 | |
WO2023090186A1 (ja) | 駐車支援装置 | |
JP7372167B2 (ja) | 駐車支援装置及び駐車支援方法 | |
US20220379878A1 (en) | Parking Assist System and Parking Assist Method | |
KR20210071454A (ko) | 차량 및 제어방법 | |
JP2023069777A (ja) | 走行支援装置及び走行支援方法 |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
A621 | Written request for application examination |
Free format text: JAPANESE INTERMEDIATE CODE: A621 Effective date: 20220704 |
|
A977 | Report on retrieval |
Free format text: JAPANESE INTERMEDIATE CODE: A971007 Effective date: 20230315 |
|
A131 | Notification of reasons for refusal |
Free format text: JAPANESE INTERMEDIATE CODE: A131 Effective date: 20230328 |
|
A521 | Request for written amendment filed |
Free format text: JAPANESE INTERMEDIATE CODE: A523 Effective date: 20230526 |
|
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: 20230822 |
|
A61 | First payment of annual fees (during grant procedure) |
Free format text: JAPANESE INTERMEDIATE CODE: A61 Effective date: 20230906 |
|
R150 | Certificate of patent or registration of utility model |
Ref document number: 7346129 Country of ref document: JP Free format text: JAPANESE INTERMEDIATE CODE: R150 |