JP2021189575A - Parking assist device, and control method for parking assist device - Google Patents

Parking assist device, and control method for parking assist device Download PDF

Info

Publication number
JP2021189575A
JP2021189575A JP2020091913A JP2020091913A JP2021189575A JP 2021189575 A JP2021189575 A JP 2021189575A JP 2020091913 A JP2020091913 A JP 2020091913A JP 2020091913 A JP2020091913 A JP 2020091913A JP 2021189575 A JP2021189575 A JP 2021189575A
Authority
JP
Japan
Prior art keywords
vehicle
parking
obstacle
parking lot
virtual obstacle
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
Application number
JP2020091913A
Other languages
Japanese (ja)
Other versions
JP7445515B2 (en
Inventor
真 石野田
Makoto ISHINODA
晋也 田川
Shinya Tagawa
Current Assignee (The listed assignees may be inaccurate. Google has not performed a legal analysis and makes no representation or warranty as to the accuracy of the list.)
Faurecia Clarion Electronics Co Ltd
Original Assignee
Faurecia Clarion Electronics Co Ltd
Priority date (The priority date 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 date listed.)
Filing date
Publication date
Application filed by Faurecia Clarion Electronics Co Ltd filed Critical Faurecia Clarion Electronics Co Ltd
Priority to JP2020091913A priority Critical patent/JP7445515B2/en
Priority to CN202110556344.0A priority patent/CN113734152A/en
Priority to US17/329,283 priority patent/US11491973B2/en
Priority to EP21175680.4A priority patent/EP3915858B1/en
Publication of JP2021189575A publication Critical patent/JP2021189575A/en
Application granted granted Critical
Publication of JP7445515B2 publication Critical patent/JP7445515B2/en
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Images

Landscapes

  • Control Of Driving Devices And Active Controlling Of Vehicle (AREA)
  • Traffic Control Systems (AREA)

Abstract

To further appropriately set a parking route.SOLUTION: A parking assist device 100 comprises: a position detection section 110 for detecting a present position of a vehicle 1; an obstacle detection section 112 for detecting an obstacle by the side of the vehicle 1 in accordance with information from a sonar provided in the vehicle 1; a parking area detection section 114 for detecting a parking area T by detecting a partitioning line TA on the basis of a captured image resulting from imaging the periphery of the vehicle 1; a virtual obstacle setting section 116 for setting a virtual obstacle C at a position adjacent to the parking area T; a virtual obstacle moving section 117 for moving the virtual obstacle C in parallel in a passage direction F of the vehicle 1 for a moving amount M corresponding to a separation distance L between the parking area T and the vehicle 1 in a case where the vehicle 1 passes the parking area T; and a parking route calculation section 118 for calculating a parking route for the vehicle 1 to move from the present position and to be parked in the parking area T on the basis of the present position of the vehicle and positions of the obstacle detected by the sonar, the virtual obstacle C and the parking area T.SELECTED DRAWING: Figure 1

Description

本発明は、駐車支援装置、及び駐車支援装置の制御方法に関する。 The present invention relates to a parking support device and a control method for the parking support device.

駐車支援に係る技術として特許文献1がある。
特許文献1の要約書の課題の欄には、「他の車両の進路に影響を与えずに安全に駐車支援を行うことを可能にする。」ことが記載されている。
特許文献1の要約書の解決手段の欄には、「本願発明の駐車支援装置は、車両の外部を検知する外部検知センサからのセンサ入力に基づいて周辺情報を生成する外部検知センサ入力処理部と、駐車位置の設定を行う駐車位置設定部と、駐車位置設定部により設定された駐車位置に基づいて仮想障害物情報を生成する仮想障害物生成部と、周辺情報と仮想障害物情報とに基づいて車両の現在位置から駐車位置までの駐車経路を生成する駐車経路計算部とを備える。」ことが記載されている。
Patent Document 1 is a technique related to parking support.
In the column of the subject of the abstract of Patent Document 1, it is stated that "it is possible to safely provide parking assistance without affecting the course of other vehicles."
In the column of the means for solving the abstract of Patent Document 1, "The parking support device of the present invention is an external detection sensor input processing unit that generates peripheral information based on sensor input from an external detection sensor that detects the outside of the vehicle. , A parking position setting unit that sets the parking position, a virtual obstacle generation unit that generates virtual obstacle information based on the parking position set by the parking position setting unit, and peripheral information and virtual obstacle information. It is provided with a parking route calculation unit that generates a parking route from the current position of the vehicle to the parking position based on the above. "

特開2019-182154号公報Japanese Unexamined Patent Publication No. 2019-182154

特許文献1において、より適切な駐車経路を得るには、仮想障害物の設定に改善の余地があった。 In Patent Document 1, there is room for improvement in the setting of virtual obstacles in order to obtain a more appropriate parking route.

本発明は、より適切な駐車経路を得ることができる駐車支援装置、及び駐車支援装置の制御方法を提供することを目的とする。 An object of the present invention is to provide a parking support device capable of obtaining a more appropriate parking route, and a control method for the parking support device.

本発明の一態様は、車両の現在位置を検出する位置検出部と、前記車両に設けられたソナーからの情報によって当該車両の側方の障害物を検出する障害物検出部と、前記車両の周辺を撮影した撮影画像に基づいて区画線を検出することで駐車区画を検出する駐車区画検出部と、仮想障害物を前記駐車区画に隣接した位置に設定する仮想障害物設定部と、前記車両が前記駐車区画を通過している場合、前記駐車区画と前記車両との離間距離に応じた移動量で、前記車両の通過方向へ、前記仮想障害物を平行移動する仮想障害物移動部と、前記車両の現在位置と、前記ソナーによって検出された障害物、前記仮想障害物、及び前記駐車区画のそれぞれの位置と、に基づいて、前記車両が現在位置から移動し前記駐車区画へ駐車する駐車経路を計算する駐車経路計算部と、を備えることを特徴とする駐車支援装置である。 One aspect of the present invention includes a position detection unit that detects the current position of the vehicle, an obstacle detection unit that detects an obstacle on the side of the vehicle based on information from a sonar provided on the vehicle, and an obstacle detection unit of the vehicle. A parking lot detection unit that detects a parking lot by detecting a lane marking based on a photographed image of the surrounding area, a virtual obstacle setting unit that sets a virtual obstacle at a position adjacent to the parking lot, and the vehicle. When the vehicle has passed through the parking lot, a virtual obstacle moving unit that moves the virtual obstacle in parallel in the passing direction of the vehicle with a movement amount corresponding to the distance between the parking lot and the vehicle. Parking where the vehicle moves from its current position and parks in the parking lot based on the current position of the vehicle and the respective positions of the obstacle detected by the sonar, the virtual obstacle, and the parking lot. It is a parking support device characterized by comprising a parking route calculation unit for calculating a route.

本発明によれば、より適切な駐車経路を得ることができる。 According to the present invention, a more appropriate parking route can be obtained.

本発明の実施形態に係る駐車支援装置が搭載された車両の構成を示す図である。It is a figure which shows the structure of the vehicle which is equipped with the parking support device which concerns on embodiment of this invention. サイドソナー及びカメラの設置態様の一例を示す図である。It is a figure which shows an example of the installation mode of a side sonar and a camera. 駐車区画を示す図である。It is a figure which shows the parking lot. サイドソナーの検出範囲の位置に基づく仮想障害物の位置の移動を示す図である。It is a figure which shows the movement of the position of a virtual obstacle based on the position of the detection range of a side sonar. サイドソナーによる障害物の検出結果に基づく駐車可能スペースの検出例を示す図である。It is a figure which shows the detection example of the parkingable space based on the detection result of the obstacle by the side sonar. 離間距離の説明図である。It is explanatory drawing of the separation distance. 駐車区画の検出タイミングの説明図である。It is explanatory drawing of the detection timing of a parking lot. 駐車支援処理のフローチャートである。It is a flowchart of parking support processing. 仮想障害物の移動による駐車経路の違いを示す図である。It is a figure which shows the difference of the parking route by the movement of a virtual obstacle. 本発明の変形例に係る駐車区画を示す図である。It is a figure which shows the parking lot which concerns on the modification of this invention.

以下、図面を参照して本発明の実施形態について説明する。
図1は、本実施形態に係る駐車支援装置100が搭載された車両1の構成を示す図である。
車両1は、周辺検出センサ部10と、車両センサ部20と、車両制御装置30と、駐車支援装置100と、を備え、これらがCAN(Controller Area Network)バスなどの車載ネットワーク5を通じてデータ通信可能に接続されている。
Hereinafter, embodiments of the present invention will be described with reference to the drawings.
FIG. 1 is a diagram showing a configuration of a vehicle 1 equipped with a parking support device 100 according to the present embodiment.
The vehicle 1 includes a peripheral detection sensor unit 10, a vehicle sensor unit 20, a vehicle control device 30, and a parking support device 100, which can perform data communication through an in-vehicle network 5 such as a CAN (Controller Area Network) bus. It is connected to the.

周辺検出センサ部10は、車両1の周辺の情報を検出するための各種のセンサを備え、検出結果(出力)を駐車支援装置100に出力する。以下、周辺の情報を「周辺情報」と言う。
周辺情報は、車両1の周辺に存在する物体の情報を含んでいる。当該物体は、例えば障害物や、車両1の駐車区画を区画する区画線などである。障害物は、車両1の走行の妨げになる各種の物体である。障害物の典型的な例として、柱や壁、消火栓などの建造物、駐車中や走行中の他車両、及び通行人が挙げられる。
The peripheral detection sensor unit 10 includes various sensors for detecting information around the vehicle 1, and outputs the detection result (output) to the parking support device 100. Hereinafter, the peripheral information is referred to as "peripheral information".
Peripheral information includes information on objects existing around the vehicle 1. The object is, for example, an obstacle, a lane marking line for dividing the parking lot of the vehicle 1, or the like. Obstacles are various objects that hinder the running of the vehicle 1. Typical examples of obstacles include structures such as pillars and walls, fire hydrants, other parked and running vehicles, and passersby.

本実施形態の周辺検出センサ部10は、サイドソナー10A、及びカメラ10Bを備えている。
サイドソナー10Aは、周辺の障害物を音波によって検出し、当該障害物と車両1との間の距離を測定する測距センサである。
サイドソナー10Aは、図2に示すように、車両1の左側、及び右側のそれぞれに配置されている。サイドソナー10Aは、扇状を成す検出範囲Rの中心角が通常のソナーよりも狭くなることで、当該検出範囲Rが略ビーム状を成している。これにより、サイドソナー10Aは、車両1の側方へ高い指向性を有し、車両1から比較的遠方(例えば5メートルなど)まで高精度に障害物を検出する。また車両1の走行にともなって(図2の例では前進走行)、車両1のサイドソナー10Aの検出範囲Rが通過した領域Wについて障害物が高精度に検出される。
The peripheral detection sensor unit 10 of the present embodiment includes a side sonar 10A and a camera 10B.
The side sonar 10A is a distance measuring sensor that detects an obstacle in the vicinity by sound waves and measures the distance between the obstacle and the vehicle 1.
As shown in FIG. 2, the side sonar 10A is arranged on the left side and the right side of the vehicle 1, respectively. In the side sonar 10A, the central angle of the detection range R forming a fan shape is narrower than that of a normal sonar, so that the detection range R has a substantially beam shape. As a result, the side sonar 10A has high directivity toward the side of the vehicle 1 and detects obstacles with high accuracy from a relatively long distance (for example, 5 meters) from the vehicle 1. Further, as the vehicle 1 travels (forward travel in the example of FIG. 2), obstacles are detected with high accuracy in the region W through which the detection range R of the side sonar 10A of the vehicle 1 has passed.

カメラ10Bは、駐車区画T(図3)を撮影する撮影手段である。
本実施形態の車両1は、図2に示すように、前方、左側方、右側方、及び後方のそれぞれにカメラ10Bが設けられている。これらのカメラ10Bによって車両1を中心とした全方位が撮影される。
なお、カメラ10Bは全方位を1台のカメラで撮影するものであってもよい。またカメラ10Bによる撮影範囲、及びカメラ10Bの台数は適宜に変更可能である。
The camera 10B is a photographing means for photographing the parking lot T (FIG. 3).
As shown in FIG. 2, the vehicle 1 of the present embodiment is provided with cameras 10B on the front side, the left side side, the right side side, and the rear side, respectively. All directions centered on the vehicle 1 are photographed by these cameras 10B.
The camera 10B may be used to shoot in all directions with one camera. Further, the shooting range by the camera 10B and the number of cameras 10B can be appropriately changed.

車両センサ部20は、車両1の走行状態の検出と、自律航法(デッドレコニング)に要する各種の情報と、の検出のための各種のセンサを備えている。かかるセンサは、車両1に搭載されたセンサであり、例えば、ジャイロセンサや加速度センサ、車速センサ、車両1の操舵角を検出する舵角センサなどである。 The vehicle sensor unit 20 includes various sensors for detecting the traveling state of the vehicle 1 and various information required for autonomous navigation (dead reckoning). Such a sensor is a sensor mounted on the vehicle 1, for example, a gyro sensor, an acceleration sensor, a vehicle speed sensor, a steering angle sensor for detecting the steering angle of the vehicle 1, and the like.

車両制御装置30は、車両1が備える操舵装置、駆動装置、及び制動制御装置を制御することで、駐車支援装置100によって算出された後述する駐車経路に基づいて車両1を自律的に移動(自動走行)させる装置である。車両制御装置30は、かかる制御を実行するコンピュータ(例えばECU(Electronic Conrtol Unit))を備えている。
なお、操舵装置は、車両1の操舵輪を操舵させるアクチュエータを含む装置である。
また駆動装置は、車両1の駆動輪の駆動力を調整するアクチュエータを含む装置である。車両1の動力源がエンジンである場合、駆動装置のアクチュエータは、スロットルアクチュエータである。動力源がモータである場合、駆動装置のアクチュエータは、動力源のモータである。
制動制御装置は、車両1に設けられたブレーキシステムを制御することで、車両1の車輪へ付与する制動力を制御するアクチュエータを備えている。
The vehicle control device 30 autonomously moves (automatically) the vehicle 1 based on the parking route to be described later calculated by the parking support device 100 by controlling the steering device, the drive device, and the braking control device included in the vehicle 1. It is a device to run). The vehicle control device 30 includes a computer (for example, an ECU (Electronic Control Unit)) that executes such control.
The steering device is a device including an actuator for steering the steering wheel of the vehicle 1.
The drive device is a device including an actuator that adjusts the drive force of the drive wheels of the vehicle 1. When the power source of the vehicle 1 is an engine, the actuator of the drive device is a throttle actuator. When the power source is a motor, the actuator of the drive device is the motor of the power source.
The braking control device includes an actuator that controls the braking force applied to the wheels of the vehicle 1 by controlling the braking system provided in the vehicle 1.

駐車支援装置100は、車両1を駐車区画Tへ自動走行させて車両1の駐車を支援する装置である。
駐車支援装置100は、CPU(Central Processing Unit)やMPU(Microprocessor Unit)などのプロセッサと、ROM(Read Only Memory)やRAM(Random Access Memory)などのメモリデバイス(主記憶装置とも呼ばれる)と、HDD(Hard Disk Drive)やSSD(Solid State Drive)などのストレージ装置(補助記憶装置とも呼ばれる)と、センサ類や周辺機器などを接続するためのインターフェース回路と、車載ネットワーク5を介して他の車載装置と通信する車載ネットワーク通信回路と、を備えたコンピュータを備えている。かかるコンピュータとして、ECU(Electronic Conrtol Unit))が用いられている。
駐車支援装置100において、プロセッサがメモリデバイス又はストレージ装置に記憶されているコンピュータプログラムを実行することで、図1に示す各種の機能的構成が実現されている。
The parking support device 100 is a device that automatically drives the vehicle 1 to the parking section T to support the parking of the vehicle 1.
The parking support device 100 includes a processor such as a CPU (Central Processing Unit) and an MPU (Microtechnology Unit), a memory device (also referred to as a main storage device) such as a ROM (Read Only Memory) and a RAM (Random Access Memory), and an HDD. Storage devices (also called auxiliary storage devices) such as (Hard Disk Drive) and SSD (Solid State Drive), interface circuits for connecting sensors and peripheral devices, and other in-vehicle devices via the in-vehicle network 5. It is equipped with a computer equipped with an in-vehicle network communication circuit that communicates with. As such a computer, an ECU (Electronic Control Unit) is used.
In the parking support device 100, various functional configurations shown in FIG. 1 are realized by the processor executing a computer program stored in the memory device or the storage device.

すなわち、駐車支援装置100は、機能的構成として、位置検出部110と、周辺情報取得部111と、障害物検出部112、マップ生成部113と、駐車区画検出部114と、駐車枠設定部115と、仮想障害物設定部116と、仮想障害物移動部117と、駐車経路計算部118と、自動走行制御部119と、を備えている。 That is, the parking support device 100 has a position detection unit 110, a peripheral information acquisition unit 111, an obstacle detection unit 112, a map generation unit 113, a parking section detection unit 114, and a parking frame setting unit 115 as functional configurations. A virtual obstacle setting unit 116, a virtual obstacle moving unit 117, a parking route calculation unit 118, and an automatic traveling control unit 119 are provided.

位置検出部110は、車両センサ部20の検出結果(出力)に基づいて、車両1の現在位置(自己位置)を、公知、又は周知のデッドレコニング手法を用いて検出する。 The position detection unit 110 detects the current position (self-position) of the vehicle 1 based on the detection result (output) of the vehicle sensor unit 20 by using a known or well-known dead reckoning method.

周辺情報取得部111は、周辺検出センサ部10の検出結果(出力)に基づいて周辺情報を取得する。サイドソナー10Aの検出範囲Rは、上述の通り、図2に示す扇状となっている。そして、このサイドソナー10Aは、検出範囲Rのうち、当該扇状の中心(検出の指向方向に一致)である主軸RKを中心とした所定角度(ただし、0<所定角度<扇状の中心角)の範囲において最も信頼度が高い検出結果が得られる構成となっている。 The peripheral information acquisition unit 111 acquires peripheral information based on the detection result (output) of the peripheral detection sensor unit 10. As described above, the detection range R of the side sonar 10A has a fan shape as shown in FIG. The side sonar 10A has a predetermined angle (however, 0 <predetermined angle <fan-shaped central angle) about the main axis RK, which is the center of the fan shape (corresponding to the direction of detection) in the detection range R. The configuration is such that the most reliable detection result can be obtained in the range.

障害物検出部112は、周辺情報に基づいて、車両1の周辺の障害物を検出する。
より具体的には、障害物検出部112は、サイドソナー10Aの検出結果に基づいて周辺の障害物を検出し、車両1を基準にした障害物の位置を検出する。
また障害物検出部112は、周辺情報のうち、サイドソナー10Aの検出範囲Rの中で最も信頼度が高い上記所定角度の範囲内の検出結果に基づく情報を用いて、車両1の周辺の障害物を検出する。
The obstacle detection unit 112 detects obstacles around the vehicle 1 based on the peripheral information.
More specifically, the obstacle detection unit 112 detects surrounding obstacles based on the detection result of the side sonar 10A, and detects the position of the obstacle with respect to the vehicle 1.
Further, the obstacle detection unit 112 uses information based on the detection result within the range of the predetermined angle, which has the highest reliability in the detection range R of the side sonar 10A, among the peripheral information, and the obstacle detection unit 112 uses the information based on the detection result, and the obstacle around the vehicle 1. Detect an object.

マップ生成部113は、障害物検出部112の検出結果に基づいてマップデータを生成する。マップデータは、適宜のタイミングにおける車両1の現在位置を原点としたローカル空間座標系に障害物の位置を記録したデータである。かかるマップデータによって車両1の周辺の障害物の分布が特定可能になる。 The map generation unit 113 generates map data based on the detection result of the obstacle detection unit 112. The map data is data in which the position of an obstacle is recorded in the local spatial coordinate system with the current position of the vehicle 1 as the origin at an appropriate timing. The map data makes it possible to identify the distribution of obstacles around the vehicle 1.

駐車区画検出部114は、周辺情報の1つである撮影画像に基づいて、車両1を駐車させる駐車区画Tを検出する。 The parking lot detection unit 114 detects the parking lot T in which the vehicle 1 is parked based on the captured image which is one of the peripheral information.

図3は、検出対象の駐車区画Tを示す図である。
駐車区画Tは、図3に示すように、地面に描画された区画線TAによって区画された駐車のための領域であり、区画線TAは駐車枠線や白線などとも称される。
駐車区画検出部114は、カメラ10Bの撮影画像に対する画像認識により区画線TAを認識することで駐車区画Tを検出する。また駐車区画検出部114は、撮影画像の2次元座標系からマップデータのローカル空間座標系への投影変換により、撮影画像における駐車区画Tの位置を、マップデータのローカル空間座標系の位置に変換する。この投影変換は、公知、又は周知の適宜の技術を用いて行うことができる。
FIG. 3 is a diagram showing a parking lot T to be detected.
As shown in FIG. 3, the parking lot T is an area for parking divided by the parking line TA drawn on the ground, and the parking lot TA is also referred to as a parking frame line, a white line, or the like.
The parking lot detection unit 114 detects the parking lot T by recognizing the lane marking TA by recognizing the image taken by the camera 10B. Further, the parking section detection unit 114 converts the position of the parking section T in the captured image into the position of the local spatial coordinate system of the map data by projecting the captured image from the two-dimensional coordinate system to the local spatial coordinate system of the map data. do. This projective transformation can be performed using a known or well-known technique as appropriate.

駐車枠設定部115は、駐車区画検出部114によって検出された駐車区画Tに基づいて、図3に示すように、矩形状の駐車枠Dを駐車区画Tの中に設定する。駐車枠Dは、駐車区画Tへの駐車時に車両1を収める範囲を規定する枠である。
本実施形態において、駐車枠設定部115は、駐車区画Tの各区画線TAについて、図3に示すように、対象の区画線TAに対向する辺が略平行となるように駐車枠Dを設定する。
As shown in FIG. 3, the parking frame setting unit 115 sets a rectangular parking frame D in the parking area T based on the parking area T detected by the parking area detection unit 114. The parking frame D is a frame that defines a range in which the vehicle 1 is accommodated when parked in the parking zone T.
In the present embodiment, the parking frame setting unit 115 sets the parking frame D so that the sides facing the target section line TA are substantially parallel to each section line TA of the parking section T, as shown in FIG. do.

仮想障害物設定部116は、駐車枠Dの手前からみて当該駐車枠Dよりも遠方側に仮想障害物Cを設定する。駐車枠Dの手前の位置は、典型的には、図3に示すように、前方の駐車枠Dに向かって前進している車両1の位置である。
仮想障害物Cは、周辺検出センサ部10の検出結果に基づいて検出される障害物とは別に仮想的に設定される障害物である。
本実施形態では、仮想障害物設定部116は、駐車枠Dの手前からみて当該駐車枠Dの最も遠方の辺に接する位置(初期位置)に仮想障害物Cを設定する。本実施形態において、遠方側の辺は、駐車状態の車両1の前後方向に延びる縦辺のうちの遠方側の辺であり、以下、この辺を最遠方辺Daと言う。
The virtual obstacle setting unit 116 sets the virtual obstacle C on the far side of the parking frame D when viewed from the front of the parking frame D. The position in front of the parking frame D is typically the position of the vehicle 1 moving forward toward the parking frame D in front, as shown in FIG.
The virtual obstacle C is an obstacle that is virtually set separately from the obstacle detected based on the detection result of the peripheral detection sensor unit 10.
In the present embodiment, the virtual obstacle setting unit 116 sets the virtual obstacle C at a position (initial position) in contact with the farthest side of the parking frame D when viewed from the front of the parking frame D. In the present embodiment, the distant side is the distant side of the vertical sides extending in the front-rear direction of the parked vehicle 1, and hereinafter, this side is referred to as the farthest side Da.

なお、仮想障害物Cの大きさ、及び形状は、駐車枠Dの大きさや、当該駐車枠Dの隣に存在することが想定される障害物(壁や他車両3(図3)など)の大きさなどに基づいて設定可能である。この場合において、仮想障害物Cは、図3に示すように、少なくとも駐車枠Dの最遠方辺Daに沿って延びる直線部Caを含む形状に設定される。
本実施形態では、仮想障害物Cは、駐車区画Tの隣に駐車し得る他車両3を示す矩形状であり、当該仮想障害物Cの大きさは当該他車両3の大きさに基づいて設定され、直線部Caが駐車枠Dの最遠方辺Daに平行になるように駐車枠Dに並べて配置される。
The size and shape of the virtual obstacle C are the size of the parking frame D and the obstacles (walls, other vehicles 3 (FIG. 3), etc.) that are supposed to exist next to the parking frame D. It can be set based on the size and so on. In this case, as shown in FIG. 3, the virtual obstacle C is set to have a shape including at least a straight portion Ca extending along the farthest side Da of the parking frame D.
In the present embodiment, the virtual obstacle C has a rectangular shape indicating another vehicle 3 that can be parked next to the parking zone T, and the size of the virtual obstacle C is set based on the size of the other vehicle 3. The straight line portion Ca is arranged side by side on the parking frame D so as to be parallel to the farthest side Da of the parking frame D.

仮想障害物移動部117は、仮想障害物設定部116によって設定された仮想障害物Cの位置を、自動駐車開始時におけるサイドソナー10Aの検出範囲Rの位置に基づいて移動する。 The virtual obstacle moving unit 117 moves the position of the virtual obstacle C set by the virtual obstacle setting unit 116 based on the position of the detection range R of the side sonar 10A at the start of automatic parking.

図4は、サイドソナー10Aの検出範囲Rの位置に基づく仮想障害物Cの位置の移動を示す図である。
仮想障害物移動部117は、図4に示すように、車両1が駐車枠Dを通過することで、当該駐車枠Dの手前の位置からみてサイドソナー10Aの検出範囲Rが最遠方辺Daよりも遠方に位置する場合、サイドソナー10Aの検出範囲Rの位置と最遠方辺Daとの離間距離Lに応じた移動量Mで、車両1の通過方向Fへ仮想障害物Cを移動する。通過方向Fは車両1が駐車枠Dを通過したときの進行方向である。
以下、サイドソナー10Aの検出範囲Rの位置を「ソナー検出位置RP」という。ソナー検出位置RPには、サイドソナー10Aのビーム状の探査波の主軸RK(図2)の位置(一般的には、車両1におけるサイドソナー10Aの配置位置と同じ)が用いられる。
FIG. 4 is a diagram showing the movement of the position of the virtual obstacle C based on the position of the detection range R of the side sonar 10A.
As shown in FIG. 4, in the virtual obstacle moving unit 117, when the vehicle 1 passes through the parking frame D, the detection range R of the side sonar 10A is from the farthest side Da when viewed from the position in front of the parking frame D. When the vehicle is located far away, the virtual obstacle C is moved in the passing direction F of the vehicle 1 with a movement amount M corresponding to the distance L between the position of the detection range R of the side sonar 10A and the farthest side Da. The passing direction F is the traveling direction when the vehicle 1 passes through the parking frame D.
Hereinafter, the position of the detection range R of the side sonar 10A is referred to as "sonar detection position RP". As the sonar detection position RP, the position of the main axis RK (FIG. 2) of the beam-shaped exploration wave of the side sonar 10A (generally the same as the arrangement position of the side sonar 10A in the vehicle 1) is used.

また本実施形態において、仮想障害物移動部117は、図4に示すように、仮想障害物Cの直線部Caと駐車枠Dの最遠方辺Daとの平行性が維持されるように通過方向Fへ当該仮想障害物Cを移動(すなわち平行移動)する。 Further, in the present embodiment, as shown in FIG. 4, the virtual obstacle moving portion 117 has a passing direction so as to maintain parallelism between the straight portion Ca of the virtual obstacle C and the farthest side Da of the parking frame D. The virtual obstacle C is moved (that is, translated) to F.

更に詳述すると、サイドソナー10Aによる障害物の検出結果に基づいて、車両1が駐車可能な駐車可能スペースEを検出する構成においては、例えば図5に示すように、障害物を示す2つの点群Gの間に、駐車可能スペースEが検出されたとしても、当該駐車可能スペースEにおける車両1の駐車時の姿勢(前後方向)が定まらない。また、駐車可能スペースEの遠方側の障害物が他車両3であった場合、この他車両3の姿勢も同図5に示すように一意には定まらない。 More specifically, in the configuration in which the vehicle 1 detects the parkable space E in which the vehicle 1 can park based on the detection result of the obstacle by the side sonar 10A, two points indicating the obstacle are shown, for example, as shown in FIG. Even if the parkable space E is detected between the groups G, the posture (front-back direction) of the vehicle 1 in the parkable space E when parked is not determined. Further, when the obstacle on the far side of the parkable space E is the other vehicle 3, the posture of the other vehicle 3 is not uniquely determined as shown in FIG.

これに対し、本実施形態では、駐車可能スペースEとして駐車区画Tが撮影画像に基づいて検出されているため、当該駐車区画Tにおける車両1の駐車時の姿勢を区画線TAの延在方向によって特定できる。また、他車両3が駐車区画Tの隣に障害物として存在している場合、一般に、当該他車両3の姿勢も駐車区画Tの区画線TAの延在方向にしたがった向きとなる。すなわち、駐車区画Tの検出によって当該駐車区画Tの隣に存在し得る他車両3の姿勢も特定することができ、また仮想障害物Cの平行移動によって当該他車両3の姿勢に合わせて仮想障害物Cを駐車区画Tに対して移動することができるのである。 On the other hand, in the present embodiment, since the parking lot T is detected as the parkable space E based on the photographed image, the posture of the vehicle 1 in the parking lot T at the time of parking is determined by the extending direction of the lane marking TA. Can be identified. Further, when the other vehicle 3 exists as an obstacle next to the parking lot T, the posture of the other vehicle 3 generally follows the extending direction of the lane marking TA of the parking lot T. That is, the posture of the other vehicle 3 that may exist next to the parking lot T can be specified by the detection of the parking lot T, and the virtual obstacle is matched to the posture of the other vehicle 3 by the parallel movement of the virtual obstacle C. The object C can be moved with respect to the parking lot T.

また本実施形態において、仮想障害物Cの移動量Mは、離間距離Lと同じ、或いは離間距離L以下に設定される。
この離間距離Lには、図6に示すように、車両1が駐車枠Dに対して斜めの姿勢になっている場合を考慮に入れて次の距離が用いられている。
すなわち、図6に示すように、駐車枠Dの最遠方辺Daの前端Da1、及び後端Da2のそれぞれを基点とし当該最遠方辺Daに垂直にソナー検出位置RPの主軸RKに向かって引いて得られる垂線Q1、Q2のうち短い方の長さが離間距離Lに用いられる。
最遠方辺Daの前端Da1は、車両1に近い側の端点であり、後端Da2は車両1から遠い側の端点である。
Further, in the present embodiment, the movement amount M of the virtual obstacle C is set to be the same as the separation distance L or equal to or less than the separation distance L.
As shown in FIG. 6, the following distance is used for the separation distance L in consideration of the case where the vehicle 1 is in an oblique posture with respect to the parking frame D.
That is, as shown in FIG. 6, with each of the front end Da1 and the rear end Da2 of the farthest side Da of the parking frame D as the base points, pull toward the main axis RK of the sonar detection position RP perpendicular to the farthest side Da. The shorter length of the obtained perpendicular lines Q1 and Q2 is used for the separation distance L.
The front end Da1 of the farthest side Da is the end point on the side closer to the vehicle 1, and the rear end Da2 is the end point on the side farther from the vehicle 1.

図6の斜め停車Aに示すように、先端側が後端側よりも駐車枠Dから遠ざかるような姿勢で車両1が停車しているときは、最遠方辺Daの前端Da1から延びる垂線Q1の長さが離間距離Lに用いられる。
また、図6の斜め停車Bに示すように、先端側が後端側よりも駐車枠Dから近付くような姿勢で車両1が停車しているときは、最遠方辺Daの後端Da2から延びる垂線Q2の長さが離間距離Lに用いられる。
これにより、仮想障害物Cの移動量Mは、当該仮想障害物Cの直線部Caがサイドソナー10Aによる未検出範囲に入り込まない量に留められる。
なお、前掲図4に示すように、車両1の姿勢が駐車枠Dに対して垂直である場合、垂線Q1、及びQ2の長さが等しくなるため、どちらの長さを離間距離Lに用いてもよい。
As shown in the diagonal stop A of FIG. 6, when the vehicle 1 is stopped in a posture in which the front end side is farther from the parking frame D than the rear end side, the length of the vertical line Q1 extending from the front end Da1 of the farthest side Da. Is used for the separation distance L.
Further, as shown in the diagonal stop B of FIG. 6, when the vehicle 1 is stopped in a posture in which the front end side is closer to the parking frame D than the rear end side, a vertical line extending from the rear end Da 2 of the farthest side Da. The length of Q2 is used for the separation distance L.
As a result, the movement amount M of the virtual obstacle C is limited to an amount that the straight line portion Ca of the virtual obstacle C does not enter the undetected range by the side sonar 10A.
As shown in FIG. 4 above, when the posture of the vehicle 1 is perpendicular to the parking frame D, the lengths of the perpendicular lines Q1 and Q2 are equal, so which length is used for the separation distance L. May be good.

駐車経路計算部118は、マップデータ(すなわち、周辺情報に基づいて検出された障害物の分布)と、仮想障害物Cと、駐車枠設定部115によって設定された駐車枠Dと、に基づいて駐車経路を計算し算出する。
本実施形態の駐車経路は、車両1が周囲の障害物、及び仮想障害物Cに衝突することなく駐車区画Tの駐車枠Dへ後ろ向き駐車するように、車両1の現在位置から駐車区画Tへ車両1を移動させる経路である。
後ろ向き駐車は、車両1を駐車区画Tへ後進によって入庫させることを言う。
The parking route calculation unit 118 is based on the map data (that is, the distribution of obstacles detected based on the surrounding information), the virtual obstacle C, and the parking frame D set by the parking frame setting unit 115. Calculate and calculate the parking route.
The parking route of the present embodiment is from the current position of the vehicle 1 to the parking lot T so that the vehicle 1 parks backward in the parking frame D of the parking lot T without colliding with the surrounding obstacles and the virtual obstacle C. This is a route for moving the vehicle 1.
Backward parking means that the vehicle 1 is stored in the parking lot T by reverse movement.

自動走行制御部119は、車両1を自動走行により前進させるための制御情報を駐車経路に基づいて生成し、当該制御情報を車両制御装置30へ出力する。
車両制御装置30が制御情報に基づいて制御を実行することで、車両1が駐車区画Tへ向けて自動走行して自動入庫することとなる。
The automatic driving control unit 119 generates control information for advancing the vehicle 1 by automatic driving based on the parking route, and outputs the control information to the vehicle control device 30.
When the vehicle control device 30 executes control based on the control information, the vehicle 1 automatically travels toward the parking lot T and automatically enters the parking lot.

次いで、本実施形態の動作を説明する。 Next, the operation of this embodiment will be described.

駐車場内を乗員が車両1を運転して移動している間、駐車支援装置100において、障害物検出部112が周辺情報に基づいて周辺の障害物(例えば他車両3(図3))を継続的に検出し、また障害物検出部112によって検出された障害物の位置をマップ生成部113がマップデータを逐次に記録する。また駐車区画検出部114が撮影画像の画像認識結果に基づいて、車両1の前方や側方に存在する駐車区画Tの検出を継続的に行う。 While the occupant is driving the vehicle 1 and moving in the parking lot, the obstacle detection unit 112 continues the surrounding obstacles (for example, another vehicle 3 (FIG. 3)) based on the peripheral information in the parking support device 100. The map generation unit 113 sequentially records the map data of the position of the obstacle detected by the obstacle detection unit 112. Further, the parking lot detection unit 114 continuously detects the parking lot T existing in front of or to the side of the vehicle 1 based on the image recognition result of the captured image.

駐車区画検出部114がカメラ10Bの撮影画像に基づいて駐車区画Tの検出を行うことで、図7に示すようにソナー検出位置RPが駐車区画Tを通過する前のタイミング、或いは、ソナー検出位置RPが駐車区画Tを通過した後であっても当該駐車区画Tに応じた大きさの空間がサイドソナー10Aの検出結果に基づいてマップデータに記録される前のタイミングで、駐車区画Tが速やかに検出される。 The parking lot detection unit 114 detects the parking lot T based on the captured image of the camera 10B, so that the timing before the sonar detection position RP passes through the parking lot T or the sonar detection position as shown in FIG. Even after the RP has passed through the parking lot T, the parking lot T is promptly set at a timing before the space having a size corresponding to the parking lot T is recorded in the map data based on the detection result of the side sonar 10A. Is detected in.

その後、乗員は車両1を停車し、図示せぬHMI(Human Machine Interface)を操作することで、自動駐車を駐車支援装置100に指示する。
駐車支援装置100は、自動駐車の指示が入力されると、駐車区画Tへ車両1を自動走行により入庫させるための自動駐車処理を開始する。
After that, the occupant stops the vehicle 1 and operates an HMI (Human Machine Interface) (not shown) to instruct the parking support device 100 to automatically park.
When the instruction for automatic parking is input, the parking support device 100 starts an automatic parking process for automatically driving the vehicle 1 into the parking section T.

図8は、自動駐車処理のフローチャートである。
先ず、駐車枠設定部115が、駐車区画Tに対して駐車枠Dを設定する(ステップSa1)。
次いで、仮想障害物設定部116は、駐車枠Dの最遠方辺Daに直線部Caが接する初期位置に仮想障害物Cを設定する(ステップSa2)。
次に、仮想障害物移動部117は、車両1の現在位置、及び駐車枠Dの位置に基づいて、ソナー検出位置RPが駐車枠Dを通過しているか否か、換言すれば、車両1のソナー検出位置RPが駐車枠Dの最遠方辺Daよりも遠方に位置するか否かを判定する(ステップSa3)。
FIG. 8 is a flowchart of the automatic parking process.
First, the parking frame setting unit 115 sets the parking frame D for the parking section T (step Sa1).
Next, the virtual obstacle setting unit 116 sets the virtual obstacle C at the initial position where the straight line portion Ca touches the farthest side Da of the parking frame D (step Sa2).
Next, the virtual obstacle moving unit 117 determines whether or not the sonar detection position RP has passed through the parking frame D based on the current position of the vehicle 1 and the position of the parking frame D, in other words, the vehicle 1. It is determined whether or not the sonar detection position RP is located farther than the farthest side Da of the parking frame D (step Sa3).

ソナー検出位置RPが駐車枠Dを通過していない場合(ステップSa3:No)、ソナー検出位置RPが最遠方辺Daの手前に位置し、駐車枠Dよりも遠方側については未だサイドソナー10Aによって未だ検出が行われていない。この場合、仮想障害物Cの位置は初期位置に固定される。 When the sonar detection position RP has not passed through the parking frame D (step Sa3: No), the sonar detection position RP is located in front of the farthest side Da, and the side sonar 10A is still on the far side from the parking frame D. It has not been detected yet. In this case, the position of the virtual obstacle C is fixed at the initial position.

一方、ソナー検出位置RPが駐車枠Dを通過している場合(ステップSa3:Yes)、仮想障害物移動部117は、車両1の現在位置、及び駐車枠Dの位置に基づいて上記離間距離Lを算出し、当該離間距離Lに応じた移動量Mで仮想障害物Cを平行移動する。(ステップSa4)。 On the other hand, when the sonar detection position RP has passed through the parking frame D (step Sa3: Yes), the virtual obstacle moving unit 117 has the separation distance L based on the current position of the vehicle 1 and the position of the parking frame D. Is calculated, and the virtual obstacle C is translated by the movement amount M corresponding to the separation distance L. (Step Sa4).

そして駐車経路計算部118が、車両1の現在位置と、マップデータの障害物、仮想障害物、及び駐車区画T(駐車枠D)のそれぞれの位置とに基づいて、障害物、及び仮想障害物に衝突することなく現在位置から駐車区画Tへ車両1を移動させる駐車経路を計算して算出する(ステップSa5)。
そして、自動走行制御部119は、駐車区画Tへ車両1を駐車経路に沿って自動走行させるために、当該駐車経路に基づいて制御情報を生成し、当該制御情報を車両制御装置30へ出力する(ステップSa6)。これにより、車両制御装置30の制御により、車両1が自動走行を開始し駐車区画Tへの駐車が行われる。
Then, the parking route calculation unit 118 determines the obstacle and the virtual obstacle based on the current position of the vehicle 1 and the respective positions of the obstacle, the virtual obstacle, and the parking section T (parking frame D) in the map data. The parking route for moving the vehicle 1 from the current position to the parking lot T without colliding with the parking lot T is calculated and calculated (step Sa5).
Then, the automatic driving control unit 119 generates control information based on the parking route in order to automatically drive the vehicle 1 to the parking section T along the parking route, and outputs the control information to the vehicle control device 30. (Step Sa6). As a result, under the control of the vehicle control device 30, the vehicle 1 starts automatic traveling and is parked in the parking lot T.

かかる処理により、ソナー検出位置RPが駐車枠Dを通過していない場合(ステップSa3:No)、図9の「初期位置」に示すように、仮想障害物Cは駐車枠Dに隣接するように位置し、当該仮想障害物Cと衝突しないように駐車経路が算出される。
一方、ソナー検出位置RPが駐車枠Dを通過している場合(ステップSa3:Yes)、図9の「移動後」に示すように、仮想障害物Cは離間距離Lに応じて平行移動する。これにより、駐車枠Dと仮想障害物Cとの間に、車両1が通過可能な領域が生じることとなる。そして、駐車経路は、駐車枠Dと仮想障害物Cとの間に生じた領域、及び、当該領域における障害物のサイドソナー10Aによる検出結果を踏まえて駐車経路が算出される。
この結果、仮想障害物Cを移動させない場合に比べて、より切り返し回数が少ない駐車経路が算出可能になる。なお、「切り返し」は、駐車区画Tへの車両1の進入角の調整のための前進、及び後進の繰り返し運転を言い、スイッチバックと称されることもある。
By this process, when the sonar detection position RP has not passed through the parking frame D (step Sa3: No), the virtual obstacle C is adjacent to the parking frame D as shown in the “initial position” of FIG. The parking route is calculated so as to be located and not to collide with the virtual obstacle C.
On the other hand, when the sonar detection position RP passes through the parking frame D (step Sa3: Yes), the virtual obstacle C moves in parallel according to the separation distance L, as shown in “after movement” in FIG. As a result, an area through which the vehicle 1 can pass is created between the parking frame D and the virtual obstacle C. Then, the parking route is calculated based on the area generated between the parking frame D and the virtual obstacle C and the detection result by the side sonar 10A of the obstacle in the area.
As a result, it becomes possible to calculate a parking route with a smaller number of turns, as compared with the case where the virtual obstacle C is not moved. In addition, "turning back" refers to repeated driving of forward movement and reverse movement for adjusting the approach angle of the vehicle 1 to the parking lot T, and is sometimes referred to as switchback.

本実施形態によれば、次の効果を奏する。 According to this embodiment, the following effects are obtained.

本実施形態の駐車支援装置100は、車両1の周辺を撮影した撮影画像に基づいて区画線TAを検出することで駐車区画Tを検出する駐車区画検出部114と、仮想障害物Cを駐車区画Tの中に設定した駐車枠Dに隣接した位置に設定する仮想障害物設定部116と、車両1が駐車区画Tを通過している場合、駐車区画Tと車両1(より正確にはソナー検出位置RP)との間の離間距離Lに応じた移動量Mで、車両1の通過方向Fへ仮想障害物Cを平行移動する仮想障害物移動部117と、車両1の現在位置と、障害物、仮想障害物C、及び駐車区画Tの中の駐車枠Dのそれぞれの位置と、に基づいて、車両1が現在位置から移動し駐車区画Tへ駐車する駐車経路を生成する駐車経路計算部118と、を備える。 The parking support device 100 of the present embodiment has a parking lot detection unit 114 that detects a parking lot T by detecting a parking lot TA based on a photographed image taken around the vehicle 1, and a parking lot that parks a virtual obstacle C. The virtual obstacle setting unit 116 set at a position adjacent to the parking frame D set in T, and when the vehicle 1 passes through the parking zone T, the parking zone T and the vehicle 1 (more accurately, sonar detection). The virtual obstacle moving unit 117 that moves the virtual obstacle C in parallel in the passing direction F of the vehicle 1 with the movement amount M according to the separation distance L from the position RP), the current position of the vehicle 1, and the obstacle. , A parking route calculation unit 118 that generates a parking route in which the vehicle 1 moves from the current position and parks in the parking zone T based on the respective positions of the virtual obstacle C and the parking frame D in the parking zone T. And.

この構成によれば、駐車区画Tの中の駐車枠Dの手前からみて駐車枠Dの遠方側にソナー検出位置RPが位置する場合、ソナー検出位置RPに対応する位置まで仮想障害物Cが移動されるため、駐車枠Dと仮想障害物Cとの間に、駐車経路に利用可能な領域が設けられる。これにより、駐車経路に利用可能な領域が増え、より適切な駐車経路を得ることができる。 According to this configuration, when the sonar detection position RP is located on the far side of the parking frame D when viewed from the front of the parking frame D in the parking lot T, the virtual obstacle C moves to the position corresponding to the sonar detection position RP. Therefore, an area that can be used for the parking route is provided between the parking frame D and the virtual obstacle C. As a result, the area available for the parking route is increased, and a more appropriate parking route can be obtained.

これに加え、車両1が駐車可能な駐車可能スペースEである駐車区画Tをサイドソナー10Aの検出結果ではなく、カメラ10Bの撮影画像に基づいて検出する構成であるため、サイドソナー10Aの検出結果に基づいて駐車可能スペースEを検出する構成に比べ、より早期に駐車区画Tを検出することができる。
さらに、駐車区画Tを検出する構成であるため、当該駐車区画Tの隣に存在し得る障害物としての他車両3の姿勢(前後方向)についても、駐車区画Tの方向に基づいて類推可能である。
したがって、仮想障害物Cを平行移動するだけで、駐車区画Tの隣の他車両3の姿勢をサイドソナー10Aの検出結果に基づいて特定せずとも、また当該検出結果による特定を待つこと無く、当該他車両3の姿勢に合わせた位置に仮想障害物Cを速やかに移動させることができる。
これにより、駐車可能スペースEの検出や駐車区画Tの隣に存在する障害物の姿勢や形状をサイドソナー10Aの検出結果を用いて特定する構成に比べて、これらをより早いタイミングで特定することができ、また、これらが早期に特定されることで、より駐車区画Tのより近くで車両1を停車させて、より短い駐車経路を算出することも可能になる。
In addition to this, the detection result of the side sonar 10A is such that the parking section T, which is the parkable space E in which the vehicle 1 can be parked, is detected based on the captured image of the camera 10B, not the detection result of the side sonar 10A. The parking lot T can be detected earlier than the configuration in which the parkable space E is detected based on the above.
Further, since the configuration is such that the parking lot T is detected, the posture (front-back direction) of the other vehicle 3 as an obstacle that may exist next to the parking lot T can be inferred based on the direction of the parking lot T. be.
Therefore, simply by translating the virtual obstacle C, the posture of the other vehicle 3 next to the parking zone T is not specified based on the detection result of the side sonar 10A, and without waiting for the detection result. The virtual obstacle C can be quickly moved to a position corresponding to the posture of the other vehicle 3.
As a result, these can be specified at an earlier timing than the configuration in which the parking space E is detected and the posture and shape of the obstacle existing next to the parking section T are specified using the detection result of the side sonar 10A. Further, by identifying these at an early stage, it is possible to stop the vehicle 1 closer to the parking lot T and calculate a shorter parking route.

本実施形態の駐車支援装置100において、仮想障害物Cは、駐車区画Tの隣に駐車し得る他車両3に基づく大きさに設定され、駐車区画Tに並列に設定される。
これにより、複数の他車両3が並列に駐車する駐車場内などにおける駐車経路を適切に算出することができる。
In the parking support device 100 of the present embodiment, the virtual obstacle C is set to a size based on another vehicle 3 that can be parked next to the parking section T, and is set in parallel with the parking section T.
This makes it possible to appropriately calculate a parking route in a parking lot or the like where a plurality of other vehicles 3 are parked in parallel.

本実施形態の駐車支援装置100において、障害物検出部112は、車両1に設けられたサイドソナー10Aから得られる周辺情報のうち、扇状の検出範囲Rの主軸RKを中心とした所定角度の範囲内(ただし、所定角度<扇状の検出範囲Rの中心角)の検出結果に基づく情報を用いる。
これにより、障害物を高い信頼度で検出することができる。
In the parking support device 100 of the present embodiment, the obstacle detection unit 112 has a range of a predetermined angle centered on the main axis RK of the fan-shaped detection range R among the peripheral information obtained from the side sonar 10A provided in the vehicle 1. Information based on the detection result within (however, the predetermined angle <the central angle of the fan-shaped detection range R) is used.
This makes it possible to detect obstacles with high reliability.

なお、上述した実施形態は、あくまでも本発明の一態様の例示であり、本発明の主旨を逸脱しない範囲において任意に変形、及び応用が可能である。 It should be noted that the above-described embodiment is merely an example of one aspect of the present invention, and can be arbitrarily modified and applied without departing from the gist of the present invention.

上述した実施形態では、駐車枠設定部115は、駐車区画Tの中に駐車枠Dを設定した。しかしながら、駐車枠設定部115は、駐車区画Tの輪郭を駐車枠Dとして設定してもよい。 In the above-described embodiment, the parking frame setting unit 115 sets the parking frame D in the parking section T. However, the parking frame setting unit 115 may set the contour of the parking section T as the parking frame D.

上述した実施形態では、他車両3や他の駐車区画Tと並列に配置された駐車区画Tに車両1を駐車させる場合を例示した。しかしながら、図10に示すように、他車両3や他の駐車区画Tと直列に並ぶ駐車区画Tに車両1を駐車させる場合(いわゆる、縦列駐車の場合)にも、本発明を適用することができる。
なお、この場合、図10に示すように、仮想障害物Cの初期位置は、駐車枠Dに直列方向に隣接する位置となる。また駐車枠Dの上記最遠方辺Daは、車両1の前後方向に延びる長辺ではなく、車両1の車幅方向に延びる短辺のうち、駐車区画Tの手前からみて最も遠い方の辺である。
In the above-described embodiment, the case where the vehicle 1 is parked in the parking lot T arranged in parallel with the other vehicle 3 or the other parking lot T is illustrated. However, as shown in FIG. 10, the present invention can also be applied to the case where the vehicle 1 is parked in the parking lot T arranged in series with the other vehicle 3 or the other parking lot T (so-called parallel parking). can.
In this case, as shown in FIG. 10, the initial position of the virtual obstacle C is a position adjacent to the parking frame D in the series direction. Further, the farthest side Da of the parking frame D is not the long side extending in the front-rear direction of the vehicle 1, but the shortest side extending in the vehicle width direction of the vehicle 1 which is the farthest side when viewed from the front of the parking section T. be.

上述した実施形態において、図1に示す機能ブロックは、本願発明を理解容易にするために、車両1や駐車支援装置100の構成要素を主な処理内容に応じて分類して示した概略図であり、これらの構成要素は、処理内容に応じて、さらに多くの構成要素に分類することもできる。また、1つの構成要素がさらに多くの処理を実行するように分類することもできる。 In the above-described embodiment, the functional block shown in FIG. 1 is a schematic diagram showing the components of the vehicle 1 and the parking support device 100 classified according to the main processing contents in order to facilitate the understanding of the present invention. Yes, these components can be further classified into more components according to the processing content. It can also be categorized so that one component performs more processing.

また、駐車支援装置100の各構成要素の処理は、1つのハードウェアで実行されてもよいし、複数のハードウェアにより実行されてもよい。また、各構成要素の処理は、1つのプログラムで実現されてもよいし、複数のプログラムで実現されてもよい。 Further, the processing of each component of the parking support device 100 may be executed by one hardware or may be executed by a plurality of hardware. Further, the processing of each component may be realized by one program or may be realized by a plurality of programs.

1 車両
10 周辺検出センサ部
10A サイドソナー
10B カメラ
100 駐車支援装置
110 位置検出部
111 周辺情報取得部
112 障害物検出部
114 駐車区画検出部
115 駐車枠設定部
116 仮想障害物設定部
117 仮想障害物移動部
118 駐車経路計算部
119 自動走行制御部
C 仮想障害物
D 駐車枠
Da 最遠方辺
F 通過方向
L 離間距離
M 移動量
R 検出範囲
RK 主軸
RP ソナー検出位置
T 駐車区画
TA 区画線
1 Vehicle 10 Peripheral detection sensor unit 10A Side sonar 10B Camera 100 Parking support device 110 Position detection unit 111 Peripheral information acquisition unit 112 Obstacle detection unit 114 Parking lot detection unit 115 Parking frame setting unit 116 Virtual obstacle setting unit 117 Virtual obstacle Moving unit 118 Parking route calculation unit 119 Automatic driving control unit C Virtual obstacle D Parking frame Da Farthest side F Passing direction L Separation distance M Movement amount R Detection range RK Main axis RP Sonar detection position T Parking division TA division line

Claims (4)

車両の現在位置を検出する位置検出部と、
前記車両に設けられたソナーからの情報によって当該車両の側方の障害物を検出する障害物検出部と、
前記車両の周辺を撮影した撮影画像に基づいて区画線を検出することで駐車区画を検出する駐車区画検出部と、
仮想障害物を前記駐車区画に隣接した位置に設定する仮想障害物設定部と、
前記車両が前記駐車区画を通過している場合、前記駐車区画と前記車両との離間距離に応じた移動量で、前記車両の通過方向へ、前記仮想障害物を平行移動する仮想障害物移動部と、
前記車両の現在位置と、前記ソナーによって検出された障害物、前記仮想障害物、及び前記駐車区画のそれぞれの位置と、に基づいて、前記車両が現在位置から移動し前記駐車区画へ駐車する駐車経路を計算する駐車経路計算部と、
を備えることを特徴とする駐車支援装置。
A position detector that detects the current position of the vehicle, and
An obstacle detection unit that detects obstacles on the side of the vehicle based on information from the sonar provided on the vehicle, and
A parking lot detection unit that detects a parking lot by detecting a lot line based on a photographed image of the surroundings of the vehicle, and a parking lot detection unit.
A virtual obstacle setting unit that sets a virtual obstacle at a position adjacent to the parking lot,
When the vehicle has passed through the parking lot, a virtual obstacle moving unit that translates the virtual obstacle in the passing direction of the vehicle with a movement amount corresponding to the distance between the parking lot and the vehicle. When,
Parking where the vehicle moves from the current position and parks in the parking lot based on the current position of the vehicle and the respective positions of the obstacle detected by the sonar, the virtual obstacle, and the parking lot. Parking route calculation unit that calculates the route, and
A parking support device characterized by being equipped with.
前記仮想障害物は、
前記駐車区画の隣に駐車し得る他車両に基づく大きさに設定され、
前記駐車区画に並列に設定される
ことを特徴とする請求項1に記載の駐車支援装置。
The virtual obstacle is
Set to a size based on other vehicles that can be parked next to the parking lot,
The parking support device according to claim 1, wherein the parking lot is set in parallel with the parking lot.
前記障害物検出部は、
前記車両に設けられたソナーからの情報のうち、所定の範囲内で検出された情報を用いる、
ことを特徴とする請求項1または2に記載の駐車支援装置。
The obstacle detection unit is
Among the information from the sonar provided in the vehicle, the information detected within a predetermined range is used.
The parking support device according to claim 1 or 2.
車両の現在位置を検出する位置検出部と、
前記車両に設けられたソナーからの情報によって当該車両の側方の障害物を検出する障害物検出部と、を備えた駐車支援装置の制御方法において、
前記車両の周辺を撮影した撮影画像に基づいて区画線を検出することで駐車区画を検出する第1ステップと、
仮想障害物を前記駐車区画に隣接した位置に設定する第2ステップと、
前記車両が前記駐車区画を通過している場合、前記駐車区画と前記車両との離間距離に応じた移動量で、前記車両の通過方向へ、前記仮想障害物を平行移動する第3ステップと
前記車両の現在位置、前記ソナーによって検出された障害物、前記仮想障害物、及び前記駐車区画のそれぞれの位置に基づいて、前記車両が現在位置から移動し前記駐車区画へ駐車する駐車経路を計算する第4ステップと、
を備えることを特徴とする駐車支援装置の制御方法。
A position detector that detects the current position of the vehicle, and
In a control method of a parking support device including an obstacle detection unit that detects an obstacle on the side of the vehicle based on information from a sonar provided on the vehicle.
The first step of detecting a parking lot by detecting a lane marking line based on a photographed image taken around the vehicle, and
The second step of setting the virtual obstacle in a position adjacent to the parking lot,
When the vehicle has passed through the parking lot, the third step of moving the virtual obstacle in parallel in the passing direction of the vehicle by the amount of movement according to the distance between the parking lot and the vehicle and the above. Based on the current position of the vehicle, the obstacle detected by the sonar, the virtual obstacle, and the respective positions of the parking lot, the parking route for the vehicle to move from the current position and park in the parking lot is calculated. 4th step and
A method of controlling a parking support device, which comprises.
JP2020091913A 2020-05-27 2020-05-27 Parking support device and method of controlling the parking support device Active JP7445515B2 (en)

Priority Applications (4)

Application Number Priority Date Filing Date Title
JP2020091913A JP7445515B2 (en) 2020-05-27 2020-05-27 Parking support device and method of controlling the parking support device
CN202110556344.0A CN113734152A (en) 2020-05-27 2021-05-21 Parking assistance device and control method for parking assistance device
US17/329,283 US11491973B2 (en) 2020-05-27 2021-05-25 Parking assist apparatus and a method of controlling the parking assist apparatus
EP21175680.4A EP3915858B1 (en) 2020-05-27 2021-05-25 A parking assist apparatus and a method of controlling the parking assist apparatus

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
JP2020091913A JP7445515B2 (en) 2020-05-27 2020-05-27 Parking support device and method of controlling the parking support device

Publications (2)

Publication Number Publication Date
JP2021189575A true JP2021189575A (en) 2021-12-13
JP7445515B2 JP7445515B2 (en) 2024-03-07

Family

ID=78849730

Family Applications (1)

Application Number Title Priority Date Filing Date
JP2020091913A Active JP7445515B2 (en) 2020-05-27 2020-05-27 Parking support device and method of controlling the parking support device

Country Status (1)

Country Link
JP (1) JP7445515B2 (en)

Cited By (1)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN115817458A (en) * 2023-02-16 2023-03-21 广州森弘信息科技有限公司 Automatic parking method fusing panoramic image and radar system

Citations (3)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP2007290558A (en) * 2006-04-25 2007-11-08 Toyota Motor Corp Parking support device and parking support method
JP2017030568A (en) * 2015-07-31 2017-02-09 アイシン精機株式会社 Parking support device
JP2019131042A (en) * 2018-01-31 2019-08-08 アイシン精機株式会社 Parking support device

Patent Citations (3)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP2007290558A (en) * 2006-04-25 2007-11-08 Toyota Motor Corp Parking support device and parking support method
JP2017030568A (en) * 2015-07-31 2017-02-09 アイシン精機株式会社 Parking support device
JP2019131042A (en) * 2018-01-31 2019-08-08 アイシン精機株式会社 Parking support device

Cited By (2)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN115817458A (en) * 2023-02-16 2023-03-21 广州森弘信息科技有限公司 Automatic parking method fusing panoramic image and radar system
CN115817458B (en) * 2023-02-16 2023-05-09 广州森弘信息科技有限公司 Automatic parking method integrating looking-around image and radar system

Also Published As

Publication number Publication date
JP7445515B2 (en) 2024-03-07

Similar Documents

Publication Publication Date Title
JP6361567B2 (en) Automated driving vehicle system
KR101503418B1 (en) Semiautomatic parking machine
US20180178780A1 (en) Automatic parking method and system of vehicle
JP2006175918A (en) Parking auxiliary device
EP3915857B1 (en) A parking assist apparatus and a method of controlling the parking assist apparatus
JP6918203B2 (en) Parking support device
JP2018169269A (en) Route generator, route generation method, and route generation program
JP2019064431A (en) Parking support device
JPWO2019008762A1 (en) Parking assistance method and parking assistance device
JPH1069598A (en) Collision preventing device for vehicle
JP7445515B2 (en) Parking support device and method of controlling the parking support device
JP6465919B2 (en) Obstacle detection system
EP3915858B1 (en) A parking assist apparatus and a method of controlling the parking assist apparatus
US20220379879A1 (en) Parking assistance device and parking assistance method
JP2658056B2 (en) Autonomous traveling vehicle control device
JP7453785B2 (en) Parking support device and parking support system
JP7502044B2 (en) Parking assistance device and parking assistance system
WO2021172532A1 (en) Parking assistance device and parking assistance method
JP2021187229A (en) Parking support device, and control method for parking support device
JP2019015570A (en) Parking position information acquisition device and automatic parking controller
JP7281728B2 (en) parking assist device
JP7453850B2 (en) Parking support device and parking support method
KR20200102005A (en) Automatic parking control device and method thereof
JP2019156393A (en) Parking support device
WO2023002863A1 (en) Driving assistance device, driving assistance method

Legal Events

Date Code Title Description
A621 Written request for application examination

Free format text: JAPANESE INTERMEDIATE CODE: A621

Effective date: 20230316

A977 Report on retrieval

Free format text: JAPANESE INTERMEDIATE CODE: A971007

Effective date: 20231025

A131 Notification of reasons for refusal

Free format text: JAPANESE INTERMEDIATE CODE: A131

Effective date: 20231031

A521 Request for written amendment filed

Free format text: JAPANESE INTERMEDIATE CODE: A523

Effective date: 20231228

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: 20240206

A61 First payment of annual fees (during grant procedure)

Free format text: JAPANESE INTERMEDIATE CODE: A61

Effective date: 20240226

R150 Certificate of patent or registration of utility model

Ref document number: 7445515

Country of ref document: JP

Free format text: JAPANESE INTERMEDIATE CODE: R150