WO2021157241A1 - Parking assistance apparatus and parking assistance method - Google Patents

Parking assistance apparatus and parking assistance method Download PDF

Info

Publication number
WO2021157241A1
WO2021157241A1 PCT/JP2020/048271 JP2020048271W WO2021157241A1 WO 2021157241 A1 WO2021157241 A1 WO 2021157241A1 JP 2020048271 W JP2020048271 W JP 2020048271W WO 2021157241 A1 WO2021157241 A1 WO 2021157241A1
Authority
WO
WIPO (PCT)
Prior art keywords
vehicle
parking
route
obstacle
distance
Prior art date
Application number
PCT/JP2020/048271
Other languages
French (fr)
Japanese (ja)
Inventor
光貴 山▲崎▼
真 石野田
Original Assignee
クラリオン株式会社
Priority date (The priority date is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the date listed.)
Filing date
Publication date
Application filed by クラリオン株式会社 filed Critical クラリオン株式会社
Publication of WO2021157241A1 publication Critical patent/WO2021157241A1/en

Links

Images

Classifications

    • BPERFORMING OPERATIONS; TRANSPORTING
    • B60VEHICLES IN GENERAL
    • B60WCONJOINT 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/00Purposes of road vehicle drive control systems not related to the control of a particular sub-unit, e.g. of systems using conjoint control of vehicle sub-units, or advanced driver assistance systems for ensuring comfort, stability and safety or drive control systems for propelling or retarding the vehicle
    • B60W30/06Automatic manoeuvring for parking
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B60VEHICLES IN GENERAL
    • B60WCONJOINT 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/00Purposes of road vehicle drive control systems not related to the control of a particular sub-unit, e.g. of systems using conjoint control of vehicle sub-units, or advanced driver assistance systems for ensuring comfort, stability and safety or drive control systems for propelling or retarding the vehicle
    • B60W30/08Active safety systems predicting or avoiding probable or impending collision or attempting to minimise its consequences
    • B60W30/09Taking automatic action to avoid collision, e.g. braking and steering

Definitions

  • the present invention relates to a parking support device and a parking support method.
  • Patent Document 1 As a technique related to automatic parking of a vehicle.
  • Patent Document 1 states, "When the own vehicle moves toward the parking space by performing steering control and speed control so that the own vehicle moves along the target route toward the recognized parking space, the own vehicle When an obstacle approaching is detected, the collision position where the own vehicle collides with the obstacle is calculated, and based on the margin distance and the collision position set according to whether the own vehicle is moving forward or backward. , An automatic parking control device that calculates the stop position on the target route and controls the speed so that the own vehicle stops at the calculated stop position. "
  • An object of the present invention is to provide a parking support device and a parking support method capable of shortening the time required for parking at a target parking position.
  • the parking support device of the present invention is a parking support device that assists the parking of a vehicle, and targets an obstacle detection unit that detects an obstacle existing around the vehicle and the vehicle.
  • a route generation unit that generates a parking route to be parked at a parking position and a vehicle control device that generates control information for traveling the vehicle along the parking route and transfers the control information to a vehicle control device that controls the traveling of the vehicle.
  • the travel control unit for output, the obstacle detected by the obstacle detection unit when traveling according to the parking route, and the prediction unit for predicting the distance to the vehicle are provided, and the route generation unit predicts the distance.
  • the travel control unit When the unit predicts that the distance between the vehicle and the obstacle will be less than or equal to a predetermined distance, it is in front of the position where the distance between the vehicle and the obstacle is less than or equal to a predetermined distance and is on the parking route.
  • the travel control unit generates control information for driving the vehicle according to the avoidance parking route, starting from the point of It is characterized in that it is generated and the control information is output to the vehicle control device.
  • the time required for parking at the target parking position can be shortened.
  • FIG. 1 is a configuration diagram showing a configuration of a parking support device and an in-vehicle device.
  • FIG. 2 is a diagram showing a parking route.
  • FIG. 3 is a diagram showing a parking route and an avoidance parking route.
  • FIG. 4 is a diagram showing a display screen displaying an intermediate position based on the parking route.
  • FIG. 5 is a diagram showing a display screen displaying an intermediate position based on the parking route and the avoidance parking route.
  • FIG. 6 is a diagram showing a display screen in which a plurality of captured images are displayed by picture-in-picture.
  • FIG. 7 is a flowchart showing the operation of the parking support device.
  • FIG. 1 is a diagram showing a configuration of an in-vehicle device 3 mounted on a vehicle.
  • the vehicle equipped with the in-vehicle device 3 will be referred to as the own vehicle 1.
  • the in-vehicle device 3 includes a position detection unit 10, a detection unit 20, an operation unit 50, a display unit 60, a vehicle control unit 70, a steering device 71, a drive device 73, a braking device 75, a transmission 77, and a parking support device 100.
  • the position detection unit 10 detects the current position of the own vehicle 1.
  • the position detection unit 10 includes a GNSS receiver that receives a GNSS (Global Navigation Satellite System) signal, and a processor that calculates the current position of the own vehicle 1 based on the GNSS signal received by the GNSS receiver. Illustration of the GNSS receiver and processor is omitted.
  • the position detection unit 10 outputs the position information indicating the current position of the own vehicle 1 obtained by calculation to the parking support device 100.
  • GNSS Global Navigation Satellite System
  • the detection unit 20 includes one or a plurality of sensors that detect an obstacle 5 (see FIG. 3) existing around the own vehicle 1 and detect the distance between the detected obstacle 5 and the own vehicle 1.
  • the detection unit 20 of the present embodiment includes a photographing unit 30 and a sonar unit 40 as sensors.
  • the sensor on which the detection unit 20 can be mounted is not limited to the camera and sonar.
  • a radar or lidar LiDAR: Laser Imaging Detection and Ringing
  • the detection unit 20 outputs the captured image of the photographing unit 30 and the sensor value of the sonar unit 40 to the parking support device 100 as detection information.
  • the photographing unit 30 includes a front camera 31 for photographing the front of the own vehicle 1, a rear camera 33 for photographing the rear of the own vehicle 1, a left side camera 35 for photographing the left side of the own vehicle 1, and the right side of the own vehicle 1.
  • a right side camera 37 for photographing is provided.
  • Each of these cameras includes an image sensor such as a CCD (Charge-Coupled Device) or a CMOS (Complementary Metal-Oxide-Semiconductor), and a data processing circuit that generates a captured image from the light receiving state of the image sensor.
  • the angle of view of the photographing unit 30 is adjusted so that the four cameras can photograph a range of 360 ° around the vehicle 1.
  • the front camera 31, the rear camera 33, the left side camera 35, and the right side camera 37 capture each shooting range at a predetermined frame rate to generate a shot image.
  • the photographing unit 30 outputs the generated photographed image to the parking support device 100.
  • the parking support device 100 temporarily stores the input captured image in the memory 110.
  • the sonar unit 40 is mounted at a plurality of locations of the own vehicle 1 such as front, rear, left side, and right side, and detects the size, position, and distance to the obstacle 5 by using ultrasonic waves. ..
  • the operation unit 50 functions as a reception unit that receives the operation of the occupant on the own vehicle 1.
  • the operation unit 50 outputs an operation signal corresponding to the received operation to the parking support device 100.
  • the operations accepted by the operation unit 50 include, for example, an operation of instructing the start of the parking support, an operation of ending the parking support, an operation of changing the captured image of the photographing unit 30 displayed on the display unit 60, and the like.
  • the display unit 60 includes a display panel 61 and a touch sensor 63.
  • a liquid crystal display, an organic EL display, or the like is used for the display panel 61.
  • the display unit 60 causes the display panel 61 to display a display image based on the display data input from the parking support device 100.
  • As the touch sensor 63 a generally known type of sensor such as a resistance film type or a capacitance type is used.
  • the display unit 60 detects the touch operation of the finger on the display panel 61 by the touch sensor 63, and generates a position signal indicating the operation position of the detected touch operation.
  • the display unit 60 outputs the generated position signal to the parking support device 100.
  • the vehicle control unit 70 corresponds to the vehicle control device of the present invention, and is a unit that controls the steering device 71, the drive device 73, the braking device 75, and the transmission device 77 mounted on the own vehicle 1.
  • the vehicle control unit 70 includes a computer (for example, an ECU (Electronic Control Unit)) that executes such control.
  • the computer is connected to the steering device 71, the driving device 73, the braking device 75, and the transmission device 77 via an in-vehicle network such as CAN (Controller Area Network).
  • the vehicle control unit 70 controls the steering device 71, the drive device 73, the braking device 75, and the transmission device 77 according to the control information input from the parking support device 100.
  • the own vehicle 1 travels by automatic driving.
  • the steering device 71 is a device including an actuator for steering the steering wheels of the own vehicle 1.
  • the drive device 73 is a device including an actuator that adjusts the driving force of the drive wheels of the own vehicle 1. This actuator corresponds to a throttle actuator when the power source of the own vehicle 1 is an engine, and corresponds to the motor when the power source is a motor.
  • the braking device 75 is a device including an actuator that controls the braking system provided in the own vehicle 1 based on the information from the parking support device 100 and controls the braking force applied to the wheels of the own vehicle 1.
  • the transmission 77 is a device including a transmission and an actuator. The transmission 77 drives an actuator to control the shift position of the transmission, and switches the gear ratio of the transmission and the forward and reverse movements of the own vehicle 1.
  • the parking support device 100 is a computer including a processor 130 such as a CPU (Central Processing Unit) and an MPU (Microprocessor Unit), and a memory 110 such as a ROM (Read Only Memory) and a RAM (Random Access Memory).
  • a storage device such as an HDD (Hard Disk Drive) or SSD (Solid State Drive), an interface circuit for connecting sensors, peripheral devices, and the like, and an in-vehicle network. It is equipped with an in-vehicle network communication circuit that communicates with other in-vehicle devices.
  • the parking support device 100 realizes various functional configurations by executing a computer program stored in the memory 110 or the storage device by the processor.
  • the parking support device 100 has a position acquisition unit 131, a map generation unit 132, an obstacle detection unit 133, a target parking position setting unit 134, a route generation unit 135, a travel control unit 136, a prediction unit 137, and a display control as functional configurations.
  • a unit 138 is provided.
  • the current position of the own vehicle 1 calculated by the position detection unit 10 is input to the position acquisition unit 131 as position information.
  • the position acquisition unit 131 estimates the current position of the own vehicle 1 by using a known or well-known dead reckoning method, and corrects the current position of the own vehicle input from the position detection unit 10 based on the estimation result.
  • the map generation unit 132 generates map data in which the obstacles 5 existing around the own vehicle 1 and the current position of the own vehicle 1 are recorded in the local coordinate system. This map data is generated in the memory 110.
  • the obstacle 5 is an appropriate object that hinders or regulates the running of the own vehicle 1. Examples of the obstacle 5 include structures such as pillars and walls, poles and ground division lines that divide the traveling area where the own vehicle 1 can travel and the parking area, other vehicles, carts, pedestrians, and the like. ..
  • the map generation unit 132 is the registration information of the map data based on the current position of the own vehicle 1 sequentially input from the position acquisition unit 131 and the detection information of the obstacle 5 sequentially input from the detection unit 20. The current position of the vehicle 1 and the position and size of the obstacle 5 are sequentially updated.
  • the parking support device 100 may acquire the map data in which the position of the obstacle 5 is recorded in advance.
  • the parking support device 100 may download the map data from the server device, or may read the map data stored in the memory 110 in advance.
  • the parking support device 100 records the current position of the own vehicle 1 input from the position acquisition unit 131 in the acquired map data to generate the map data.
  • the obstacle detection unit 133 detects obstacles 5 existing around the own vehicle 1.
  • the obstacle detection unit 133 detects obstacles 5 existing around the own vehicle 1 based on the map data generated by the map generation unit 132. For example, the obstacle detection unit 133 detects an obstacle 5 whose distance from the own vehicle 1 is equal to or less than a preset first set distance.
  • the obstacle 5 detected by the obstacle detection unit 133 is a candidate object that can be an obstacle to the traveling of the own vehicle 1 when the own vehicle 1 is traveled along the parking route R1.
  • the target parking position setting unit 134 sets the target parking position, which is the position where the own vehicle 1 is parked.
  • the target parking position setting unit 134 sets the target parking position for parking the own vehicle 1 based on the map data generated by the map generation unit 132, the captured image of the photographing unit 30, and the sensor value of the sonar unit 40.
  • the target parking position setting unit 134 detects a parking frame line such as a white line drawn on the road surface from the captured image of the photographing unit 30.
  • the target parking position setting unit 134 detects a parking area in which no other vehicle is parked based on the detection result of the parking frame line and the map data, and sets the target parking position in the detected parking area.
  • the route generation unit 135 generates a parking route.
  • the route generation unit 135 generates a parking route for parking the own vehicle 1 at the target parking position without contacting the obstacle 5 based on the map data generated by the map generation unit 132.
  • the parking route first generated by the route generation unit 135 after the start of parking support will be referred to as a parking route R1.
  • the route generation unit 135 outputs the generated parking route R1 to the travel control unit 136.
  • FIG. 2 is a diagram showing an example of the parking route R1.
  • the parking route R1 generated by the route generation unit 135 may include a route for changing the traveling direction of the own vehicle 1 by temporarily stopping the own vehicle 1 after the own vehicle 1 starts traveling along the route. be.
  • the change in the traveling direction includes a case where the traveling direction of the own vehicle 1 is changed from forward to reverse and a case where the traveling direction is changed from reverse to forward.
  • the position where the own vehicle 1 is temporarily stopped in order to change the traveling direction is referred to as an intermediate position.
  • the intermediate position may include a position where the own vehicle 1 turns left, a position where the own vehicle 1 turns right, and the like.
  • the parking route R1 is composed of the route R11 and the route R12 shown in FIG.
  • the route R11 is a section in which the own vehicle 1 travels forward
  • the route R12 is a section in which the own vehicle 1 travels backward.
  • the parking route R1 includes three positions P1, P2 and P3.
  • P1 corresponds to the current position of the own vehicle 1
  • P2 corresponds to the intermediate position
  • P3 corresponds to the target parking position.
  • P1 will be referred to as the current position P1
  • P2 will be referred to as the first intermediate position P2
  • P3 will be referred to as the target parking position P3.
  • the own vehicle 1 starts at the current position P1 and moves forward along the route R11. When the own vehicle 1 reaches the first intermediate position P2, it stops once and switches the traveling direction from forward to reverse. After that, the own vehicle 1 travels backward along the route R12 and parks at the target parking position P3.
  • the travel control unit 136 generates control information for controlling the travel of the own vehicle 1 based on the parking route R1 generated by the route generation unit 135.
  • This control information is information for driving the own vehicle 1 along the parking path R1, and includes information for controlling steering, driving, braking, and shifting, respectively.
  • the prediction unit 137 predicts the distance to the obstacle 5 detected by the obstacle detection unit 133 after the own vehicle 1 starts traveling along the parking route R1. For example, the prediction unit 137 sets the virtual vehicle 7 on the map data based on the current position of the own vehicle 1, and determines the distance between the obstacle 5 detected by the obstacle detection unit 133 and the virtual vehicle 7. .. The prediction unit 137 sets the virtual vehicle 7 (see FIG. 3) at a position at a predetermined distance from the own vehicle 1 in front of the vehicle in the traveling direction according to the parking route R1. The prediction unit 137 predicts the distance between the own vehicle 1 and the obstacle 5 by determining the contact or collision of the set virtual vehicle 7 with the obstacle 5.
  • the virtual vehicle 7 virtually sets the own vehicle 1, and when the own vehicle 1 moves forward, the prediction unit 137 sets the virtual vehicle 7 in front of the own vehicle 1 and the own vehicle 1 moves backward. In this case, the virtual vehicle 7 is set behind the own vehicle 1.
  • the size in the length direction and the width direction of the virtual vehicle 7 matches the size in the length direction and the width direction of the own vehicle 1. Further, the position of the virtual vehicle 7 moves as the own vehicle 1 travels.
  • the prediction unit 137 determines whether or not the detection accuracy of the obstacle 5 detected by the detection unit 20 is equal to or higher than a certain accuracy.
  • the detection accuracy of the detection unit 20 becomes higher as the distance from the obstacle 5 becomes closer. For example, even if the obstacle 5 is captured in the captured image of the detection unit 20, if the own vehicle 1 and the obstacle 5 are far apart, the obstacle 5 may not be recognized as the obstacle 5.
  • the sensor value of the sonar unit 40 becomes higher in detection accuracy as the distance from the obstacle 5 becomes closer. For example, assuming that the obstacle 5 exists at the first intermediate position P2, the size and position of the obstacle 5 detected at the current position P1 and the obstacle 5 detected near the first intermediate position P2. The size and position may differ.
  • the prediction unit 137 determines the position and size of the obstacle 5 detected by the detection unit 20. , It is determined that the information has an accuracy of a certain degree or more.
  • the second set distance is a distance shorter than the first set distance.
  • the prediction unit 137 determines whether or not the distance between the virtual vehicle 7 and the obstacle 5 is equal to or less than the third set distance.
  • the third set distance is set to a distance shorter than the second set distance.
  • the third set distance may be set to 0 cm, which is the distance at which the virtual vehicle 7 and the obstacle 5 are determined to collide or come into contact with each other.
  • the second set distance may be set to a distance that gives the occupants on the own vehicle 1 anxiety that the own vehicle 1 may come into contact with the obstacle 5, for example, 50 cm or less.
  • the third set distance corresponds to the predetermined distance of the present invention.
  • the prediction unit 137 determines that the distance between the virtual vehicle 7 and the obstacle 5 is equal to or less than the third set distance, the prediction unit 137 instructs the route generation unit 135 to regenerate the parking route.
  • the parking route generated by the route generation unit 135 according to the instruction of the prediction unit 137 is referred to as an avoidance parking route R2.
  • FIG. 3 is a diagram showing a parking route R1 and an avoidance parking route R2.
  • the parking route R1 shown by a broken line in FIG. 3 is composed of a route R11 and a route R12 as in FIG. 2.
  • the parking route R1 shown in FIG. 3 includes a current position P1, a first intermediate position P2, and a target parking position P3, as in FIG. It is assumed that when the own vehicle 1 moves to the position P5 shown in FIG. 3, the prediction unit 137 determines that the distance between the obstacle 5 and the virtual vehicle 7 is equal to or less than the third set distance.
  • the position of the virtual vehicle 7 when the position of the own vehicle 1 is the current position P1 is shown by a broken line. Further, FIG.
  • the prediction unit 137 determines that the distance between the virtual vehicle 7 and the obstacle 5 is equal to or less than the third set distance at the position P5, and avoids parking in the route generation unit 135 while continuing the traveling of the own vehicle 1. Instructs the generation of path R2.
  • the route generation unit 135 generates an avoidance parking route R2 whose route is different from that of the parking route R1 according to the instruction of the prediction unit 137.
  • the route generation unit 135 generates an avoidance parking route R2 that has a start point of the route on the parking route R1 and can move to the target parking position P3.
  • the avoidance parking route R2 is a route in which the distance to the obstacle 5 is longer than the third set distance even if the own vehicle 1 is driven along the avoidance parking route R2 at the position of the own vehicle 1.
  • the starting point of the avoidance parking route R2 is on the parking route R1 between the current position P1 of the own vehicle 1 and the position where the distance between the virtual vehicle 7 and the obstacle 5 is equal to or less than the second set distance. Is set to. For example, when the second set distance is 0 cm, the position where the distance between the virtual vehicle 7 and the obstacle 5 is equal to or less than the second set distance is the position where the obstacle 5 is detected.
  • the route generation unit 135 is based on the number of changes in which the traveling direction of the own vehicle 1 is changed from forward to reverse or backward to forward when generating the avoidance parking route R2, and the mileage of the avoidance parking route R2. Then, the avoidance parking route R2 is generated.
  • the route generation unit 135 generates a route having a small number of changes in the traveling direction and a short mileage as an avoidance parking route R2. Further, the route generation unit 135 may generate the avoidance parking route R2 by setting priorities for the number of changes in the traveling direction and the mileage. For example, it is assumed that the mileage is set to have a higher priority than the number of changes in the traveling direction.
  • the route generation unit 135 has generated two routes, route A and route B, as candidates for the avoidance parking route R2.
  • the route generation unit 135 selects the avoidance parking route R2 based on the difference in the mileage between the high-priority route A and the route B, but the difference in the mileage between the route A and the route B is predetermined.
  • the distance is less than or equal to the distance, either one of the route A and the route B may be selected as the avoidance parking route R2 based on the number of changes in the traveling direction.
  • the route composed of the route R21 and the route R22 shown in FIG. 3 is the avoidance parking route R2.
  • the position P6 is the starting point position of the avoidance parking route R2, and the position P7 corresponds to the intermediate position of the avoidance parking route R2.
  • the position P6 is referred to as a start point position P6, and the position P7 is referred to as a second intermediate position P7.
  • the route generation unit 135 outputs the generated avoidance parking route R2 to the travel control unit 136.
  • the travel control unit 136 causes the vehicle control unit 70 to stop the own vehicle 1.
  • the travel control unit 136 generates control information based on the avoidance parking route R2.
  • the travel control unit 136 outputs the generated control information to the vehicle control unit 70.
  • the own vehicle 1 starts automatic traveling along the avoidance parking route R2.
  • the parking support device 100 continues to detect the obstacle 5 by the obstacle detection unit 133 and determine the distance between the detected obstacle 5 and the virtual vehicle 7 until the own vehicle 1 reaches the target parking position P3. do.
  • the parking support device 100 detects an obstacle 5 and determines that the distance between the detected obstacle 5 and the virtual vehicle 7 is equal to or less than the third set distance, the distance to the obstacle 5 is the third set distance.
  • the larger avoidance parking route R2 is generated again. Then, the parking support device 100 continues traveling according to the generated avoidance parking route R2 until the own vehicle 1 reaches the target parking position P3.
  • the display control unit 138 generates display data to be displayed on the display panel 61, and outputs the generated display data to the display unit 60.
  • the display unit 60 generates a display screen 300 based on the input display data, and displays the generated display screen 300 on the display panel 61.
  • FIG. 4 and 5 are views showing a display screen 300 displayed on the display panel 61.
  • FIG. 4 is a diagram showing a display screen 300 when the own vehicle 1 is traveling along the parking route R1.
  • the display screen 300 includes a first display screen 310 and a second display screen 320.
  • a bird's-eye view image 315 of the own vehicle 1 taken from above is displayed.
  • the bird's-eye view image 315 is an image generated by synthesizing the captured images of the front camera 31, the rear camera 33, the left side camera 35, and the right side camera 37.
  • a stop position image 210a showing a stop position corresponding to the first intermediate position P2 is displayed as a solid line.
  • the bird's-eye view image 315 displays a parking position image 220 showing the target parking position P3.
  • the bird's-eye view image 315 shown in FIG. 4 shows a state in which the obstacle 5 exists in the stop position image 210a.
  • the first child screen 330 and the second child screen 340 are displayed on the second display screen 320.
  • a photographed image of the camera that captures the traveling direction of the own vehicle 1 is displayed.
  • FIG. 4 shows a first sub-screen 330 on which the captured image of the front camera 31 is displayed.
  • the predicted advance routes 331 and 333 are displayed on the first child screen 330.
  • Predicted travel routes 331 and 333 are images displayed under the control of the display control unit 138, and are images showing the traveling direction of the own vehicle 1 when the steering angle of the steering wheel of the own vehicle 1 is the current steering angle. Is.
  • the captured image displayed on the first child screen 330 also shows the captured state of the obstacle 5.
  • the icon 345 is displayed on the second child screen 340.
  • the icon 345 indicates the position of the camera that captured the captured image displayed on the first sub screen 330 in the own vehicle 1.
  • FIG. 4 shows a state in which the icon 345A indicating the shooting range of the front camera 31 that shoots the front of the own vehicle 1 is displayed as the icon 345.
  • the cancel button 360 is displayed on the second display screen 320.
  • the cancel button 360 is displayed on the second display screen 320.
  • FIG. 5 is a diagram showing a display screen 300 displayed on the display panel 61.
  • FIG. 5 is a diagram showing a display screen 300 when an obstacle 5 is detected and the parking route is changed from the parking route R1 to the avoidance parking route R2.
  • the display screen 300 also includes a first display screen 310 and a second display screen 320.
  • the stop position image 210b is displayed on the first display screen 310 in addition to the stop position image 210a.
  • the stop position image 210a is an image showing the first intermediate position P2 included in the parking path R1.
  • the stop position image 210b is an image showing the second intermediate position P7 included in the avoidance parking route R2.
  • the display control unit 138 displays the stop position image 210a and the stop position image 210b on the first display screen 310
  • the display control unit 138 displays the stop position image 210a and the stop position image 210b in different display modes.
  • the stop position image 210a may be displayed by a broken line
  • the stop position image 210b may be displayed by a solid line.
  • the display control unit 138 may change the display color of the stop position image 210a and the stop position image 210b.
  • the display control unit 138 displays the stop position image 210a in a dark color such as black, and displays the stop position image 210b in a bright color such as red.
  • the display control unit 138 may change the brightness of the stop position image 210a and the stop position image 210b.
  • the display control unit 138 displays the brightness of the stop position image 210b higher than the brightness of the stop position image 210a. Further, the display control unit 138 may turn on or blink the display of the stop position image 210b.
  • a frame image 335 showing the position of the obstacle 5 in the captured image is displayed.
  • the display control unit 175 detects the position of the obstacle 5 in the captured image, and displays a frame image 335 showing the range of the detected obstacle 5 around the obstacle 5.
  • the obstacle 5 for displaying the frame image 335 is an obstacle 5 whose distance to the virtual vehicle 7 is determined to be equal to or less than the third set distance, and is around the obstacle 5 which is unlikely to come into contact with the virtual vehicle 7. It is not displayed by the frame image 335.
  • the guidance display 370 is displayed on the second display screen 320.
  • a guidance indicating that the parking route has been changed from the parking route R1 to the avoidance parking route R2 is displayed because the obstacle 5 that is predicted to come into contact with the own vehicle 1 is detected.
  • a guidance indicating that the intermediate position, that is, the stop position at which the own vehicle 1 is stopped has been changed may be displayed.
  • the notification operation may be performed by outputting a preset voice from the speaker mounted on the own vehicle 1. For example, a voice guidance notifying that the parking route has been changed may be output from the speaker.
  • FIG. 6 is a diagram showing a display screen 300 displayed on the display panel 61.
  • FIG. 6 is a diagram showing a case where the parking route is changed from the parking route R1 to the avoidance parking route R2 and the captured image displayed on the first sub screen 330 is changed.
  • the second intermediate position P7 is changed from the front of the own vehicle 1 to the right front by changing the parking route R1 to the avoidance parking route R2, and the front camera 31 is displayed on the first child screen 330.
  • the case where the photographed image of the right side camera 37 is displayed in addition to the captured image is shown.
  • the display control unit 138 displays the captured image of the front camera 31 and the captured image of the right side camera 37 on the first sub screen 330 without erasing the captured image of the front camera 31 from the first sub screen 330. Is displayed as a picture-in-picture.
  • FIG. 6 shows an example in which the grandchild screen 380 displaying the captured image of the right side camera 37 is displayed in the first sub screen 330 displaying the captured image of the front camera 31.
  • the display control unit 139 generates a picture-in-picture image so that the photographed image to be displayed later is displayed in the photographed image first displayed on the first child screen 330.
  • the icon 345 displayed on the second child screen 340 is changed from the icon 345A to the icon 345B.
  • the icon 345B shown in FIG. 6 is an icon indicating a shooting range of the front camera 31 that shoots the front of the own vehicle 1 and a shooting range of the right side camera 37 that shoots the right side of the own vehicle 1.
  • FIG. 7 is a flowchart showing the operation of the parking support device 100.
  • the operation of the parking support device 100 will be described with reference to the flowchart shown in FIG. 7.
  • the parking support device 100 determines whether or not the operation unit 50 has accepted the start operation for starting the parking support (step S1). When the parking support device 100 does not accept the start operation (step S1 / NO), the parking support device 100 waits until the start operation is accepted.
  • Step S2 When the parking support device 100 accepts the start operation (step S1 / YES), first, the photographed image of the photographing unit 30 and the sensor value of the sonar unit 40 are acquired as detection information (step S2).
  • the parking support device 100 generates map data in which the current position of the own vehicle 1, the position of the obstacle 5, and the like are recorded based on the analysis result obtained by analyzing the acquired captured image and the sensor value of the sonar unit 40 ().
  • Step S3 Steps S2 and S3 correspond to the detection steps of the present invention.
  • Step S4 corresponds to the generation step of the present invention.
  • the parking support device 100 analyzes the captured image to detect the parking frame line, detects the parking area in which no other vehicle is parked based on the detection result of the parking frame line and the map data, and detects the parking area. Set the target parking position within. Further, the parking support device 100 sets a parking area in which the detected other vehicle is not parked at the target parking position, and parks the own vehicle 1 at the target parking position without contacting the obstacle 5. Is generated (step S4).
  • the parking support device 100 causes the display unit 60 to display the display screen 300 shown in FIG. 4 (step S5).
  • the display screen 300 includes a first display screen 310 and a second display screen 320.
  • a stop position image 210a showing the stop position of the own vehicle 1 when the own vehicle 1 is stopped at the first intermediate position P2 is displayed with a solid line.
  • the parking support device 100 generates control information for driving the own vehicle 1 along the parking route R1 (step S6), and outputs the generated control information to the vehicle control unit 70 (step S7).
  • Steps S6 and S7 correspond to the output steps of the present invention.
  • the vehicle control unit 70 controls the driving of the steering device 71, the driving device 73, the braking device 75, and the transmission device 77 according to the control information, so that the own vehicle 1 starts automatic traveling along the parking path R1 (step). S8).
  • the parking support device 100 continues to acquire the captured image of the photographing unit 30 which is the detection information of the detection unit 20 and the sensor value of the sonar unit 40 even after the own vehicle 1 starts traveling by automatic driving (step S9). ..
  • the parking support device 100 detects the obstacle 5 based on the acquired sensor value of the sonar unit 40 and the analysis result of the captured image, and records the position and size of the detected obstacle 5 in the map data.
  • Step S9 corresponds to the detection step of the present invention.
  • the parking support device 100 updates the position and size of the obstacle 5 in the map data, it determines whether or not the distance between the detected obstacle 5 and the virtual vehicle 7 is equal to or less than the third set distance (step S10). ).
  • Step S10 corresponds to the prediction step of the present invention.
  • the parking support device 100 determines whether or not the own vehicle 1 is parked at the target parking position (step). S11).
  • step S11 / NO When the own vehicle 1 is not parked at the target parking position (step S11 / NO), the parking support device 100 returns to the process of step S9 to acquire the detection information of the detection unit 20, and the distance to the virtual vehicle 7 is reduced. It is determined whether or not the obstacle 5 which is equal to or less than the third set distance is detected. Further, when the parking support device 100 determines that the own vehicle 1 is parked at the target parking position (step S11 / YES), the parking support device 100 ends this processing flow.
  • step S10 when the distance between the obstacle 5 and the virtual vehicle 7 is equal to or less than the third set distance (step S10 / YES), the parking support device 100 generates the avoidance parking route R2 (step S12). ).
  • Step S12 corresponds to the generation step of the present invention.
  • the parking support device 100 determines whether or not the current position of the own vehicle 1 is the start point position P6 of the avoidance parking route R2 (step S13). When the current position of the own vehicle 1 is not the start point position P6 of the avoidance parking route R2 (step S13 / NO), the parking support device 100 waits until the own vehicle 1 moves to the start point position P6 of the avoidance parking route R2. ..
  • the parking support device 100 When the own vehicle 1 moves to the start point position P6 of the avoidance parking route R2 (step S13 / YES), the parking support device 100 outputs a stop instruction to the vehicle control unit 70 (step S14). After that, the parking support device 100 updates the display of the display screen 300 displayed on the display unit 60 (step S15). The display screen 300 displayed on the display unit 60 is updated from the display screen 300 shown in FIG. 4 to the display screen 300 shown in FIG.
  • the stop position image 210b is displayed in addition to the stop position image 210a. Further, when the obstacle 5 is photographed in the photographed image displayed on the first sub screen 330, the frame image 335 showing the position of the obstacle 5 is superimposed and displayed on the photographed image. Further, on the second display screen 320, a guidance display 370 for informing that the parking route has been changed from the parking route R1 to the avoidance parking route R2 is displayed because the obstacle 5 in contact with the own vehicle 1 is detected.
  • the parking support device 100 After the own vehicle 1 is stopped, the parking support device 100 generates control information based on the generated avoidance parking route R2 (step S16), and outputs the generated control information to the vehicle control unit 70 (step S17). Steps S16 and S17 correspond to the output steps of the present invention. As a result, the own vehicle 1 starts traveling along the avoidance parking route R2 (step S18). After that, the parking support device 100 shifts to the process of step S9 and restarts the detection of the obstacle 5.
  • the parking support device 100 of the present embodiment is a device that supports parking of a vehicle, and includes an obstacle detection unit 133, a route generation unit 135, a travel control unit 136, and a prediction unit 137.
  • the obstacle detection unit 133 detects obstacles 5 existing around the own vehicle 1.
  • the route generation unit 135 generates a parking route R1 for parking the own vehicle 1 at the target parking position.
  • the travel control unit 136 generates control information for driving the own vehicle 1 according to the parking route R1, and outputs the control information to the vehicle control unit 70 that controls the travel of the own vehicle 1.
  • the prediction unit 137 predicts the distance between the obstacle 5 detected by the obstacle detection unit 133 and the own vehicle 1 when traveling along the parking route R1.
  • the route generation unit 135 is more than a position where the distance between the own vehicle 1 and the obstacle 5 is less than or equal to the predetermined value.
  • the avoidance parking route R2 which is in front of the vehicle and starts at a point on the parking route R1 and is separated from the obstacle 5 by a predetermined distance or more, is generated. Further, the travel control unit 136 generates control information for driving the own vehicle 1 according to the avoidance parking route R2, and outputs the control information to the vehicle control unit 70.
  • the avoidance parking route R2 is calculated after stopping the own vehicle 1 in front of the obstacle 5. In comparison, the time required to park the own vehicle 1 at the target parking position can be shortened.
  • the prediction unit 137 is located on the parking path R1 and sets the virtual vehicle 7 at a predetermined position in front of the traveling direction of the own vehicle 1, and whether or not the distance between the virtual vehicle 7 and the obstacle 5 is equal to or less than the predetermined distance. Is determined, and the distance between the obstacle 5 and the own vehicle 1 is predicted. Therefore, the accuracy of predicting the distance between the obstacle 5 and the own vehicle 1 can be improved.
  • the route generation unit 135 is on the parking route R1 set as the start point of the avoidance parking route R2 based on the mileage when the own vehicle 1 is parked at the target parking position and the number of changes for changing the traveling direction of the own vehicle 1. Set the point of. Therefore, the time for parking the own vehicle 1 at the target parking position can be shortened.
  • FIG. 1 is a schematic view showing components classified according to the main processing contents in order to facilitate understanding of the present invention, and the components are further classified according to the processing contents. It can also be classified into many components. It can also be categorized so that one component performs more processing.
  • the parking support device 100 may be configured to integrally include at least one of the position detection unit 10 and the detection unit 20.
  • the parking support method of the present invention is realized by using a computer, it is also possible to configure the program to be executed by the computer in the form of a recording medium or a transmission medium for transmitting this program.
  • a recording medium a magnetic or optical recording medium or a semiconductor memory device can be used. Specifically, flexible disks, HDDs (Hard Disk Drives), CD-ROMs (Compact Disk Read Only Memory), DVDs, Blu-ray (registered trademark) Discs, magneto-optical disks, flash memories, card-type recording media, etc. Examples include portable or fixed recording media.
  • the recording medium may be a non-volatile storage device such as a RAM, a ROM, or an HDD included in the parking support device 100.
  • the processing unit of the flowchart shown in FIG. 7 is divided according to the main processing contents in order to make the processing of the parking support device 100 easier to understand, and it depends on the method and name of division of the processing unit.
  • the present invention is not limited.
  • the processing of the parking support device 100 may be divided into more processing units depending on the processing content. Further, the processing of the parking support device 100 may be divided so that one processing unit includes more processing.

Abstract

Provided is a parking assistance apparatus capable of shortening time required for parking at a target parking position. A parking assistance apparatus 100 is provided with: a prediction section 137 that predicts the distance between an obstacle 5 detected by an obstacle detection section 133 and a host vehicle 1 when the vehicle travels in accordance with a parking route R1 generated by a route generation section 135; the route generation section 135 that, if the prediction section 137 has predicted that the distance between the host vehicle 1 and the obstacle 5 is not more than a third set distance, generates an avoidance parking route R2 in which the distance from the obstacle 5 is more than the third set distance and which starts at a point on the parking route R1 located before a position where the distance between the host vehicle 1 and the obstacle 5 becomes not more than the third set distance; and a traveling control section 136 that generates control information for causing the host vehicle 1 to travel along the avoidance parking route R2, and that outputs the control information to a vehicle control unit 70.

Description

駐車支援装置及び駐車支援方法Parking support device and parking support method
 本発明は、駐車支援装置及び駐車支援方法に関する。 The present invention relates to a parking support device and a parking support method.
 従来、車両の自動駐車に関する技術として特許文献1がある。特許文献1には、「認識された駐車スペースに向かって自車両が目標経路に沿って移動するように操舵制御と速度制御とを行い、自車両が駐車スペースに向かって移動するとき、自車両に接近する障害物を検知したときは、自車両が障害物と衝突する衝突位置を演算し、自車両が前進中か後進中かに応じて設定されている余裕距離と衝突位置とに基づいて、目標経路上での停止位置を演算し、演算した停止位置で自車両が停止するように速度制御を行う自動駐車制御装置」が記載されている。 Conventionally, there is Patent Document 1 as a technique related to automatic parking of a vehicle. Patent Document 1 states, "When the own vehicle moves toward the parking space by performing steering control and speed control so that the own vehicle moves along the target route toward the recognized parking space, the own vehicle When an obstacle approaching is detected, the collision position where the own vehicle collides with the obstacle is calculated, and based on the margin distance and the collision position set according to whether the own vehicle is moving forward or backward. , An automatic parking control device that calculates the stop position on the target route and controls the speed so that the own vehicle stops at the calculated stop position. "
特開2015-81022号公報Japanese Unexamined Patent Publication No. 2015-81022
 しかしながら、特許文献1の技術では、車両を停車させた後に次の駐車経路の生成を行うため、目標駐車位置に駐車させるまでに時間がかかるという問題がある。
 本発明は、目標駐車位置に駐車させるまでにかかる時間を短縮できる駐車支援装置及び駐車支援方法を提供することを目的とする。
However, in the technique of Patent Document 1, since the next parking route is generated after the vehicle is stopped, there is a problem that it takes time to park the vehicle at the target parking position.
An object of the present invention is to provide a parking support device and a parking support method capable of shortening the time required for parking at a target parking position.
 この明細書には、2020年2月7日に出願された日本国特許出願・特願2020-019391号のすべての内容が含まれる。 This specification includes all the contents of the Japanese patent application / Japanese Patent Application No. 2020-019391 filed on February 7, 2020.
 上記目的を達成するために本発明の駐車支援装置は、車両の駐車を支援する駐車支援装置であって、前記車両の周囲に存在する障害物を検出する障害物検出部と、前記車両を目標駐車位置に駐車させる駐車経路を生成する経路生成部と、前記車両を前記駐車経路に沿って走行させるための制御情報を生成し、前記制御情報を、前記車両の走行を制御する車両制御装置に出力する走行制御部と、前記駐車経路に従って走行した場合、前記障害物検出部が検出した障害物と、前記車両との距離を予測する予測部と、を備え、前記経路生成部は、前記予測部が、前記車両と前記障害物との距離が所定距離以下になると予測した場合に、前記車両と前記障害物との距離が所定距離以下になる位置よりも手前であって、前記駐車経路上の地点を始点とし、前記車両と前記障害物との距離が前記所定距離より離れた回避駐車経路を生成し、前記走行制御部は、前記車両を前記回避駐車経路に従って走行させるための制御情報を生成して、前記制御情報を前記車両制御装置に出力することを特徴とする。 In order to achieve the above object, the parking support device of the present invention is a parking support device that assists the parking of a vehicle, and targets an obstacle detection unit that detects an obstacle existing around the vehicle and the vehicle. A route generation unit that generates a parking route to be parked at a parking position and a vehicle control device that generates control information for traveling the vehicle along the parking route and transfers the control information to a vehicle control device that controls the traveling of the vehicle. The travel control unit for output, the obstacle detected by the obstacle detection unit when traveling according to the parking route, and the prediction unit for predicting the distance to the vehicle are provided, and the route generation unit predicts the distance. When the unit predicts that the distance between the vehicle and the obstacle will be less than or equal to a predetermined distance, it is in front of the position where the distance between the vehicle and the obstacle is less than or equal to a predetermined distance and is on the parking route. The travel control unit generates control information for driving the vehicle according to the avoidance parking route, starting from the point of It is characterized in that it is generated and the control information is output to the vehicle control device.
 本発明によれば、目標駐車位置に駐車させるまでにかかる時間を短縮できる。 According to the present invention, the time required for parking at the target parking position can be shortened.
図1は、駐車支援装置及び車載装置の構成を示す構成図である。FIG. 1 is a configuration diagram showing a configuration of a parking support device and an in-vehicle device. 図2は、駐車経路を示す図である。FIG. 2 is a diagram showing a parking route. 図3は、駐車経路及び回避駐車経路を示す図である。FIG. 3 is a diagram showing a parking route and an avoidance parking route. 図4は、駐車経路に基づく中間位置を表示した表示画面を示す図である。FIG. 4 is a diagram showing a display screen displaying an intermediate position based on the parking route. 図5は、駐車経路及び回避駐車経路に基づく中間位置を表示した表示画面を示す図である。FIG. 5 is a diagram showing a display screen displaying an intermediate position based on the parking route and the avoidance parking route. 図6は、複数の撮影画像をピクチャインピクチャにより表示した表示画面を示す図である。FIG. 6 is a diagram showing a display screen in which a plurality of captured images are displayed by picture-in-picture. 図7は、駐車支援装置の動作を示すフローチャートである。FIG. 7 is a flowchart showing the operation of the parking support device.
 以下、添付図面を参照して本発明の実施形態について説明する。
 図1は、車両に搭載された車載装置3の構成を示す図である。以下では、車載装置3が搭載された車両を自車両1と表記する。
 車載装置3は、位置検出ユニット10、検出部20、操作部50、表示部60、車両制御ユニット70、操舵装置71、駆動装置73、制動装置75、変速装置77及び駐車支援装置100を備える。
Hereinafter, embodiments of the present invention will be described with reference to the accompanying drawings.
FIG. 1 is a diagram showing a configuration of an in-vehicle device 3 mounted on a vehicle. In the following, the vehicle equipped with the in-vehicle device 3 will be referred to as the own vehicle 1.
The in-vehicle device 3 includes a position detection unit 10, a detection unit 20, an operation unit 50, a display unit 60, a vehicle control unit 70, a steering device 71, a drive device 73, a braking device 75, a transmission 77, and a parking support device 100.
 位置検出ユニット10は、自車両1の現在位置を検出する。位置検出ユニット10は、GNSS(Global Navigation Satellite System)信号を受信するGNSS受信器と、GNSS受信器が受信したGNSS信号に基づいて自車両1の現在位置を演算するプロセッサと、を備える。GNSS受信器及びプロセッサの図示は省略する。位置検出ユニット10は、演算により求めた自車両1の現在位置を示す位置情報を駐車支援装置100に出力する。 The position detection unit 10 detects the current position of the own vehicle 1. The position detection unit 10 includes a GNSS receiver that receives a GNSS (Global Navigation Satellite System) signal, and a processor that calculates the current position of the own vehicle 1 based on the GNSS signal received by the GNSS receiver. Illustration of the GNSS receiver and processor is omitted. The position detection unit 10 outputs the position information indicating the current position of the own vehicle 1 obtained by calculation to the parking support device 100.
 検出部20は、自車両1の周囲に存在する障害物5(図3参照)を検出し、検出した障害物5と自車両1との距離を検出する1又は複数のセンサを備える。本実施形態の検出部20は、センサとして、撮影部30及びソナーユニット40を備える。本実施形態では、検出部20がカメラ及びソナーを備える場合について説明するが、検出部20が搭載可能なセンサは、カメラ及びソナーに限定されるものではない。例えば、電波や光等を利用して障害物5との間の距離を測定可能なレーダーやライダー(LiDAR:Laser Imaging Detection and Ranging)を検出部20に搭載してもよい。検出部20は、撮影部30の撮影画像や、ソナーユニット40のセンサ値を検出情報として駐車支援装置100に出力する。 The detection unit 20 includes one or a plurality of sensors that detect an obstacle 5 (see FIG. 3) existing around the own vehicle 1 and detect the distance between the detected obstacle 5 and the own vehicle 1. The detection unit 20 of the present embodiment includes a photographing unit 30 and a sonar unit 40 as sensors. In the present embodiment, the case where the detection unit 20 includes a camera and sonar will be described, but the sensor on which the detection unit 20 can be mounted is not limited to the camera and sonar. For example, a radar or lidar (LiDAR: Laser Imaging Detection and Ringing) capable of measuring the distance to the obstacle 5 using radio waves, light, or the like may be mounted on the detection unit 20. The detection unit 20 outputs the captured image of the photographing unit 30 and the sensor value of the sonar unit 40 to the parking support device 100 as detection information.
 撮影部30は、自車両1の前方を撮影するフロントカメラ31、自車両1の後方を撮影するリアカメラ33、自車両1の左側方を撮影する左サイドカメラ35、及び自車両1の右側方を撮影する右サイドカメラ37を備える。これらのカメラは、それぞれCCD(Charge-Coupled Device)やCMOS(Complementary Metal-Oxide-Semiconductor)等のイメージセンサと、イメージセンサの受光状態から撮影画像を生成するデータ処理回路とを備える。撮影部30は、4台のカメラにより車両1を中心に360°の範囲を撮影可能となるように画角が調整されている。フロントカメラ31、リアカメラ33、左サイドカメラ35及び右サイドカメラ37は、各々の撮影範囲を所定のフレームレートで撮影して撮影画像を生成する。撮影部30は、生成した撮影画像を駐車支援装置100に出力する。駐車支援装置100は、入力された撮影画像をメモリ110に一時的に記憶させる。 The photographing unit 30 includes a front camera 31 for photographing the front of the own vehicle 1, a rear camera 33 for photographing the rear of the own vehicle 1, a left side camera 35 for photographing the left side of the own vehicle 1, and the right side of the own vehicle 1. A right side camera 37 for photographing is provided. Each of these cameras includes an image sensor such as a CCD (Charge-Coupled Device) or a CMOS (Complementary Metal-Oxide-Semiconductor), and a data processing circuit that generates a captured image from the light receiving state of the image sensor. The angle of view of the photographing unit 30 is adjusted so that the four cameras can photograph a range of 360 ° around the vehicle 1. The front camera 31, the rear camera 33, the left side camera 35, and the right side camera 37 capture each shooting range at a predetermined frame rate to generate a shot image. The photographing unit 30 outputs the generated photographed image to the parking support device 100. The parking support device 100 temporarily stores the input captured image in the memory 110.
 ソナーユニット40は、前方、後方、左側方及び右側方等の自車両1の複数箇所に搭載され、超音波を用いて障害物5の大きさ、位置、及び障害物5までの距離を検出する。 The sonar unit 40 is mounted at a plurality of locations of the own vehicle 1 such as front, rear, left side, and right side, and detects the size, position, and distance to the obstacle 5 by using ultrasonic waves. ..
 操作部50は、自車両1に搭乗した乗員の操作を受け付ける受け付け部として機能する。操作部50は、受け付けた操作に対応した操作信号を駐車支援装置100に出力する。操作部50が受け付ける操作には、例えば、駐車支援の開始を指示する操作や、駐車支援を終了させる操作、表示部60に表示する撮影部30の撮影画像を変更する操作等が含まれる。 The operation unit 50 functions as a reception unit that receives the operation of the occupant on the own vehicle 1. The operation unit 50 outputs an operation signal corresponding to the received operation to the parking support device 100. The operations accepted by the operation unit 50 include, for example, an operation of instructing the start of the parking support, an operation of ending the parking support, an operation of changing the captured image of the photographing unit 30 displayed on the display unit 60, and the like.
 表示部60は、表示パネル61と、タッチセンサ63と、を備える。
 表示パネル61には、液晶ディスプレイや有機ELディスプレイ等が用いられる。表示部60は、駐車支援装置100から入力された表示データに基づく表示画像を表示パネル61に表示させる。タッチセンサ63は、抵抗膜方式や静電容量方式等の一般的に知られた方式のセンサが用いられる。表示部60は、表示パネル61に対する指のタッチ操作をタッチセンサ63により検出し、検出したタッチ操作の操作位置を示す位置信号を生成する。表示部60は、生成した位置信号を駐車支援装置100に出力する。
The display unit 60 includes a display panel 61 and a touch sensor 63.
A liquid crystal display, an organic EL display, or the like is used for the display panel 61. The display unit 60 causes the display panel 61 to display a display image based on the display data input from the parking support device 100. As the touch sensor 63, a generally known type of sensor such as a resistance film type or a capacitance type is used. The display unit 60 detects the touch operation of the finger on the display panel 61 by the touch sensor 63, and generates a position signal indicating the operation position of the detected touch operation. The display unit 60 outputs the generated position signal to the parking support device 100.
 車両制御ユニット70は、本発明の車両制御装置に相当し、自車両1に搭載された操舵装置71、駆動装置73、制動装置75及び変速装置77を制御するユニットである。車両制御ユニット70は、かかる制御を実行するコンピュータ(例えばECU(Electronic Control Unit))を備える。当該コンピュータは、CAN(Controller Area Network)等の車載ネットワークを介して操舵装置71、駆動装置73、制動装置75及び変速装置77に接続される。車両制御ユニット70は、駐車支援装置100から入力される制御情報に従って操舵装置71、駆動装置73、制動装置75及び変速装置77を制御する。これにより、自車両1が自動運転により走行する。 The vehicle control unit 70 corresponds to the vehicle control device of the present invention, and is a unit that controls the steering device 71, the drive device 73, the braking device 75, and the transmission device 77 mounted on the own vehicle 1. The vehicle control unit 70 includes a computer (for example, an ECU (Electronic Control Unit)) that executes such control. The computer is connected to the steering device 71, the driving device 73, the braking device 75, and the transmission device 77 via an in-vehicle network such as CAN (Controller Area Network). The vehicle control unit 70 controls the steering device 71, the drive device 73, the braking device 75, and the transmission device 77 according to the control information input from the parking support device 100. As a result, the own vehicle 1 travels by automatic driving.
 操舵装置71は、自車両1の操舵輪を操舵させるアクチュエータを含む装置である。
 駆動装置73は、自車両1の駆動輪の駆動力を調整するアクチュエータを含む装置である。このアクチュエータには、自車両1の動力源がエンジンである場合はスロットルアクチュエータが該当し、動力源がモータである場合には当該モータが該当する。
 制動装置75は、駐車支援装置100からの情報に基づいて、自車両1に設けられたブレーキシステムを制御し、自車両1の車輪へ付与する制動力を制御するアクチュエータを含む装置である。
 変速装置77は、変速機及びアクチュエータを含む装置である。変速装置77は、アクチュエータを駆動させて変速機のシフト位置を制御し、変速機の変速比や、自車両1の前進及び後進を切り替える。
The steering device 71 is a device including an actuator for steering the steering wheels of the own vehicle 1.
The drive device 73 is a device including an actuator that adjusts the driving force of the drive wheels of the own vehicle 1. This actuator corresponds to a throttle actuator when the power source of the own vehicle 1 is an engine, and corresponds to the motor when the power source is a motor.
The braking device 75 is a device including an actuator that controls the braking system provided in the own vehicle 1 based on the information from the parking support device 100 and controls the braking force applied to the wheels of the own vehicle 1.
The transmission 77 is a device including a transmission and an actuator. The transmission 77 drives an actuator to control the shift position of the transmission, and switches the gear ratio of the transmission and the forward and reverse movements of the own vehicle 1.
 駐車支援装置100は、CPU(Central Processing Unit)やMPU(Microprocessor Unit)等のプロセッサ130と、ROM(Read Only Memory)やRAM(Random Access Memory)等のメモリ110と、を備えるコンピュータである。駐車支援装置100は、これらの装置の他に、HDD(Hard Disk Drive)やSSD(Solid State Drive)等のストレージ装置や、センサ類や周辺機器等を接続するためのインターフェース回路、車載ネットワークを介して他の車載装置と通信する車載ネットワーク通信回路等を備える。駐車支援装置100は、メモリ110又はストレージ装置が記憶するコンピュータプログラムをプロセッサが実行することで各種の機能的構成を実現する。 The parking support device 100 is a computer including a processor 130 such as a CPU (Central Processing Unit) and an MPU (Microprocessor Unit), and a memory 110 such as a ROM (Read Only Memory) and a RAM (Random Access Memory). In addition to these devices, the parking support device 100 is provided via a storage device such as an HDD (Hard Disk Drive) or SSD (Solid State Drive), an interface circuit for connecting sensors, peripheral devices, and the like, and an in-vehicle network. It is equipped with an in-vehicle network communication circuit that communicates with other in-vehicle devices. The parking support device 100 realizes various functional configurations by executing a computer program stored in the memory 110 or the storage device by the processor.
 駐車支援装置100は、機能的構成として、位置取得部131、マップ生成部132、障害物検出部133、目標駐車位置設定部134、経路生成部135、走行制御部136、予測部137及び表示制御部138を備える。 The parking support device 100 has a position acquisition unit 131, a map generation unit 132, an obstacle detection unit 133, a target parking position setting unit 134, a route generation unit 135, a travel control unit 136, a prediction unit 137, and a display control as functional configurations. A unit 138 is provided.
 位置取得部131には、位置検出ユニット10により算出された自車両1の現在位置が位置情報として入力される。位置取得部131は、公知又は周知のデッドレコニングの手法を用いて、自車両1の現在位置を推定し、位置検出ユニット10から入力された自車両の現在位置を、推定結果に基づき補正する。 The current position of the own vehicle 1 calculated by the position detection unit 10 is input to the position acquisition unit 131 as position information. The position acquisition unit 131 estimates the current position of the own vehicle 1 by using a known or well-known dead reckoning method, and corrects the current position of the own vehicle input from the position detection unit 10 based on the estimation result.
 マップ生成部132は、自車両1の周囲に存在する障害物5や、自車両1の現在位置をローカル座標系に記録したマップデータを生成する。このマップデータは、メモリ110に生成される。障害物5は、自車両1の走行を阻害、或いは規制する適宜の物体である。障害物5の例として、例えば柱や壁等の建造物、自車両1が走行可能な走行領域と駐車領域とを区画するポールや地面の区画線、他車両、カート、歩行者等が挙げられる。
 また、マップ生成部132は、位置取得部131から逐次入力される自車両1の現在位置や、検出部20から逐次入力される障害物5の検出情報に基づき、マップデータの登録情報である自車両1の現在位置や、障害物5の位置や大きさを逐次更新する。
The map generation unit 132 generates map data in which the obstacles 5 existing around the own vehicle 1 and the current position of the own vehicle 1 are recorded in the local coordinate system. This map data is generated in the memory 110. The obstacle 5 is an appropriate object that hinders or regulates the running of the own vehicle 1. Examples of the obstacle 5 include structures such as pillars and walls, poles and ground division lines that divide the traveling area where the own vehicle 1 can travel and the parking area, other vehicles, carts, pedestrians, and the like. ..
Further, the map generation unit 132 is the registration information of the map data based on the current position of the own vehicle 1 sequentially input from the position acquisition unit 131 and the detection information of the obstacle 5 sequentially input from the detection unit 20. The current position of the vehicle 1 and the position and size of the obstacle 5 are sequentially updated.
 本実施形態では、マップ生成部132によりマップデータを生成する場合について説明するが、障害物5の位置が予め記録されたマップデータを駐車支援装置100が取得する構成であってもよい。例えば、駐車支援装置100がサーバ装置からマップデータをダウンロードしてもよいし、メモリ110に予め記憶させたマップデータを読み出してもよい。この場合、駐車支援装置100は、取得したマップデータに、位置取得部131から入力される自車両1の現在位置を記録してマップデータを生成する。 In the present embodiment, the case where the map data is generated by the map generation unit 132 will be described, but the parking support device 100 may acquire the map data in which the position of the obstacle 5 is recorded in advance. For example, the parking support device 100 may download the map data from the server device, or may read the map data stored in the memory 110 in advance. In this case, the parking support device 100 records the current position of the own vehicle 1 input from the position acquisition unit 131 in the acquired map data to generate the map data.
 障害物検出部133は、自車両1の周囲に存在する障害物5を検出する。
 障害物検出部133は、マップ生成部132が生成したマップデータに基づいて、自車両1の周囲に存在する障害物5を検出する。例えば、障害物検出部133は、自車両1との距離が、予め設定された第1設定距離以下の障害物5を検出する。障害物検出部133が検出する障害物5は、自車両1を駐車経路R1に沿って走行させた場合に、自車両1の走行の障害となり得る候補の物体である。
The obstacle detection unit 133 detects obstacles 5 existing around the own vehicle 1.
The obstacle detection unit 133 detects obstacles 5 existing around the own vehicle 1 based on the map data generated by the map generation unit 132. For example, the obstacle detection unit 133 detects an obstacle 5 whose distance from the own vehicle 1 is equal to or less than a preset first set distance. The obstacle 5 detected by the obstacle detection unit 133 is a candidate object that can be an obstacle to the traveling of the own vehicle 1 when the own vehicle 1 is traveled along the parking route R1.
 目標駐車位置設定部134は、自車両1を駐車させる位置である目標駐車位置を設定する。目標駐車位置設定部134は、マップ生成部132が生成したマップデータや、撮影部30の撮影画像、ソナーユニット40のセンサ値に基づき、自車両1を駐車させる目標駐車位置を設定する。例えば、目標駐車位置設定部134は、撮影部30の撮影画像から路面に引かれた白線等の駐車枠線を検出する。目標駐車位置設定部134は、駐車枠線の検出結果と、マップデータとに基づいて他車両が駐車していない駐車領域を検出し、検出した駐車領域内に目標駐車位置を設定する。 The target parking position setting unit 134 sets the target parking position, which is the position where the own vehicle 1 is parked. The target parking position setting unit 134 sets the target parking position for parking the own vehicle 1 based on the map data generated by the map generation unit 132, the captured image of the photographing unit 30, and the sensor value of the sonar unit 40. For example, the target parking position setting unit 134 detects a parking frame line such as a white line drawn on the road surface from the captured image of the photographing unit 30. The target parking position setting unit 134 detects a parking area in which no other vehicle is parked based on the detection result of the parking frame line and the map data, and sets the target parking position in the detected parking area.
 経路生成部135は、駐車経路を生成する。経路生成部135は、マップ生成部132が生成したマップデータに基づき、障害物5と接触せずに自車両1を目標駐車位置に駐車させるための駐車経路を生成する。以下では、駐車支援の開始後、経路生成部135が最初に生成する駐車経路を駐車経路R1と表記する。経路生成部135は、生成した駐車経路R1を走行制御部136に出力する。 The route generation unit 135 generates a parking route. The route generation unit 135 generates a parking route for parking the own vehicle 1 at the target parking position without contacting the obstacle 5 based on the map data generated by the map generation unit 132. In the following, the parking route first generated by the route generation unit 135 after the start of parking support will be referred to as a parking route R1. The route generation unit 135 outputs the generated parking route R1 to the travel control unit 136.
 図2は、駐車経路R1の一例を示す図である。
 経路生成部135が生成する駐車経路R1には、自車両1が経路に沿った走行を開始した後、自車両1を一旦停車させて自車両1の進行方向を変更する経路が含まれる場合がある。進行方向の変更には、自車両1の進行方向を前進から後進に変更する場合と、後進から前進に変更する場合とが含まれる。以下、進行方向の変更のため、自車両1を一旦停車させる位置を中間位置という。中間位置には、自車両1が左折する位置、自車両1が右折する位置等を含めてもよい。
FIG. 2 is a diagram showing an example of the parking route R1.
The parking route R1 generated by the route generation unit 135 may include a route for changing the traveling direction of the own vehicle 1 by temporarily stopping the own vehicle 1 after the own vehicle 1 starts traveling along the route. be. The change in the traveling direction includes a case where the traveling direction of the own vehicle 1 is changed from forward to reverse and a case where the traveling direction is changed from reverse to forward. Hereinafter, the position where the own vehicle 1 is temporarily stopped in order to change the traveling direction is referred to as an intermediate position. The intermediate position may include a position where the own vehicle 1 turns left, a position where the own vehicle 1 turns right, and the like.
 例えば、駐車経路R1が、図2に示す経路R11及び経路R12により構成されると仮定する。経路R11は、自車両1を前進により走行させる区間であり、経路R12は、自車両1を後進により走行させる区間である。 For example, it is assumed that the parking route R1 is composed of the route R11 and the route R12 shown in FIG. The route R11 is a section in which the own vehicle 1 travels forward, and the route R12 is a section in which the own vehicle 1 travels backward.
 また、駐車経路R1には、P1、P2及びP3の3つの位置が含まれる。
 P1は、自車両1の現在位置に相当し、P2は、中間位置に相当し、P3は、目標駐車位置に相当する。以下、P1を現在位置P1と表記し、P2を第1中間位置P2と表記し、P3を目標駐車位置P3と表記する。自車両1は、現在位置P1をスタートし、経路R11に沿って前進走行により移動する。自車両1は、第1中間位置P2に到達すると一旦停車し、進行方向を前進から後進に切り替える。その後、自車両1は、経路R12に沿って後進走行し、目標駐車位置P3に駐車する。
Further, the parking route R1 includes three positions P1, P2 and P3.
P1 corresponds to the current position of the own vehicle 1, P2 corresponds to the intermediate position, and P3 corresponds to the target parking position. Hereinafter, P1 will be referred to as the current position P1, P2 will be referred to as the first intermediate position P2, and P3 will be referred to as the target parking position P3. The own vehicle 1 starts at the current position P1 and moves forward along the route R11. When the own vehicle 1 reaches the first intermediate position P2, it stops once and switches the traveling direction from forward to reverse. After that, the own vehicle 1 travels backward along the route R12 and parks at the target parking position P3.
 走行制御部136は、経路生成部135が生成した駐車経路R1に基づいて自車両1の走行を制御する制御情報を生成する。この制御情報は、駐車経路R1に沿って自車両1を走行させるための情報であり、操舵、駆動、制動及び変速をそれぞれ制御する情報が含まれる。 The travel control unit 136 generates control information for controlling the travel of the own vehicle 1 based on the parking route R1 generated by the route generation unit 135. This control information is information for driving the own vehicle 1 along the parking path R1, and includes information for controlling steering, driving, braking, and shifting, respectively.
 予測部137は、自車両1が駐車経路R1に従った走行を開始した後、障害物検出部133が検出した障害物5との距離を予測する。例えば、予測部137は、自車両1の現在位置に基づいてマップデータ上に仮想車両7を設定して、障害物検出部133が検出した障害物5と、仮想車両7との距離を判例する。予測部137は、駐車経路R1に従った進行方向の前方であって、自車両1から所定距離の位置に仮想車両7(図3参照)を設定する。予測部137は、この設定した仮想車両7が障害物5に接触や衝突を判定することで、自車両1と障害物5との距離を予測する。仮想車両7は、自車両1を仮想的に設定したものであり、自車両1が前進する場合、予測部137は、自車両1の前方に仮想車両7を設定し、自車両1が後進する場合、自車両1の後方に仮想車両7を設定する。仮想車両7の長さ方向及び幅方向のサイズは、自車両1の長さ方向及び幅方向のサイズに一致する。また、仮想車両7の位置は、自車両1の走行により移動する。 The prediction unit 137 predicts the distance to the obstacle 5 detected by the obstacle detection unit 133 after the own vehicle 1 starts traveling along the parking route R1. For example, the prediction unit 137 sets the virtual vehicle 7 on the map data based on the current position of the own vehicle 1, and determines the distance between the obstacle 5 detected by the obstacle detection unit 133 and the virtual vehicle 7. .. The prediction unit 137 sets the virtual vehicle 7 (see FIG. 3) at a position at a predetermined distance from the own vehicle 1 in front of the vehicle in the traveling direction according to the parking route R1. The prediction unit 137 predicts the distance between the own vehicle 1 and the obstacle 5 by determining the contact or collision of the set virtual vehicle 7 with the obstacle 5. The virtual vehicle 7 virtually sets the own vehicle 1, and when the own vehicle 1 moves forward, the prediction unit 137 sets the virtual vehicle 7 in front of the own vehicle 1 and the own vehicle 1 moves backward. In this case, the virtual vehicle 7 is set behind the own vehicle 1. The size in the length direction and the width direction of the virtual vehicle 7 matches the size in the length direction and the width direction of the own vehicle 1. Further, the position of the virtual vehicle 7 moves as the own vehicle 1 travels.
 まず、予測部137は、検出部20が検出する障害物5の検出精度が一定の確度以上であるか否かを判定する。検出部20の検出精度は、障害物5との距離が近くなるほど、精度が高くなる。例えば、障害物5が検出部20の撮影画像に撮影されていても、自車両1と障害物5との距離が離れていると、障害物5として認識されない場合がある。また、ソナーユニット40のセンサ値は、障害物5との距離が近くなるほど、その検出精度は高くなる。例えば、第1中間位置P2に障害物5が存在していると仮定した場合、現在位置P1で検出した障害物5の大きさや位置と、第1中間位置P2の近くで検出した障害物5の大きさや位置とが異なる場合がある。このため、予測部137は、障害物検出部133が検出した障害物5との距離が、第2設定距離以下であった場合、検出部20により検出された障害物5の位置や大きさは、一定の確度以上の精度を有する情報であると判定する。第2設定距離は、第1設定距離よりも短い距離である。 First, the prediction unit 137 determines whether or not the detection accuracy of the obstacle 5 detected by the detection unit 20 is equal to or higher than a certain accuracy. The detection accuracy of the detection unit 20 becomes higher as the distance from the obstacle 5 becomes closer. For example, even if the obstacle 5 is captured in the captured image of the detection unit 20, if the own vehicle 1 and the obstacle 5 are far apart, the obstacle 5 may not be recognized as the obstacle 5. Further, the sensor value of the sonar unit 40 becomes higher in detection accuracy as the distance from the obstacle 5 becomes closer. For example, assuming that the obstacle 5 exists at the first intermediate position P2, the size and position of the obstacle 5 detected at the current position P1 and the obstacle 5 detected near the first intermediate position P2. The size and position may differ. Therefore, when the distance to the obstacle 5 detected by the obstacle detection unit 133 is equal to or less than the second set distance, the prediction unit 137 determines the position and size of the obstacle 5 detected by the detection unit 20. , It is determined that the information has an accuracy of a certain degree or more. The second set distance is a distance shorter than the first set distance.
 次に、予測部137は、障害物5の検出精度が一定の確度以上である場合、仮想車両7と障害物5との距離が、第3設定距離以下であるか否かを判定する。第3設定距離は、第2設定距離よりも短い距離に設定されている。例えば、第3設定距離は、仮想車両7と障害物5とが衝突又は接触すると判定される距離である0cmに設定してもよい。また、第2設定距離は、自車両1に搭乗した乗員に、自車両1が障害物5に接触するのではとの不安感を与える距離、例えば、50cm以下等に設定してもよい。第3設定距離は、本発明の所定距離に相当する。 Next, when the detection accuracy of the obstacle 5 is equal to or higher than a certain accuracy, the prediction unit 137 determines whether or not the distance between the virtual vehicle 7 and the obstacle 5 is equal to or less than the third set distance. The third set distance is set to a distance shorter than the second set distance. For example, the third set distance may be set to 0 cm, which is the distance at which the virtual vehicle 7 and the obstacle 5 are determined to collide or come into contact with each other. Further, the second set distance may be set to a distance that gives the occupants on the own vehicle 1 anxiety that the own vehicle 1 may come into contact with the obstacle 5, for example, 50 cm or less. The third set distance corresponds to the predetermined distance of the present invention.
 予測部137は、仮想車両7と、障害物5との距離が第3設定距離以下であると判定すると、経路生成部135に駐車経路の再生成を指示する。経路生成部135が予測部137の指示により生成する駐車経路を、回避駐車経路R2という。 When the prediction unit 137 determines that the distance between the virtual vehicle 7 and the obstacle 5 is equal to or less than the third set distance, the prediction unit 137 instructs the route generation unit 135 to regenerate the parking route. The parking route generated by the route generation unit 135 according to the instruction of the prediction unit 137 is referred to as an avoidance parking route R2.
 図3は、駐車経路R1及び回避駐車経路R2を示す図である。
 図3に破線で示す駐車経路R1は、図2と同様に、経路R11及び経路R12により構成される。また、図3に示す駐車経路R1には、図2と同様に、現在位置P1、第1中間位置P2及び目標駐車位置P3が含まれる。
 自車両1が、図3に示す位置P5に移動したときに、予測部137により、障害物5と仮想車両7との距離が第3設定距離以下であると判定されたと仮定する。図3には、自車両1の位置が現在位置P1である場合の仮想車両7の位置を破線で示す。また、図3には、第1中間位置P2の直前に、障害物5であるカートが存在している場合を示す。予測部137は、位置P5において、仮想車両7と、障害物5との距離が第3設定距離以下であると判定し、自車両1の走行を継続させたまま、経路生成部135に回避駐車経路R2の生成を指示する。
FIG. 3 is a diagram showing a parking route R1 and an avoidance parking route R2.
The parking route R1 shown by a broken line in FIG. 3 is composed of a route R11 and a route R12 as in FIG. 2. Further, the parking route R1 shown in FIG. 3 includes a current position P1, a first intermediate position P2, and a target parking position P3, as in FIG.
It is assumed that when the own vehicle 1 moves to the position P5 shown in FIG. 3, the prediction unit 137 determines that the distance between the obstacle 5 and the virtual vehicle 7 is equal to or less than the third set distance. In FIG. 3, the position of the virtual vehicle 7 when the position of the own vehicle 1 is the current position P1 is shown by a broken line. Further, FIG. 3 shows a case where a cart which is an obstacle 5 exists immediately before the first intermediate position P2. The prediction unit 137 determines that the distance between the virtual vehicle 7 and the obstacle 5 is equal to or less than the third set distance at the position P5, and avoids parking in the route generation unit 135 while continuing the traveling of the own vehicle 1. Instructs the generation of path R2.
 経路生成部135は、予測部137の指示により、駐車経路R1とは経路が異なる回避駐車経路R2を生成する。経路生成部135は、駐車経路R1上に経路の始点を有し、目標駐車位置P3まで移動可能な回避駐車経路R2を生成する。また、回避駐車経路R2は、自車両1の位置において、自車両1を回避駐車経路R2に沿って走行させても、障害物5との距離が第3設定距離よりも離れた経路である。回避駐車経路R2の始点となる位置は、自車両1の現在位置である位置P1と、仮想車両7と障害物5との距離が第2設定距離以下となる位置との間の駐車経路R1上に設定される。例えば、第2設定距離が0cmである場合、仮想車両7と障害物5との距離が第2設定距離以下となる位置とは、障害物5が検出された位置である。 The route generation unit 135 generates an avoidance parking route R2 whose route is different from that of the parking route R1 according to the instruction of the prediction unit 137. The route generation unit 135 generates an avoidance parking route R2 that has a start point of the route on the parking route R1 and can move to the target parking position P3. Further, the avoidance parking route R2 is a route in which the distance to the obstacle 5 is longer than the third set distance even if the own vehicle 1 is driven along the avoidance parking route R2 at the position of the own vehicle 1. The starting point of the avoidance parking route R2 is on the parking route R1 between the current position P1 of the own vehicle 1 and the position where the distance between the virtual vehicle 7 and the obstacle 5 is equal to or less than the second set distance. Is set to. For example, when the second set distance is 0 cm, the position where the distance between the virtual vehicle 7 and the obstacle 5 is equal to or less than the second set distance is the position where the obstacle 5 is detected.
 また、経路生成部135は、回避駐車経路R2を生成する場合に、自車両1の進行方向を前進から後進、又は後進から前進に変更する変更回数と、回避駐車経路R2の走行距離とに基づいて、回避駐車経路R2を生成する。経路生成部135は、進行方向の変更回数が少なく、かつ走行距離が短い経路を回避駐車経路R2として生成する。また、経路生成部135は、進行方向の変更回数と、走行距離とに優先度を設定して回避駐車経路R2を生成してもよい。例えば、走行距離が、進行方向の変更回数よりも優先度が高く設定されていると仮定する。また、経路生成部135が、回避駐車経路R2の候補として経路Aと、経路Bとの2つの経路を生成したと仮定する。この場合、経路生成部135は、優先度の高い経路Aと経路Bとの走行距離の差に基づいて回避駐車経路R2を選択するが、経路Aと経路Bとの走行距離の差が予めされた距離以下である場合に、進行方向の変更回数に基づいて経路Aと経路Bとのいずれか一方を回避駐車経路R2として選択してもよい。 Further, the route generation unit 135 is based on the number of changes in which the traveling direction of the own vehicle 1 is changed from forward to reverse or backward to forward when generating the avoidance parking route R2, and the mileage of the avoidance parking route R2. Then, the avoidance parking route R2 is generated. The route generation unit 135 generates a route having a small number of changes in the traveling direction and a short mileage as an avoidance parking route R2. Further, the route generation unit 135 may generate the avoidance parking route R2 by setting priorities for the number of changes in the traveling direction and the mileage. For example, it is assumed that the mileage is set to have a higher priority than the number of changes in the traveling direction. Further, it is assumed that the route generation unit 135 has generated two routes, route A and route B, as candidates for the avoidance parking route R2. In this case, the route generation unit 135 selects the avoidance parking route R2 based on the difference in the mileage between the high-priority route A and the route B, but the difference in the mileage between the route A and the route B is predetermined. When the distance is less than or equal to the distance, either one of the route A and the route B may be selected as the avoidance parking route R2 based on the number of changes in the traveling direction.
 図3に示す経路R21及び経路R22により構成される経路が回避駐車経路R2であると仮定する。図3に示す回避駐車経路R2は、位置P6が回避駐車経路R2の始点位置であり、位置P7が回避駐車経路R2の中間位置に相当する。以下、位置P6を始点位置P6と表記し、位置P7を第2中間位置P7と表記する。経路生成部135は、生成した回避駐車経路R2を、走行制御部136に出力する。 It is assumed that the route composed of the route R21 and the route R22 shown in FIG. 3 is the avoidance parking route R2. In the avoidance parking route R2 shown in FIG. 3, the position P6 is the starting point position of the avoidance parking route R2, and the position P7 corresponds to the intermediate position of the avoidance parking route R2. Hereinafter, the position P6 is referred to as a start point position P6, and the position P7 is referred to as a second intermediate position P7. The route generation unit 135 outputs the generated avoidance parking route R2 to the travel control unit 136.
 走行制御部136は、自車両1の現在位置が、回避駐車経路R2の始点位置P6に一致すると、車両制御ユニット70に、自車両1を停車させる。走行制御部136は、自車両1が停車すると、回避駐車経路R2に基づいて制御情報を生成する。走行制御部136は、生成した制御情報を車両制御ユニット70に出力する。これにより、自車両1は、回避駐車経路R2に沿った自動走行を開始する。 When the current position of the own vehicle 1 matches the start point position P6 of the avoidance parking route R2, the travel control unit 136 causes the vehicle control unit 70 to stop the own vehicle 1. When the own vehicle 1 stops, the travel control unit 136 generates control information based on the avoidance parking route R2. The travel control unit 136 outputs the generated control information to the vehicle control unit 70. As a result, the own vehicle 1 starts automatic traveling along the avoidance parking route R2.
 駐車支援装置100は、自車両1が目標駐車位置P3に到達するまで、障害物検出部133による障害物5の検出と、検出した障害物5と仮想車両7との距離の判定と、を継続する。駐車支援装置100は、障害物5が検出され、検出された障害物5と仮想車両7との距離が第3設定距離以下であると判定した場合、障害物5との距離が第3設定距離よりも大きい回避駐車経路R2を再度、生成する。そして、駐車支援装置100は、生成した回避駐車経路R2に従った走行を、自車両1が目標駐車位置P3に到達するまで継続する。 The parking support device 100 continues to detect the obstacle 5 by the obstacle detection unit 133 and determine the distance between the detected obstacle 5 and the virtual vehicle 7 until the own vehicle 1 reaches the target parking position P3. do. When the parking support device 100 detects an obstacle 5 and determines that the distance between the detected obstacle 5 and the virtual vehicle 7 is equal to or less than the third set distance, the distance to the obstacle 5 is the third set distance. The larger avoidance parking route R2 is generated again. Then, the parking support device 100 continues traveling according to the generated avoidance parking route R2 until the own vehicle 1 reaches the target parking position P3.
 表示制御部138は、表示パネル61に表示させる表示データを生成し、生成した表示データを表示部60に出力する。表示部60は、入力された表示データに基づく表示画面300を生成し、生成した表示画面300を表示パネル61に表示させる。 The display control unit 138 generates display data to be displayed on the display panel 61, and outputs the generated display data to the display unit 60. The display unit 60 generates a display screen 300 based on the input display data, and displays the generated display screen 300 on the display panel 61.
 図4及び図5は、表示パネル61に表示される表示画面300を示す図である。特に、図4は、自車両1が駐車経路R1に従って走行している場合の表示画面300を示す図である。表示画面300には、第1表示画面310及び第2表示画面320が含まれる。 4 and 5 are views showing a display screen 300 displayed on the display panel 61. In particular, FIG. 4 is a diagram showing a display screen 300 when the own vehicle 1 is traveling along the parking route R1. The display screen 300 includes a first display screen 310 and a second display screen 320.
 第1表示画面310には、自車両1を上方から撮影した俯瞰画像315が表示される。俯瞰画像315は、フロントカメラ31、リアカメラ33、左サイドカメラ35及び右サイドカメラ37の撮影画像を合成して生成される画像である。この俯瞰画像315には、第1中間位置P2に対応した停車位置を示す停車位置画像210aが実線で表示される。また、俯瞰画像315には、目標駐車位置P3を示す駐車位置画像220が表示される。また、図4に示す俯瞰画像315には、停車位置画像210a内に障害物5が存在する状態が示されている。 On the first display screen 310, a bird's-eye view image 315 of the own vehicle 1 taken from above is displayed. The bird's-eye view image 315 is an image generated by synthesizing the captured images of the front camera 31, the rear camera 33, the left side camera 35, and the right side camera 37. In the bird's-eye view image 315, a stop position image 210a showing a stop position corresponding to the first intermediate position P2 is displayed as a solid line. Further, the bird's-eye view image 315 displays a parking position image 220 showing the target parking position P3. Further, the bird's-eye view image 315 shown in FIG. 4 shows a state in which the obstacle 5 exists in the stop position image 210a.
 第2表示画面320には、第1子画面330と、第2子画面340とが表示される。第1子画面330には、自車両1の進行方向を撮影したカメラの撮影画像が表示される。図4には、フロントカメラ31の撮影画像が表示された第1子画面330を示す。また、第1子画面330には、予測進路線331、333が表示される。予測進路線331、333は、表示制御部138の制御により表示される画像であり、自車両1の操舵輪の操舵角が、現在の操舵角である場合の自車両1の進行方向を示す画像である。また、第1子画面330に表示された撮影画像にも、障害物5が撮影された状態を示す。 The first child screen 330 and the second child screen 340 are displayed on the second display screen 320. On the first sub-screen 330, a photographed image of the camera that captures the traveling direction of the own vehicle 1 is displayed. FIG. 4 shows a first sub-screen 330 on which the captured image of the front camera 31 is displayed. Further, the predicted advance routes 331 and 333 are displayed on the first child screen 330. Predicted travel routes 331 and 333 are images displayed under the control of the display control unit 138, and are images showing the traveling direction of the own vehicle 1 when the steering angle of the steering wheel of the own vehicle 1 is the current steering angle. Is. In addition, the captured image displayed on the first child screen 330 also shows the captured state of the obstacle 5.
 第2子画面340には、アイコン345が表示される。アイコン345は、第1子画面330に表示された撮影画像を撮影したカメラの自車両1における位置を示す。図4には、アイコン345として、自車両1の前方を撮影するフロントカメラ31の撮影範囲を示すアイコン345Aが表示された状態を示す。 The icon 345 is displayed on the second child screen 340. The icon 345 indicates the position of the camera that captured the captured image displayed on the first sub screen 330 in the own vehicle 1. FIG. 4 shows a state in which the icon 345A indicating the shooting range of the front camera 31 that shoots the front of the own vehicle 1 is displayed as the icon 345.
 第2表示画面320には、この他に、キャンセルボタン360が表示される。乗員がこのキャンセルボタン360を押下することで、駐車支援装置100による駐車支援が中止される。 In addition to this, the cancel button 360 is displayed on the second display screen 320. When the occupant presses the cancel button 360, the parking support by the parking support device 100 is stopped.
 図5は、表示パネル61に表示される表示画面300を示す図である。特に、図5は、障害物5が検出され、駐車経路を駐車経路R1から回避駐車経路R2に変更した場合の表示画面300を示す図である。この表示画面300にも、第1表示画面310と第2表示画面320とが含まれる。 FIG. 5 is a diagram showing a display screen 300 displayed on the display panel 61. In particular, FIG. 5 is a diagram showing a display screen 300 when an obstacle 5 is detected and the parking route is changed from the parking route R1 to the avoidance parking route R2. The display screen 300 also includes a first display screen 310 and a second display screen 320.
 駐車経路が駐車経路R1から回避駐車経路R2に変更された場合、第1表示画面310には、停車位置画像210aに加えて停車位置画像210bが表示される。
 停車位置画像210aは、駐車経路R1に含まれる第1中間位置P2を示す画像である。停車位置画像210bは、回避駐車経路R2に含まれる第2中間位置P7を示す画像である。
When the parking route is changed from the parking route R1 to the avoidance parking route R2, the stop position image 210b is displayed on the first display screen 310 in addition to the stop position image 210a.
The stop position image 210a is an image showing the first intermediate position P2 included in the parking path R1. The stop position image 210b is an image showing the second intermediate position P7 included in the avoidance parking route R2.
 表示制御部138は、停車位置画像210a及び停車位置画像210bを第1表示画面310に表示させる場合、停車位置画像210aと停車位置画像210bとを異なる表示態様で表示させる。例えば、停車位置画像210aを破線で表示し、停車位置画像210bを実線で表示してもよい。
 また、表示制御部138は、停車位置画像210aと停車位置画像210bとの表示色を変更してもよい。例えば、表示制御部138は、停車位置画像210aを黒等の暗い色で表示し、停車位置画像210bを赤等の明るい色で表示する。また、表示制御部138は、停車位置画像210aと停車位置画像210bとの輝度を変更してもよい。表示制御部138は、停車位置画像210bの輝度を、停車位置画像210aの輝度よりも高く表示させる。また、表示制御部138は、停車位置画像210bの表示を点灯又は点滅させてもよい。
When the display control unit 138 displays the stop position image 210a and the stop position image 210b on the first display screen 310, the display control unit 138 displays the stop position image 210a and the stop position image 210b in different display modes. For example, the stop position image 210a may be displayed by a broken line, and the stop position image 210b may be displayed by a solid line.
Further, the display control unit 138 may change the display color of the stop position image 210a and the stop position image 210b. For example, the display control unit 138 displays the stop position image 210a in a dark color such as black, and displays the stop position image 210b in a bright color such as red. Further, the display control unit 138 may change the brightness of the stop position image 210a and the stop position image 210b. The display control unit 138 displays the brightness of the stop position image 210b higher than the brightness of the stop position image 210a. Further, the display control unit 138 may turn on or blink the display of the stop position image 210b.
 第1子画面330には、撮影画像における障害物5の位置を示す枠画像335が表示される。表示制御部175は、撮影画像における障害物5の位置を検出し、検出した障害物5の範囲を示す枠画像335を、障害物5の周囲に表示させる。枠画像335を表示させる障害物5は、仮想車両7との距離が第3設定距離以下となると判定された障害物5であり、仮想車両7と接触する可能性のない障害物5の周囲を枠画像335により表示させることはない。 On the first sub screen 330, a frame image 335 showing the position of the obstacle 5 in the captured image is displayed. The display control unit 175 detects the position of the obstacle 5 in the captured image, and displays a frame image 335 showing the range of the detected obstacle 5 around the obstacle 5. The obstacle 5 for displaying the frame image 335 is an obstacle 5 whose distance to the virtual vehicle 7 is determined to be equal to or less than the third set distance, and is around the obstacle 5 which is unlikely to come into contact with the virtual vehicle 7. It is not displayed by the frame image 335.
 また、第2表示画面320には、案内表示370が表示される。この案内表示370には、自車両1との接触が予測される障害物5が検出されたため、駐車経路を駐車経路R1から回避駐車経路R2に変更したことを示す案内が表示される。また、案内表示370として、中間位置、すなわち自車両1を停車させる停車位置が変更されたことを示す案内を表示してもよい。 In addition, the guidance display 370 is displayed on the second display screen 320. On the guidance display 370, a guidance indicating that the parking route has been changed from the parking route R1 to the avoidance parking route R2 is displayed because the obstacle 5 that is predicted to come into contact with the own vehicle 1 is detected. Further, as the guidance display 370, a guidance indicating that the intermediate position, that is, the stop position at which the own vehicle 1 is stopped has been changed may be displayed.
 表示制御部138が第2表示画面320に案内表示370を表示させる以外の動作として、仮想車両7との距離が第3設定距離以下となる障害物5が検出された場合、又は駐車経路が駐車経路R1から回避駐車経路R2に変更された場合に、自車両1に搭載されたスピーカから予め設定された音声を出力することで報知動作を行ってもよい。例えば、駐車経路が変更されたことを通知する音声案内をスピーカから出力してもよい。 As an operation other than displaying the guidance display 370 on the second display screen 320 by the display control unit 138, when an obstacle 5 whose distance to the virtual vehicle 7 is equal to or less than the third set distance is detected, or the parking route is parked. When the route R1 is changed to the avoidance parking route R2, the notification operation may be performed by outputting a preset voice from the speaker mounted on the own vehicle 1. For example, a voice guidance notifying that the parking route has been changed may be output from the speaker.
 図6は、表示パネル61に表示される表示画面300を示す図である。特に、図6は、駐車経路が駐車経路R1から回避駐車経路R2に変更され、第1子画面330に表示される撮影画像が変更された場合を示す図である。
 図6は、駐車経路の駐車経路R1から回避駐車経路R2への変更により、第2中間位置P7が、自車両1の前方から右前方に変更され、第1子画面330に、フロントカメラ31の撮影画像に加え、右サイドカメラ37の撮影画像を表示させた場合を示す。この場合、表示制御部138は、フロントカメラ31の撮影画像を第1子画面330から消去せずに、第1子画面330に、フロントカメラ31の撮影画像と、右サイドカメラ37の撮影画像とをピクチャインピクチャで表示させる。図6には、フロントカメラ31の撮影画像を表示させた第1子画面330の中に、右サイドカメラ37の撮影画像を表示した孫画面380を表示させた例を示す。表示制御部139は、最初に第1子画面330に表示させた撮影画像中に、後から表示させる撮影画像が表示されるようにピクチャインピクチャ画像を生成する。
FIG. 6 is a diagram showing a display screen 300 displayed on the display panel 61. In particular, FIG. 6 is a diagram showing a case where the parking route is changed from the parking route R1 to the avoidance parking route R2 and the captured image displayed on the first sub screen 330 is changed.
In FIG. 6, the second intermediate position P7 is changed from the front of the own vehicle 1 to the right front by changing the parking route R1 to the avoidance parking route R2, and the front camera 31 is displayed on the first child screen 330. The case where the photographed image of the right side camera 37 is displayed in addition to the captured image is shown. In this case, the display control unit 138 displays the captured image of the front camera 31 and the captured image of the right side camera 37 on the first sub screen 330 without erasing the captured image of the front camera 31 from the first sub screen 330. Is displayed as a picture-in-picture. FIG. 6 shows an example in which the grandchild screen 380 displaying the captured image of the right side camera 37 is displayed in the first sub screen 330 displaying the captured image of the front camera 31. The display control unit 139 generates a picture-in-picture image so that the photographed image to be displayed later is displayed in the photographed image first displayed on the first child screen 330.
 また、第2子画面340に表示されるアイコン345が、アイコン345Aからアイコン345Bに変更される。図6に示すアイコン345Bは、自車両1の前方を撮影するフロントカメラ31の撮影範囲と、自車両1の右側方を撮影する右サイドカメラ37の撮影範囲とを示すアイコンである。 Also, the icon 345 displayed on the second child screen 340 is changed from the icon 345A to the icon 345B. The icon 345B shown in FIG. 6 is an icon indicating a shooting range of the front camera 31 that shoots the front of the own vehicle 1 and a shooting range of the right side camera 37 that shoots the right side of the own vehicle 1.
 図7は、駐車支援装置100の動作を示すフローチャートである。
 図7に示すフローチャートを参照しながら駐車支援装置100の動作について説明する。
 駐車支援装置100は、駐車支援を開始させる開始操作を操作部50により受け付けたか否かを判定する(ステップS1)。駐車支援装置100は、開始操作を受け付けていない場合(ステップS1/NO)、開始操作を受け付けるまで待機する。
FIG. 7 is a flowchart showing the operation of the parking support device 100.
The operation of the parking support device 100 will be described with reference to the flowchart shown in FIG. 7.
The parking support device 100 determines whether or not the operation unit 50 has accepted the start operation for starting the parking support (step S1). When the parking support device 100 does not accept the start operation (step S1 / NO), the parking support device 100 waits until the start operation is accepted.
 駐車支援装置100は、開始操作を受け付けた場合(ステップS1/YES)、まず、撮影部30の撮影画像や、ソナーユニット40のセンサ値を検出情報として取得する(ステップS2)。駐車支援装置100は、取得した撮影画像を解析した解析結果や、ソナーユニット40のセンサ値に基づき、自車両1の現在位置や、障害物5の位置等が記録されたマップデータを生成する(ステップS3)。ステップS2及びS3は、本発明の検出ステップに相当する。 When the parking support device 100 accepts the start operation (step S1 / YES), first, the photographed image of the photographing unit 30 and the sensor value of the sonar unit 40 are acquired as detection information (step S2). The parking support device 100 generates map data in which the current position of the own vehicle 1, the position of the obstacle 5, and the like are recorded based on the analysis result obtained by analyzing the acquired captured image and the sensor value of the sonar unit 40 (). Step S3). Steps S2 and S3 correspond to the detection steps of the present invention.
 次に、駐車支援装置100は、生成したマップデータに基づいて駐車経路R1を生成する(ステップS4)。ステップS4は、本発明の生成ステップに相当する。駐車支援装置100は、撮影画像を解析して駐車枠線を検出し、駐車枠線の検出結果と、マップデータとに基づいて他車両が駐車していない駐車領域を検出し、検出した駐車領域内に目標駐車位置を設定する。さらに、駐車支援装置100は、検出した他車両が駐車していない駐車領域を目標駐車位置に設定し、障害物5と接触せずに自車両1を目標駐車位置に駐車させるための駐車経路R1を生成する(ステップS4)。 Next, the parking support device 100 generates a parking route R1 based on the generated map data (step S4). Step S4 corresponds to the generation step of the present invention. The parking support device 100 analyzes the captured image to detect the parking frame line, detects the parking area in which no other vehicle is parked based on the detection result of the parking frame line and the map data, and detects the parking area. Set the target parking position within. Further, the parking support device 100 sets a parking area in which the detected other vehicle is not parked at the target parking position, and parks the own vehicle 1 at the target parking position without contacting the obstacle 5. Is generated (step S4).
 次に、駐車支援装置100は、図4に示す表示画面300を表示部60に表示させる(ステップS5)。表示画面300には、第1表示画面310及び第2表示画面320が含まれる。第1表示画面310には、第1中間位置P2に自車両1を停車させるときの自車両1の停車位置を示す停車位置画像210aが実線で表示される。 Next, the parking support device 100 causes the display unit 60 to display the display screen 300 shown in FIG. 4 (step S5). The display screen 300 includes a first display screen 310 and a second display screen 320. On the first display screen 310, a stop position image 210a showing the stop position of the own vehicle 1 when the own vehicle 1 is stopped at the first intermediate position P2 is displayed with a solid line.
 次に、駐車支援装置100は、自車両1を駐車経路R1に沿って走行させるための制御情報を生成し(ステップS6)、生成した制御情報を車両制御ユニット70に出力する(ステップS7)。ステップS6及びS7は、本発明の出力ステップに相当する。車両制御ユニット70が、制御情報に従って操舵装置71、駆動装置73、制動装置75及び変速装置77の駆動を制御することで、自車両1は、駐車経路R1に沿った自動走行を開始する(ステップS8)。 Next, the parking support device 100 generates control information for driving the own vehicle 1 along the parking route R1 (step S6), and outputs the generated control information to the vehicle control unit 70 (step S7). Steps S6 and S7 correspond to the output steps of the present invention. The vehicle control unit 70 controls the driving of the steering device 71, the driving device 73, the braking device 75, and the transmission device 77 according to the control information, so that the own vehicle 1 starts automatic traveling along the parking path R1 (step). S8).
 駐車支援装置100は、自車両1が自動運転による走行を開始した後も、検出部20の検出情報である撮影部30の撮影画像や、ソナーユニット40のセンサ値を引き続き取得する(ステップS9)。駐車支援装置100は、取得したソナーユニット40のセンサ値や、撮影画像の解析結果に基づいて障害物5を検出し、検出した障害物5の位置や大きさをマップデータに記録する。ステップS9は、本発明の検出ステップに相当する。駐車支援装置100は、マップデータにおける障害物5の位置や大きさを更新すると、検出した障害物5と仮想車両7との距離が第3設定距離以下であるか否かを判定する(ステップS10)。ステップS10は、本発明の予測ステップに相当する。駐車支援装置100は、障害物5と仮想車両7との距離が第3設定距離以下ではない場合(ステップS10/NO)、自車両1が目標駐車位置に駐車したか否かを判定する(ステップS11)。 The parking support device 100 continues to acquire the captured image of the photographing unit 30 which is the detection information of the detection unit 20 and the sensor value of the sonar unit 40 even after the own vehicle 1 starts traveling by automatic driving (step S9). .. The parking support device 100 detects the obstacle 5 based on the acquired sensor value of the sonar unit 40 and the analysis result of the captured image, and records the position and size of the detected obstacle 5 in the map data. Step S9 corresponds to the detection step of the present invention. When the parking support device 100 updates the position and size of the obstacle 5 in the map data, it determines whether or not the distance between the detected obstacle 5 and the virtual vehicle 7 is equal to or less than the third set distance (step S10). ). Step S10 corresponds to the prediction step of the present invention. When the distance between the obstacle 5 and the virtual vehicle 7 is not less than or equal to the third set distance (step S10 / NO), the parking support device 100 determines whether or not the own vehicle 1 is parked at the target parking position (step). S11).
 駐車支援装置100は、自車両1が目標駐車位置に駐車していない場合(ステップS11/NO)、ステップS9の処理に戻って検出部20の検出情報を取得し、仮想車両7との距離が第3設定距離以下となる障害物5が検出されたか否かを判定する。また、駐車支援装置100は、自車両1が目標駐車位置に駐車したと判定した場合(ステップS11/YES)、この処理フローを終了させる。 When the own vehicle 1 is not parked at the target parking position (step S11 / NO), the parking support device 100 returns to the process of step S9 to acquire the detection information of the detection unit 20, and the distance to the virtual vehicle 7 is reduced. It is determined whether or not the obstacle 5 which is equal to or less than the third set distance is detected. Further, when the parking support device 100 determines that the own vehicle 1 is parked at the target parking position (step S11 / YES), the parking support device 100 ends this processing flow.
 また、ステップS10の判定において、障害物5と仮想車両7との距離が第3設定距離以下である場合(ステップS10/YES)、駐車支援装置100は、回避駐車経路R2を生成する(ステップS12)。ステップS12は、本発明の生成ステップに相当する。そして、駐車支援装置100は、自車両1の現在位置が、回避駐車経路R2の始点位置P6であるか否かを判定する(ステップS13)。駐車支援装置100は、自車両1の現在位置が、回避駐車経路R2の始点位置P6ではない場合(ステップS13/NO)、自車両1が回避駐車経路R2の始点位置P6に移動するまで待機する。 Further, in the determination of step S10, when the distance between the obstacle 5 and the virtual vehicle 7 is equal to or less than the third set distance (step S10 / YES), the parking support device 100 generates the avoidance parking route R2 (step S12). ). Step S12 corresponds to the generation step of the present invention. Then, the parking support device 100 determines whether or not the current position of the own vehicle 1 is the start point position P6 of the avoidance parking route R2 (step S13). When the current position of the own vehicle 1 is not the start point position P6 of the avoidance parking route R2 (step S13 / NO), the parking support device 100 waits until the own vehicle 1 moves to the start point position P6 of the avoidance parking route R2. ..
 駐車支援装置100は、自車両1が回避駐車経路R2の始点位置P6に移動すると(ステップS13/YES)、停車指示を車両制御ユニット70に出力する(ステップS14)。その後、駐車支援装置100は、表示部60に表示した表示画面300の表示を更新する(ステップS15)。表示部60に表示される表示画面300が、図4に示す表示画面300から図5に示す表示画面300に更新される。 When the own vehicle 1 moves to the start point position P6 of the avoidance parking route R2 (step S13 / YES), the parking support device 100 outputs a stop instruction to the vehicle control unit 70 (step S14). After that, the parking support device 100 updates the display of the display screen 300 displayed on the display unit 60 (step S15). The display screen 300 displayed on the display unit 60 is updated from the display screen 300 shown in FIG. 4 to the display screen 300 shown in FIG.
 表示画面300の第1表示画面310には、停車位置画像210aに加えて停車位置画像210bが表示される。また、第1子画面330に表示した撮影画像に障害物5が撮影されている場合、この障害物5の位置を示す枠画像335が、撮影画像に重畳表示される。また、第2表示画面320には、自車両1に接触する障害物5が検出されたため、駐車経路を駐車経路R1から回避駐車経路R2に変更したことを案内する案内表示370が表示される。 On the first display screen 310 of the display screen 300, the stop position image 210b is displayed in addition to the stop position image 210a. Further, when the obstacle 5 is photographed in the photographed image displayed on the first sub screen 330, the frame image 335 showing the position of the obstacle 5 is superimposed and displayed on the photographed image. Further, on the second display screen 320, a guidance display 370 for informing that the parking route has been changed from the parking route R1 to the avoidance parking route R2 is displayed because the obstacle 5 in contact with the own vehicle 1 is detected.
 駐車支援装置100は、自車両1の停車後、生成した回避駐車経路R2に基づいて制御情報を生成し(ステップS16)、生成した制御情報を車両制御ユニット70に出力する(ステップS17)。ステップS16及びS17は、本発明の出力ステップに相当する。これにより、自車両1は、回避駐車経路R2に沿った走行を開始する(ステップS18)。その後、駐車支援装置100は、ステップS9の処理に移行して障害物5の検出を再開する。 After the own vehicle 1 is stopped, the parking support device 100 generates control information based on the generated avoidance parking route R2 (step S16), and outputs the generated control information to the vehicle control unit 70 (step S17). Steps S16 and S17 correspond to the output steps of the present invention. As a result, the own vehicle 1 starts traveling along the avoidance parking route R2 (step S18). After that, the parking support device 100 shifts to the process of step S9 and restarts the detection of the obstacle 5.
 以上説明したように本実施形態の駐車支援装置100は、車両の駐車を支援する装置であって、障害物検出部133、経路生成部135、走行制御部136及び予測部137を備える。
 障害物検出部133は、自車両1の周囲に存在する障害物5を検出する。
 経路生成部135は、自車両1を目標駐車位置に駐車させる駐車経路R1を生成する。
 走行制御部136は、自車両1を駐車経路R1に従って走行させるための制御情報を生成し、制御情報を、自車両1の走行を制御する車両制御ユニット70に出力する。
 予測部137は、駐車経路R1に従って走行した場合に、障害物検出部133が検出した障害物5と、自車両1と、の距離を予測する。
As described above, the parking support device 100 of the present embodiment is a device that supports parking of a vehicle, and includes an obstacle detection unit 133, a route generation unit 135, a travel control unit 136, and a prediction unit 137.
The obstacle detection unit 133 detects obstacles 5 existing around the own vehicle 1.
The route generation unit 135 generates a parking route R1 for parking the own vehicle 1 at the target parking position.
The travel control unit 136 generates control information for driving the own vehicle 1 according to the parking route R1, and outputs the control information to the vehicle control unit 70 that controls the travel of the own vehicle 1.
The prediction unit 137 predicts the distance between the obstacle 5 detected by the obstacle detection unit 133 and the own vehicle 1 when traveling along the parking route R1.
 経路生成部135は、自車両1と障害物5との距離が所定値以下になると予測部137が予測した場合に、自車両1と障害物5との距離が所定値以下になる位置よりも手前であって、駐車経路R1上の地点を始点とした、障害物5から所定距離以上離れた回避駐車経路R2を生成する。
 また、走行制御部136は、自車両1を回避駐車経路R2に従って走行させるための制御情報を生成して、制御情報を車両制御ユニット70に出力する。
 このため、自車両1と障害物5との距離が所定値以下になることが予測される場合に、自車両1を障害物5の手前で停止させてから回避駐車経路R2を演算する場合と比較して、自車両1を目標駐車位置に駐車させるまでに要する時間を短縮することができる。
When the prediction unit 137 predicts that the distance between the own vehicle 1 and the obstacle 5 will be less than or equal to the predetermined value, the route generation unit 135 is more than a position where the distance between the own vehicle 1 and the obstacle 5 is less than or equal to the predetermined value. The avoidance parking route R2, which is in front of the vehicle and starts at a point on the parking route R1 and is separated from the obstacle 5 by a predetermined distance or more, is generated.
Further, the travel control unit 136 generates control information for driving the own vehicle 1 according to the avoidance parking route R2, and outputs the control information to the vehicle control unit 70.
Therefore, when it is predicted that the distance between the own vehicle 1 and the obstacle 5 will be equal to or less than a predetermined value, the avoidance parking route R2 is calculated after stopping the own vehicle 1 in front of the obstacle 5. In comparison, the time required to park the own vehicle 1 at the target parking position can be shortened.
 予測部137は、駐車経路R1上に位置し、自車両1の進行方向の前方の所定位置に仮想車両7を設定し、仮想車両7と障害物5との距離が所定距離以下になるか否かを判定して、障害物5と自車両1との距離を予測する。
 従って、障害物5と自車両1との距離の予測精度を高めることができる。
The prediction unit 137 is located on the parking path R1 and sets the virtual vehicle 7 at a predetermined position in front of the traveling direction of the own vehicle 1, and whether or not the distance between the virtual vehicle 7 and the obstacle 5 is equal to or less than the predetermined distance. Is determined, and the distance between the obstacle 5 and the own vehicle 1 is predicted.
Therefore, the accuracy of predicting the distance between the obstacle 5 and the own vehicle 1 can be improved.
 経路生成部135は、自車両1を目標駐車位置に駐車させる場合の走行距離と、自車両1の進行方向を変更する変更回数とに基づき、回避駐車経路R2の始点に設定する駐車経路R1上の地点を設定する。
 従って、自車両1を目標駐車位置に駐車させる時間を短縮することができる。
The route generation unit 135 is on the parking route R1 set as the start point of the avoidance parking route R2 based on the mileage when the own vehicle 1 is parked at the target parking position and the number of changes for changing the traveling direction of the own vehicle 1. Set the point of.
Therefore, the time for parking the own vehicle 1 at the target parking position can be shortened.
 上述した実施形態は、あくまでも本発明の一態様を例示したものであって、本発明の主旨を逸脱しない範囲で任意に変形、及び応用が可能である。
 例えば、図1に示すブロックは、本願発明を理解容易にするために、構成要素を主な処理内容に応じて分類して示した概略図であり、構成要素は、処理内容に応じて、さらに多くの構成要素に分類することもできる。また、1つの構成要素がさらに多くの処理を実行するように分類することもできる。
The above-described embodiment is merely an example of one aspect of the present invention, and can be arbitrarily modified and applied without departing from the gist of the present invention.
For example, the block shown in FIG. 1 is a schematic view showing components classified according to the main processing contents in order to facilitate understanding of the present invention, and the components are further classified according to the processing contents. It can also be classified into many components. It can also be categorized so that one component performs more processing.
 また、図1において、駐車支援装置100が、位置検出ユニット10及び検出部20の少なくとも一方を一体に備える構成であってもよい。 Further, in FIG. 1, the parking support device 100 may be configured to integrally include at least one of the position detection unit 10 and the detection unit 20.
 また、本発明の駐車支援方法を、コンピュータを用いて実現する場合、このコンピュータに実行させるプログラムを記録媒体、又はこのプログラムを伝送する伝送媒体の態様で構成することも可能である。記録媒体には、磁気的、光学的記録媒体又は半導体メモリーデバイスを用いることができる。具体的には、フレキシブルディスク、HDD(Hard Disk Drive)、CD-ROM(Compact Disk Read Only Memory)、DVD、Blu-ray(登録商標) Disc、光磁気ディスク、フラッシュメモリ、カード型記録媒体等の可搬型、或いは固定式の記録媒体が挙げられる。また、上記記録媒体は、駐車支援装置100が備えるRAM、ROM、HDD等の不揮発性記憶装置であってもよい。 Further, when the parking support method of the present invention is realized by using a computer, it is also possible to configure the program to be executed by the computer in the form of a recording medium or a transmission medium for transmitting this program. As the recording medium, a magnetic or optical recording medium or a semiconductor memory device can be used. Specifically, flexible disks, HDDs (Hard Disk Drives), CD-ROMs (Compact Disk Read Only Memory), DVDs, Blu-ray (registered trademark) Discs, magneto-optical disks, flash memories, card-type recording media, etc. Examples include portable or fixed recording media. Further, the recording medium may be a non-volatile storage device such as a RAM, a ROM, or an HDD included in the parking support device 100.
 また、例えば、図7に示すフローチャートの処理単位は、駐車支援装置100の処理を理解容易にするために、主な処理内容に応じて分割したものであり、処理単位の分割の仕方や名称によって、本発明が限定されることはない。駐車支援装置100の処理は、処理内容に応じて、さらに多くの処理単位に分割してもよい。また、駐車支援装置100の処理は、1つの処理単位がさらに多くの処理を含むように分割してもよい。 Further, for example, the processing unit of the flowchart shown in FIG. 7 is divided according to the main processing contents in order to make the processing of the parking support device 100 easier to understand, and it depends on the method and name of division of the processing unit. , The present invention is not limited. The processing of the parking support device 100 may be divided into more processing units depending on the processing content. Further, the processing of the parking support device 100 may be divided so that one processing unit includes more processing.
 1 車両
 3 車載装置
 5 障害物
 7 仮想車両
 10 位置検出ユニット
 20 検出部
 30 撮影部
 31 フロントカメラ
 33 リアカメラ
 35 左サイドカメラ
 37 右サイドカメラ
 40 ソナーユニット
 50 操作部
 63 タッチセンサ
 70 車両制御ユニット
 71 操舵装置
 73 駆動装置
 75 制動装置
 77 変速装置
 100 駐車支援装置
 110 メモリ
 130 プロセッサ
 131 位置取得部
 132 マップ生成部
 133 障害物検出部
 134 目標駐車位置設定部
 135 経路生成部
 136 走行制御部
 137 予測部
 138 表示制御部
 210a、210b 停車位置画像
 220 駐車位置画像
 310 第1表示画面
 315 俯瞰画像
 320 第2表示画面
 330 第1子画面
 331、333 予測進路線
 335 枠画像
 340 第2子画面
 345 アイコン
 360 キャンセルボタン
 370 案内表示
 380 孫画面
1 Vehicle 3 In-vehicle device 5 Obstacle 7 Virtual vehicle 10 Position detection unit 20 Detection unit 30 Imaging unit 31 Front camera 33 Rear camera 35 Left side camera 37 Right side camera 40 Sonar unit 50 Operation unit 63 Touch sensor 70 Vehicle control unit 71 Steering Device 73 Drive device 75 Braking device 77 Speed change device 100 Parking support device 110 Memory 130 Processor 131 Position acquisition unit 132 Map generation unit 133 Obstacle detection unit 134 Target parking position setting unit 135 Route generation unit 136 Travel control unit 137 Prediction unit 138 Display Control unit 210a, 210b Stop position image 220 Parking position image 310 First display screen 315 Bird's-eye view image 320 Second display screen 330 First child screen 331, 333 Predicted advance route 335 Frame image 340 Second child screen 345 Icon 360 Cancel button 370 Guidance display 380 grandchild screen

Claims (4)

  1.  車両の駐車を支援する駐車支援装置であって、
     前記車両の周囲に存在する障害物を検出する障害物検出部と、
     前記車両を目標駐車位置に駐車させる駐車経路を生成する経路生成部と、
     前記車両を前記駐車経路に沿って走行させるための制御情報を生成し、前記制御情報を、前記車両の走行を制御する車両制御装置に出力する走行制御部と、
     前記駐車経路に従って走行した場合、前記障害物検出部が検出した障害物と、前記車両との距離を予測する予測部と、を備え、
     前記経路生成部は、
     前記予測部が、前記車両と前記障害物との距離が所定距離以下になると予測した場合に、前記車両と前記障害物との距離が所定距離以下になる位置よりも手前であって、前記駐車経路上の地点を始点とし、前記車両と前記障害物との距離が前記所定距離より離れた回避駐車経路を生成し、
     前記走行制御部は、
     前記車両を前記回避駐車経路に従って走行させるための制御情報を生成して、前記制御情報を前記車両制御装置に出力する、
     ことを特徴とする駐車支援装置。
    It is a parking support device that supports the parking of vehicles.
    An obstacle detection unit that detects obstacles around the vehicle,
    A route generation unit that generates a parking route for parking the vehicle at a target parking position,
    A travel control unit that generates control information for driving the vehicle along the parking route and outputs the control information to a vehicle control device that controls the travel of the vehicle.
    When traveling along the parking route, the obstacle detection unit detects an obstacle and a prediction unit that predicts the distance to the vehicle.
    The route generation unit
    When the prediction unit predicts that the distance between the vehicle and the obstacle will be less than or equal to a predetermined distance, the parking is before the position where the distance between the vehicle and the obstacle is less than or equal to the predetermined distance. An avoidance parking route is generated in which the distance between the vehicle and the obstacle is longer than the predetermined distance, starting from a point on the route.
    The traveling control unit
    It generates control information for driving the vehicle according to the avoidance parking route, and outputs the control information to the vehicle control device.
    A parking support device characterized by this.
  2.  前記予測部は、前記駐車経路上に位置し、前記車両の進行方向の前方の所定位置に仮想的な車両を設定し、前記仮想的な車両と前記障害物との距離が前記所定距離以下になるか否かを予測する、ことを特徴とする請求項1記載の駐車支援装置。 The prediction unit is located on the parking route, sets a virtual vehicle at a predetermined position in front of the vehicle in the traveling direction, and the distance between the virtual vehicle and the obstacle is set to be equal to or less than the predetermined distance. The parking support device according to claim 1, wherein the parking support device is characterized in that it predicts whether or not the parking will occur.
  3.  前記経路生成部は、前記車両を前記目標駐車位置に駐車させる場合の走行距離と、前記車両の進行方向を変更する変更回数とに基づき、前記回避駐車経路の始点に設定する前記駐車経路上の地点を設定する、ことを特徴とする請求項1又は2記載の駐車支援装置。 The route generation unit is set on the parking route as a start point of the avoidance parking route based on the mileage when the vehicle is parked at the target parking position and the number of changes for changing the traveling direction of the vehicle. The parking support device according to claim 1 or 2, wherein a point is set.
  4.  車両の駐車を支援する駐車支援方法であって、
     前記車両の周囲に存在する障害物を検出する検出ステップと、
     前記車両を目標駐車位置に駐車させる駐車経路を生成する生成ステップと、
     前記車両を前記駐車経路に沿って走行させるための制御情報を生成し、前記制御情報を、前記車両の走行を制御する車両制御装置に出力する出力ステップと、
     前記駐車経路に従って走行した場合、前記検出ステップにより検出した障害物と、前記車両と、の距離を予測する予測ステップと、を備え、
     前記生成ステップは、
     前記予測ステップにより、前記車両と前記障害物との距離が所定距離以下になると予測した場合に、前記車両と前記障害物との距離が所定距離以下になる位置よりも手前であって、前記駐車経路上の地点を始点とし、前記車両と前記障害物との距離が前記所定距離より離れた回避駐車経路を生成し、
     前記出力ステップは、
     前記車両を前記回避駐車経路に従って走行させるための制御情報を生成して、前記制御情報を前記車両制御装置に出力する、
     ことを特徴とする駐車支援方法。
    It is a parking support method that supports the parking of vehicles.
    A detection step for detecting an obstacle existing around the vehicle, and
    A generation step of generating a parking route for parking the vehicle at a target parking position, and
    An output step that generates control information for driving the vehicle along the parking route and outputs the control information to a vehicle control device that controls the travel of the vehicle.
    When traveling according to the parking route, the obstacle detected by the detection step and the prediction step for predicting the distance between the vehicle and the vehicle are provided.
    The generation step
    When the prediction step predicts that the distance between the vehicle and the obstacle will be less than or equal to the predetermined distance, the parking is before the position where the distance between the vehicle and the obstacle is less than or equal to the predetermined distance. An avoidance parking route is generated in which the distance between the vehicle and the obstacle is longer than the predetermined distance, starting from a point on the route.
    The output step
    It generates control information for driving the vehicle according to the avoidance parking route, and outputs the control information to the vehicle control device.
    A parking support method characterized by that.
PCT/JP2020/048271 2020-02-07 2020-12-23 Parking assistance apparatus and parking assistance method WO2021157241A1 (en)

Applications Claiming Priority (2)

Application Number Priority Date Filing Date Title
JP2020019391A JP7372167B2 (en) 2020-02-07 2020-02-07 Parking support device and parking support method
JP2020-019391 2020-02-07

Publications (1)

Publication Number Publication Date
WO2021157241A1 true WO2021157241A1 (en) 2021-08-12

Family

ID=77199929

Family Applications (1)

Application Number Title Priority Date Filing Date
PCT/JP2020/048271 WO2021157241A1 (en) 2020-02-07 2020-12-23 Parking assistance apparatus and parking assistance method

Country Status (2)

Country Link
JP (1) JP7372167B2 (en)
WO (1) WO2021157241A1 (en)

Citations (9)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP2005239048A (en) * 2004-02-27 2005-09-08 Denso Corp Parking assistance system
JP2017007399A (en) * 2015-06-17 2017-01-12 日産自動車株式会社 Parking support device and method
US20190016332A1 (en) * 2017-07-11 2019-01-17 Hyundai Mobis Co., Ltd. Smart parking system and parking track generation method thereof
US20190118801A1 (en) * 2017-10-24 2019-04-25 Lg Electronics Inc. Device for automatically parking vehicle and method for controlling the same
WO2019096357A1 (en) * 2017-11-14 2019-05-23 Continental Automotive Gmbh Method for controlling a parking operation of a motor vehicle
US20190193724A1 (en) * 2017-12-26 2019-06-27 Lg Electronics Inc. Autonomous vehicle and controlling method thereof
JP2019182154A (en) * 2018-04-06 2019-10-24 日立オートモティブシステムズ株式会社 Parking assisting device
JP2020001677A (en) * 2018-06-27 2020-01-09 バイドゥ・ユーエスエイ・リミテッド・ライアビリティ・カンパニーBaidu USA LLC Planning parking trajectory generation for self-driving vehicles using optimization method
JP2020050263A (en) * 2018-09-28 2020-04-02 パナソニックIpマネジメント株式会社 Travel control device, travel control method, and program

Family Cites Families (1)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US10710579B2 (en) 2017-06-01 2020-07-14 Waymo Llc Collision prediction system

Patent Citations (9)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP2005239048A (en) * 2004-02-27 2005-09-08 Denso Corp Parking assistance system
JP2017007399A (en) * 2015-06-17 2017-01-12 日産自動車株式会社 Parking support device and method
US20190016332A1 (en) * 2017-07-11 2019-01-17 Hyundai Mobis Co., Ltd. Smart parking system and parking track generation method thereof
US20190118801A1 (en) * 2017-10-24 2019-04-25 Lg Electronics Inc. Device for automatically parking vehicle and method for controlling the same
WO2019096357A1 (en) * 2017-11-14 2019-05-23 Continental Automotive Gmbh Method for controlling a parking operation of a motor vehicle
US20190193724A1 (en) * 2017-12-26 2019-06-27 Lg Electronics Inc. Autonomous vehicle and controlling method thereof
JP2019182154A (en) * 2018-04-06 2019-10-24 日立オートモティブシステムズ株式会社 Parking assisting device
JP2020001677A (en) * 2018-06-27 2020-01-09 バイドゥ・ユーエスエイ・リミテッド・ライアビリティ・カンパニーBaidu USA LLC Planning parking trajectory generation for self-driving vehicles using optimization method
JP2020050263A (en) * 2018-09-28 2020-04-02 パナソニックIpマネジメント株式会社 Travel control device, travel control method, and program

Also Published As

Publication number Publication date
JP2021123276A (en) 2021-08-30
JP7372167B2 (en) 2023-10-31

Similar Documents

Publication Publication Date Title
KR102073496B1 (en) Method and apparatus for detecting frame line of parking space
KR102042371B1 (en) Parking space detection method and apparatus
US8018488B2 (en) Vehicle-periphery image generating apparatus and method of switching images
JP2008276642A (en) Traveling lane recognition device and traveling lane recognition method
JP2005112267A (en) Reverse travel support device for vehicle and support method for vehicle
EP3865377A1 (en) Parking support device, parking support system, and parking support method
JP2020147059A (en) Parking support device and parking support method
JP2019128844A (en) Parking device
JP2021123277A (en) Parking support device and parking support method
US11643071B2 (en) Parking assistance device and parking assistance method
CN112298166B (en) Parking support device and control method for parking support device
JP2021146769A (en) On-vehicle device, remote operation system, operation terminal and on-vehicle device control method
JP2011075437A (en) Device, method and program for displaying vehicle periphery
JP5109224B2 (en) Parking space detection device
WO2021157241A1 (en) Parking assistance apparatus and parking assistance method
US20200408560A1 (en) Parking assist apparatus and parking assist method
JP2003323699A (en) Safe driving supporting device
JP5262224B2 (en) Drive recorder
JP2021187249A (en) On-vehicle device and exit support method
JP2021194926A (en) Parking assist device and parking assist method
US20220379877A1 (en) Parking Assist System and Parking Assist Method
JP4682936B2 (en) Vehicle driving support device
JP2022077093A (en) Parking assistance device and parking assistance method
JP2021062738A (en) Parking support device, parking support method, and program
JP2022071969A (en) Parking support device and parking support method

Legal Events

Date Code Title Description
121 Ep: the epo has been informed by wipo that ep was designated in this application

Ref document number: 20917773

Country of ref document: EP

Kind code of ref document: A1

NENP Non-entry into the national phase

Ref country code: DE

122 Ep: pct application non-entry in european phase

Ref document number: 20917773

Country of ref document: EP

Kind code of ref document: A1