KR102466727B1 - Parking assistance method and parking control device - Google Patents
Parking assistance method and parking control device Download PDFInfo
- Publication number
- KR102466727B1 KR102466727B1 KR1020227002326A KR20227002326A KR102466727B1 KR 102466727 B1 KR102466727 B1 KR 102466727B1 KR 1020227002326 A KR1020227002326 A KR 1020227002326A KR 20227002326 A KR20227002326 A KR 20227002326A KR 102466727 B1 KR102466727 B1 KR 102466727B1
- Authority
- KR
- South Korea
- Prior art keywords
- frame
- parking
- frame line
- vehicle
- line
- Prior art date
Links
- 238000000034 method Methods 0.000 title claims abstract description 34
- 238000001514 detection method Methods 0.000 claims description 28
- 238000010586 diagram Methods 0.000 description 20
- 230000010365 information processing Effects 0.000 description 14
- 238000012545 processing Methods 0.000 description 14
- 238000012937 correction Methods 0.000 description 11
- 230000000694 effects Effects 0.000 description 2
- 238000013459 approach Methods 0.000 description 1
- 238000004891 communication Methods 0.000 description 1
- 230000003111 delayed effect Effects 0.000 description 1
- 238000006073 displacement reaction Methods 0.000 description 1
- 230000002452 interceptive effect 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
-
- 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
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B60—VEHICLES IN GENERAL
- B60R—VEHICLES, VEHICLE FITTINGS, OR VEHICLE PARTS, NOT OTHERWISE PROVIDED FOR
- B60R1/00—Optical viewing arrangements; Real-time viewing arrangements for drivers or passengers using optical image capturing systems, e.g. cameras or video systems specially adapted for use in or on vehicles
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B60—VEHICLES IN GENERAL
- B60R—VEHICLES, VEHICLE FITTINGS, OR VEHICLE PARTS, NOT OTHERWISE PROVIDED FOR
- B60R11/00—Arrangements for holding or mounting articles, not otherwise provided for
- B60R11/04—Mounting of cameras operative during drive; Arrangement of controls thereof relative to the vehicle
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B60—VEHICLES IN GENERAL
- B60R—VEHICLES, VEHICLE FITTINGS, OR VEHICLE PARTS, NOT OTHERWISE PROVIDED FOR
- B60R21/00—Arrangements or fittings on vehicles for protecting or preventing injuries to occupants or pedestrians in case of accidents or other traffic risks
-
- 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/18—Propelling the vehicle
- B60W30/18009—Propelling the vehicle related to particular drive situations
- B60W30/18036—Reversing
-
- 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
- B60W40/02—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 related to ambient conditions
- B60W40/06—Road conditions
-
- 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
- B60W40/10—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 related to vehicle motion
-
- 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
- B60W60/00—Drive control systems specially adapted for autonomous road vehicles
- B60W60/001—Planning or execution of driving tasks
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01S—RADIO DIRECTION-FINDING; RADIO NAVIGATION; DETERMINING DISTANCE OR VELOCITY BY USE OF RADIO WAVES; LOCATING OR PRESENCE-DETECTING BY USE OF THE REFLECTION OR RERADIATION OF RADIO WAVES; ANALOGOUS ARRANGEMENTS USING OTHER WAVES
- G01S13/00—Systems using the reflection or reradiation of radio waves, e.g. radar systems; Analogous systems using reflection or reradiation of waves whose nature or wavelength is irrelevant or unspecified
- G01S13/86—Combinations of radar systems with non-radar systems, e.g. sonar, direction finder
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01S—RADIO DIRECTION-FINDING; RADIO NAVIGATION; DETERMINING DISTANCE OR VELOCITY BY USE OF RADIO WAVES; LOCATING OR PRESENCE-DETECTING BY USE OF THE REFLECTION OR RERADIATION OF RADIO WAVES; ANALOGOUS ARRANGEMENTS USING OTHER WAVES
- G01S13/00—Systems using the reflection or reradiation of radio waves, e.g. radar systems; Analogous systems using reflection or reradiation of waves whose nature or wavelength is irrelevant or unspecified
- G01S13/88—Radar or analogous systems specially adapted for specific applications
- G01S13/93—Radar or analogous systems specially adapted for specific applications for anti-collision purposes
-
- 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/588—Recognition of the road, e.g. of lane markings; Recognition of the vehicle driving pattern in relation to the road
-
- G—PHYSICS
- G08—SIGNALLING
- G08G—TRAFFIC CONTROL SYSTEMS
- G08G1/00—Traffic control systems for road vehicles
- G08G1/16—Anti-collision systems
- G08G1/167—Driving aids for lane monitoring, lane changing, e.g. blind spot detection
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B60—VEHICLES IN GENERAL
- B60R—VEHICLES, VEHICLE FITTINGS, OR VEHICLE PARTS, NOT OTHERWISE PROVIDED FOR
- B60R2300/00—Details of viewing arrangements using cameras and displays, specially adapted for use in a vehicle
- B60R2300/80—Details of viewing arrangements using cameras and displays, specially adapted for use in a vehicle characterised by the intended use of the viewing arrangement
- B60R2300/806—Details of viewing arrangements using cameras and displays, specially adapted for use in a vehicle characterised by the intended use of the viewing arrangement for aiding 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
- B60W2520/00—Input parameters relating to overall vehicle dynamics
- B60W2520/06—Direction of travel
Landscapes
- Engineering & Computer Science (AREA)
- Mechanical Engineering (AREA)
- Physics & Mathematics (AREA)
- Automation & Control Theory (AREA)
- Transportation (AREA)
- General Physics & Mathematics (AREA)
- Remote Sensing (AREA)
- Radar, Positioning & Navigation (AREA)
- Multimedia (AREA)
- Theoretical Computer Science (AREA)
- Mathematical Physics (AREA)
- Computer Networks & Wireless Communication (AREA)
- Human Computer Interaction (AREA)
- Electromagnetism (AREA)
- Steering Control In Accordance With Driving Conditions (AREA)
- Control Of Driving Devices And Active Controlling Of Vehicle (AREA)
- Traffic Control Systems (AREA)
Abstract
자차량의 주위의 빈 주차 스페이스로의 주차 제어를 실행하는 주차 제어 장치의 주차 지원 방법에 있어서, 빈 주차 스페이스의 차폭 방향과 직교하는 방향의 제1 프레임선 W1 및 해당 제1 프레임선과 쌍이 되는 제2 프레임선 W2를 검출하고, 제1 프레임선 W1 상의 점과, 제2 프레임선 W2 상의 점을 연결한 직선 L 상에 주차 목표 p3을 설정하는, 예를 들어 제1 프레임선 W1 상의 단부와, 제2 프레임선 W2 상의 단부를 연결한 직선 상에 상기 주차 목표 p3을 설정하고, 자차량의 차륜의 위치를 주차 목표 p3에 맞추도록 주차 제어를 실행한다.A parking assisting method of a parking control device that performs parking control to an empty parking space around a host vehicle, wherein a first frame line W1 in a direction orthogonal to a vehicle width direction of an empty parking space and a first frame line paired with the first frame line are provided. 2 For example, an end portion on the first frame line W1 that detects the frame line W2 and sets a parking target p3 on a straight line L connecting a point on the first frame line W1 and a point on the second frame line W2; The parking target p3 is set on a straight line connecting the ends on the second frame line W2, and parking control is executed so as to match the position of the wheels of the host vehicle to the parking target p3.
Description
본 발명은, 주차 지원 방법 및 주차 제어 장치에 관한 것이다.The present invention relates to a parking assist method and a parking control device.
종래부터 차량을 차고 등의 주차 영역에 주차시키는 운전 조작을 지원하는 주차 제어 장치로서, 예를 들어 특허문헌 1에 기재된 것이 알려져 있다. 특허문헌 1에서는, 주차 프레임선의 단부를 연결하여, 목표 도달 구획을 설정하는 것이 개시되어 있다.BACKGROUND ART Conventionally, as a parking control device that supports a driving operation for parking a vehicle in a parking area such as a garage, for example, one described in Patent Literature 1 is known. Patent Literature 1 discloses connecting end portions of parking frame lines to set a target reach section.
그러나, 특허문헌 1에 개시된 종래예에서는, 차량이 목표 도달 구획에 들어가도록 주차 제어를 실행함으로써, 차량이 목표 도달 구획으로부터 비어져 나오는 것을 상정하고 있지 않다. 그 때문에 차량을, 목표 도달 구획의 적절한 위치에 주차할 수 없을 가능성이 있었다.However, in the conventional example disclosed in Patent Literature 1, it is not assumed that the vehicle protrudes from the target reaching region by executing the parking control so that the vehicle enters the target reaching region. Therefore, there was a possibility that the vehicle could not be parked at an appropriate position in the target reaching section.
본 발명은, 상기 과제를 감안하여 이루어진 것이며, 차량을 적절한 위치에 주차할 수 있도록 하는 주차 지원 방법 및 주차 제어 장치를 제공하는 것을 목적으로 하고 있다.The present invention has been made in view of the above problems, and has as its object to provide a parking assisting method and a parking control device enabling a vehicle to be parked at an appropriate position.
본 발명의 일 양태에 관한 주차 지원 방법은, 빈 주차 스페이스의 차폭 방향과 직교하는 방향의 제1 프레임선과 제2 프레임선을 검출하고, 제1 프레임선 상의 점과, 제2 프레임선 상의 점을 연결한 직선 상에 주차 목표를 설정하고, 자차량의 차륜의 위치를 그 주차 목표에 맞추도록 주차 제어한다.A parking assist method according to an aspect of the present invention detects first frame lines and second frame lines in a direction orthogonal to the vehicle width direction of an empty parking space, and determines a point on the first frame line and a point on the second frame line. A parking target is set on the connected straight line, and parking control is performed so as to match the position of the wheels of the host vehicle to the parking target.
본 발명의 주차 지원 방법에 의하면, 차량을 빈 주차 스페이스의 적절한 위치에 주차시킬 수 있다.According to the parking assisting method of the present invention, a vehicle can be parked at an appropriate location in an empty parking space.
도 1은 본 발명의 실시 형태에 관한 주차 제어 장치를 탑재한 차량의 일부 구성을 예시한 블록도이다.
도 2는 도 1에 도시한 주차 제어 장치의 화상 정보 처리부와 주차 지원 제어부의 상세한 구성을 도시하는 블록도이다.
도 3은 차량을 후진시켜 빈 주차 스페이스에 넣을 때의 주행 경로를 도시하는 모식도이다.
도 4는 차량을 전진시켜 빈 주차 스페이스에 넣을 때의 주행 경로를 도시하는 모식도이다.
도 5는 도 1에 도시한 주차 제어 장치의 처리 수순을 설명하는 흐름도이다.
도 6a는 차량을 빈 주차 스페이스에 주차시킬 때의, 목표 경로를 따른 위치와 차속의 관계를 나타내는 그래프이며, 목표 속도와 실속도의 변화를 나타낸다.
도 6b는 차량을 빈 주차 스페이스에 주차시킬 때의, 목표 경로를 따른 위치와 차속의 관계를 나타내는 그래프이며, 수정 목표 속도와 실속도의 변화를 나타낸다.
도 7은 차량을 초기 위치로부터 목표 주차 위치로 이동시킬 때의 목표 경로, 및 공주 거리에 의한 어긋남이 발생하였을 때의 주행 경로를 도시하는 설명도이다.
도 8a는 차량을 주차 영역에 주차시킬 때의, 목표 경로를 따른 위치와 타각의 관계를 나타내는 그래프이며, 목표 타각과 실타각의 변화를 나타낸다.
도 8b는 차량을 주차 영역에 주차시킬 때의, 목표 경로를 따른 위치와 타각의 관계를 나타내는 그래프이며, 목표 타각과 수정 목표 타각의 변화를 나타낸다.
도 9는 차량을 초기 위치로부터 목표 주차 위치로 이동시킬 때의 목표 경로, 및 타각의 추종 지연에 의한 어긋남이 발생하였을 때의 주행 경로를 도시하는 설명도이다.
도 10a는 차량을 주차 스페이스에 주차시킬 때의, 목표 경로를 따른 위치와 타각의 관계를 나타내는 그래프이며, 목표 타각과 정상 편차가 발생하였을 때의 실타각의 변화를 나타낸다.
도 10b는 차량을 주차 스페이스에 주차시킬 때의, 목표 경로를 따른 위치와 타각의 관계를 나타내는 그래프이며, 수정 목표 타각과 수정 목표 타각으로 하였을 때의 실타각의 변화를 나타낸다.
도 11은 본 발명의 실시 형태에 관한 주차 제어 장치의 처리 수순을 설명하는 흐름도이다.
도 12는 본 발명의 실시 형태에 관한 주차 목표를 설정하는 처리 수순을 설명하는 흐름도이다.
도 13a는 제1·제2 프레임선의 길이가 차량(자차량)의 전체 길이보다 긴 경우의 주차 스페이스와 차량을 평면으로 본 도면이며, 후진 주차의 경우를 도시하는 도면이다.
도 13b는 제1·제2 프레임선의 길이가 차량(자차량)의 전체 길이보다 긴 경우의 주차 스페이스와 차량을 평면으로 본 도면이며, 전진 주차의 경우를 도시하는 도면이다.
도 14a는 제1·제2 프레임선의 길이가 차량(자차량)의 휠베이스보다 짧은 경우의 주차 스페이스와 차량을 평면으로 본 도면이며, 후진 주차의 경우를 도시하는 도면이다.
도 14b는 제1·제2 프레임선의 길이가 차량(자차량)의 휠베이스보다 짧은 경우의 주차 스페이스와 차량을 평면으로 본 도면이며, 전진 주차의 경우를 도시하는 도면이다.
도 15a는 제1·제2 프레임선의 길이가 차량(자차량)의 휠베이스보다도 길고 또한 차량의 전체 길이보다도 짧은 경우의 주차 스페이스와 차량을 평면으로 본 도면이며, 후진 주차의 경우를 도시하는 도면이다.
도 15b는 제1·제2 프레임선의 길이가 차량(자차량)의 휠베이스보다도 길고 또한 차량의 전체 길이보다도 짧은 경우의 주차 스페이스와 차량을 평면으로 본 도면이며, 전진 주차의 경우를 도시하는 도면이다.
도 16a는 제1·제2 프레임선의 차량이 진입하는 방향 안쪽의 단부만이 남는 주차 스페이스와 차량을 평면으로 본 도면이며, 후진 주차의 경우를 도시하는 도면이다.
도 16b는 제1·제2 프레임선의 차량이 진입하는 방향 안쪽의 단부만이 남는 주차 스페이스와 차량을 평면으로 본 도면이며, 전진 주차의 경우를 도시하는 도면이다.
도 17a는 제1·제2 프레임선의 차량이 진입하는 방향 앞쪽의 단부만이 남는 주차 스페이스와 차량을 평면으로 본 도면이며, 후진 주차의 경우를 도시하는 도면이다.
도 17b는 제1·제2 프레임선의 차량이 진입하는 방향 앞쪽의 단부만이 남는 주차 스페이스와 차량을 평면으로 본 도면이며, 전진 주차의 경우를 도시하는 도면이다.
도 18a는 제1·제2 프레임선의 길이가 상이한 경우의 주차 스페이스와 차량을 평면으로 본 도면이며, 후진 주차의 경우를 도시하는 도면이다.
도 18b는 제1·제2 프레임선의 길이가 상이한 경우의 주차 스페이스와 차량을 평면으로 본 도면이며, 전진 주차의 경우를 도시하는 도면이다.1 is a block diagram illustrating some configurations of a vehicle equipped with a parking control device according to an embodiment of the present invention.
FIG. 2 is a block diagram showing detailed configurations of an image information processing unit and a parking assisting control unit of the parking control device shown in FIG. 1;
Fig. 3 is a schematic diagram showing a travel path when the vehicle is reversed and put into an empty parking space.
Fig. 4 is a schematic diagram showing a travel path when the vehicle is moved forward and put into an empty parking space.
FIG. 5 is a flowchart for explaining the processing procedure of the parking control device shown in FIG. 1;
6A is a graph showing a relationship between a position along a target path and a vehicle speed when a vehicle is parked in an empty parking space, and shows changes in the target speed and stall speed.
6B is a graph showing a relationship between a position along a target path and a vehicle speed when a vehicle is parked in an empty parking space, and shows changes in a corrected target speed and stall speed.
Fig. 7 is an explanatory view showing a target route when moving a vehicle from an initial position to a target parking position, and a travel route when a deviation occurs due to an idle distance.
8A is a graph showing a relationship between a position along a target path and a steering angle when a vehicle is parked in a parking area, and shows a change in a target steering angle and an actual steering angle.
8B is a graph showing a relationship between a position along a target path and a steering angle when a vehicle is parked in a parking area, and shows a change in a target steering angle and a corrected target steering angle.
Fig. 9 is an explanatory diagram showing a target path when the vehicle is moved from an initial position to a target parking position, and a travel path when a discrepancy occurs due to a tracking delay of the steering angle.
10A is a graph showing a relationship between a position along a target path and a steering angle when a vehicle is parked in a parking space, and shows a change in the actual steering angle when a normal deviation from the target steering angle occurs.
10B is a graph showing the relationship between a position along a target path and a steering angle when a vehicle is parked in a parking space, and shows a change in the actual steering angle when a corrected target steering angle and a corrected target steering angle are set.
11 is a flowchart for explaining the processing procedure of the parking control device according to the embodiment of the present invention.
Fig. 12 is a flowchart for explaining a processing procedure for setting a parking target according to an embodiment of the present invention.
Fig. 13A is a planar view of a parking space and a vehicle when the lengths of first and second frame lines are longer than the overall length of the vehicle (own vehicle), and is a diagram showing the case of reverse parking.
Fig. 13B is a planar view of a parking space and a vehicle when the lengths of the first and second frame lines are longer than the overall length of the vehicle (own vehicle), and is a diagram showing the case of forward parking.
Fig. 14A is a planar view of a parking space and a vehicle when the lengths of first and second frame lines are shorter than the wheelbase of the vehicle (own vehicle), and is a diagram showing the case of reverse parking.
14B is a planar view of a parking space and a vehicle when the length of the first and second frame lines is shorter than the wheelbase of the vehicle (own vehicle), and is a diagram showing the case of forward parking.
15A is a plan view of a parking space and a vehicle when the length of first and second frame lines is longer than the wheelbase of the vehicle (own vehicle) and shorter than the total length of the vehicle, and is a diagram showing the case of reverse parking. to be.
15B is a plan view of a parking space and a vehicle when the length of the first and second frame lines is longer than the wheelbase of the vehicle (own vehicle) and shorter than the total length of the vehicle, and is a diagram showing forward parking. to be.
Fig. 16A is a plane view of a parking space and a vehicle in which only the ends of the first and second frame lines in the direction in which the vehicle enters are left, and is a diagram showing the case of reverse parking.
Fig. 16B is a plan view of a parking space and a vehicle in which only the ends of the first and second frame lines in the direction in which the vehicle enters are left, and is a diagram showing the case of forward parking.
Fig. 17A is a planar view of a parking space and a vehicle in which only the front end of the first and second frame lines in the direction in which the vehicle enters is left, and is a diagram showing the case of reverse parking.
Fig. 17B is a planar view of a parking space and a vehicle in which only the front end of the first and second frame lines in the direction in which the vehicle enters is left, and is a diagram showing the case of forward parking.
Fig. 18A is a planar view of a parking space and a vehicle when the lengths of first and second frame lines are different, and is a diagram showing the case of reverse parking.
Fig. 18B is a planar view of a parking space and a vehicle in the case where the lengths of the first and second frame lines are different, and is a diagram showing the case of forward parking.
이하, 본 발명의 실시 형태를 도면에 기초하여 설명한다.EMBODIMENT OF THE INVENTION Hereinafter, embodiment of this invention is described based on drawing.
도 1은 본 발명의 실시 형태에 관한 주차 제어 장치를 탑재한 차량의 일부 구성을 예시한 블록도이다. 도 1에 도시한 바와 같이, 이 주차 제어 장치(100)는, 차량 제어 ECU(40)에 출력하는 타각 제어 신호와 속도 제어 신호를 생성한다. 또한, 본 실시 형태에 있어서의 주차란, 차량을 빈 주차 스페이스를 향하여 이동하여, 빈 주차 스페이스에 정차하는 것을 말한다. 자동차에 있어서는, 주차장 내의 주차 스페이스에, 자동차를 세우기 위해, 빈 주차 스페이스로 이동하여, 빈 주차 스페이스에 정차하는 것을 말한다.1 is a block diagram illustrating some configurations of a vehicle equipped with a parking control device according to an embodiment of the present invention. As shown in FIG. 1 , this
주차 제어 장치(100)는, 목표 주차 프레임 검지 센서(10), 화상 정보 처리부(20)(목표 위치 설정 회로), 및 주차 지원 연산부(30)(차량 제어 회로)를 구비한다.The
목표 주차 프레임 검지 센서(10)는, 예를 들어 차량의 주위를 촬상하는 복수의 카메라로 구성된다. 카메라(10a)는 차량의 전방에 탑재되어 차량 전방을 촬상한다. 카메라(10b)는 차량의 후방에 탑재되어 차량 후방을 촬상한다. 카메라(10c)는 차량의 좌측에 탑재되어 차량 좌측을 촬상한다. 카메라(10d)는 차량의 우측에 탑재되어 차량 우측을 촬상한다. 각각의 카메라는, 차량의 루프보다 하방에 설치된다.The target parking
목표 주차 프레임 검지 센서(10)는 다른 센서로 구성해도 된다. 예를 들어, 대상물을 향하여 적외선 레이저를 조사하고, 그 반사광의 강도에 의해 대상물까지의 거리를 측정하는 레이저 레인지 파인더(LRF) 등으로 구성해도 된다. 반사광의 강도에 따라 주차 스페이스를 나타내는 백선 등의 길이를 검출하는 것도 가능하다. 또한, 초음파를 이용하는 클리어런스 소너를 사용해도 된다. 또한, 목표 주차 프레임 검지 센서(10)는, 반드시 차량에 마련된 센서는 아니어도 되고, 자차량의 주위에 구비된 센서(예를 들어, 주차장의 카메라, 타차량에 구비되는 센서, 카메라)여도 된다. 이 경우, 차량의 주위에 구비된 센서에 의해 얻어진 데이터를, 무선 통신을 사용하여, 자차량에 송신하도록 해도 된다. 또한, 본 실시 형태는, 자차량의 카메라를 사용하여 목표 주차 프레임 검지 센서(10)를 구성한 예로 설명한다.The target parking
화상 정보 처리부(20)는, 목표 주차 프레임 검지 센서(10)로 촬상한 자차량의 주위의 화상 정보를, 화상 인식하여 주차 지원에 필요한 정보를 생성한다. 그 정보는, 주차 지원 연산부(30)에 출력된다. 주차 지원에 필요한 정보에 대하여, 상세하게는 후술한다.The image
주차 지원 연산부(30)에는, 화상 정보 처리부(20) 외에, 입력 인터페이스(51), 차륜속 센서(52), 및 타각 센서(53)가 접속된다. 또한, 주차 지원 연산부(30)의 출력은, 차량 제어 ECU(40)에 접속된다.In addition to the image
목표 주차 프레임 검지 센서(10)는, 각 카메라(10a 내지 10d)로 촬상된 화상으로부터, 빈 주차 스페이스의 차폭 방향과 직교하는 방향의 제1 프레임선 및 해당 제1 프레임선과 쌍이 되는 제2 프레임선을 검출하는 프레임선 검지 회로(10e)를 더 구비한다. 목표 위치 설정 회로(20)는, 제1 프레임선 상의 점과, 제2 프레임선 상의 점을 연결한 직선 상에 주차 목표를 설정한다. 차량 제어 회로(30)는, 자차량의 차륜의 위치를 주차 목표에 맞추도록 주차 제어를 실행한다. 구체적으로는, 차량 제어 회로(30)는, 주차 목표까지의 목표 주차 경로를 생성하고, 생성한 목표 주차 경로를 따르도록, 자차량의 위치, 자차량의 자세, 자차량의 속도를 제어하고, 목표 위치에 자차량의 소정의 위치(차륜, 차량의 단부)가 맞도록 정지 제어를 실행한다. 또한, 본 실시 형태에 있어서의 제1 프레임선과 제2 프레임선은, 주차 스페이스를 구성하는 프레임선 중, 특정할 필요는 없다. 즉, 제1 프레임선은, 주차 스페이스의 차폭 방향의 전방측, 후방측 중 어느 쪽이어도 되고, 또한, 긴 쪽, 짧은 쪽 중 어느 쪽이어도 된다. 또한, 제1 프레임선의 길이를 검출하는 경우, 제1 프레임선의 길이와, 자차량의 전체 길이 및 자차량의 전륜과 후륜 사이의 길이를 비교하는 경우, 주차 스페이스를 구성하는 2개의 프레임선 중, 어느 쪽을 제1 프레임선으로 해도 된다.The target parking
목표 주차 프레임 검지 센서(10), 목표 위치 설정 회로(20), 및 차량 제어 회로(30)를 구비하는 주차 제어 장치(100)에 의하면, 자차량을 빈 주차 스페이스의 적절한 위치에 주차시킬 수 있다.According to the
입력 인터페이스(51)는, 조작자에 의한 주차 위치의 조정, 주차 위치의 선택, 주차 방식(전진 주차, 후진 주차) 등에 관한 각종 정보를 입력하는 단말기이다. 조작자가 승차하고 있는 경우를 상정하여, 차량 내에 조이 스틱이나 조작 스위치, 터치 패널 등, 차량에 탑재되는 각종 조작 입력 디바이스 등을 마련해도 된다. 또한, 차량에 설치되어 있는 스피커를 사용하여, 운전자에게 각종 조작 입력을 재촉하는 음성 안내를 행하도록 해도 된다.The
차륜속 센서(52)는, 자차량의 차륜속을 검출하는 센서이다.The
타각 센서(53)는, 자차량의 타각을 검출하는 센서이며, 스티어링의 회전축에 설치하는 인코더를 사용하는 것이 일반적이다.The
주차 지원 연산부(30)는, 화상 정보 처리부(20)가 생성하는 주차 지원에 필요한 각 정보, 차륜속 센서(52)에서 검출한 자차량의 차륜속 정보, 타각 센서(53)에서 검출한 타각 정보, 및 입력 인터페이스(51)에 입력되는 주차 위치에 관한 각종 정보에 기초하여 타각 제어 신호와 속도 제어 신호를 생성한다.The parking
주차 지원 연산부(30)에서 생성된 타각 제어 신호와 속도 제어 신호는, 차량 제어 ECU(40)에 입력된다. 또한, 차량 제어 ECU(40)에는, 차륜속 센서(52)와 타각 센서(53)가 접속된다. 차량 제어 ECU(40)의 출력은, 스티어링, 차속 등을 제어하는 액추에이터(50)에 접속된다.The steering angle control signal and the speed control signal generated by the parking assist
화상 정보 처리부(20) 및 차량 제어 ECU(40)는, 예를 들어 중앙 연산 유닛(CPU)이나, RAM, ROM, 하드 디스크 등의 기억 수단으로 이루어지는 일체형 컴퓨터로서 구성할 수 있다.The image
도 2는 화상 정보 처리부(20) 및 주차 지원 연산부(30)의 상세한 구성을 도시하는 블록이다. 화상 정보 처리부(20)는, 목표 주차 프레임 검지부(21), 목표 주차 위치 설정부(22), 주차 개시 위치 설정부(23), 및 현재 위치 추정부(24)를 구비한다.FIG. 2 is a block showing detailed configurations of the image
목표 주차 프레임 검지부(21)는, 프레임선 검지 회로(10e)에서 검출한 제1 프레임선과 제2 프레임선을 사용하여 자차량을 주차시키는 위치인 목표 주차 프레임 위치를 출력한다. 또한, 목표 주차 프레임 검지부(21)는, 목표 주차 프레임 검지 센서(10)로 촬상한 화상으로부터 빈 주차 스페이스의 차폭 방향과 직교하는 방향의 제1 프레임선 및 해당 제1 프레임선과 쌍이 되는 제2 프레임선을 검출하고, 목표 주차 프레임 위치를 출력해도 된다. 복수의 빈 주차 스페이스를 검지한 경우에는, 그 중에서 가장 주차하기 쉬운(주차 시간이 짧거나, 주차 거리가 짧거나, 사각이 적은 것 등) 빈 주차 스페이스를 목표 주차 프레임 위치로 할 수 있다.The target parking
또한, 목표 주차 프레임 위치는 입력 인터페이스(51)로부터의 조작 입력에 의해 설정하는 것에 의해, 목표 주차 프레임 검지부(21)로부터 출력된 목표 주차 프레임 위치를 변경할 수 있다. 예를 들어, 목표 주차 프레임 위치로의 주차를 중지시키는 것도, 복수의 빈 주차 스페이스 중에서 다른 빈 주차 스페이스로 변경하는 것도 가능하다.In addition, the target parking frame position outputted from the target parking
도 3은 차량 V1을, 빈 주차 스페이스로 넣을 때의 주행 경로를 도시하는 모식도이다. 도면 중의 X1은, 화상 정보 처리부(20)에서 인식한 주차 공간을 나타낸다. 또한, R1은 주로를 나타낸다. 도 3에 있어서의 주로 R1은, 주차 스페이스의 차량 전후 방향에 대하여 수직(직교하는 방향)으로 설정되어 있다. 또한, 본 실시 형태에 있어서의, 주로 R1의 방향은, 주차 스페이스에 대하여 어떤 방향이어도 되어, 방향은 불문한다. 목표 주차 프레임 검지부(21)가 출력하는 목표 주차 프레임 위치는, 제1 프레임선 W1과 제2 프레임선 W2의 각각의 좌표와 길이를 포함한다. 좌표는, 주차 공간 X1 상의 2차원 좌표이다. 도면 중의 제1 프레임선 W1과 제2 프레임선 W2는, 차량 V1이, 예를 들어 초기 위치 p1의 위치에서 검지한 예를 나타낸다.Fig. 3 is a schematic diagram showing a travel path when the vehicle V1 is put into an empty parking space. X1 in the figure represents a parking space recognized by the image
목표 주차 위치 설정부(22)는, 제1 프레임선 W1 상의 점과, 제2 프레임선 W2 상의 점을 연결한 직선 L 상에 주차 목표를 설정한다. 도 3은 주차 목표 p3에, 차량 V1의 리어측의 차륜의 단부(후륜의 후단)의 위치를 맞춘 예를 도시한다. 또한, 주차 목표 p3에, 차량 V1 상의 어느 위치를 맞출지는, 제1·제2 프레임선 W1, W2의 길이나 주차 방식(후진 또는 전진)에 따라 상이하다. 또한, 주차 목표 p3의 제1·제2 프레임선 W1, W2 상의 각각을 연결하는 직선 L을 인출하는 점도 상이하다. 그 상이한 예에 대해서는 후술한다. 또한, 주차 목표 p3에, 차량 V1 상의 어느 위치를 맞출지는, 차량 V1의 후륜의 어느 위치를 맞춰도 되고, 후단, 차륜의 중앙, 차륜 중앙으로부터 소정의 위치 등을, 설정하도록 해도 된다.The target parking
주차 개시 위치 설정부(23)는, 목표 주차 프레임 검지 센서(10)로 촬상한 화상으로부터, 초기 위치 p1, 주차 개시 위치 p2, 및 주차 목표 p3을 설정한다. 주차 개시 위치 p2는, 차량 V1을 주차 목표 p3으로 유도하기 위한 방향 전환 위치이며, 이후 방향 전환 위치 p2라 칭한다.The parking start
현재 위치 추정부(24)는, 목표 주차 프레임 검지 센서(10)로 촬상된 백선(제1 프레임선 W1, 제2 프레임선 W2), 물체 인식 결과, 및 차량 V1의 상대 위치 관계로부터 차량 V1의 현재의 위치를 추정한다.The current
주차 지원 연산부(30)(도 2)는, 주차 경로 생성부(31), 주차 경로 추종 제어부(32), 조타각 제어부(33), 목표 속도 생성부(34), 및 속도 제어부(35)를 구비한다.The parking assistance calculation unit 30 (FIG. 2) includes a parking
주차 경로 생성부(31)는, 차량 V1의 현재의 위치(예를 들어 초기 위치 p1), 방향 전환 위치 p2, 및 주차 목표 p3으로부터, 차량 V1을 주차 목표 p3으로 이동시키는 주차 경로를 생성한다. 주차 경로는, 차량 V1이 장해물과 간섭하지 않고 주차 목표 p3까지 이동 가능한 경로이다.The parking
주차 경로 추종 제어부(32)는, 주차 경로와 차량 V1의 현재의 위치로부터, 차량 V1을 주차 목표 p3까지 이동시키는 데 필요한 목표 조타각을 생성한다.The parking
조타각 제어부(33)는, 목표 조타각에 대응시켜 스티어링 타각을 제어하는 타각 제어 신호를 생성한다.The
목표 속도 생성부(34)는, 주차 경로와 차량 V1의 현재의 위치로부터, 차량 V1을 이동시키는 목표 속도를 생성한다.The
속도 제어부(35)는, 차량 V1의 차속이 목표 속도가 되도록 제어하는 속도 제어 신호를 생성한다.The
이상 설명한 주차 경로 추종 제어부(32), 조타각 제어부(33), 목표 속도 생성부(34), 및 속도 제어부(35)는, 예를 들어 데드 레코닝 방법에 기초하여 타각 제어 신호와 속도 제어 신호를 생성하도록 해도 된다. 데드 레코닝 방법이란, 극저속, 또한 전륜 조타차에 있어서, 후륜 차축 중심의 주행 거리와 전륜 조타각의 관계에 기초하여, 차량의 위치 및 자세를 추정하는 방법이며, 주차 동작 등의 제한된 구간을 주행하는 경우에 유용한 방법이다.The above-described parking
차량 제어 ECU(40)는, 타각 제어 신호와 속도 제어 신호에 기초하여, 차량 V1의 구동과 제동 및 조타를 제어하는 액추에이터(50)의 구동을 제어한다. 주차 경로 생성부(31)에서 생성한 주차 경로를 따라서 차량 V1이 이동하도록 스티어링 타각과 속도를 제어하면, 차량 V1 상의 특정 위치를, 주차 목표 P3에 맞추어 주차시킬 수 있다.The
도 4는 차량 V1을, 전진 주차로 빈 주차 스페이스에 넣을 때의 주행 경로를 도시하는 모식도이다. 도 4에서는, 주차 목표 p3에 맞추는 차량 V1 상의 위치가, 예를 들어 차량 V1의 프론트의 차륜의 단부(전륜의 전단)로 설정되어 있다. 따라서, 차량 V1의 전륜의 위치는, 제1 프레임선 W1의 차량 V1이 진입하는 방향 안쪽의 단부와 쌍을 이루는 제2 프레임선의 차량 V1이 진입하는 방향 안쪽의 단부를 연결한 직선 L 상에, 맞도록 주차 제어가 행해진다. 또한, 주차 목표 p3에, 차량 V1 상의 어느 위치를 맞출지는, 차량 V1의 전륜의 어느 위치를 맞추어도 되고, 후단, 차륜의 중앙, 차륜 중앙으로부터 소정의 위치 등을, 설정하도록 해도 된다.Fig. 4 is a schematic diagram showing a travel route when the vehicle V1 is put into an empty parking space by forward parking. In Fig. 4, the position on the vehicle V1 that meets the parking target p3 is set to, for example, the end of the front wheel of the vehicle V1 (front end of the front wheel). Therefore, the position of the front wheels of the vehicle V1 is on a straight line L connecting the end of the first frame line W1 in the direction in which the vehicle V1 enters and the end of the second frame line paired with the end in the direction in which the vehicle V1 enters, Parking control is performed to match. In addition, which position on the vehicle V1 is set to the parking target p3, which position of the front wheels of the vehicle V1 may be set, or a predetermined position from the rear end, the center of the wheel, or the center of the wheel may be set.
이와 같이 후진 주차와 전진 주차(주차 방식)에서, 주차 목표 p3에 맞추는 차량 V1 상의 위치가 변화된다. 또한, 주차 목표 p3이 설정되는 제1 프레임선 W1과 제2 프레임선 W2를 연결하는 직선 L의 위치도 변화된다. 그 구체예에 대해서는 후술한다.Thus, in reverse parking and forward parking (parking mode), the position on the vehicle V1 that meets the parking target p3 is changed. In addition, the position of the straight line L connecting the first frame line W1 and the second frame line W2 at which the parking target p3 is set is also changed. A specific example thereof will be described later.
다음에, 상기와 같이 구성된 본 실시 형태에 관한 주차 제어 장치(100)의 작용을, 도 5에 도시한 흐름도와 도 3을 참조하여 설명한다.Next, the operation of the
주차 공간 X1 상의 초기 위치 p1을, 저속으로 이동, 혹은 정차하고 있는 차량 V1은, 빈 주차 스페이스를 탐색한다(스텝 S1). 차량 V1의 목표 주차 프레임 검지 센서(10)가, 빈 주차 스페이스를 검지하면(스텝 S2의 "예"), 화상 정보 처리부(20)는 주차 방식과 목표 주차 프레임 위치를 결정한다(스텝 S3).The vehicle V1, which is moving at a low speed or stopped at the initial position p1 on the parking space X1, searches for an empty parking space (step S1). When the target parking
주차 방식과 목표 주차 프레임 위치는, 화상 정보 처리부(20)가 자동으로 결정해도 되고, 입력 인터페이스(51)로부터의 조작 입력에 의해 결정해도 된다.The image
주차 지원 연산부(30)는, 화상 정보 처리부(20)가 생성하는 초기 위치 p1, 방향 전환 위치 p2, 및 주차 목표 p3으로부터, 차량 V1을 주차 목표 p3까지 이동시키는 주차 경로를 생성한다(스텝 S4). 그리고, 주차 제어를 개시한다(스텝 S5).The parking
주차 지원 연산부(30)는, 차량 V1의 위치를, 방향 전환 위치 p2에 도달하도록, 타각 제어 신호와 속도 제어 신호를 변화시킨다(스텝 S6의 "아니오").The parking
차량 V1의 위치가 방향 전환 위치 p2에 도달하면(스텝 S6의 "예"), 차량 제어 ECU(40)는, 시프트 포지션을 R 레인지로 전환한다(스텝 S7).When the position of the vehicle V1 reaches the direction change position p2 (YES in step S6), the
시프트 포지션이 R 레인지로 전환되면, 주차 제어 장치(100)는, 검지 중인 제1 프레임선 W1과 제2 프레임선 W2를 재검지하여, 주차 목표 p3을 재설정한다(스텝 S9).When the shift position is switched to the R range, the
그리고, 주차 제어 장치(100)는, 주차 목표 p3에, 차량 V1 상의 위치가 일치하도록 타각 제어 신호와 속도 제어 신호의 각각을 제어한다(스텝 S10). 이 스텝 S9 내지 S10의 처리는, 차량 V1 상의 위치가 주차 목표 p3에 도달할 때까지 반복된다(스텝 S11의 "아니오").Then, the
이 스텝 S9 내지 S10의 처리는, 예를 들어 목표 주차 프레임 검지 센서(10)가 하나의 화상을 촬상하는 프레임 레이트의 단위로 행해진다. 즉, 주차 목표 p3으로 차량 V1을 유도하는 타각 제어 신호와 속도 제어 신호는, 리얼타임으로 설정된다.The processing of these steps S9 to S10 is performed in units of the frame rate at which the target parking
리얼타임으로 제어되는 타각 제어 신호와 속도 제어 신호에 의해, 차량 V1 상의 위치가 주차 목표 p3에 도달하면(스텝 S11의 "예"), 시프트 포지션이 P 레인지로 전환되고, 주차 지원 제어는 종료된다(스텝 S12).When the position on the vehicle V1 reaches the parking target p3 by the steering angle control signal and the speed control signal controlled in real time (YES in step S11), the shift position is switched to the P range, and the parking assist control is ended. (Step S12).
다음에, 주차 경로와 차량 V1의 주행 경로 사이에 발생하는 차를 적게 하는 리얼타임 제어에 대하여 설명한다. 주차 경로와 주행 경로 사이에 발생하는 차의 요인으로서, 「A: 차량 정지 시에 발생하는 공주 거리」, 「B: 타각의 추종 지연」, 「C: 타각의 정상 편차」, 「D: 목표 주차 프레임 검지 센서(10)의 검출 오차」의 4개가 있다. 이들 각각의 영향을 작게 하는 방법에 대하여 상세하게 설명한다.Next, real-time control for reducing the difference between the parking path and the traveling path of the vehicle V1 will be described. As factors of the difference between the parking route and the driving route, "A: Gong distance that occurs when the vehicle is stopped", "B: tracking delay of steering angle", "C: normal deviation of steering angle", "D: target parking" Detection error of the frame detecting sensor 10'. A method for reducing each of these influences will be described in detail.
「A: 차량 정지 시에 발생하는 공주 거리」「A: Gongju Street that occurs when the vehicle is stopped」
주차 경로를 따라서 차량 V1을 주행시키기 위한, 주행 위치에 대한 속도 제어 신호의 변화를 도 6에 도시한다. 도 6a의 횡축은 차량 V1의 위치, 종축은 차량 V1의 목표 속도 q1(실선), 및 실속도 q2(파선)이다. 횡축에 나타내는 p1은, 도 3에 도시한 초기 위치 p1에 대응하고, p2는 방향 전환 위치 p2에 대응하고, p3은 주차 목표 p3에 대응하고 있다.Fig. 6 shows the change of the speed control signal with respect to the driving position for driving the vehicle V1 along the parking path. 6A, the horizontal axis represents the position of the vehicle V1, and the vertical axis represents the target speed q1 (solid line) and stall speed q2 (broken line) of the vehicle V1. P1 indicated on the horizontal axis corresponds to the initial position p1 shown in FIG. 3, p2 corresponds to the direction change position p2, and p3 corresponds to the parking target p3.
목표 속도 q1은, 초기 위치 p1로부터 방향 전환 위치 p2를 향하는 경로(도 3의 x0)에 있어서, 전진 방향의 목표 속도가 설정되어 있다. 또한, 방향 전환 위치 p2로부터 주차 목표 p3을 향하는 경로(도 3의 x1)에 있어서, 후진 방향의 목표 속도가 설정되어 있다. 목표 속도 q1은, 차량 V1의 위치에 따라서 목표 속도가 램프형으로 변화되는 패턴으로 하고 있다.The target speed q1 is set as the target speed in the forward direction on the path from the initial position p1 to the direction change position p2 (x0 in Fig. 3). Further, in the path from the direction change position p2 to the parking target p3 (x1 in Fig. 3), a target speed in the reverse direction is set. The target speed q1 has a pattern in which the target speed changes in a ramp-like manner according to the position of the vehicle V1.
도 6a에 도시한 바와 같이, 초기 위치 p1로부터 방향 전환 위치 p2를 향할 때는, 목표 속도 q1에 추종하여 실속도 q2가 변화된다. 그러나, 방향 전환 위치 p2에서 정지할 때는, 목표 속도 q1에 추종할 수 없는 경우가 있어, 차량 V1이 공주한다. 즉, 차량 V1이 방향 전환 위치 p2에 도달하였을 때, 실속도 q2는 제로가 되지 않고 공주하므로, 공주 거리(「L1」)만큼 지나친 위치 p21에서 실속도 q2가 제로가 된다. 공주 거리 L1은, 타각 센서(53)의 검출 데이터에 기초하여 산출할 수 있다.As shown in Fig. 6A, when going from the initial position p1 to the direction change position p2, the stall speed q2 follows the target speed q1 and changes. However, when stopping at the direction change position p2, there is a case where the target speed q1 cannot be followed, and the vehicle V1 runs at speed. That is, when the vehicle V1 reaches the direction change position p2, the stall speed q2 does not become zero and starts running, so the stall speed q2 becomes zero at the position p21 that is excessive by the running distance ("L1"). The idle distance L1 can be calculated based on the detection data of the
차량 V1이 공주함으로써, 방향 전환 위치 p2를 지나친 위치 p21에서 차량 V1이 정지한다. 따라서, 이 공주 거리 L1을 보정하지 않고 차량 V1을 후진시키면, 주차 경로 x1을 따라서 차량 V1이 후진하여 주차 목표 p3에 도달해야 할 곳이, 주차 경로 x1과 상이한 경로 x2를 따라서 후진해 버려, 주차 목표 p3과 상이한 위치 p31에 도달해 버린다.When the vehicle V1 runs, the vehicle V1 stops at the position p21 beyond the direction change position p2. Therefore, if the vehicle V1 reverses without correcting this empty distance L1, the vehicle V1 reverses along the parking path x1 and reaches the parking target p3, reverses along the path x2 different from the parking path x1, and parks. A position p31 different from the target p3 is reached.
따라서, 공주 거리 L1에 기초하여, 차량 V1이 후진할 때의 목표 속도 q1을 수정하여, 도 6b에 도시한 바와 같이, 수정 목표 속도 q1a를 설정한다. 수정 목표 속도 q1a는, 후진 시의 거리가 공주 거리 L1만큼 길어지도록 속도를 설정한다. 수정 목표 속도 q1a를 설정함으로써, 공주 거리 L1에서 발생한 주차 경로와 주행 경로의 어긋남을 보정할 수 있어, 차량 V1을 주차 목표 p3에 도달시킬 수 있다. 도 6b 중의 q2a는, 수정 목표 속도 q1a에 대한 실속도 q2a이다.Therefore, based on the idling distance L1, the target speed q1 when the vehicle V1 moves backward is corrected, and the corrected target speed q1a is set as shown in FIG. 6B. The corrected target speed q1a is set so that the distance at the time of backward movement becomes longer by the idling distance L1. By setting the corrected target speed q1a, it is possible to correct the deviation between the parking path and the traveling path generated at the idling distance L1, so that the vehicle V1 can reach the parking target p3. q2a in FIG. 6B is the stall speed q2a for the corrected target speed q1a.
도 7은 이상 기술한 설명을 평면으로 보아 도시하는 도면이다. 차량 V1의 정지 시에 공주 거리 L1이 발생한 경우라도, 공주 거리 L1과 동일한 거리만큼 차량 V1을 후진시킨 후, 즉, 위치 p21로부터 방향 전환 위치 p2로 되돌린 후에, 차량 V1의 후진을 본래의 제어 신호로 제어하므로, 차량 V1을 주차 목표 p3의 위치에 주차시킬 수 있다. 또한, 차량 V1이 위치 p21로부터 방향 전환 위치 p2로 되돌아갈 때의 타각은, 공주 시의 타각과 동일한 타각으로 한다.Fig. 7 is a view showing the explanation described above in plan view. Even if the idle distance L1 occurs when the vehicle V1 is stopped, after the vehicle V1 is reversed by the same distance as the idle distance L1, that is, after returning from the position p21 to the direction change position p2, the backward movement of the vehicle V1 is originally controlled. Since it is controlled by a signal, the vehicle V1 can be parked at the position of the parking target p3. In addition, the steering angle when the vehicle V1 returns from the position p21 to the direction change position p2 is set to be the same steering angle as the steering angle at idle.
「B: 타각의 추종 지연」「B: Follow-up delay」
다음에, 차량 V1의 타각 제어에 대하여 설명한다. 도 8a는 차량 V1의 위치에 대한 타각의 변화를 나타내는 그래프이며, 곡선 q11은, 주차 경로를 따라서 차량을 주행시킬 때의 목표 조타각을 나타내고, 곡선 q12는 실타각을 나타내고 있다. 목표 조타각을 나타내는 곡선 q11은, 클로소이드를 베이스로 한 조타 패턴이며, 타각 변화량의 기울기는 스티어링 액추에이터의 동작 한계를 고려한 값이 되도록 설정한다. 그리고, 차량 V1의 타각을 제어할 때 목표 타각 q11을 설정하면, 타각계의 다이내믹스에 의해 어느 정도의 지연을 갖고 추종하게 된다. 즉, 실타각 q12는 목표 조타각 q11에 대하여 약간 어긋난 위치에서 설정되게 된다.Next, steering angle control of the vehicle V1 will be described. 8A is a graph showing changes in the steering angle with respect to the position of the vehicle V1, curve q11 represents a target steering angle when the vehicle is driven along a parking path, and curve q12 represents an actual steering angle. The curve q11 representing the target steering angle is a steering pattern based on the clothoid, and the slope of the steering angle variation is set to a value considering the operation limit of the steering actuator. When the target steering angle q11 is set when controlling the steering angle of the vehicle V1, the steering angle is followed with a certain amount of delay due to the dynamics of the steering angle system. That is, the actual steering angle q12 is set at a position slightly deviated from the target steering angle q11.
그 결과, 도 9에 도시한 바와 같이, 초기 위치 p1로부터 방향 전환 위치 p2를 향할 때, 타각 제어가 지연되어 버려, 주행 경로의 곡률 반경이 커진다. 구체적으로는, 경로 x3을 주행하여, 위치 p22로 정지하게 되어, 방향 전환 위치 p2에 대하여 거리 L2만큼 어긋난 위치가 되어 버린다. 그리고, 이 위치 p22로부터 차량 V1을 후진시키면, 경로 x4를 따라서 후진하게 되어, 위치 p32에서 정지하게 된다. 즉, 차량 V1을 주차 목표 p3에 정지시킬 수 없다.As a result, as shown in Fig. 9, when moving from the initial position p1 to the direction change position p2, the steering angle control is delayed, and the radius of curvature of the traveling route increases. Specifically, it travels along the path x3 and comes to a stop at the position p22, resulting in a position deviated from the direction change position p2 by the distance L2. Then, when the vehicle V1 is moved backward from this position p22, it moves backward along the path x4 and comes to a stop at the position p32. That is, the vehicle V1 cannot be stopped at the parking target p3.
본 실시 형태에서는, 도 8b에 도시한 바와 같이, 타각의 추종 지연을 고려하여, 미리 타각 제어의 타이밍이 약간 빨라지도록 설정한다. 즉, 목표 조타각 q11에 대하여, 보다 전방의 위치에서 타각이 변화되도록 수정한 수정 목표 조타각 q13을 설정한다. 그리고, 이 수정 목표 조타각 q13을 사용하여 차량 V1의 주행을 제어함으로써, 목표 조타각 q11과 거의 일치하는 실타각을 얻을 수 있다. 따라서, 도 9에 도시한 목표 경로 x0을 따라서 차량 V1을 방향 전환 위치 p2에 도달시킬 수 있고, 또한, 주차 경로 x1을 따라서 주차 목표 p3으로 차량 V1을 이동시킬 수 있다.In the present embodiment, as shown in Fig. 8B, the timing of steering angle control is set to be slightly earlier in advance in consideration of the tracking delay of steering angle. That is, with respect to the target steering angle q11, a corrected target steering angle q13 is set so that the steering angle changes at a more forward position. Then, by controlling the running of the vehicle V1 using this corrected target steering angle q13, an actual steering angle substantially coincident with the target steering angle q11 can be obtained. Accordingly, the vehicle V1 can be brought to the direction changing position p2 along the target path x0 shown in FIG. 9, and the vehicle V1 can be moved to the parking target p3 along the parking path x1.
「C: 타각의 정상 편차」"C: normal deviation of steering angle"
차량 V1의 타각 제어에서는, 상술한 추종 지연 이외에, 타각의 정상 편차에 의해 목표 조타각과 실타각 사이에 어긋남이 발생하는 경우가 있다. 이하, 도 10을 참조하여 설명한다. 도 10a는, 차량 V1의 위치에 대한 목표 조타각 q21의 변화, 및 정상 편차가 발생하였을 때의 실타각 q22의 변화를 나타내는 그래프이다. 또한, 도 10에서는, 타각의 추종 지연에 대해서는 고려하고 있지 않다.In the steering angle control of the vehicle V1, a deviation may occur between the target steering angle and the actual steering angle due to the normal deviation of the steering angle in addition to the above-mentioned following delay. Hereinafter, description will be made with reference to FIG. 10 . 10A is a graph showing a change in the target steering angle q21 with respect to the position of the vehicle V1 and a change in the actual steering angle q22 when a normal deviation occurs. In Fig. 10, the follow-up delay of the steering angle is not considered.
부호 y1로 나타내는 바와 같이, 정상 편차가 발생함으로써, 실타각 q22는 목표 조타각 q21에 대하여 증대되어 있다. 따라서, 차량 V1이 방향 전환 위치 p2로부터 후진할 때 주차 경로 x1을 따라서 후진시킬 수 없다.As indicated by the symbol y1, the actual steering angle q22 is increased with respect to the target steering angle q21 due to the occurrence of a steady deviation. Therefore, when the vehicle V1 reverses from the direction change position p2, it cannot reverse along the parking path x1.
본 실시 형태에서는, 정상 편차가 발생하는 위치에 있어서는, 정상 편차를 고려하여 목표 조타각 q21을 수정하여, 도 10b에 도시한 수정 목표 조타각 q32를 설정한다. 이와 같은 설정에 의해, 정상 편차가 발생한 경우라도, 이것에 기인하는 타각의 어긋남양을 예측하여 목표 타각이 수정되므로, 목표 조타각과 거의 일치하는 실타각을 얻을 수 있다. 따라서, 차량 V1을 고정밀도로 주차 경로 x0, x1을 따라서 이동시켜, 주차 목표 p3에 주차시킬 수 있다.In the present embodiment, in the position where the steady deviation occurs, the target steering angle q21 is corrected in consideration of the steady deviation, and the corrected target steering angle q32 shown in Fig. 10B is set. With such a setting, even when a normal deviation occurs, the target steering angle is corrected by predicting the deviation amount of the steering angle resulting from this, so that an actual steering angle substantially coincident with the target steering angle can be obtained. Accordingly, the vehicle V1 can be moved along the parking paths x0 and x1 with high precision and parked at the parking target p3.
「D: 목표 주차 프레임 검지 센서(10)의 검출 오차」"D: detection error of target parking
목표 주차 프레임 검지 센서(10)는 빈 주차 스페이스를 검출하고, 목표 주차 위치 설정부(22)에 의해 주차 목표를 설정하고, 주차 경로 생성부(31)에 의해, 설정된 주차 목표까지의 경로를 생성한다. 주차 목표가 설정된 시점에 있어서, 주차 목표와 차량 V1의 거리가 있는 경우, 주차장의 환경(예를 들어, 비, 밤)이 나쁜 경우, 빈 주차 스페이스가 주차 차량이나 장해물(예를 들어, 주차 장소의 기둥, 벽)에 둘러싸여 있는 경우 등 주차 목표의 위치를 잘못 검출하는 경우가 있다. 그 때문에, 주차 목표를 향하여 주차하는 과정에서, 새로운 주차 목표를 검출하는 경우가 있다. 이 경우, 검출한 새로운 주차 목표에 대한 목표 주차 경로를 설정하여 리얼타임으로 제어 내용을 조정함으로써, 참된 주차 목표에 접근하여 주차시킬 수 있다.The target parking
[처리 동작의 설명][Description of processing operation]
다음에, 도 11에 도시한 흐름도를 참조하여, 본 실시 형태에 관한 주차 제어 장치(100)의 처리 수순에 대하여 설명한다. 이 처리는, 미리 설정한 연산 주기마다 실행된다.Next, with reference to the flowchart shown in FIG. 11, the processing procedure of the
처음에, 스텝 S20에 있어서, 화상 정보 처리부(20)는, 목표 주차 프레임 검지 센서(10)에서 검출된 정보에 기초하여, 주차 공간 X1을 취득한다. 구체적으로는, 도 3에 도시한 바와 같이 차량 V1이 주행 가능한 영역인 주차 공간 X1을 취득한다.First, in step S20, the image
스텝 S21에 있어서, 주차 경로 생성부(31)는, 차량을 주차하기 위한 방향 전환 위치 p2, 및 주차 목표 p3을, 주차 공간 X1로부터 일탈하지 않는 범위에서 설정한다. 또한, 주차 경로 생성부(31)는, 주차 공간 X1의 영역 내에 있어서, 초기 위치 p1에 있는 차량 V1이, 방향 전환 위치 p2를 경유하여 목표 주차 위치 p3에 도달할 때까지의 주행 경로를 설정한다. 그 결과, 도 3에 도시한 주차 경로 x0, x1이 설정된다.In step S21, the parking
스텝 S22에 있어서, 주차 경로 추종 제어부(32)는, 차량 V1이 도 3에 도시한 주차 경로 x0, x1을 따라서 주행하도록, 목표 조타각의 보정량을 산출한다. 이 보정량은, 주차 경로 x0, x1에 의해 산출할 수 있으므로, 차량 V1이 초기 위치 p1로부터 전진을 개시하기 전의 시점에서 설정할 수 있다. 그 결과, 도 8b에 도시한 수정 목표 조타각 q13, 혹은 도 10b에 도시한 수정 목표 조타각 q31이 설정된다. 예를 들어, 목표 조타각에 대한 실타각의 추종 지연이 발생하는 경우에는, 수정 목표 조타각 q13을 설정하고, 실타각의 정상 편차에 의한 어긋남이 발생하는 경우에는, 수정 목표 조타각 q31을 설정한다. 또한, 양쪽의 영향에 의한 어긋남이 발생하는 경우에는, 양쪽의 어긋남양을 보정하기 위한 수정 목표 조타각을 설정한다.In step S22, the parking path follow-up
스텝 S23에 있어서, 속도 제어부(35)로부터 차속, 및 조타각 제어부(33)로부터 조타각의 제어 명령이 출력되고, 차량 제어 ECU(40)의 제어에 의해 차량 V1의 자율적인 주차 동작을 개시한다. 따라서, 차량 V1은, 도 3에 도시한 초기 위치 p1로부터 주차 경로 x0을 따라서 전진을 개시한다.In step S23, the vehicle
스텝 S24에 있어서, 현재 위치 추정부(24)는, 목표 주차 프레임 검지 센서(10)에서 촬상한 주위의 화상으로부터, 차량 V1의 위치를 추정한다. 또한, 차량 V1의 위치의 추정에, 차륜속 센서(52) 및 타각 센서(53)에서 검출된 차속 정보 및 조타각 정보를 사용해도 된다.In step S24, the current
스텝 S25에 있어서, 주차 경로 추종 제어부(32)는, 주차 경로 x0과, 현재 위치 추정부(24)에서 추정된 자기 위치를 비교하여, 어긋남양을 산출한다. 예를 들어, 차량이 방향 전환 위치 p2에서 정지하는 경우에는, 이 방향 전환 위치 p2에서 확실하게 정지한다고는 할 수 없고, 차량 V1이 공주하여 방향 전환 위치 p2를 지난 위치까지 이동하는 경우가 있다. 주차 경로 추종 제어부(32)는 이때의 양쪽의 어긋남양을 산출한다. 구체적으로는, 도 7에 도시한 공주 거리 L1을 산출한다.In step S25, the parking path follow-up
스텝 S26에 있어서, 주차 경로 추종 제어부(32) 및 목표 속도 생성부(34)는, 보정의 필요가 있는지 여부를 판단한다. 예를 들어, 어긋남양이 미리 설정한 역치보다도 작은 경우 등에는, 어긋남양을 보정하지 않아도, 문제없다고 판단할 수 있으므로, 어긋남양이 역치보다도 큰 경우에, 보정의 필요 있음으로 판단한다. 보정의 필요가 없다고 판단된 경우에는(스텝 S26에서 "아니오"), 스텝 S29로 처리를 진행시킨다.In step S26, the parking path follow-up
보정의 필요가 있다고 판단한 경우에는(스텝 S26에서 "예"), 스텝 S27에 있어서, 주차 경로 추종 제어부(32) 및 목표 속도 생성부(34)는, 보정량을 산출한다. 이 처리에서는, 스텝 S22의 처리에서 설정한 타각의 보정량 및 스텝 S25의 처리에서 산출한 공주 거리 L1(어긋남양)을 보정량으로 한다. 또한, 타각의 보정량 및 공주 거리 L1에 의한 보정량은, 리얼타임으로 설정해도 된다.When it is determined that correction is necessary (YES in step S26), in step S27, the parking route follow-up
스텝 S28에 있어서, 조타각 제어부(33) 및 속도 제어부(35)는, 산출된 보정량에 기초하여 차량 V1의 동작을 보정한 차속 제어 신호를 생성하여 차량 제어 ECU(40)에 출력한다. 예를 들어, 도 7에 도시한 바와 같이, 공주 거리 L1만큼 어긋난 위치 p21에 차량 V1이 정지한 경우에는, 이 공주 거리 L1과 동일하며 역방향의 거리만큼 이동하도록, 차량 V1의 제어 신호를 보정한다. 따라서, 차량 V1이 위치 p21로부터 방향 전환 위치 p2로 이동한 후에, 본래의 후진 제어가 실시되게 된다. 또한, 타각의 보정량에 기초하여, 목표 조타각을 보정한다.In step S28, the steering
스텝 S29에 있어서, 차량 제어 ECU(40)에 의한 차량의 유도 제어가 실시된다. 그 결과, 차량 V1은, 주차 경로 x0, x1을 따라서 주행하게 되어, 주차 목표 p3에 확실하게 정지시킬 수 있다.In step S29, guidance control of the vehicle by the
이와 같이 하여 본 실시 형태에 관한 주차 제어 장치(100)에서는, 차량의 현재 위치와 목표 경로에 있어서의 위치의 어긋남양을 산출하고, 이 어긋남양을 저감하도록, 목표 속도와 목표 조타각을 보정하므로, 차량 V1 상의 위치를 고정밀도로 주차 목표 p3에 맞추어 주차시킬 수 있다.In this way, in the
〔주차 목표 p3의 구체예〕[Specific example of parking target p3]
본 실시 형태에 관한 주차 지원 방법은, 빈 주차 스페이스의 차폭 방향과 직교하는 방향의 제1 프레임선 W1 및 제1 프레임선 W1과 쌍이 되는 제2 프레임선 W2를 검출하고, 제1 프레임선 W1 상의 점과, 제2 프레임선 W2 상의 점을 연결한 직선 상에 주차 목표 p3을 설정한다. 이 주차 목표 p3의 위치는, 제1·제2 프레임선 W1, W2의 길이 등으로 변화된다. 다음에, 그 구체예에 대하여 설명한다.The parking assist method according to the present embodiment detects a first frame line W1 in a direction orthogonal to the vehicle width direction of an empty parking space and a second frame line W2 paired with the first frame line W1, and A parking target p3 is set on a straight line connecting the dot and the dot on the second frame line W2. The position of this parking target p3 changes depending on the lengths of the first and second frame lines W1 and W2, and the like. Next, a specific example thereof will be described.
도 12는 주차 목표 p3을 설정하는 처리(도 5: 스텝 S9)의 상세한 흐름도이다. 주차 제어 장치(100)는, 주차 제어를 개시하면, 빈 주차 스페이스의 제1 프레임선 W1과 제2 프레임선 W2를 탐색한다(스텝 S90). 제1·제2 프레임선 W1, W2를 검출할 수 없는 경우에는, 프레임선을 이용한 주차 지원 제어를 중지한다. 이 경우에는, 종래의 일반적인 주차 제어를 실행한다.Fig. 12 is a detailed flowchart of the process of setting the parking target p3 (Fig. 5: step S9). When the
빈 주차 스페이스의 제1 프레임선 W1과 제2 프레임선 W2가 검출된 경우(스텝 S90의 "예"), 제1 프레임선 W1과 제2 프레임선 W2의 단부끼리를 연결하는 직선과, 제1 프레임선 W1 또는 제2 프레임선 W2가 이루는 각도가 직각에 가까운지 여부를 판정한다(스텝 S91).When the first frame line W1 and the second frame line W2 of the vacant parking space are detected (Yes in step S90), a straight line connecting the ends of the first frame line W1 and the second frame line W2, and It is determined whether or not the angle formed by the frame line W1 or the second frame line W2 is close to a right angle (step S91).
해당 직선과, 제1 프레임선 W1 또는 제2 프레임선 W2가 이루는 각도가 직각에 가까운 경우(스텝 S91의 "예"), 다음에, 제1·제2 프레임선 W1, W2의 길이가 차량 V1(자차량)의 전체 길이보다 긴지 여부를 판정한다(스텝 S92).If the angle formed by the straight line and the first frame line W1 or the second frame line W2 is close to a right angle (YES in step S91), then the lengths of the first and second frame lines W1 and W2 are the vehicle V1 It is determined whether or not it is longer than the total length of (own vehicle) (step S92).
(프레임선의 길이>차량 길이)(length of frame line > vehicle length)
도 13은 제1·제2 프레임선 W1, W2의 길이가 차량 V1(자차량)의 전체 길이보다 긴 경우(스텝 S92의 "예")의 주차 스페이스와 차량 V1을 평면으로 본 도면이다. 이 경우, 제1 프레임선 W1의 자차량이 진입하는 방향 앞쪽의 단부와, 제2 프레임선 W2의 자차량이 진입하는 방향 앞쪽의 단부를 연결한 직선 L 상에 주차 목표 p3이 설정된다.Fig. 13 is a plan view of the parking space and the vehicle V1 when the lengths of the first and second frame lines W1 and W2 are longer than the overall length of the vehicle V1 (own vehicle) (YES in step S92). In this case, the parking target p3 is set on a straight line L connecting the front end of the first frame line W1 in the direction the host vehicle enters and the front end of the second frame line W2 in the direction the host vehicle enters.
도 13a는 후진 주차의 경우이며, 이 경우에는 자차량이 진입하는 전방측의 제1·제2 프레임선 W1, W2의 단부끼리를 연결하는 직선 L 상에 주차 목표 p3이 설정되고, 그 주차 목표 p3에, 자차량의 진행 방향과 반대측의 단부(프론트 선단부)가 일치하도록 주차 제어가 실행된다(스텝 S94).13A is a case of reverse parking, and in this case, a parking target p3 is set on a straight line L connecting the ends of the first and second frame lines W1 and W2 on the front side into which the host vehicle enters, and the parking target At p3, parking control is executed so that the end (front end) on the opposite side to the traveling direction of the host vehicle coincides (step S94).
도 13b는 전진 주차의 경우이다. 이 경우도 주차 목표 p3은, 자차량이 진입하는 전방측의 제1·제2 프레임선 W1, W2의 단부끼리를 연결하는 직선 L 상에 설정된다. 그리고 그 주차 목표 p3에, 자차량의 진행 방향과 반대측의 단부(리어 선단부)가 일치하도록 주차 제어가 실행된다(스텝 S94).13B is a case of forward parking. Also in this case, the parking target p3 is set on a straight line L connecting the ends of the first and second frame lines W1 and W2 on the front side into which the host vehicle enters. Then, parking control is executed so that the end (rear front end) on the opposite side to the traveling direction of the host vehicle coincides with the parking target p3 (step S94).
이에 의해 차량 V1은, 후진 주차와 전진 주차 중 어느 경우라도, 자차량이 진입하는 전방측의 제1 프레임선 W1과 제2 프레임선 W2의 단부끼리를 연결한 직선 L로부터, 튀어나오지 않는다. 즉, 차량 V1을 프레임선 내에 주차시킬 수 있다.As a result, the vehicle V1 does not protrude from the straight line L connecting the ends of the first frame line W1 and the second frame line W2 on the front side into which the host vehicle enters, in either case of reverse parking or forward parking. That is, the vehicle V1 can be parked within the frame line.
(프레임선의 길이<휠베이스_(1))(length of frame line<wheelbase_(1))
제1·제2 프레임선 W1, W2의 길이가 차량 V1(자차량)의 전체 길이보다 짧은 경우(스텝 S92의 "아니오")에는, 다음에, 제1·제2 프레임선 W1, W2의 길이가 차량 V1의 휠베이스보다 긴지 여부를 판정한다(스텝 S95).If the lengths of the first and second frame lines W1 and W2 are shorter than the total length of the vehicle V1 (own vehicle) (NO in step S92), then the lengths of the first and second frame lines W1 and W2 It is determined whether or not is longer than the wheelbase of the vehicle V1 (step S95).
제1·제2 프레임선 W1, W2의 길이가 차량 V1의 휠베이스보다 짧은 경우(스텝 S95의 "예"), 다음에, 제1·제2 프레임선 W1, W2의 길이가 소정의 길이 이상인지 여부를 판정한다(스텝 S96).If the lengths of the first and second frame lines W1 and W2 are shorter than the wheelbase of the vehicle V1 (Yes in step S95), then the lengths of the first and second frame lines W1 and W2 are equal to or greater than the predetermined length. Whether or not it is recognized is determined (step S96).
소정의 길이란, 예를 들어 50㎝ 정도의 길이이다. 제1·제2 프레임선 W1, W2의 길이가, 예를 들어 50㎝ 이상이며 또한 휠베이스보다도 짧은 경우(스텝 S96의 "예")의 프레임선은, 주차 스페이스의 차량 V1의 폭 방향만을 표기하고, 주차 스페이스의 깊이 방향의 중앙 부분에 표시되는 경우가 많다.The predetermined length is, for example, a length of about 50 cm. When the lengths of the first and second frame lines W1 and W2 are, for example, 50 cm or more and shorter than the wheel base (Yes in step S96), the frame lines indicate only the width direction of the vehicle V1 in the parking space. and is often displayed at the central part in the depth direction of the parking space.
도 14는 제1·제2 프레임선 W1, W2의 길이가 차량 V1(자차량)의 휠베이스보다 짧은 경우(스텝 S95의 "예")의 주차 스페이스와 차량 V1을 평면으로 본 도면이다. 이 경우, 제1 프레임선 W1의 중심과, 제2 프레임선의 중심을 연결한 직선 L 상에 주차 목표 p3을 설정한다(스텝 S97).Fig. 14 is a plan view of the parking space and the vehicle V1 when the lengths of the first and second frame lines W1 and W2 are shorter than the wheelbase of the vehicle V1 (own vehicle) (YES in step S95). In this case, the parking target p3 is set on the straight line L connecting the center of the first frame line W1 and the center of the second frame line (step S97).
도 14a는, 후진 주차의 경우이며, 이 경우에는 제1 프레임선 W1과 제2 프레임선 W2의 각각의 중심을 연결하는 직선 L 상에 주차 목표 p3이 설정된다. 그리고, 그 주차 목표 p3과, 자차량의 중심의 위치가 일치하도록 주차 제어가 실행된다(스텝 S98). 이 경우, 자차량의 진입하는 방향 앞쪽에 차량 V1의 프론트가 위치한다.14A shows a case of reverse parking, and in this case, a parking target p3 is set on a straight line L connecting the respective centers of the first frame line W1 and the second frame line W2. Then, parking control is executed so that the parking target p3 and the position of the center of the host vehicle coincide (step S98). In this case, the front of the vehicle V1 is located in front of the direction in which the host vehicle enters.
도 14b는 전진 주차의 경우이다. 이 경우도 주차 목표 p3은, 제1 프레임선 W1과 제2 프레임선 W2의 각각의 중심을 연결하는 직선 L 상에 설정된다. 그리고, 그 주차 목표 p3의 위치와, 자차량의 중심의 위치가 일치하도록 주차 제어가 실행된다(스텝 S98). 이 경우, 자차량의 진입하는 방향 앞쪽에 차량 V1의 리어가 위치한다.14b is a case of forward parking. Also in this case, the parking target p3 is set on a straight line L connecting the centers of the first frame line W1 and the second frame line W2. Then, parking control is executed so that the position of the parking target p3 coincides with the position of the center of the host vehicle (step S98). In this case, the rear of the vehicle V1 is located in front of the direction in which the host vehicle enters.
이에 의해, 차량 V1의 제1 프레임선 W1과 제2 프레임선 W2로부터 비어져 나오는 길이는, 프론트측과 리어측에서 동일한 길이가 된다. 따라서 차량 V1을, 제1·제2 프레임선 W1, W2에 대하여 밸런스가 좋은 위치에 주차시킬 수 있다.Accordingly, the lengths protruding from the first frame line W1 and the second frame line W2 of the vehicle V1 are the same on the front and rear sides. Accordingly, the vehicle V1 can be parked at a well-balanced position with respect to the first and second frame lines W1 and W2.
(프레임선의 길이<휠베이스_(2))(length of frame line<wheelbase_(2))
제1·제2 프레임선 W1, W2의 길이가 차량 V1(자차량)의 전체 길이보다 짧은 경우(스텝 S92의 "아니오")에는, 다음에 제1·제2 프레임선 W1, W2의 길이가 차량 V1의 휠베이스보다 긴지 여부를 판정한다(스텝 S95).If the lengths of the first and second frame lines W1 and W2 are shorter than the total length of the vehicle V1 (own vehicle) (NO in step S92), then the lengths of the first and second frame lines W1 and W2 are It is determined whether or not it is longer than the wheelbase of vehicle V1 (step S95).
제1·제2 프레임선 W1, W2의 길이가 차량 V1의 휠베이스보다 짧은 경우(스텝 S95의 "예"), 다음에, 제1·제2 프레임선 W1, W2의 길이가 소정의 길이 이상인지 여부를 판정한다(스텝 S96).If the lengths of the first and second frame lines W1 and W2 are shorter than the wheelbase of the vehicle V1 (Yes in step S95), then the lengths of the first and second frame lines W1 and W2 are equal to or greater than the predetermined length. Whether or not it is recognized is determined (step S96).
소정의 길이란, 예를 들어 50㎝ 정도의 길이이다. 제1·제2 프레임선 W1, W2의 길이가, 예를 들어 50㎝ 이상이며 또한 휠베이스보다도 짧은 경우(스텝 S96의 "예")의 프레임선은, 주차 스페이스의 차량 V1의 폭 방향만을 표기하는 경우가 있다.The predetermined length is, for example, a length of about 50 cm. When the lengths of the first and second frame lines W1 and W2 are, for example, 50 cm or more and shorter than the wheel base (Yes in step S96), the frame lines indicate only the width direction of the vehicle V1 in the parking space. There are times when
이 경우, 제1 프레임선 W1의 단부와, 제2 프레임선의 단부를 연결한 직선 L 상에 주차 목표 p3을 설정한다(스텝 S97).In this case, the parking target p3 is set on the straight line L connecting the end of the first frame line W1 and the end of the second frame line (step S97).
그리고, 제1·제2 프레임선 W1, W2의 길이가 차량 V1의 휠베이스보다 짧은 경우에 있어서, 자차량의 차륜의 위치를 제1 프레임선 W1의 단부와, 제2 프레임선의 단부를 연결한 직선 L 상에 설정한 주차 목표 p3에 맞추도록 주차 제어를 실행한다.And, when the lengths of the first and second frame lines W1 and W2 are shorter than the wheelbase of the vehicle V1, the position of the wheel of the host vehicle is connected to the end of the first frame line W1 and the end of the second frame line. Parking control is executed so as to match the parking target p3 set on the straight line L.
이에 의해, 차량 V1의 제1 프레임선 W1과 제2 프레임선 W2로부터의 비어져 나옴을, 프론트측과 리어측으로 나눌 수 있기 때문에, 프론트측과 리어측 중 어느 쪽에서 크게 비어져 나오는 것을 억제할 수 있다.As a result, since the protrusion from the first frame line W1 and the second frame line W2 of the vehicle V1 can be divided into the front side and the rear side, large protrusion on either the front side or the rear side can be suppressed. have.
또한, 제1·제2 프레임선 W1, W2의 길이가 차량 V1의 휠베이스보다 짧은 경우에 있어서, 빈 주차 스페이스에 대한 자차량의 주차 방향을 판정하고, 자차량의 주차 방향이 후진 주차인 경우에는, 자차량의 후륜의 위치를 주차 목표 p3에 맞추도록 주차 제어를 실행한다. 이 경우, 자차량의 진입하는 방향 앞쪽에 차량 V1의 프론트가 위치한다.Further, in the case where the lengths of the first and second frame lines W1 and W2 are shorter than the wheelbase of the vehicle V1, the parking direction of the host vehicle with respect to the vacant parking space is determined, and the parking direction of the host vehicle is reverse parking. , parking control is executed so as to align the position of the rear wheels of the host vehicle with the parking target p3. In this case, the front of the vehicle V1 is located in front of the direction in which the host vehicle enters.
이에 의해, 제1·제2 프레임선 W1, W2의 길이가 차량 V1의 휠베이스보다 짧은 경우에 있어서, 자차량의 후륜의 위치가 주차 목표 p3에 맞도록 제어하기 때문에, 차량 V1의 제1 프레임선 W1과 제2 프레임선 W2로부터의 비어져 나옴을, 프론트측과 리어측으로 나눌 수 있으므로, 프론트측과 리어측 중 어느 쪽에서 크게 비어져 나오는 것을 억제할 수 있다.Accordingly, when the lengths of the first and second frame lines W1 and W2 are shorter than the wheelbase of the vehicle V1, since the position of the rear wheels of the host vehicle is controlled to match the parking target p3, the first frame of the vehicle V1 Since the protrusion from the line W1 and the second frame line W2 can be divided into the front side and the rear side, large protrusion from either the front side or the rear side can be suppressed.
게다가, 제1·제2 프레임선 W1, W2의 길이가 차량 V1의 휠베이스보다 짧은 경우에 있어서, 빈 주차 스페이스에 대한 자차량의 주차 방향을 판정하고, 자차량의 주차 방향이 후진 주차인 경우에는, 자차량의 후륜의 위치를 주차 목표 p3에 맞추도록 주차 제어를 실행할 수 있기 때문에, 후진 주차에 있어서, 차량 V1을, 제1·제2 프레임선 W1, W2에 대하여 밸런스가 좋은 위치에 주차시킬 수 있다.In addition, in the case where the lengths of the first and second frame lines W1 and W2 are shorter than the wheelbase of the vehicle V1, the parking direction of the host vehicle with respect to the vacant parking space is determined, and the parking direction of the host vehicle is reverse parking. , since parking control can be executed so as to match the position of the rear wheels of the host vehicle to the parking target p3, in reverse parking, the vehicle V1 is parked at a well-balanced position with respect to the first and second frame lines W1 and W2. can make it
또한, 제1·제2 프레임선 W1, W2의 길이가 차량 V1의 휠베이스보다 짧은 경우에 있어서, 빈 주차 스페이스에 대한 자차량의 주차 방향을 판정하고, 자차량의 주차 방향이 전진 주차인 경우도, 자차량의 전륜의 위치를 주차 목표 p3에 맞추도록 주차 제어를 실행한다. 이 경우, 자차량의 진입하는 방향 앞쪽에 차량 V1의 리어가 위치한다.Further, in the case where the lengths of the first and second frame lines W1 and W2 are shorter than the wheelbase of the vehicle V1, the parking direction of the host vehicle with respect to the vacant parking space is determined, and the parking direction of the host vehicle is forward parking. Also, parking control is executed so that the position of the front wheels of the host vehicle is aligned with the parking target p3. In this case, the rear of the vehicle V1 is located in front of the direction in which the host vehicle enters.
이에 의해, 제1·제2 프레임선 W1, W2의 길이가 차량 V1의 휠베이스보다 짧은 경우에 있어서, 자차량의 전륜의 위치가 주차 목표 p3에 맞도록 제어하기 때문에, 차량 V1의 제1 프레임선 W1과 제2 프레임선 W2로부터의 비어져 나옴을, 프론트측과 리어측으로 나눌 수 있으므로, 프론트측과 리어측 중 어느 쪽으로부터 크게 비어져 나오는 것을 억제할 수 있다.Accordingly, when the lengths of the first and second frame lines W1 and W2 are shorter than the wheelbase of the vehicle V1, since the position of the front wheels of the host vehicle is controlled to match the parking target p3, the first frame of the vehicle V1 Since the protrusion from the line W1 and the second frame line W2 can be divided into the front side and the rear side, large protrusion from either the front side or the rear side can be suppressed.
또한, 제1·제2 프레임선 W1, W2의 길이가 차량 V1의 휠베이스보다 짧은 경우에 있어서, 빈 주차 스페이스에 대한 자차량의 주차 방향을 판정하고, 자차량의 주차 방향이 전진 주차인 경우에는, 자차량의 전륜의 위치를 주차 목표 p3에 맞추도록 주차 제어를 실행할 수 있기 때문에, 전진 주차에 있어서, 차량 V1을, 제1·제2 프레임선 W1, W2에 대하여 밸런스가 좋은 위치에 주차시킬 수 있다.Further, in the case where the lengths of the first and second frame lines W1 and W2 are shorter than the wheelbase of the vehicle V1, the parking direction of the host vehicle with respect to the vacant parking space is determined, and the parking direction of the host vehicle is forward parking. , since parking control can be executed so as to match the position of the front wheels of the host vehicle to the parking target p3, in forward parking, the vehicle V1 is parked at a well-balanced position with respect to the first and second frame lines W1 and W2. can make it
(휠베이스<프레임선의 길이<차량 길이)(Wheelbase<Length of frame line<Vehicle length)
도 15는 제1·제2 프레임선 W1, W2의 길이가 차량 V1(자차량)의 휠베이스보다도 길고 또한 차량 V1의 전체 길이보다도 짧은 경우(스텝 S95의 "아니오")의 주차 스페이스와 차량 V1을 평면으로 본 도면이다. 이 경우, 제1 프레임선 W1의 자차량이 진입하는 방향 안쪽의 단부와, 제2 프레임선의 자차량이 진입하는 방향 안쪽의 단부를 연결한 직선 L 상에 주차 목표 p3이 설정된다(스텝 S99).Fig. 15 shows the parking space and vehicle V1 when the lengths of the first and second frame lines W1 and W2 are longer than the wheelbase of the vehicle V1 (own vehicle) and shorter than the overall length of the vehicle V1 (NO in step S95). is a planar view. In this case, a parking target p3 is set on a straight line L connecting the end of the first frame line W1 in the direction in which the host vehicle enters and the end of the second frame line in the direction in which the host vehicle enters (step S99). .
도 15a는, 후진 주차의 경우이며, 이 경우에는 자차량이 진입하는 방향 안쪽의 단부끼리를 연결하는 직선 L 상에 주차 목표 p3이 설정되고, 그 주차 목표 p3에, 자차량의 진행 방향의 차륜의 위치가 일치하도록 주차 제어가 실행된다(스텝 S100의 전단). 이 경우, 자차량의 진입하는 방향 안쪽의 후륜의 위치와, 주차 목표 p3이 일치하도록 주차 제어가 실행된다(스텝 S100).15A is a case of reverse parking. In this case, a parking target p3 is set on a straight line L connecting the ends in the direction in which the host vehicle enters, and a wheel in the direction of travel of the host vehicle is set to the parking target p3. Parking control is executed so that the positions of are coincident (previous stage of step S100). In this case, parking control is executed so that the position of the rear wheels on the inside of the direction in which the host vehicle is entering coincides with the parking target p3 (step S100).
도 15b는 전진 주차의 경우이다. 이 경우도 주차 목표 p3은, 자차량이 진입하는 방향 안쪽의 단부끼리를 연결하는 직선 L 상에 설정된다. 그리고, 그 주차 목표 p3과, 자차량의 진입하는 방향 안쪽의 전륜의 위치와, 주차 목표 p3이 일치하도록 주차 제어가 실행된다(스텝 S100의 전단).15B is a case of forward parking. Also in this case, the parking target p3 is set on a straight line L connecting the ends in the direction in which the host vehicle enters. Then, parking control is executed so that the parking target p3 coincides with the position of the front wheels in the direction in which the host vehicle enters, and the parking target p3 (previous stage of step S100).
이에 의해 차량 V1은, 제1 프레임선 W1과 제2 프레임선 W2의 자차량이 진입하는 방향 안쪽의 단부에 타이어의 단부를 맞추어 주차된다. 따라서, 프레임선의 후방측에 단차나 홈이 있었던 경우라도, 차량 V1을 그 전방에 주차시킬 수 있다.Accordingly, the vehicle V1 is parked with the ends of the tires aligned with the inner ends of the first frame line W1 and the second frame line W2 in the direction in which the host vehicle enters. Accordingly, even when there is a step or groove on the rear side of the frame line, the vehicle V1 can be parked in front of it.
또한, 차량 V1의 주차 스페이스로부터 비어져 나오는 양(길이)을 적절하게 설정할 수 있다. 따라서, 차량 V1을, 주차 스페이스의 적절한 위치에 주차시킬 수 있다.In addition, the amount (length) protruding from the parking space of the vehicle V1 can be appropriately set. Therefore, the vehicle V1 can be parked at an appropriate location in the parking space.
(프레임선의 길이<차량 길이)(Length of frame line < vehicle length)
제1·제2 프레임선 W1, W2의 길이가 차량 V1(자차량)의 전체 길이보다 짧은지 여부를 판정한다.It is determined whether or not the lengths of the first and second frame lines W1 and W2 are shorter than the overall length of the vehicle V1 (own vehicle).
제1·제2 프레임선 W1, W2의 길이가 차량 V1의 전체 길이보다 짧은 경우, 제1 프레임선 W1의 단부와, 제2 프레임선의 단부를 연결한 직선 L 상에 주차 목표 p3을 설정한다(스텝 S97).When the lengths of the first and second frame lines W1 and W2 are shorter than the overall length of the vehicle V1, the parking target p3 is set on a straight line L connecting the end of the first frame line W1 and the end of the second frame line ( Step S97).
제1·제2 프레임선 W1, W2의 길이가 차량 V1의 전체 길이보다도 짧은 경우에, 자차량의 차륜의 위치를 제1 프레임선 W1의 단부와, 제2 프레임선의 단부를 연결한 직선 L 상에 설정한 주차 목표 p3에 맞추도록 주차 제어를 실행한다.When the lengths of the first and second frame lines W1 and W2 are shorter than the overall length of the vehicle V1, the position of the wheel of the host vehicle is located on a straight line L connecting the end of the first frame line W1 and the end of the second frame line. Parking control is executed so as to match the parking target p3 set in .
이에 의해, 프론트 혹은 리어측의 비어져 나옴에 의해, 프론트측과 리어측 중 어느 쪽에서 크게 비어져 나오는 것을 억제할 수 있다.Thereby, it is possible to suppress large protrusion on either the front side or the rear side due to protrusion on the front or rear side.
또한, 제1·제2 프레임선 W1, W2의 길이가 차량 V1의 전체 길이보다도 짧은 경우에, 빈 주차 스페이스에 대한 자차량의 주차 방향을 판정하고, 자차량의 주차 방향이 후진 주차인 경우에는, 자차량의 후륜의 위치를 주차 목표 p3에 맞추도록 주차 제어를 실행한다. 이 경우, 자차량의 진입하는 방향 앞쪽에 차량 V1의 프론트가 위치한다.Further, when the lengths of the first and second frame lines W1 and W2 are shorter than the overall length of the vehicle V1, the parking direction of the host vehicle is determined with respect to the vacant parking space, and when the parking direction of the host vehicle is reverse parking, , parking control is executed so that the position of the rear wheels of the host vehicle is aligned with the parking target p3. In this case, the front of the vehicle V1 is located in front of the direction in which the host vehicle enters.
이에 의해, 제1·제2 프레임선 W1, W2의 길이가 차량 V1의 전체 길이보다도 짧은 경우에, 자차량의 후륜의 위치가 주차 목표 p3에 맞도록 제어하기 때문에, 차량 V1의 제1 프레임선 W1과 제2 프레임선 W2로부터의 비어져 나옴을, 프론트측과 리어측으로 나눌 수 있기 때문에, 프론트측과 리어측 중 어느 쪽에서 크게 비어져 나오는 것을 억제할 수 있다.Accordingly, when the lengths of the first and second frame lines W1 and W2 are shorter than the overall length of the vehicle V1, the position of the rear wheels of the host vehicle is controlled to match the parking target p3, so that the first frame line of the vehicle V1 Since the protrusion from W1 and the second frame line W2 can be divided into the front side and the rear side, large protrusion from either the front side or the rear side can be suppressed.
게다가, 제1·제2 프레임선 W1, W2의 길이가 차량 V1의 전체 길이보다도 짧은 경우에, 빈 주차 스페이스에 대한 자차량의 주차 방향을 판정하고, 자차량의 주차 방향이 후진 주차인 경우에는, 자차량의 후륜의 위치를 주차 목표 p3에 맞추도록 주차 제어를 실행할 수 있기 때문에, 후진 주차에 있어서, 차량 V1을, 제1·제2 프레임선 W1, W2에 대하여 밸런스가 좋은 위치에 주차시킬 수 있다.In addition, when the lengths of the first and second frame lines W1 and W2 are shorter than the total length of the vehicle V1, the parking direction of the host vehicle with respect to the vacant parking space is determined, and when the parking direction of the host vehicle is reverse parking, , Since parking control can be executed to match the position of the rear wheels of the host vehicle to the parking target p3, in reverse parking, the vehicle V1 can be parked at a well-balanced position with respect to the first and second frame lines W1 and W2. can
또한, 제1·제2 프레임선 W1, W2의 길이가 차량 V1의 전체 길이보다도 짧은 경우에, 빈 주차 스페이스에 대한 자차량의 주차 방향을 판정하고, 자차량의 주차 방향이 전진 주차인 경우도, 자차량의 전륜의 위치를 주차 목표 p3에 맞추도록 주차 제어를 실행한다. 이 경우, 자차량이 진입하는 방향 앞쪽에 차량 V1의 리어가 위치한다.In addition, when the lengths of the first and second frame lines W1 and W2 are shorter than the total length of the vehicle V1, the parking direction of the host vehicle with respect to the vacant parking space is determined, and the parking direction of the host vehicle is also forward parking. , parking control is executed so that the position of the front wheels of the host vehicle is aligned with the parking target p3. In this case, the rear of the vehicle V1 is located in front of the direction in which the host vehicle enters.
이에 의해, 제1·제2 프레임선 W1, W2의 길이가 차량 V1의 전체 길이보다도 짧은 경우에, 자차량의 전륜의 위치가 주차 목표 p3에 맞도록 제어하기 때문에, 차량 V1의 제1 프레임선 W1과 제2 프레임선 W2로부터의 비어져 나옴을, 프론트측과 리어측으로 나눌 수 있으므로, 프론트측과 리어측 중 어느 쪽에서 크게 비어져 나오는 것을 억제할 수 있다.Accordingly, when the lengths of the first and second frame lines W1 and W2 are shorter than the overall length of the vehicle V1, the position of the front wheels of the host vehicle is controlled so as to match the parking target p3, so that the first frame line of the vehicle V1 Since the protrusion from W1 and the second frame line W2 can be divided into the front side and the rear side, large protrusion on either the front side or the rear side can be suppressed.
또한, 제1·제2 프레임선 W1, W2의 길이가 차량 V1의 전체 길이보다도 짧은 경우에, 빈 주차 스페이스에 대한 자차량의 주차 방향을 판정하고, 자차량의 주차 방향이 전진 주차인 경우에는, 자차량의 전륜의 위치를 주차 목표 p3에 맞추도록 주차 제어를 실행할 수 있기 때문에, 전진 주차에 있어서, 차량 V1을, 제1·제2 프레임선 W1, W2에 대하여 밸런스가 좋은 위치에 주차시킬 수 있다.Further, when the lengths of the first and second frame lines W1 and W2 are shorter than the overall length of the vehicle V1, the parking direction of the host vehicle with respect to the vacant parking space is determined, and when the parking direction of the host vehicle is forward parking, , Since parking control can be executed so as to match the position of the front wheels of the host vehicle to the parking target p3, in forward parking, the vehicle V1 can be parked at a well-balanced position with respect to the first and second frame lines W1 and W2. can
(프레임선의 단부만)(Only the end of the frame line)
주차 스페이스를 명시하는 프레임선은, 시간 경과에 수반하여 흐려지고 최후에는 소실된다. 그 과정에 있어서, 프레임선의 단부만이 남은 경우가 있다. 다음에, 그 경우의 주차 목표 p3에 대하여 설명한다.The frame lines specifying the parking spaces become blurred over time and eventually disappear. In the process, there are cases where only the ends of the frame lines remain. Next, the parking target p3 in that case will be described.
이 경우에는, 프레임선<휠베이스(스텝 S95의 "예")이며, 또한 프레임선이 소정의 길이 이하(스텝 S96의 "아니오")에 대응한다.In this case, the frame line < the wheel base (YES in step S95), and the frame line corresponds to a predetermined length or less (NO in step S96).
도 16은 제1·제2 프레임선 W1, W2의 차량 V1이 진입하는 방향 안쪽의 단부만이 남는 주차 스페이스와 차량 V1을 평면으로 본 도면이다. 이 경우, 제1 프레임선 W1의 자차량이 진입하는 방향 안쪽의 단부와, 제2 프레임선의 자차량이 진입하는 방향 안쪽의 단부를 연결한 직선 L 상에 주차 목표 p3이 설정된다(스텝 S99).Fig. 16 is a plane view of the parking space and the vehicle V1 where only the ends of the first and second frame lines W1 and W2 in the direction in which the vehicle V1 enters are left. In this case, a parking target p3 is set on a straight line L connecting the end of the first frame line W1 in the direction in which the host vehicle enters and the end of the second frame line in the direction in which the host vehicle enters (step S99). .
즉, 제1 프레임선 W1의 자차량이 진입하는 방향 안쪽의 단부와 쌍을 이루는 제2 프레임선 W2의 자차량이 진입하는 방향 안쪽의 단부를 검출할 수 있는 경우에, 제1 프레임선의 단부와 제2 프레임선의 단부를 연결한 직선 L 상에 주차 목표 p3을 설정하고, 자차량의 빈 주차 스페이스로 진입하는 방향 안쪽의 차륜의 위치를 주차 목표 p3에 맞추도록 주차 제어를 실행한다(스텝 S100의 전단). 또한, 이에 의해, 리어측의 비어져 나옴에 의해, 프론트측과 리어측 중 어느 쪽에서 크게 비어져 나오는 것을 억제할 수 있다.That is, when it is possible to detect the end of the first frame line W1 in the direction in which the host vehicle enters and the end of the second frame line W2 paired with the end in the direction in which the host vehicle enters, the end of the first frame line A parking target p3 is set on the straight line L connecting the ends of the second frame line, and parking control is executed so that the position of the wheel in the direction of entering the empty parking space of the host vehicle is aligned with the parking target p3 (step S100). shear). In addition, by this, it is possible to suppress large protrusion on either the front side or the rear side due to the protrusion on the rear side.
도 16a는 전진 주차의 경우, 도 16b는 후진 주차의 경우이다. 도 16a, 도 16b의 각각은, 도 15a, 도 15b에 대응한다. 도 16의 상세한 설명은 생략한다.16A is for forward parking, and FIG. 16B is for reverse parking. 16A and 16B correspond to FIGS. 15A and 15B. A detailed description of FIG. 16 is omitted.
도 17은 제1·제2 프레임선 W1, W2의 차량 V1이 진입하는 방향 앞쪽의 단부만이 남는 주차 스페이스와 차량 V1을 평면으로 본 도면이다. 이 경우, 제1 프레임선 W1의 자차량이 진입하는 방향 안쪽의 단부와, 제2 프레임선의 자차량이 진입하는 방향 안쪽의 단부를 연결한 직선 L 상에 주차 목표 p3이 설정된다(스텝 S99).Fig. 17 is a plan view of the parking space and the vehicle V1 where only the front ends of the first and second frame lines W1 and W2 in the direction in which the vehicle V1 enters are left. In this case, a parking target p3 is set on a straight line L connecting the end of the first frame line W1 in the direction in which the host vehicle enters and the end of the second frame line in the direction in which the host vehicle enters (step S99). .
이 경우에는, 제1 프레임선 W1의 자차량이 진입하는 방향 앞쪽의 단부와 쌍을 이루는 제2 프레임선 W2의 자차량이 진입하는 방향 앞쪽의 단부를 검출할 수 있는 경우에, 제1 프레임선의 단부와 제2 프레임선의 단부를 연결한 직선 L 상에 주차 목표 p3을 설정하고, 자차량의 빈 주차 스페이스로 진입하는 방향 앞쪽의 단부의 위치를 주차 목표 p3에 맞추도록 주차 제어를 실행한다(스텝 S100의 후단). 또한, 이에 의해, 프론트측의 비어져 나옴에 의해, 프론트측과 리어측 중 어느 쪽에서 크게 비어져 나오는 것을 억제할 수 있다.In this case, when the front end of the first frame line W1 in the direction in which the host vehicle enters and the end of the second frame line W2 paired with the front end in the direction in which the host vehicle enters can be detected, the first frame line A parking target p3 is set on the straight line L connecting the end and the end of the second frame line, and parking control is executed so that the position of the end in front of the direction entering the empty parking space of the host vehicle is aligned with the parking target p3 (step the rear end of the S100). In addition, by this, it is possible to suppress large protrusion on either the front side or the rear side due to the protrusion on the front side.
(제1 프레임선 W1과 제2 프레임선 W2의 길이가 상이함)(The first frame line W1 and the second frame line W2 have different lengths)
주차 스페이스를 명시하는 제1 프레임선 W1과 제2 프레임선 W2는, 동일한 형상으로 표기된다고는 할 수 없다. 예를 들어, 주로 R1이 비스듬하게 기운 경우나 주차 스페이스가 이형인 경우에는, 제1 프레임선 W1과 제2 프레임선 W2의 길이가 상이한 경우가 있다. 또한, 한쪽 프레임선의 단부가 시간 경과로 보다 많이 소실 된 경우도 제1 프레임선 W1과 제2 프레임선 W2의 길이는 상이하게 된다. 또한, 센서에 의해 프레임선의 일부를 검출할 수 없는 경우가 있다.It cannot be said that the first frame line W1 and the second frame line W2 specifying the parking space are marked with the same shape. For example, in the case where R1 is mainly slanted or the parking space is heterogeneous, the lengths of the first frame line W1 and the second frame line W2 may differ. In addition, even when the end of one frame line is lost more than the length of time, the lengths of the first frame line W1 and the second frame line W2 are different. In addition, there are cases where a part of the frame line cannot be detected by the sensor.
도 18은 제1 프레임선 W1과 제2 프레임선 W2의 길이가 상이한 경우의 주차 스페이스와 차량 V1을 평면으로 본 도면이다. 이 예는, 제1 프레임선 W1의 차량 V1의 진입하는 방향 앞쪽의 단부가, 해당 단부와 쌍이 되는 제2 프레임선 W2의 단부보다도 많이 소실되어, 제1 프레임선 W1의 길이가 제2 프레임선 W2보다도 짧아진 경우를 나타낸다.Fig. 18 is a plan view of the parking space and the vehicle V1 when the lengths of the first frame line W1 and the second frame line W2 are different. In this example, the front end of the first frame line W1 in the approaching direction of the vehicle V1 is lost more than the end of the second frame line W2 paired with the end, so that the length of the first frame line W1 is reduced to the second frame line. The case where it is shorter than W2 is shown.
도 18에 도시한 예에서는, 제1 프레임선 W1의 단부와 쌍을 이루는 제2 프레임선 W2의 단부를 연결한 직선 L과, 제1 프레임선 W1 또는 제2 프레임선 W2와 이루는 각도가, 직각이 아니다(스텝 S91의 "아니오"). 또한, 차량 V1의 진입하는 방향 안쪽의 제1 프레임선 W1과 제2 프레임선 W2의 단부끼리를 연결한 직선 L과, 제1 프레임선 W1 또는 제2 프레임선 W2와 이루는 각도가 직각이거나, 또는 직각에 가깝다.In the example shown in FIG. 18 , the angle formed by the straight line L connecting the end of the first frame line W1 and the end of the paired second frame line W2 and the first frame line W1 or the second frame line W2 is a right angle. ("No" at step S91). Further, an angle between a straight line L connecting the ends of the first frame line W1 and the second frame line W2 on the inside in the direction in which the vehicle V1 enters and the first frame line W1 or the second frame line W2 is a right angle, or close to right angles
이 경우, 차량 V1은, 진입하는 방향 안쪽의 직선 L 상에 주차 목표 p3이 설정된다. 즉, 제1 프레임선 W1의 단부와 쌍을 이루는 제2 프레임선 W2의 단부를 연결한 직선 L과, 제1 프레임선 W1 또는 제2 프레임선 W2와 이루는 각도가, 직각에 가까운 직선 L 상에 주차 목표 p3이 설정된다(스텝 S101).In this case, the parking target p3 is set on the straight line L in the direction in which the vehicle V1 enters. That is, on a straight line L close to a right angle, an angle between a straight line L connecting the end of the first frame line W1 and the end of the paired second frame line W2 and the first frame line W1 or the second frame line W2 is A parking target p3 is set (step S101).
그리고 해당 주차 목표 p3에, 자차량의 빈 주차 스페이스로 진입하는 방향 안쪽의 차륜의 위치를 맞추도록 주차 제어를 실행한다(스텝 S102의 전단). 후진 주차의 경우에는, 차량 V1의 후륜의 단부(리어측)를, 주차 목표 p3에 맞추어 주차된다. 또한, 전진 주차의 경우에는, 차량 V1의 전륜의 단부(프론트측)를 주차 목표 p3에 맞추어 주차된다.Then, parking control is executed so as to align the positions of the wheels on the inside in the direction of entering the vacant parking space of the host vehicle with the parking target p3 (previous stage of step S102). In the case of reverse parking, the end (rear side) of the rear wheel of the vehicle V1 is parked in alignment with the parking target p3. In the case of forward parking, the front wheel end (front side) of the vehicle V1 is aligned with the parking target p3 and parked.
이에 의해, 차량 V1은, 직각에 가까운 직선 상에 주차 목표 p3을 설정하기 때문에, 차량 V1을 빈 주차 스페이스 내에 보다 많이 주차시킬 수 있으므로, 프론트측 혹은 리어측의 비어져 나옴양을 억제할 수 있다.As a result, since the vehicle V1 sets the parking target p3 on a straight line close to a right angle, the vehicle V1 can be parked more in the vacant parking space, so that the amount of protrusion on the front or rear side can be suppressed. .
또한, 제1 프레임선 W1과 제2 프레임선 W2의 자차량이 진입하는 방향 안쪽의 단부에, 자차량의 빈 주차 스페이스로 진입하는 방향 안쪽의 차륜의 위치를 맞추어 주차된다. 이 효과는, 상기 「휠베이스<프레임선의 길이<차량 길이(도 15)」의 경우와 동일하다.In addition, the wheels are aligned with the inner end of the first frame line W1 and the second frame line W2 in the direction in which the host vehicle enters the parking space, and the vehicle is parked. This effect is the same as in the case of "wheel base < frame line length < vehicle length (FIG. 15)".
또한, 차량 V1의 진입하는 방향 앞쪽의 제1 프레임선 W1과 제2 프레임선 W2의 단부끼리를 연결한 직선 L과, 제1 프레임선 W1 또는 제2 프레임선 W2와 이루는 각도가 직각이거나, 또는 직각에 가까운 경우(도시하지 않음), 주차 목표 p3은, 차량 V1의 진입하는 방향 앞쪽의 직선 L 상에 설정된다(스텝 S101).In addition, the angle formed by the straight line L connecting the ends of the first frame line W1 and the second frame line W2 on the front side in the direction of entry of the vehicle V1 and the first frame line W1 or the second frame line W2 is a right angle, or When it is close to a right angle (not shown), the parking target p3 is set on the straight line L ahead of the entering direction of the vehicle V1 (step S101).
그리고 해당 주차 목표 p3에, 자차량의 빈 주차 스페이스로 진입하는 방향 앞쪽의 단부의 위치를 맞추도록 주차 제어를 실행한다(스텝 S102의 후단). 후진 주차의 경우에는, 차량 V1의 리어측의 단부를, 주차 목표 p3에 맞추어 주차된다. 또한, 전진 주차의 경우에는, 차량 V1의 프론트측의 단부를, 주차 목표 p3에 맞추어 주차된다. 이에 의해 차량 V1은, 제1 프레임선 W1과 제2 프레임선 W2의 자차량이 진입하는 방향 앞쪽의 단부에, 차량의 단부를 맞추어 주차된다.Then, parking control is executed so as to align the position of the front end in the direction of entering the vacant parking space of the host vehicle with the parking target p3 (the rear end of step S102). In the case of reverse parking, the rear end of the vehicle V1 is parked in alignment with the parking target p3. In addition, in the case of forward parking, the vehicle V1 is parked in alignment with the front end of the vehicle V1 to the parking target p3. As a result, the vehicle V1 is parked with its end aligned with the front end of the first frame line W1 and the second frame line W2 in the direction in which the host vehicle enters.
이에 의해, 차량 V1은, 제1 프레임선 W1과 제2 프레임선 W2의 자차량이 진입하는 방향 앞쪽의 단부에, 자차량의 빈 주차 스페이스로 진입하는 방향 앞쪽의 단부의 위치를 맞추어 주차된다. 이 효과는, 상기 「프레임선의 길이>차량 길이(도 13)」의 경우와 동일하다.As a result, the vehicle V1 is parked by aligning the front ends of the first frame line W1 and the second frame line W2 in the direction in which the host vehicle enters with the front ends in the direction in which the vehicle enters the vacant parking space of the host vehicle. This effect is the same as that of the case of "the length of the frame line > the vehicle length (Fig. 13)".
또한, 제1 프레임선 W1과 제2 프레임선 W2의 길이의 차를 검출하고, 길이의 차가 미리 정한 소정값(예를 들어, 50㎝) 이상인 경우에, 제1 프레임선 W1의 단부와 쌍을 이루는 제2 프레임선 W2의 단부를 연결한 직선 L과, 제1 프레임선 W1 또는 제2 프레임선 W2와 이루는 각도가, 직각에 가까운 직선 L 상에 주차 목표 p3을 설정할 수 있다.Further, a difference in length between the first frame line W1 and the second frame line W2 is detected, and when the difference in length is equal to or greater than a predetermined value (for example, 50 cm), a pair with an end of the first frame line W1 is selected. The parking target p3 can be set on a straight line L where the angle between the straight line L connecting the ends of the second frame line W2 and the first frame line W1 or the second frame line W2 is close to a right angle.
제1 프레임선 W1과 제2 프레임선 W2의 길이의 차가 미리 정한 소정값 이상인 경우에는, 프론트측과 리어측 중 어느 쪽으로, 차량 V1가 크게 비어져 나올 가능성이 있지만, 제1 프레임선 W1과 제2 프레임선 W2의 길이의 차를 검출하고, 길이의 차가 미리 정한 소정값(예를 들어, 50㎝) 이상인 경우에, 제1 프레임선 W1의 단부와 쌍을 이루는 제2 프레임선 W2의 단부를 연결한 직선 L과, 제1 프레임선 W1 또는 제2 프레임선 W2와 이루는 각도가, 직각에 가까운 직선 L 상에 주차 목표 p3을 설정할 수 있기 때문에, 프론트측 혹은 리어측의 비어져 나옴을 억제할 수 있다.When the difference between the lengths of the first frame line W1 and the second frame line W2 is equal to or greater than a predetermined value, there is a possibility that the vehicle V1 protrudes greatly on either the front side or the rear side. The difference in the lengths of the two frame lines W2 is detected, and when the difference in lengths is equal to or greater than a predetermined value (for example, 50 cm), the end of the second frame line W2 paired with the end of the first frame line W1 is selected. Since the parking target p3 can be set on the straight line L where the angle formed by the connected straight line L and the first frame line W1 or the second frame line W2 is close to a right angle, the protrusion on the front or rear side can be suppressed. can
이상 설명한 바와 같이 본 실시 형태에 관한 주차 지원 방법에 의하면, 빈 주차 스페이스의 차폭 방향과 직교하는 방향의 제1 프레임선 W1 및 제1 프레임선 W1과 쌍이 되는 제2 프레임선 W2를 검출하고, 제1 프레임선 W1 상의 점과, 제2 프레임선 W2 상의 점을 연결한 직선 L 상에 주차 목표 p3을 설정하고, 자차량의 차륜의 위치를 주차 목표 p3에 맞추도록 주차 제어를 실행한다. 이에 의해, 차량을 빈 주차 스페이스의 적절한 위치에 주차시킬 수 있다.As described above, according to the parking assisting method according to the present embodiment, the first frame line W1 in the direction orthogonal to the vehicle width direction of the vacant parking space and the second frame line W2 paired with the first frame line W1 are detected, and A parking target p3 is set on a straight line L connecting a point on the first frame line W1 and a point on the second frame line W2, and parking control is executed so as to align the position of the wheels of the host vehicle with the parking target p3. Thereby, the vehicle can be parked at an appropriate position in an empty parking space.
또한, 제1 프레임선 상의 단부와, 제2 프레임선 상의 단부를 연결한 직선 상에 주차 목표를 설정하고, 자차량의 차륜의 위치를 주차 목표에 맞추도록 상기 주차 제어를 실행한다. 이에 의해, 차량 V의 비어져 나옴을, 프론트측 혹은 리어측으로 정할 수 있기 때문에, 프론트측 혹은 리어측으로 크게 비어져 나오는 것을 억제할 수 있다.In addition, a parking target is set on a straight line connecting an end on the first frame line and an end on the second frame line, and the parking control is executed so that the position of the wheels of the host vehicle is aligned with the parking target. As a result, since the protrusion of the vehicle V can be determined to the front side or the rear side, large protrusion to the front or rear side can be suppressed.
또한, 차량 V1이 방향 전환 위치 p2에서 정지할 때의 공주 거리 L1을 측정하고, 이 공주 거리 L1을 어긋남양으로 하고, 이 어긋남양을 저감하도록 목표 속도를 보정하므로, 공주 거리가 발생한 경우라도, 차량 V1을 고정밀도로 주차 목표 p3에 주차시킬 수 있다.In addition, since the idle distance L1 is measured when the vehicle V1 stops at the direction change position p2, this idle distance L1 is taken as a deviation amount, and the target speed is corrected so as to reduce this deviation amount, even when the idle distance occurs, The vehicle V1 can be parked at the parking target p3 with high precision.
또한, 방향 전환 위치 p2에서 정지할 때의 공주 거리 L1과 동일 거리만큼, 차량 V1을 후진시키고, 그 후 주차 경로 x1을 따라서 차량 V1을 후진시키므로, 차량 V1이 방향 전환 위치 p2에서 공주한 경우라도, 이 어긋남양을 보정하여, 주차 경로 x1을 따른 차량의 이동이 가능해진다.In addition, since the vehicle V1 is reversed by the same distance as the running distance L1 at the time of stopping at the direction change position p2, and then the vehicle V1 is reversed along the parking route x1, even if the vehicle V1 is running at the direction change position p2. , by correcting this displacement amount, movement of the vehicle along the parking route x1 becomes possible.
또한, 공주 거리 L1과 동일 거리만큼 차량 V1을 후진시키는 경우에는, 공주 거리 L1을 전진하였을 때와 동일한 타각으로 설정하므로, 확실하게 공주 거리 L1을 보정하는 것이 가능해진다.In addition, since the idle distance L1 is set to the same steering angle as when moving forward when the vehicle V1 moves backward by the same distance as the idle distance L1, it becomes possible to reliably correct the idle distance L1.
또한, 목표 조타각에 대한 실타각의 추종 지연에 의한 차량 V1의 현재 위치와 목표 경로에 있어서의 위치 사이에 발생하는 어긋남양을 추정하고, 이 어긋남양을 저감하도록, 목표 조타각을 보정하므로, 타각의 추종 지연이 발생한 경우라도 확실하게 차량을 주차 경로 x0, x1을 따라서 이동시킬 수 있다.In addition, since the deviation amount generated between the current position of the vehicle V1 and the position on the target route due to the tracking delay of the actual steering angle with respect to the target steering angle is estimated, and the target steering angle is corrected so as to reduce this deviation amount, Even when a follow-up delay occurs, the vehicle can be reliably moved along the parking paths x0 and x1.
또한, 목표 조타각에 대한 실타각의 정상 편차에 의한 차량 V1의 현재 위치와 목표 경로에 있어서의 위치 사이에 발생하는 어긋남양을 추정하고, 이 어긋남양을 저감하도록, 목표 조타각을 보정하므로, 정상 편차가 발생하는 경우라도 확실하게 차량을 주차 경로 x0, x1을 따라서 이동시킬 수 있다. 따라서, 차량을 주차 스페이스의 적절한 위치에 주차시킬 수 있다.In addition, since the deviation amount occurring between the current position of the vehicle V1 and the position on the target route due to the normal deviation of the actual steering angle from the target steering angle is estimated, and the target steering angle is corrected so as to reduce this deviation amount, Even when a normal deviation occurs, the vehicle can be reliably moved along the parking paths x0 and x1. Accordingly, the vehicle can be parked at an appropriate location in the parking space.
빈 주차 스페이스에 있어서 카스토퍼를 검출하고, 카스토퍼를 검출한 경우에는, 자차량의 차륜의 위치를 카스토퍼에 맞추도록 주차 제어를 실행시킬 수 있다. 이에 의해, 카스토퍼가 있는 경우에는, 카스토퍼에 맞추어 주차시킬 수 있기 때문에, 차량 V1을 빈 주차 스페이스 내의 적절한 위치에 주차시킬 수 있다.A car stopper is detected in an empty parking space, and when a car stopper is detected, parking control can be executed so as to match the position of the wheel of the host vehicle to the car stopper. Accordingly, when there is a car stopper, it is possible to park the car according to the car stopper, so that the vehicle V1 can be parked at an appropriate position in the vacant parking space.
본 실시 형태에 관한 주차 제어 장치(100)는, 주차 경로 생성부(31)에서 설정한 주차 경로를 따라서 차량이 주차 목표 p3에 도달하도록 자동으로 운전을 제어하는 인텔리전트 파킹 어시스트에 사용할 수 있다.The
또한, 예를 들어 상술한 구성에 대해 차량 V1의 현재 위치를 명시하는 도형이나 주차 목표 p3, 및 방향 전환 위치 p2를 나타내는 도형, 초기 위치 p1이나 방향 전환 위치 p2에서의 타각을 지시하는 정보 등과 같이, 운전자가 주차 시의 운전 조작을 행함에 있어서 유용한 각종 지원 정보를 표시하는 지원 정보 표시 기능을 부가한 구성으로 하면, 운전자가 보다 조작하기 쉽도록 지원할 수 있다. 또한, 차량 V1에 탑재되어 있는 스피커를 사용하여, 차량 V1이 주차 경로 x0, x1을 따라서 이동하도록, 조타 방향, 조타량 등을 가이드하는 음성 안내를 행하도록 하면, 보다 세심한 주차 지원이 가능해진다.In addition, for example, a figure specifying the current position of the vehicle V1, a figure indicating a parking target p3, a direction change position p2, information indicating a steering angle at the initial position p1 or direction change position p2, etc. , If a configuration is provided with an assistance information display function for displaying various types of assistance information useful for the driver's driving operation at the time of parking, the driver's operation can be assisted more easily. In addition, if a speaker installed in the vehicle V1 is used to provide voice guidance for guiding the steering direction, steering amount, etc. so that the vehicle V1 moves along the parking paths x0 and x1, more detailed parking assistance becomes possible.
이상, 본 발명의 주차 지원 방법 및 주차 제어 장치를, 도시한 실시 형태에 기초하여 설명하였지만, 본 발명은 이것에 한정되는 것은 아니고, 각 부의 구성은, 마찬가지의 기능을 갖는 임의의 구성의 것으로 치환할 수 있다. 예를 들어, 상기한 실시 형태에서는, 차량을 병렬 주차하는 예에 대하여 설명하였지만, 종렬 주차에 대해서도 적용할 수 있다. 또한, 자동차에 한하지 않고, 이동체이면 적용하는 것이 가능하다.As mentioned above, the parking assistance method and parking control device of the present invention have been described based on the illustrated embodiment, but the present invention is not limited to this, and the configuration of each unit is replaced with an arbitrary configuration having the same function. can do. For example, in the above embodiment, an example of parallel parking of vehicles has been described, but it can also be applied to parallel parking. In addition, it is possible to apply it not only to automobiles, but also to mobile bodies.
또한, 상술한 실시 형태의 각 기능부는, 하나 또는 복수의 처리 회로에 의해 실장될 수 있다. 처리 회로는, 전기 회로를 포함하는 처리 장치 등의 프로그램된 처리 장치를 포함한다. 처리 장치는, 또한, 실시 형태에 기재된 기능을 실행하도록 어레인지된 특정 용도용 집적 회로(ASIC)나 종래형 회로 부품과 같은 장치를 포함해도 된다.In addition, each functional unit of the above-described embodiment may be implemented by one or a plurality of processing circuits. The processing circuit includes a programmed processing device, such as a processing device comprising an electrical circuit. The processing device may also include a device such as an application-specific integrated circuit (ASIC) or conventional circuit component arranged to perform the functions described in the embodiments.
또한, 본 발명의 주차 지원 방법은, 자차량의 주위에 장해물이 없는 경우에 실행된다. 예를 들어, 목표 주차 프레임 검지 센서(10)가, 주차 경로 상에 장해물을 발견한 경우에는, 바로 주차 지원 제어가 중지되어, 안전이 최우선되는 것은 물론이다.Also, the parking assist method of the present invention is executed when there are no obstacles around the host vehicle. For example, when the target parking
10: 목표 주차 프레임 검지 센서
10a, 10b, 10c, 10d: 카메라
10e: 프레임선 검지 회로
20: 화상 정보 처리부(목표 위치 설정 회로)
21: 목표 주차 프레임 검지부
22: 목표 주차 위치 설정부
23: 주차 개시 위치 설정부
24: 현재 위치 추정부
30: 주차 지원 연산부(차량 제어 회로)
31: 주차 경로 생성부
32: 주차 경로 추종 제어부
33: 조타각 제어부
34: 목표 속도 생성부
35: 속도 제어부
40: 차량 제어 ECU
50: 액추에이터
51: 입력 인터페이스
52: 차륜속 센서
53: 타각 센서10: target parking frame detection sensor
10a, 10b, 10c, 10d: camera
10e: frame line detection circuit
20: image information processing unit (target position setting circuit)
21: target parking frame detection unit
22: target parking position setting unit
23: parking start position setting unit
24: current position estimation unit
30: Parking assistance calculation unit (vehicle control circuit)
31: parking route generation unit
32: parking path following control unit
33: steering angle control
34: target speed generator
35: speed control
40: vehicle control ECU
50: actuator
51: input interface
52: wheel speed sensor
53: steering angle sensor
Claims (6)
상기 빈 주차 스페이스의 차폭 방향과 직교하는 방향의 제1 프레임선 및 해당 제1 프레임선과 쌍이 되는 제2 프레임선을 검출하고,
상기 제1 및 제2 프레임선의 길이를 검출하고,
상기 제1 프레임선과 상기 제2 프레임선의 단부끼리를 연결한 직선과, 상기 제1 프레임선 또는 상기 제2 프레임선이 이루는 각도가 직각에 가까운지 여부를 판정하고,
상기 제1 프레임선과 상기 제2 프레임선의 단부끼리를 연결한 직선과, 상기 제1 프레임선 또는 상기 제2 프레임선이 이루는 각도가 직각에 가까운 경우,
상기 제1 및 제2 프레임선의 길이가 자차량의 전체 길이보다 긴지 여부를 판정하고,
상기 제1 및 제2 프레임선의 길이가 자차량의 전체 길이보다 긴 경우, 상기 제1 프레임선의 상기 자차량이 진입하는 방향 앞쪽의 단부와, 상기 제2 프레임선의 상기 자차량이 진입하는 방향 앞쪽의 단부를 연결한 직선 상에 주차 목표를 설정하고,
상기 제1 및 제2 프레임선의 길이가 자차량의 전체 길이보다 짧은 경우, 상기 제1 프레임선의 상기 자차량이 진입하는 방향 안쪽의 단부와, 상기 제2 프레임선의 상기 자차량이 진입하는 방향 안쪽의 단부를 연결한 직선 상에 주차 목표를 설정하고,
상기 빈 주차 스페이스에 대한 상기 자차량의 주차 방향을 판정하고,
상기 자차량이 후진 주차이며, 상기 제1 및 제2 프레임선의 길이가 상기 자차량의 전체 길이보다도 짧은 경우에는, 상기 자차량의 후륜의 위치를 상기 주차 목표에 맞추도록 상기 주차 제어를 실행하고,
상기 자차량이 후진 주차이며, 상기 제1 및 제2 프레임선의 길이가 상기 자차량의 전체 길이보다도 긴 경우에는, 상기 자차량의 프론트 선단부의 위치를 상기 주차 목표에 맞추도록 상기 주차 제어를 실행하고,
상기 제1 프레임선과 상기 제2 프레임선의 단부끼리를 연결한 직선과, 상기 제1 프레임선 또는 제2 프레임선이 이루는 각도가 직각에 가깝지 않은 경우,
제1 프레임의 한쪽 단부와 쌍을 이루는 제 2 프레임의 한쪽 단부를 연결하는 직선과, 상기 제1 프레임의 다른 쪽 단부와 쌍을 이루는 상기 제 2 프레임의 다른 쪽 단부를 연결한 직선 중, 상기 제1 프레임선 또는 상기 제2 프레임선과 이루는 각도가 직각에 가까운 상기 직선상에 주차 목표를 설정하고,
상기 제1 프레임선 또는 상기 제2 프레임선과 이루는 각도가 직각에 가까운 상기 직선이, 상기 제 1 프레임선과 상기 제 2 프레임선의 상기 자차량이 진입하는 방향 안쪽의 단부끼리를 연결한 직선인 경우에는 상기 주차 목표에 상기 자차량의 상기 빈 주차 스페이스로 진입하는 방향 안쪽의 차륜의 위치를 맞추도록 주차 제어를 실행하고,
상기 제1 프레임선 또는 상기 제2 프레임선과 이루는 각도가 직각에 가까운 상기 직선이, 상기 제 1 프레임선과 상기 제 2 프레임선의 상기 자차량이 진입하는 방향 앞쪽의 단부끼리를 연결한 직선인 경우에는 상기 주차 목표에 상기 자차량의 상기 빈 주차 스페이스로 진입하는 방향 앞쪽의 단부의 위치를 맞추도록 주차 제어를 실행하는 것을 특징으로 하는 주차 지원 방법.A parking assisting method of a parking control device that performs parking control to an empty parking space around a host vehicle, comprising:
detecting a first frame line in a direction orthogonal to the vehicle width direction of the empty parking space and a second frame line paired with the first frame line;
Detecting lengths of the first and second frame lines;
determining whether an angle between a straight line connecting ends of the first frame line and the second frame line and the first frame line or the second frame line is close to a right angle;
When an angle between a straight line connecting ends of the first frame line and the second frame line and the first frame line or the second frame line is close to a right angle,
determining whether the lengths of the first and second frame lines are longer than the overall length of the own vehicle;
When the lengths of the first and second frame lines are longer than the total length of the own vehicle, the front end of the first frame line in the direction in which the own vehicle enters and the front end of the second frame line in the direction in which the own vehicle enters Set a parking target on a straight line connecting the ends,
When the lengths of the first and second frame lines are shorter than the total length of the own vehicle, the inner end of the first frame line in the direction in which the own vehicle enters and the inner end of the second frame line in the direction in which the own vehicle enters Set a parking target on a straight line connecting the ends,
Determining the parking direction of the own vehicle with respect to the empty parking space;
When the host vehicle is parked in reverse and the lengths of the first and second frame lines are shorter than the overall length of the host vehicle, the parking control is executed so as to match the position of the rear wheels of the host vehicle to the parking target;
When the host vehicle is parked in reverse and the lengths of the first and second frame lines are longer than the overall length of the host vehicle, the parking control is executed so as to match the position of the front end of the host vehicle to the parking target; ,
When an angle between a straight line connecting ends of the first frame line and the second frame line and the first frame line or the second frame line is not close to a right angle,
Among a straight line connecting one end of the first frame and one end of the paired second frame and a straight line connecting the other end of the second frame paired with the other end of the first frame, the first frame Setting a parking target on the straight line where the angle formed with the first frame line or the second frame line is close to a right angle,
When the straight line, the angle of which is close to a right angle with the first frame line or the second frame line, is a straight line connecting the ends of the first frame line and the second frame line on the inner side in the direction in which the host vehicle enters, the straight line Execute parking control so as to match the position of a wheel in the direction of entering the empty parking space of the host vehicle to a parking target;
When the straight line having an angle close to a right angle with the first frame line or the second frame line is a straight line connecting the front ends of the first frame line and the second frame line in the direction in which the host vehicle enters, the straight line connects the first frame line and the second frame line to each other. A parking assisting method characterized by executing parking control so as to align the position of the front end of the host vehicle in the direction of entering the vacant parking space with a parking target.
상기 빈 주차 스페이스의 차폭 방향과 직교하는 방향의 제1 프레임선 및 해당 제1 프레임선과 쌍이 되는 제2 프레임선을 검출하고,
상기 제1 및 제2 프레임선의 길이를 검출하고,
상기 제1 프레임선과 상기 제2 프레임선의 단부끼리를 연결한 직선과, 상기 제1 프레임선 또는 제2 프레임선이 이루는 각도가 직각에 가까운지 여부를 판정하고,
상기 제1 프레임선과 상기 제2 프레임선의 단부끼리를 연결한 직선과, 상기 제1 프레임선 또는 제2 프레임선이 이루는 각도가 직각에 가까운 경우,
상기 제1 및 제2 프레임선의 길이가 자차량의 전체 길이보다 긴지 여부를 판정하고,
상기 제1 및 제2 프레임선의 길이가 자차량의 전체 길이보다 긴 경우, 상기 제1 프레임선의 상기 자차량이 진입하는 방향 앞쪽의 단부와, 상기 제2 프레임선의 상기 자차량이 진입하는 방향 앞쪽의 단부를 연결한 직선 상에 주차 목표를 설정하고,
상기 제1 및 제2 프레임선의 길이가 자차량의 전체 길이보다 짧은 경우, 상기 제1 프레임선의 상기 자차량이 진입하는 방향 안쪽의 단부와, 상기 제2 프레임선의 상기 자차량이 진입하는 방향 안쪽의 단부를 연결한 직선 상에 주차 목표를 설정하고,
상기 빈 주차 스페이스에 대한 상기 자차량의 주차 방향을 판정하고,
상기 자차량이 전진 주차이며, 상기 제1 및 제2 프레임선의 길이가 상기 자차량의 전체 길이보다도 짧은 경우에는, 상기 자차량의 전륜의 위치를 상기 주차 목표에 맞추도록 상기 주차 제어를 실행하고,
상기 자차량이 전진 주차이며, 상기 제1 및 제2 프레임선의 길이가 상기 자차량의 전체 길이보다도 긴 경우에는, 상기 자차량의 리어 선단부의 위치를 상기 주차 목표에 맞추도록 상기 주차 제어를 실행하고,
상기 제1 프레임선과 상기 제2 프레임선의 단부끼리를 연결한 직선과, 상기 제1 프레임선 또는 제2 프레임선이 이루는 각도가 직각에 가깝지 않은 경우,
제1 프레임의 한쪽 단부와 쌍을 이루는 제 2 프레임의 한쪽 단부를 연결하는 직선과, 상기 제1 프레임의 다른 쪽 단부와 쌍을 이루는 상기 제 2 프레임의 다른 쪽 단부를 연결한 직선 중, 상기 제1 프레임선 또는 상기 제2 프레임선과 이루는 각도가 직각에 가까운 상기 직선상에 주차 목표를 설정하고,
상기 제1 프레임선 또는 상기 제2 프레임선과 이루는 각도가 직각에 가까운 상기 직선이, 상기 제 1 프레임선과 상기 제 2 프레임선의 상기 자차량이 진입하는 방향 안쪽의 단부끼리를 연결한 직선인 경우에는 상기 주차 목표에 상기 자차량의 상기 빈 주차 스페이스로 진입하는 방향 안쪽의 차륜의 위치를 맞추도록 주차 제어를 실행하고,
상기 제1 프레임선 또는 상기 제2 프레임선과 이루는 각도가 직각에 가까운 상기 직선이, 상기 제 1 프레임선과 상기 제 2 프레임선의 상기 자차량이 진입하는 방향 앞쪽의 단부끼리를 연결한 직선인 경우에는 상기 주차 목표에 상기 자차량의 상기 빈 주차 스페이스로 진입하는 방향 앞쪽의 단부의 위치를 맞추도록 주차 제어를 실행하는 것을 특징으로 하는 주차 지원 방법.A parking assisting method of a parking control device that performs parking control to an empty parking space around a host vehicle, comprising:
detecting a first frame line in a direction orthogonal to the vehicle width direction of the empty parking space and a second frame line paired with the first frame line;
Detecting lengths of the first and second frame lines;
determining whether an angle between a straight line connecting ends of the first frame line and the second frame line and the first frame line or the second frame line is close to a right angle;
When an angle between a straight line connecting ends of the first frame line and the second frame line and the first frame line or the second frame line is close to a right angle,
determining whether the lengths of the first and second frame lines are longer than the overall length of the own vehicle;
When the lengths of the first and second frame lines are longer than the total length of the own vehicle, the front end of the first frame line in the direction in which the own vehicle enters and the front end of the second frame line in the direction in which the own vehicle enters Set a parking target on a straight line connecting the ends,
When the lengths of the first and second frame lines are shorter than the total length of the own vehicle, the inner end of the first frame line in the direction in which the own vehicle enters and the inner end of the second frame line in the direction in which the own vehicle enters Set a parking target on a straight line connecting the ends,
Determining the parking direction of the own vehicle with respect to the empty parking space;
When the host vehicle is forward parked and the lengths of the first and second frame lines are shorter than the overall length of the host vehicle, the parking control is executed so as to match the position of the front wheels of the host vehicle to the parking target;
When the host vehicle is forward parked and the lengths of the first and second frame lines are longer than the overall length of the host vehicle, the parking control is executed so as to match the position of the rear end of the host vehicle to the parking target; ,
When an angle between a straight line connecting ends of the first frame line and the second frame line and the first frame line or the second frame line is not close to a right angle,
Among a straight line connecting one end of the first frame and one end of the paired second frame and a straight line connecting the other end of the second frame paired with the other end of the first frame, the first frame Setting a parking target on the straight line where the angle formed with the first frame line or the second frame line is close to a right angle,
When the straight line, the angle of which is close to a right angle with the first frame line or the second frame line, is a straight line connecting the ends of the first frame line and the second frame line on the inner side in the direction in which the host vehicle enters, the straight line Execute parking control so as to match the position of a wheel in the direction of entering the empty parking space of the host vehicle to a parking target;
When the straight line having an angle close to a right angle with the first frame line or the second frame line is a straight line connecting the front ends of the first frame line and the second frame line in the direction in which the host vehicle enters, the straight line connects the first frame line and the second frame line to each other. A parking assisting method characterized by executing parking control so as to align the position of the front end of the host vehicle in the direction of entering the vacant parking space with a parking target.
상기 제1 프레임선과 상기 제2 프레임선의 길이의 차를 검출하고,
상기 길이의 차가 미리 정한 소정값 이상인 경우에, 상기 제1 프레임선의 단부와 쌍을 이루는 상기 제2 프레임선의 단부를 연결한 직선과, 상기 제1 프레임선 또는 상기 제2 프레임선과 이루는 각도가, 직각에 가까운 상기 직선 상에 상기 주차 목표를 설정하는 것을 특징으로 하는 주차 지원 방법.According to claim 1 or 2,
detecting a difference between the lengths of the first frame line and the second frame line;
When the difference in length is greater than or equal to a predetermined value, an angle between a straight line connecting the end of the first frame line and the end of the pair of the second frame line and the first frame line or the second frame line is a right angle. and setting the parking target on the straight line close to .
상기 빈 주차 스페이스의 차폭 방향과 직교하는 방향의 제1 프레임선 및 해당 제1 프레임선과 쌍이 되는 제2 프레임선을 검출하고, 상기 제1 프레임선 및 제2 프레임선의 길이를 검출하는 목표 주차 프레임 검지 센서와,
주차 목표를 설정하는 목표 위치 설정 회로와,
상기 자차량의 위치를 상기 주차 목표에 맞추도록 상기 주차 제어를 실행하는 차량 제어 회로
를 구비하고,
상기 목표 위치 설정 회로는,
상기 제1 프레임선과 상기 제2 프레임선의 단부끼리를 연결한 직선과, 상기 제1 프레임선 또는 상기 제2 프레임선이 이루는 각도가 직각에 가까운지 여부를 판정하고,
상기 제1 프레임선과 상기 제2 프레임선의 단부끼리를 연결한 직선과, 상기 제1 프레임선 또는 상기 제2 프레임선이 이루는 각도가 직각에 가까운 경우,
상기 제1 및 제2 프레임선의 길이가 자차량의 전체 길이보다 긴지 여부를 판정하고,
상기 제1 및 제2 프레임선의 길이가 자차량의 전체 길이보다 긴 경우, 제1 프레임선의 상기 자차량이 진입하는 방향 앞쪽의 단부와, 상기 제2 프레임선의 상기 자차량이 진입하는 방향 앞쪽의 단부를 연결한 직선 상에 주차 목표를 설정하고,
상기 제1 및 제2 프레임선의 길이가 자차량의 전체 길이보다 짧은 경우, 상기 제1 프레임선의 상기 자차량이 진입하는 방향 안쪽의 단부와, 상기 제2 프레임선의 상기 자차량이 진입하는 방향 안쪽의 단부를 연결한 직선 상에 주차 목표를 설정하고,
상기 차량 제어 회로는,
상기 빈 주차 스페이스에 대한 상기 자차량의 주차 방향을 판정하고,
상기 자차량이 후진 주차이며, 상기 제1 및 제2 프레임선의 길이가 상기 자차량의 전체 길이보다도 짧은 경우에는, 상기 자차량의 후륜의 위치를 상기 주차 목표에 맞추도록 상기 주차 제어를 실행하고,
상기 자차량이 후진 주차이며, 상기 제1 및 제2 프레임선의 길이가 상기 자차량의 전체 길이보다도 긴 경우에는, 상기 자차량의 프론트 선단부의 위치를 상기 주차 목표에 맞추도록 상기 주차 제어를 실행하고,
상기 제1 프레임선과 상기 제2 프레임선의 단부끼리를 연결한 직선과, 상기 제1 프레임선 또는 제2 프레임선이 이루는 각도가 직각에 가깝지 않은 경우,
제1 프레임의 한쪽 단부와 쌍을 이루는 제 2 프레임의 한쪽 단부를 연결하는 직선과, 상기 제1 프레임의 다른 쪽 단부와 쌍을 이루는 상기 제 2 프레임의 다른 쪽 단부를 연결한 직선 중, 상기 제1 프레임선 또는 상기 제2 프레임선과 이루는 각도가 직각에 가까운 상기 직선상에 주차 목표를 설정하고,
상기 제1 프레임선 또는 상기 제2 프레임선과 이루는 각도가 직각에 가까운 상기 직선이, 상기 제 1 프레임선과 상기 제 2 프레임선의 상기 자차량이 진입하는 방향 안쪽의 단부끼리를 연결한 직선인 경우에는 상기 주차 목표에 상기 자차량의 상기 빈 주차 스페이스로 진입하는 방향 안쪽의 차륜의 위치를 맞추도록 주차 제어를 실행하고,
상기 제1 프레임선 또는 상기 제2 프레임선과 이루는 각도가 직각에 가까운 상기 직선이, 상기 제 1 프레임선과 상기 제 2 프레임선의 상기 자차량이 진입하는 방향 앞쪽의 단부끼리를 연결한 직선인 경우에는 상기 주차 목표에 상기 자차량의 상기 빈 주차 스페이스로 진입하는 방향 앞쪽의 단부의 위치를 맞추도록 주차 제어를 실행하는 것을 특징으로 하는 주차 제어 장치.A parking control device that performs parking control to an empty parking space around a host vehicle,
Target parking frame detection for detecting a first frame line in a direction orthogonal to the vehicle width direction of the empty parking space and a second frame line paired with the first frame line, and detecting the lengths of the first frame line and the second frame line. with the sensor,
a target position setting circuit for setting a parking target;
A vehicle control circuit that executes the parking control to align the position of the host vehicle with the parking target
to provide,
The target position setting circuit,
determining whether an angle between a straight line connecting ends of the first frame line and the second frame line and the first frame line or the second frame line is close to a right angle;
When an angle between a straight line connecting ends of the first frame line and the second frame line and the first frame line or the second frame line is close to a right angle,
determining whether the lengths of the first and second frame lines are longer than the overall length of the own vehicle;
When the lengths of the first and second frame lines are longer than the total length of the own vehicle, the front end of the first frame line in the direction in which the own vehicle enters and the front end of the second frame line in the direction in which the own vehicle enters Set a parking target on a straight line connecting
When the lengths of the first and second frame lines are shorter than the total length of the own vehicle, the inner end of the first frame line in the direction in which the own vehicle enters and the inner end of the second frame line in the direction in which the own vehicle enters Set a parking target on a straight line connecting the ends,
The vehicle control circuit,
Determining the parking direction of the own vehicle with respect to the empty parking space;
When the host vehicle is parked in reverse and the lengths of the first and second frame lines are shorter than the overall length of the host vehicle, the parking control is executed so as to match the position of the rear wheels of the host vehicle to the parking target;
When the host vehicle is parked in reverse and the lengths of the first and second frame lines are longer than the overall length of the host vehicle, the parking control is executed so as to match the position of the front end of the host vehicle to the parking target; ,
When an angle between a straight line connecting ends of the first frame line and the second frame line and the first frame line or the second frame line is not close to a right angle,
Among a straight line connecting one end of the first frame and one end of the paired second frame and a straight line connecting the other end of the second frame paired with the other end of the first frame, the first frame Setting a parking target on the straight line where the angle formed with the first frame line or the second frame line is close to a right angle;
When the straight line, the angle of which is close to a right angle with the first frame line or the second frame line, is a straight line connecting the ends of the first frame line and the second frame line on the inner side in the direction in which the host vehicle enters, the straight line Execute parking control so as to match the position of a wheel in the direction of entering the empty parking space of the host vehicle to a parking target;
When the straight line having an angle close to a right angle with the first frame line or the second frame line is a straight line connecting the front ends of the first frame line and the second frame line in the direction in which the host vehicle enters, the straight line connects the first frame line and the second frame line to each other. A parking control device characterized in that it executes parking control so as to align the position of the front end of the host vehicle in the direction of entering the vacant parking space with a parking target.
상기 빈 주차 스페이스의 차폭 방향과 직교하는 방향의 제1 프레임선 및 해당 제1 프레임선과 쌍이 되는 제2 프레임선을 검출하고, 상기 제1 프레임선 및 제2 프레임선의 길이를 검출하는 목표 주차 프레임 검지 센서와,
주차 목표를 설정하는 목표 위치 설정 회로와,
상기 자차량의 위치를 상기 주차 목표에 맞추도록 상기 주차 제어를 실행하는 차량 제어 회로
를 구비하고,
상기 목표 위치 설정 회로는,
상기 제1 프레임선과 상기 제2 프레임선의 단부끼리를 연결한 직선과, 상기 제1 프레임선 또는 상기 제2 프레임선이 이루는 각도가 직각에 가까운지 여부를 판정하고,
상기 제1 프레임선과 상기 제2 프레임선의 단부끼리를 연결한 직선과, 상기 제1 프레임선 또는 상기 제2 프레임선이 이루는 각도가 직각에 가까운 경우,
상기 제1 및 제2 프레임선의 길이가 자차량의 전체 길이보다 긴지 여부를 판정하고,
상기 제1 및 제2 프레임선의 길이가 자차량의 전체 길이보다 긴 경우, 제1 프레임선의 상기 자차량이 진입하는 방향 앞쪽의 단부와, 상기 제2 프레임선의 상기 자차량이 진입하는 방향 앞쪽의 단부를 연결한 직선 상에 주차 목표를 설정하고,
상기 제1 및 제2 프레임선의 길이가 자차량의 전체 길이보다 짧은 경우, 상기 제1 프레임선의 상기 자차량이 진입하는 방향 안쪽의 단부와, 상기 제2 프레임선의 상기 자차량이 진입하는 방향 안쪽의 단부를 연결한 직선 상에 주차 목표를 설정하고,
상기 차량 제어 회로는,
상기 빈 주차 스페이스에 대한 상기 자차량의 주차 방향을 판정하고,
상기 자차량이 전진 주차이며, 상기 제1 및 제2 프레임선의 길이가 상기 자차량의 전체 길이보다도 짧은 경우에는, 상기 자차량의 전륜의 위치를 상기 주차 목표에 맞추도록 상기 주차 제어를 실행하고,
상기 자차량이 전진 주차이며, 상기 제1 및 제2 프레임선의 길이가 상기 자차량의 전체 길이보다도 긴 경우에는, 상기 자차량의 리어 선단부의 위치를 상기 주차 목표에 맞추도록 상기 주차 제어를 실행하고,
상기 제1 프레임선과 상기 제2 프레임선의 단부끼리를 연결한 직선과, 상기 제1 프레임선 또는 제2 프레임선이 이루는 각도가 직각에 가깝지 않은 경우,
제1 프레임의 한쪽 단부와 쌍을 이루는 제 2 프레임의 한쪽 단부를 연결하는 직선과, 상기 제1 프레임의 다른 쪽 단부와 쌍을 이루는 상기 제 2 프레임의 다른 쪽 단부를 연결한 직선 중, 상기 제1 프레임선 또는 상기 제2 프레임선과 이루는 각도가 직각에 가까운 상기 직선상에 주차 목표를 설정하고,
상기 제1 프레임선 또는 상기 제2 프레임선과 이루는 각도가 직각에 가까운 상기 직선이, 상기 제 1 프레임선과 상기 제 2 프레임선의 상기 자차량이 진입하는 방향 안쪽의 단부끼리를 연결한 직선인 경우에는 상기 주차 목표에 상기 자차량의 상기 빈 주차 스페이스로 진입하는 방향 안쪽의 차륜의 위치를 맞추도록 주차 제어를 실행하고,
상기 제1 프레임선 또는 상기 제2 프레임선과 이루는 각도가 직각에 가까운 상기 직선이, 상기 제 1 프레임선과 상기 제 2 프레임선의 상기 자차량이 진입하는 방향 앞쪽의 단부끼리를 연결한 직선인 경우에는 상기 주차 목표에 상기 자차량의 상기 빈 주차 스페이스로 진입하는 방향 앞쪽의 단부의 위치를 맞추도록 주차 제어를 실행하는 것을 특징으로 하는 주차 제어 장치.A parking control device that performs parking control to an empty parking space around a host vehicle,
Target parking frame detection for detecting a first frame line in a direction orthogonal to the vehicle width direction of the empty parking space and a second frame line paired with the first frame line, and detecting the lengths of the first frame line and the second frame line. with the sensor,
a target position setting circuit for setting a parking target;
A vehicle control circuit that executes the parking control to align the position of the host vehicle with the parking target
to provide,
The target position setting circuit,
determining whether an angle between a straight line connecting ends of the first frame line and the second frame line and the first frame line or the second frame line is close to a right angle;
When an angle between a straight line connecting ends of the first frame line and the second frame line and the first frame line or the second frame line is close to a right angle,
determining whether the lengths of the first and second frame lines are longer than the overall length of the own vehicle;
When the lengths of the first and second frame lines are longer than the total length of the own vehicle, the front end of the first frame line in the direction in which the own vehicle enters and the front end of the second frame line in the direction in which the own vehicle enters Set a parking target on a straight line connecting
When the lengths of the first and second frame lines are shorter than the total length of the own vehicle, the inner end of the first frame line in the direction in which the own vehicle enters and the inner end of the second frame line in the direction in which the own vehicle enters Set a parking target on a straight line connecting the ends,
The vehicle control circuit,
Determining the parking direction of the own vehicle with respect to the empty parking space;
When the host vehicle is forward parked and the lengths of the first and second frame lines are shorter than the overall length of the host vehicle, the parking control is executed so as to match the position of the front wheels of the host vehicle to the parking target;
When the host vehicle is forward parked and the lengths of the first and second frame lines are longer than the overall length of the host vehicle, the parking control is executed so as to match the position of the rear end of the host vehicle to the parking target; ,
When an angle between a straight line connecting ends of the first frame line and the second frame line and the first frame line or the second frame line is not close to a right angle,
Among a straight line connecting one end of the first frame and one end of the paired second frame and a straight line connecting the other end of the second frame paired with the other end of the first frame, the first frame Setting a parking target on the straight line where the angle formed with the first frame line or the second frame line is close to a right angle,
When the straight line, the angle of which is close to a right angle with the first frame line or the second frame line, is a straight line connecting the ends of the first frame line and the second frame line on the inner side in the direction in which the host vehicle enters, the straight line Execute parking control so as to match the position of a wheel in the direction of entering the empty parking space of the host vehicle to a parking target;
When the straight line having an angle close to a right angle with the first frame line or the second frame line is a straight line connecting the front ends of the first frame line and the second frame line in the direction in which the host vehicle enters, the straight line connects the first frame line and the second frame line to each other. A parking control device characterized in that it executes parking control so as to align the position of the front end of the host vehicle in the direction of entering the vacant parking space with a parking target.
Applications Claiming Priority (2)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
PCT/JP2017/025000 WO2019008757A1 (en) | 2017-07-07 | 2017-07-07 | Parking assistance method and parking control device |
KR1020207001795A KR20200019725A (en) | 2017-07-07 | 2017-07-07 | Parking Assistance Method and Parking Control Device |
Related Parent Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
KR1020207001795A Division KR20200019725A (en) | 2017-07-07 | 2017-07-07 | Parking Assistance Method and Parking Control Device |
Publications (2)
Publication Number | Publication Date |
---|---|
KR20220016291A KR20220016291A (en) | 2022-02-08 |
KR102466727B1 true KR102466727B1 (en) | 2022-11-16 |
Family
ID=64950766
Family Applications (2)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
KR1020227002326A KR102466727B1 (en) | 2017-07-07 | 2017-07-07 | Parking assistance method and parking control device |
KR1020207001795A KR20200019725A (en) | 2017-07-07 | 2017-07-07 | Parking Assistance Method and Parking Control Device |
Family Applications After (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
KR1020207001795A KR20200019725A (en) | 2017-07-07 | 2017-07-07 | Parking Assistance Method and Parking Control Device |
Country Status (11)
Country | Link |
---|---|
US (1) | US11242048B2 (en) |
EP (1) | EP3650286B1 (en) |
JP (2) | JP7038118B2 (en) |
KR (2) | KR102466727B1 (en) |
CN (1) | CN110785328B (en) |
BR (1) | BR112020000295B1 (en) |
CA (1) | CA3069417A1 (en) |
MX (1) | MX2019015353A (en) |
MY (1) | MY197903A (en) |
RU (1) | RU2741680C1 (en) |
WO (1) | WO2019008757A1 (en) |
Families Citing this family (14)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP6917330B2 (en) * | 2018-03-28 | 2021-08-11 | 日立Astemo株式会社 | Parking support device |
JP7133336B2 (en) * | 2018-04-06 | 2022-09-08 | 日立Astemo株式会社 | parking assist device |
CN112469599A (en) * | 2018-07-09 | 2021-03-09 | 三菱电机株式会社 | Parking assistance device and parking assistance method |
JP7212486B2 (en) * | 2018-09-26 | 2023-01-25 | フォルシアクラリオン・エレクトロニクス株式会社 | position estimator |
CN111615476B (en) * | 2018-12-26 | 2023-05-23 | 百度时代网络技术(北京)有限公司 | Spiral curve-based vertical parking planning system for autonomous vehicles |
JP2020166758A (en) * | 2019-03-29 | 2020-10-08 | 株式会社デンソーテン | Image processing device and image processing method |
EP3953195A1 (en) | 2019-04-12 | 2022-02-16 | Continental Automotive Systems, Inc. | Autonomous vehicle-trailer maneuvering and parking |
JP7296768B2 (en) * | 2019-04-22 | 2023-06-23 | フォルシアクラリオン・エレクトロニクス株式会社 | Image processing device and image processing method |
JP7323356B2 (en) * | 2019-06-28 | 2023-08-08 | フォルシアクラリオン・エレクトロニクス株式会社 | PARKING ASSIST DEVICE AND PARKING ASSIST METHOD |
JP7427907B2 (en) * | 2019-10-15 | 2024-02-06 | 株式会社アイシン | parking assist device |
JP6975766B2 (en) * | 2019-12-13 | 2021-12-01 | 本田技研工業株式会社 | Parking support device, parking support method and program |
JP7200973B2 (en) * | 2020-05-01 | 2023-01-10 | 株式会社デンソー | PARKING ASSIST DEVICE, PARKING ASSIST METHOD, AND PARKING ASSIST PROGRAM |
US20220297674A1 (en) * | 2021-03-18 | 2022-09-22 | DUS Operating, Inc. | Surround view localization of a vehicle |
US20230311854A1 (en) * | 2022-03-29 | 2023-10-05 | Continental Autonomous Mobility US, LLC | Autonomous vehicle garage parking |
Citations (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP2006347428A (en) * | 2005-06-17 | 2006-12-28 | Aisin Seiki Co Ltd | Driving support device |
JP2016084094A (en) * | 2014-10-28 | 2016-05-19 | アイシン精機株式会社 | Parking assist apparatus |
JP5999195B2 (en) * | 2012-11-27 | 2016-09-28 | 日産自動車株式会社 | Vehicle acceleration suppression device and vehicle acceleration suppression method |
Family Cites Families (23)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US6476730B2 (en) * | 2000-02-29 | 2002-11-05 | Aisin Seiki Kabushiki Kaisha | Assistant apparatus and method for a vehicle in reverse motion |
JP4235051B2 (en) * | 2003-08-29 | 2009-03-04 | トヨタ自動車株式会社 | Parking assistance device |
JP4969269B2 (en) * | 2007-02-21 | 2012-07-04 | アルパイン株式会社 | Image processing device |
WO2008117386A1 (en) * | 2007-03-23 | 2008-10-02 | Pioneer Corporation | Image processing apparatus for vehicle and image processing program for vehicle |
KR101013898B1 (en) * | 2007-12-12 | 2011-02-14 | 현대자동차주식회사 | Automatic parking system for vehicle |
JP5099451B2 (en) * | 2008-12-01 | 2012-12-19 | アイシン精機株式会社 | Vehicle periphery confirmation device |
CN102933428B (en) * | 2010-06-15 | 2015-07-15 | 爱信精机株式会社 | Drive assist device |
JP2012017021A (en) * | 2010-07-08 | 2012-01-26 | Panasonic Corp | Parking assistance apparatus, and vehicle |
JP2012096585A (en) * | 2010-10-29 | 2012-05-24 | Suzuki Motor Corp | Parking support device |
DE102012015922A1 (en) * | 2012-08-10 | 2014-02-13 | Daimler Ag | A method for performing a parking operation of a vehicle by means of a driver assistance system |
JP5761159B2 (en) * | 2012-11-16 | 2015-08-12 | 株式会社デンソー | Driving support device and driving support method |
CN103241239B (en) * | 2013-04-27 | 2015-10-14 | 重庆邮电大学 | A kind of automated parking system parking stall recognition methods |
JP6155944B2 (en) * | 2013-08-01 | 2017-07-05 | 日産自動車株式会社 | Vehicle acceleration suppression device and vehicle acceleration suppression method |
JP6167824B2 (en) | 2013-10-04 | 2017-07-26 | アイシン精機株式会社 | Parking assistance device |
JP2016016681A (en) * | 2014-07-04 | 2016-02-01 | クラリオン株式会社 | Parking frame recognition device |
JP6275007B2 (en) * | 2014-09-12 | 2018-02-07 | アイシン精機株式会社 | Parking assistance device |
JP2016066322A (en) * | 2014-09-26 | 2016-04-28 | 富士通テン株式会社 | Image processor and image display system |
CN105584480B (en) * | 2014-10-24 | 2018-11-02 | 法雷奥汽车内部控制(深圳)有限公司 | Parking assistance method for automatically selecting shut-down operation and system |
JP6517561B2 (en) | 2015-03-27 | 2019-05-22 | クラリオン株式会社 | Vehicle control device |
JP2017021747A (en) * | 2015-07-15 | 2017-01-26 | クラリオン株式会社 | Vehicle parking support device |
JP2017030569A (en) * | 2015-07-31 | 2017-02-09 | アイシン精機株式会社 | Parking support device |
JP6768275B2 (en) * | 2015-09-11 | 2020-10-14 | クラリオン株式会社 | Vehicle parking lot recognition device |
BR112018008270B1 (en) * | 2015-10-22 | 2023-03-21 | Nissan Motor Co., Ltd | PARKING SPACE LINE DETECTION DEVICE AND METHOD |
-
2017
- 2017-07-07 KR KR1020227002326A patent/KR102466727B1/en active IP Right Grant
- 2017-07-07 BR BR112020000295-0A patent/BR112020000295B1/en active IP Right Grant
- 2017-07-07 JP JP2019528315A patent/JP7038118B2/en active Active
- 2017-07-07 MY MYPI2019007581A patent/MY197903A/en unknown
- 2017-07-07 US US16/625,530 patent/US11242048B2/en active Active
- 2017-07-07 KR KR1020207001795A patent/KR20200019725A/en not_active IP Right Cessation
- 2017-07-07 RU RU2020105663A patent/RU2741680C1/en active
- 2017-07-07 CA CA3069417A patent/CA3069417A1/en active Pending
- 2017-07-07 WO PCT/JP2017/025000 patent/WO2019008757A1/en unknown
- 2017-07-07 MX MX2019015353A patent/MX2019015353A/en unknown
- 2017-07-07 EP EP17916885.1A patent/EP3650286B1/en active Active
- 2017-07-07 CN CN201780092314.0A patent/CN110785328B/en active Active
-
2021
- 2021-06-29 JP JP2021107858A patent/JP7147930B2/en active Active
Patent Citations (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP2006347428A (en) * | 2005-06-17 | 2006-12-28 | Aisin Seiki Co Ltd | Driving support device |
JP5999195B2 (en) * | 2012-11-27 | 2016-09-28 | 日産自動車株式会社 | Vehicle acceleration suppression device and vehicle acceleration suppression method |
JP2016084094A (en) * | 2014-10-28 | 2016-05-19 | アイシン精機株式会社 | Parking assist apparatus |
Also Published As
Publication number | Publication date |
---|---|
CN110785328B (en) | 2022-06-28 |
JP2021183484A (en) | 2021-12-02 |
US11242048B2 (en) | 2022-02-08 |
BR112020000295A2 (en) | 2020-07-14 |
KR20220016291A (en) | 2022-02-08 |
JP7147930B2 (en) | 2022-10-05 |
JPWO2019008757A1 (en) | 2020-06-25 |
US20200369262A1 (en) | 2020-11-26 |
MY197903A (en) | 2023-07-24 |
EP3650286B1 (en) | 2021-10-20 |
EP3650286A4 (en) | 2020-09-16 |
JP7038118B2 (en) | 2022-03-17 |
CA3069417A1 (en) | 2020-01-07 |
MX2019015353A (en) | 2020-02-07 |
EP3650286A1 (en) | 2020-05-13 |
KR20200019725A (en) | 2020-02-24 |
WO2019008757A1 (en) | 2019-01-10 |
BR112020000295B1 (en) | 2023-01-17 |
RU2741680C1 (en) | 2021-01-28 |
CN110785328A (en) | 2020-02-11 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
KR102466727B1 (en) | Parking assistance method and parking control device | |
KR101990257B1 (en) | Parking Assist Device and Parking Assistance Method | |
US10988139B2 (en) | Vehicle position control method and device vehicle position control device for correcting position in drive-assisted vehicle | |
JP6243931B2 (en) | Vehicle travel control device | |
JP4037722B2 (en) | Outside-of-vehicle monitoring device and travel control device equipped with this out-of-vehicle monitoring device | |
EP2581272B1 (en) | Parking assistance device and method | |
JP6747179B2 (en) | Parking assistance method and parking assistance device | |
JP6750365B2 (en) | Parking assistance method and parking assistance device | |
KR102205144B1 (en) | Parking assistance method and parking assistance device | |
JP2018034540A (en) | Parking support method and parking support apparatus | |
KR20150012799A (en) | Apparatus and method for providing parking control | |
JP2015003565A (en) | Parking assist system | |
JP2018039294A (en) | Parking support method and parking support apparatus | |
JP5971197B2 (en) | Parking assistance device | |
JP7059528B2 (en) | Parking support method and parking control device | |
JP2019217846A (en) | Vehicle control device, vehicle control method, and program | |
JP6720751B2 (en) | Parking assistance method and parking assistance device | |
JP2018083480A (en) | Parking support method and parking support device | |
JP6897068B2 (en) | Parking support method and parking support device | |
CN110576858B (en) | Vehicle control device, vehicle control method, and recording medium | |
US20230294702A1 (en) | Control device, control method, and storage medium | |
JP7001541B2 (en) | Vehicle control devices, vehicle control methods and programs | |
US20200114906A1 (en) | Vehicle control system and vehicle control method | |
KR20230079285A (en) | Method and device for controlling automatic driving vehicle |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
A107 | Divisional application of patent | ||
E902 | Notification of reason for refusal | ||
E601 | Decision to refuse application | ||
AMND | Amendment | ||
X701 | Decision to grant (after re-examination) | ||
GRNT | Written decision to grant |