[go: up one dir, main page]
More Web Proxy on the site http://driver.im/

WO2018047295A1 - 駐車支援装置 - Google Patents

駐車支援装置 Download PDF

Info

Publication number
WO2018047295A1
WO2018047295A1 PCT/JP2016/076623 JP2016076623W WO2018047295A1 WO 2018047295 A1 WO2018047295 A1 WO 2018047295A1 JP 2016076623 W JP2016076623 W JP 2016076623W WO 2018047295 A1 WO2018047295 A1 WO 2018047295A1
Authority
WO
WIPO (PCT)
Prior art keywords
parking
vehicle
obstacle
reflection position
control unit
Prior art date
Application number
PCT/JP2016/076623
Other languages
English (en)
French (fr)
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 三菱電機株式会社
Priority to PCT/JP2016/076623 priority Critical patent/WO2018047295A1/ja
Priority to US16/324,659 priority patent/US11161547B2/en
Priority to CN201680088967.7A priority patent/CN110035930B/zh
Priority to DE112016007206.6T priority patent/DE112016007206T5/de
Priority to JP2018537948A priority patent/JP6625228B2/ja
Publication of WO2018047295A1 publication Critical patent/WO2018047295A1/ja

Links

Images

Classifications

    • BPERFORMING OPERATIONS; TRANSPORTING
    • B62LAND VEHICLES FOR TRAVELLING OTHERWISE THAN ON RAILS
    • B62DMOTOR VEHICLES; TRAILERS
    • B62D15/00Steering not otherwise provided for
    • B62D15/02Steering position indicators ; Steering position determination; Steering aids
    • B62D15/027Parking aids, e.g. instruction means
    • B62D15/0285Parking performed automatically
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B60VEHICLES IN GENERAL
    • B60RVEHICLES, VEHICLE FITTINGS, OR VEHICLE PARTS, NOT OTHERWISE PROVIDED FOR
    • B60R21/00Arrangements or fittings on vehicles for protecting or preventing injuries to occupants or pedestrians in case of accidents or other traffic risks
    • 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
    • B60W30/06Automatic manoeuvring for parking
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B62LAND VEHICLES FOR TRAVELLING OTHERWISE THAN ON RAILS
    • B62DMOTOR VEHICLES; TRAILERS
    • B62D15/00Steering not otherwise provided for
    • B62D15/02Steering position indicators ; Steering position determination; Steering aids
    • B62D15/027Parking aids, e.g. instruction means
    • GPHYSICS
    • G01MEASURING; TESTING
    • G01SRADIO DIRECTION-FINDING; RADIO NAVIGATION; DETERMINING DISTANCE OR VELOCITY BY USE OF RADIO WAVES; LOCATING OR PRESENCE-DETECTING BY USE OF THE REFLECTION OR RERADIATION OF RADIO WAVES; ANALOGOUS ARRANGEMENTS USING OTHER WAVES
    • G01S15/00Systems using the reflection or reradiation of acoustic waves, e.g. sonar systems
    • G01S15/87Combinations of sonar systems
    • GPHYSICS
    • G01MEASURING; TESTING
    • G01SRADIO DIRECTION-FINDING; RADIO NAVIGATION; DETERMINING DISTANCE OR VELOCITY BY USE OF RADIO WAVES; LOCATING OR PRESENCE-DETECTING BY USE OF THE REFLECTION OR RERADIATION OF RADIO WAVES; ANALOGOUS ARRANGEMENTS USING OTHER WAVES
    • G01S15/00Systems using the reflection or reradiation of acoustic waves, e.g. sonar systems
    • G01S15/88Sonar systems specially adapted for specific applications
    • G01S15/93Sonar systems specially adapted for specific applications for anti-collision purposes
    • GPHYSICS
    • G01MEASURING; TESTING
    • G01SRADIO DIRECTION-FINDING; RADIO NAVIGATION; DETERMINING DISTANCE OR VELOCITY BY USE OF RADIO WAVES; LOCATING OR PRESENCE-DETECTING BY USE OF THE REFLECTION OR RERADIATION OF RADIO WAVES; ANALOGOUS ARRANGEMENTS USING OTHER WAVES
    • G01S15/00Systems using the reflection or reradiation of acoustic waves, e.g. sonar systems
    • G01S15/88Sonar systems specially adapted for specific applications
    • G01S15/93Sonar systems specially adapted for specific applications for anti-collision purposes
    • G01S15/931Sonar systems specially adapted for specific applications for anti-collision purposes of land vehicles
    • GPHYSICS
    • G06COMPUTING; CALCULATING OR COUNTING
    • G06VIMAGE OR VIDEO RECOGNITION OR UNDERSTANDING
    • G06V20/00Scenes; Scene-specific elements
    • G06V20/50Context or environment of the image
    • G06V20/56Context or environment of the image exterior to a vehicle by using sensors mounted on the vehicle
    • G06V20/58Recognition of moving objects or obstacles, e.g. vehicles or pedestrians; Recognition of traffic objects, e.g. traffic signs, traffic lights or roads
    • GPHYSICS
    • G08SIGNALLING
    • G08GTRAFFIC CONTROL SYSTEMS
    • G08G1/00Traffic control systems for road vehicles
    • G08G1/16Anti-collision systems
    • GPHYSICS
    • G01MEASURING; TESTING
    • G01SRADIO DIRECTION-FINDING; RADIO NAVIGATION; DETERMINING DISTANCE OR VELOCITY BY USE OF RADIO WAVES; LOCATING OR PRESENCE-DETECTING BY USE OF THE REFLECTION OR RERADIATION OF RADIO WAVES; ANALOGOUS ARRANGEMENTS USING OTHER WAVES
    • G01S15/00Systems using the reflection or reradiation of acoustic waves, e.g. sonar systems
    • G01S15/88Sonar systems specially adapted for specific applications
    • G01S15/93Sonar systems specially adapted for specific applications for anti-collision purposes
    • G01S15/931Sonar systems specially adapted for specific applications for anti-collision purposes of land vehicles
    • G01S2015/932Sonar systems specially adapted for specific applications for anti-collision purposes of land vehicles for parking operations
    • GPHYSICS
    • G01MEASURING; TESTING
    • G01SRADIO DIRECTION-FINDING; RADIO NAVIGATION; DETERMINING DISTANCE OR VELOCITY BY USE OF RADIO WAVES; LOCATING OR PRESENCE-DETECTING BY USE OF THE REFLECTION OR RERADIATION OF RADIO WAVES; ANALOGOUS ARRANGEMENTS USING OTHER WAVES
    • G01S15/00Systems using the reflection or reradiation of acoustic waves, e.g. sonar systems
    • G01S15/88Sonar systems specially adapted for specific applications
    • G01S15/93Sonar systems specially adapted for specific applications for anti-collision purposes
    • G01S15/931Sonar systems specially adapted for specific applications for anti-collision purposes of land vehicles
    • G01S2015/932Sonar systems specially adapted for specific applications for anti-collision purposes of land vehicles for parking operations
    • G01S2015/933Sonar systems specially adapted for specific applications for anti-collision purposes of land vehicles for parking operations for measuring the dimensions of the parking space when driving past
    • GPHYSICS
    • G01MEASURING; TESTING
    • G01SRADIO DIRECTION-FINDING; RADIO NAVIGATION; DETERMINING DISTANCE OR VELOCITY BY USE OF RADIO WAVES; LOCATING OR PRESENCE-DETECTING BY USE OF THE REFLECTION OR RERADIATION OF RADIO WAVES; ANALOGOUS ARRANGEMENTS USING OTHER WAVES
    • G01S15/00Systems using the reflection or reradiation of acoustic waves, e.g. sonar systems
    • G01S15/88Sonar systems specially adapted for specific applications
    • G01S15/93Sonar systems specially adapted for specific applications for anti-collision purposes
    • G01S15/931Sonar systems specially adapted for specific applications for anti-collision purposes of land vehicles
    • G01S2015/932Sonar systems specially adapted for specific applications for anti-collision purposes of land vehicles for parking operations
    • G01S2015/933Sonar systems specially adapted for specific applications for anti-collision purposes of land vehicles for parking operations for measuring the dimensions of the parking space when driving past
    • G01S2015/935Sonar systems specially adapted for specific applications for anti-collision purposes of land vehicles for parking operations for measuring the dimensions of the parking space when driving past for measuring the contour, e.g. a trajectory of measurement points, representing the boundary of the parking space

Definitions

  • the present invention relates to a parking assistance device.
  • the vehicle V of Patent Document 1 has a pair of left and right Fr sonars 31 attached to the front of the vehicle side part, and a pair of left and right Rr sonars 32 attached to the rear of the vehicle side part.
  • the detectable range of the Rr sonar 32 is set below the detectable range of the Fr sonar 31.
  • the ECU 10 uses the Fr sonar 31 and the Rr sonar 32, that is, two sonars provided on both sides of the vehicle V, so that obstacles such as other vehicles Va, Vb and the column F cannot be overcome, and the curb E , E1 and other low obstacles that can be overcome are detected.
  • the ECU 10 executes automatic parking using the detection results obtained by the Fr sonar 31 and the Rr sonar 32 as shown in FIG. 6 of Patent Document 1 (see FIG. 1, FIG. 2, FIG. 6, etc. of Patent Document 1).
  • Patent Document 1 describes automatic parking when there is a curb on the back side of another vehicle in parallel parking (see paragraph [0045], FIG. 6 (d), etc. of Patent Document 1).
  • obstacles existing on the back side of other vehicles in parallel parking are not limited to curbs, and there may be obstacles such as walls that cannot be overcome.
  • the parking assist device disclosed in Patent Document 1 has a problem that an appropriate guidance route cannot be set depending on whether the obstacle is a curb or a wall when performing automatic parking by parallel parking. It was.
  • the parking assist device of Patent Document 1 detects obstacles and low obstacles using two sonars provided on each side of the vehicle, that is, a total of four sonars.
  • the arrangement interval between the Fr sonar and the Rr sonar is increased, that is, the Fr sonar and the Rr sonar are arranged so as to be shifted from each other with respect to the longitudinal direction of the vehicle. It is required to do.
  • the problem is that the travel distance required for detection becomes long. was there.
  • the detection timing by the Fr sonar and the detection timing by the Rr sonar are deviated, so that there is a problem that the detection accuracy is low.
  • the present invention has been made to solve the above-described problems, and when performing automatic parking by parallel parking, an appropriate guide route is set depending on whether the obstacle is a curb or a wall. It is an object of the present invention to provide a parking assistance device that can be used.
  • the parking assist device of the present invention compares the level values of the pair of left and right sonar provided in the vehicle and the reflected wave received by the sonar with each of the first threshold value and the second threshold value which are different from each other.
  • An obstacle detection control unit that determines whether an obstacle existing within the target distance range is a wall or a curb, and a guidance route for automatic parking is set according to the determination result by the obstacle detection control unit
  • An automatic parking control unit and in the automatic parking by parallel parking, when the determination result indicates a curb, the guidance of the vehicle is greater than when the determination result indicates a wall A route is set.
  • the parking assist device of the present invention can set an appropriate guidance route according to whether the obstacle is a curb or a wall when performing automatic parking by parallel parking.
  • FIG. 2A is an explanatory diagram showing an ultrasonic radiation pattern by the left sonar and the ultrasonic path reflected by the wall according to Embodiment 1 of the present invention.
  • FIG. 2B is an explanatory diagram showing an ultrasonic radiation pattern by the left sonar and the ultrasonic path reflected by the curb according to Embodiment 1 of the present invention.
  • It is a characteristic view which shows the level value of the reflected wave with respect to the distance between a vehicle and an obstruction.
  • FIG. 4A is an explanatory diagram illustrating the reflection position calculated by the reflection position calculation unit according to Embodiment 1 of the present invention.
  • FIG. 4A is an explanatory diagram illustrating the reflection position calculated by the reflection position calculation unit according to Embodiment 1 of the present invention.
  • FIG. 4B is an explanatory diagram showing another reflection position calculated by the reflection position calculation unit according to Embodiment 1 of the present invention. It is explanatory drawing which shows the table corresponding to the determination method by the kind determination part which concerns on Embodiment 1 of this invention.
  • FIG. 6A is an explanatory diagram showing a parallel parking guidance route set by the guidance route setting unit according to Embodiment 1 of the present invention.
  • FIG. 6B is an explanatory diagram showing another guide route for parallel parking set by the guide route setting unit according to Embodiment 1 of the present invention.
  • FIG. 7A is a hardware configuration diagram illustrating a main part of the control device according to Embodiment 1 of the present invention.
  • FIG. 7B is another hardware configuration diagram showing the main part of the control device according to Embodiment 1 of the present invention. It is a flowchart which shows operation
  • FIG. 10A is an explanatory diagram illustrating the reflection position calculated by the reflection position calculation unit according to Embodiment 2 of the present invention.
  • FIG. 10B is an explanatory diagram showing another reflection position calculated by the reflection position calculation unit according to Embodiment 2 of the present invention.
  • FIG. 11A is an explanatory diagram showing groups set by the grouping processing unit according to Embodiment 2 of the present invention.
  • FIG. 11B is an explanatory diagram showing another group set by the grouping processing unit according to Embodiment 2 of the present invention.
  • FIG. 12A is an explanatory diagram illustrating a straight line and a normal vector between reflection positions in a group corresponding to a wall.
  • FIG. 12B is an explanatory diagram illustrating a straight line and a normal vector between reflection positions in a group corresponding to the curb.
  • FIG. 12C is an explanatory diagram illustrating a straight line and a normal vector between reflection positions in a group corresponding to another vehicle in the parallel parking state.
  • FIG. 12D is an explanatory diagram illustrating a straight line and a normal vector between reflection positions in a group corresponding to another vehicle in the parallel parking state.
  • FIG. 14A is an explanatory diagram showing a table corresponding to the determination method by the type determination unit according to Embodiment 2 of the present invention.
  • FIG. 14B is an explanatory diagram showing another table corresponding to the determination method by the type determination unit according to Embodiment 2 of the present invention.
  • FIG. 14C is an explanatory diagram showing another table corresponding to the determination method by the type determination unit according to Embodiment 2 of the present invention.
  • FIG. 21A is an explanatory diagram illustrating the reflection position calculated by the reflection position calculation unit according to Embodiment 3 of the present invention.
  • FIG. 21B is an explanatory diagram illustrating other reflection positions calculated by the reflection position calculation unit according to Embodiment 3 of the present invention.
  • FIG. 22A is an explanatory diagram showing groups set by the grouping processing unit according to Embodiment 3 of the present invention.
  • FIG. 22B is an explanatory diagram showing another group set by the grouping processing unit according to Embodiment 3 of the present invention. It is explanatory drawing which shows the table corresponding to the determination method by the kind determination part which concerns on Embodiment 3 of this invention.
  • FIG. 21A is an explanatory diagram illustrating the reflection position calculated by the reflection position calculation unit according to Embodiment 3 of the present invention.
  • FIG. 21B is an explanatory diagram illustrating other reflection positions calculated by the reflection position calculation unit according to Embodiment 3 of the present invention.
  • FIG. 22A is an explanatory diagram
  • FIG. 24A is an explanatory diagram showing another table corresponding to the determination method by the type determination unit according to Embodiment 3 of the present invention.
  • FIG. 24B is an explanatory diagram showing another table corresponding to the determination method by the type determination unit according to Embodiment 3 of the present invention.
  • FIG. 24C is an explanatory diagram showing another table corresponding to the determination method by the type determination unit according to Embodiment 3 of the present invention.
  • FIG. 25A is an explanatory diagram showing another group set by the grouping processing unit according to Embodiment 3 of the present invention.
  • FIG. 25B is an explanatory diagram showing another group set by the grouping processing unit according to Embodiment 3 of the present invention.
  • FIG. 1 is a functional block diagram showing a state in which the parking assistance apparatus according to Embodiment 1 of the present invention is mounted on a vehicle.
  • the parking assistance apparatus 100 of Embodiment 1 is demonstrated centering on the example applied to the vehicle 1 which consists of a four-wheeled vehicle.
  • the wheel speed sensor 2 detects the rotational speed of the wheel of the vehicle 1 and outputs a signal indicating the rotational speed.
  • the yaw rate sensor 3 detects the yaw rate of the vehicle 1 and outputs a signal indicating the yaw rate.
  • the left sonar 4L is constituted by, for example, a single ultrasonic sensor provided in the front half of the left side of the vehicle 1.
  • the right sonar 4R is configured by, for example, a single ultrasonic sensor provided in the front half of the right side of the vehicle 1.
  • the left sonar 4L and the right sonar 4R may be collectively referred to simply as “sonar”.
  • the sonars 4 ⁇ / b> L and 4 ⁇ / b> R radiate ultrasonic waves toward the side of the vehicle 1 and receive ultrasonic waves (hereinafter referred to as “reflected waves”) reflected by an obstacle present on the side of the vehicle 1. It is.
  • FIG. 2 shows an example of an ultrasonic radiation pattern EP by the left sonar 4L.
  • the left sonar 4L has directivity in a direction along the horizontal direction.
  • An arrow A1 in FIG. 2A indicates an ultrasonic path when the ultrasonic wave emitted from the left sonar 4L is reflected by the wall W when the wall W exists on the left side of the vehicle 1.
  • the route is a route along the direction of the left sonar 4L.
  • An arrow A2 in FIG. 2B indicates an ultrasonic path when the ultrasonic wave emitted from the left sonar 4L is reflected by the curb C when the curb C exists on the left side of the vehicle 1.
  • the route is a route shifted downward with respect to the direction of the left sonar 4L. For this reason, when the distance D2 between the vehicle 1 and the curb C is equal to the distance D1 between the vehicle 1 and the wall W, the level value of the reflected wave by the curb C is smaller than the level value of the reflected wave by the wall W.
  • the right sonar 4R has the same directivity as the left sonar 4L, and the ultrasonic radiation pattern by the right sonar 4R is the same as the radiation pattern EP shown in FIG. For this reason, illustration and description of the ultrasonic radiation pattern and the like by the right sonar 4R are omitted.
  • the horizontal axis represents the distance between the vehicle 1 and the obstacle present on the side of the vehicle 1
  • the vertical axis represents the level value of the reflected wave from the obstacle received by the sonars 4L and 4R.
  • a characteristic diagram is shown.
  • a characteristic line CL1 in FIG. 3 indicates the level value of the reflected wave by the wall W.
  • the level value of the reflected wave from the wall W gradually decreases as the distance between the vehicle 1 and the wall W increases.
  • a characteristic line CL2 in FIG. 3 indicates the level value of the reflected wave by the curb C.
  • the level value of the reflected wave by the curb C is a value smaller than the level value of the reflected wave by the wall W over almost the entire distance range.
  • the characteristic line CL2 has a level value peak at a site where the distance between the vehicle 1 and the curb C is approximately 2 meters. This is because as the distance between the vehicle 1 and the curb C decreases, the deviation between the direction of the sonars 4L and 4R and the ultrasonic path (that is, the path corresponding to the arrow A2 shown in FIG. 2B) gradually increases. This is because C moves out of the detectable area by the sonars 4L and 4R. As a result, the level value of the reflected wave by the curb C is not less than Lth1 and less than Lth2 within a predetermined distance range ⁇ D including the peak of the characteristic line CL2 (distance range of 1 to 3 meters in the example of FIG.
  • Lth1 illustrated in FIG. 3 corresponds to the first threshold set in the reflection position calculation unit 11.
  • Lth2 illustrated in FIG. 3 corresponds to the second threshold set in the reflection position calculation unit 11.
  • the reflection position calculation unit 11 uses the first threshold value Lth1 to calculate a position where the ultrasonic waves transmitted by the sonars 4L and 4R are reflected (hereinafter referred to as “reflection position”) (hereinafter “first reflection position calculation”). Process "). That is, the reflection position calculation unit 11 causes the sonars 4L and 4R to transmit ultrasonic waves. When the sonar 4L, 4R receives a reflected wave having a level value equal to or greater than the first threshold value Lth1, the reflection position calculating unit 11 transmits the ultrasonic wave after the sonar 4L, 4R receives the reflected wave. The round-trip propagation distance of the ultrasonic wave is calculated by multiplying the time until the ultrasonic wave propagation speed.
  • the reflection position calculation unit 11 uses the output signals of the wheel speed sensor 2 and the yaw rate sensor 3 to position the vehicle 1 when the sonars 4L and 4R transmit and receive ultrasonic waves (hereinafter referred to as “own vehicle position”). Is calculated.
  • the reflection position calculation unit 11 calculates the reflection position using the round-trip propagation distance and the own vehicle position. Specifically, for example, the reflection position calculation unit 11 sets a position separated from the own vehicle position by a half of the round-trip propagation distance toward the side of the vehicle 1 as a reflection position, or a so-called “aperture synthesis process”. ”To calculate the reflection position.
  • the reflection position calculated by the first reflection position calculation process may be referred to as a “first reflection position”.
  • the reflection position calculation unit 11 executes a process of calculating a reflection position using the second threshold Lth2 (hereinafter referred to as “second reflection position calculation process”). That is, the reflection position calculation unit 11 causes the sonars 4L and 4R to transmit ultrasonic waves. When the sonar 4L, 4R receives a reflected wave having a level value equal to or greater than the second threshold Lth2, the reflection position calculating unit 11 transmits the ultrasonic wave after the sonar 4L, 4R receives the reflected wave. The round-trip propagation distance of the ultrasonic wave is calculated by multiplying the time until the ultrasonic wave propagation speed.
  • the reflection position calculation unit 11 uses the output signals of the wheel speed sensor 2 and the yaw rate sensor 3 to calculate the vehicle position when the sonars 4L and 4R transmit and receive ultrasonic waves.
  • the reflection position calculation unit 11 calculates the reflection position using the round-trip propagation distance and the own vehicle position. Specifically, for example, the reflection position calculation unit 11 sets a position separated from the own vehicle position by a half of the round-trip propagation distance toward the side of the vehicle 1 as a reflection position, or reflects by aperture synthesis processing. Calculate the position.
  • the reflection position calculated by the second reflection position calculation process may be referred to as a “second reflection position”.
  • the reflection position calculation unit 11 executes the first reflection position calculation process and the second reflection position calculation process at different timings. Specifically, for example, when the vehicle control unit 22 described later executes automatic parking by parallel parking, the reflection position calculation unit 11 is configured so that the vehicle 1 is at a speed equal to or lower than a predetermined reference speed (for example, every 10 kilometers). When traveling, the first reflection position calculation process and the second reflection position calculation process are repeatedly executed alternately.
  • FIG. 4 shows an example of the reflection position calculated by the reflection position calculation unit 11.
  • a white circle ( ⁇ ) indicates the first reflection position
  • a black circle ( ⁇ ) indicates the second reflection position.
  • An arrow A3 indicates a travel route of the vehicle 1 at a speed equal to or lower than the reference speed.
  • a distance range ⁇ D in FIG. 4 indicates a distance range similar to the distance range ⁇ D in FIG.
  • the first reflection position and the second reflection position are alternately arranged along the obstacle O. That is, as described with reference to FIG. 3, the level value of the reflected wave by the wall W existing within the distance range ⁇ D is equal to or greater than the second threshold value Lth2, and thus the first reflection position calculation process and the second reflection are performed.
  • the reflection position is calculated by both the position calculation processes.
  • the level value of the reflected wave by the curb C existing in the distance range ⁇ D is a value not less than the first threshold value Lth1 and less than the second threshold value Lth2. While the reflection position is calculated by the calculation process, the reflection position is not calculated by the second reflection position calculation process.
  • the type determination unit 12 uses the reflection position calculated by the reflection position calculation unit 11 and the type of the obstacle O existing in the distance range ⁇ D (hereinafter referred to as “determination target distance range”) illustrated in FIGS. 3 and 4. Is determined. Specifically, for example, the type determination unit 12 includes both the first reflection position and the second reflection position in the reflection position within the determination target distance range ⁇ D among the reflection positions calculated by the reflection position calculation unit 11. If it is, the obstacle O corresponding to the reflection position is determined to be the wall W. Moreover, the kind determination part 12 determines with the obstacle O corresponding to the said reflection position being the curb C, when only the 1st reflection position is contained in the reflection position in determination object distance range (DELTA) D.
  • FIG. 5 shows a table corresponding to the determination method. That is, the type determination unit 12 determines the type of obstacle based on the table shown in FIG.
  • the reflection position calculation unit 11 may calculate a reflection position outside the determination target distance range ⁇ D.
  • the type determination unit 12 excludes obstacles existing outside the determination target distance range ⁇ D from the type determination target. This is because, firstly, in the obstacle detection for setting the guidance route for automatic parking, it is sufficient to set the obstacle within the determination target distance range ⁇ D as the type determination target.
  • the detection accuracy of the sonars 4L and 4R is generally low and the determination is made.
  • a distance range larger than the upper limit value of the target distance range ⁇ D (a distance range of 3 meters or more in the examples of FIGS. 3 and 4)
  • the level value of the reflected wave by the wall W and the level value of the reflected wave by the curb C This is because the difference value is small and it is difficult to identify both using the first threshold value Lth1 and the second threshold value Lth2.
  • the guidance route setting unit 21 sets a guidance route for automatic parking when the vehicle control unit 22 described later executes automatic parking by parallel parking. At this time, the guide route setting unit 21 sets different guide routes depending on whether the determination result by the type determination unit 12 indicates the wall W or the curb C. Specifically, when the determination result indicates curb C, the guide route setting unit 21 sets a guide route in which the vehicle 1 is cut more than when the determination result indicates a wall W.
  • FIG. 6 shows an example of the guidance route set by the guidance route setting unit 21.
  • Arrows A4 and A5 in FIG. 6A indicate guidance routes when the obstacle O existing on the back side of the other vehicle V is the wall W when the vehicle 1 performs parallel parking between the two other vehicles V. ing.
  • an arrow A6 in FIG. 6B indicates a guide route when the obstacle O existing on the back side of the other vehicle V is the curb C in the same case.
  • the guidance path (arrow A4) when the obstacle O is the wall W is smaller than the guidance path (arrow A6) when the obstacle O is the curb C.
  • the corner portion of the vehicle 1 the rear end portion of the left side portion of the vehicle 1 in the example of FIG. 6A
  • the vehicle 1 is turned back and forth (arrow A5) to adjust the position and orientation of the vehicle 1.
  • the guidance path (arrow A6) when the obstacle O is the curb C is cut larger than the guidance path (arrow A4) when the obstacle O is the wall W.
  • the corner portion of the vehicle 1 overlaps the obstacle O in the middle of the cutting, but at this time, the curb C is below the rear bumper. Since it enters the space, contact between the curb C and the vehicle 1 does not occur.
  • the number of turn-backs after the cut is reduced (unnecessary in the example of FIG. 6B), and the time required for parking can be shortened.
  • the vehicle control unit 22 performs automatic parking by parallel parking by controlling the steering 5 of the vehicle 1 based on the guidance route set by the guidance route setting unit 21.
  • the vehicle control unit 22 may control the brake 6 provided in the vehicle 1 in addition to the steering 5.
  • the vehicle control unit 22 may control the torque of the engine 7 provided in the vehicle 1 as necessary.
  • the obstacle detection control unit 10 is configured by the reflection position calculation unit 11 and the type determination unit 12.
  • the guidance route setting unit 21 and the vehicle control unit 22 constitute an automatic parking control unit 20.
  • the obstacle detection control unit 10 and the automatic parking control unit 20 constitute a main part of the control device 30.
  • the sonar 4L, 4R and the control device 30 constitute a parking assistance device 100.
  • FIG. 7 shows an example of the hardware configuration of the main part of the control device 30.
  • the control device 30 is configured by a general-purpose computer and includes a memory 31 and a processor 32.
  • the memory 31 stores a program for causing the computer to function as the obstacle detection control unit 10 and the automatic parking control unit 20 shown in FIG.
  • the processor 32 reads and executes the program stored in the memory 31, the functions of the obstacle detection control unit 10 and the automatic parking control unit 20 shown in FIG. 1 are realized.
  • the memory 31 may be, for example, a RAM (Random Access Memory), a ROM (Read Only Memory), a flash memory, an EPROM (Erasable Programmable Read Only Memory) or an EEPROM (Electrically E-Ready Semiconductor Memory). (Hard Disk Drive) or the like.
  • the processor 32 is constituted by, for example, a CPU (Central Processing Unit), a DSP (Digital Signal Processor), a microcontroller, or a microprocessor.
  • control device 30 is configured by a dedicated processing circuit 33.
  • the processing circuit 33 is, for example, an ASIC (Application Specific Integrated Circuit), an FPGA (Field-Programmable Gate Array), a system LSI (Large-Scale Integration), or a combination thereof.
  • the processing circuit 33 may be realized by the processing circuit 33, or the functions of the respective units may be realized by the processing circuit 33 collectively. .
  • the function of the obstacle detection control unit 10 is realized by the processing circuit 33 provided in the first ECU (Electronic Control Unit), and the function of the automatic parking control unit 20 is provided in the second ECU. It may be realized by the other processing circuit 33 provided.
  • some functions of the obstacle detection control unit 10 and the automatic parking control unit 20 shown in FIG. 1 are realized by the memory 31 and the processor 32 shown in FIG. 7A, and the remaining functions are the processing circuit 33 shown in FIG. 7B. It may be realized by.
  • control device 30 When a predetermined start condition is satisfied, for example, when an operation instructing execution of automatic parking by parallel parking is input to an operation input device (not shown), the control device 30 causes the vehicle 1 to move at a speed equal to or lower than the reference speed.
  • a predetermined start condition for example, when an operation instructing execution of automatic parking by parallel parking is input to an operation input device (not shown)
  • the control device 30 causes the vehicle 1 to move at a speed equal to or lower than the reference speed.
  • traveling the process of step ST1 is started.
  • the traveling speed of the vehicle 1 can be calculated using an output signal from the wheel speed sensor 2 or can be acquired from an ECU (not shown).
  • the reflection position calculation unit 11 calculates the reflection position. Specifically, for example, the reflection position calculation unit 11 repeatedly executes a first reflection position calculation process and a second reflection position calculation unit alternately. The reflection position calculation unit 11 repeatedly executes the reflection position calculation process until the vehicle 1 stops, for example.
  • the type determination unit 12 determines the type of the obstacle O existing in the determination target distance range ⁇ D using the reflection position calculated by the reflection position calculation unit 11 in step ST1. Specifically, for example, the type determination unit 12 includes both the first reflection position and the second reflection position in the reflection position within the determination target distance range ⁇ D among the reflection positions calculated by the reflection position calculation unit 11. If it is, the obstacle O corresponding to the reflection position is determined to be the wall W. Moreover, the kind determination part 12 determines with the obstacle O corresponding to the said reflection position being the curb C, when only the 1st reflection position is contained in the reflection position in determination object distance range (DELTA) D.
  • DELTA determination object distance range
  • step ST3 the guidance route setting unit 21 sets a parallel parking guidance route according to the obstacle type determination result in step ST2. Specifically, when the determination result indicates curb C, the guide route setting unit 21 sets a guide route in which the vehicle 1 is cut more than when the determination result indicates a wall W.
  • step ST4 the vehicle control unit 22 executes automatic parking by controlling the steering 5 and the like.
  • the vehicle control unit 22 executes automatic parking by parallel parking based on the guidance route set by the guidance route setting unit 21 in step ST3. Thereby, automatic parking is performed as shown in FIG.
  • the determination target distance range ⁇ D has a value of the level of the reflected wave by the curb C that is equal to or greater than the first threshold value Lth1 and less than the second threshold value Lth2, and the level value of the reflected wave from the wall W is equal to or greater than the second threshold value Lth2.
  • the distance range is not limited to the distance range of 1 to 3 meters.
  • the reflection position calculation unit 11 can calculate the reflection position so that the type determination unit 12 can determine whether the obstacle O within the determination target distance range ⁇ D is the wall W or the curb C.
  • the configuration is not limited to the configuration in which the first reflection position calculation process and the second reflection position calculation process are alternately and repeatedly executed.
  • the reflection position calculation unit 11 may calculate the reflection position as follows.
  • the reflection position calculation unit 11 causes the sonars 4L and 4R to transmit ultrasonic waves a plurality of times.
  • the reflected position calculation unit 11 receives a reflected wave having a level value greater than or equal to the first threshold value Lth1 and less than the second threshold value Lth2 for each ultrasonic wave, the reflected position (hereinafter referred to as “low reflection”). "Position”).
  • the reflected position calculation unit 11 receives a reflected wave having a level value equal to or greater than the second threshold value Lth2 for each ultrasonic wave, the reflected position (hereinafter referred to as “high reflection position”). ) Is calculated.
  • the type determination unit 12 when the reflection position within the determination target distance range ⁇ D among the reflection positions calculated by the reflection position calculation unit 11 is a high reflection position, the type determination unit 12 has an obstacle O corresponding to the reflection position. It is determined that the wall W. In addition, when the reflection position within the determination target distance range ⁇ D is the low reflection position among the reflection positions calculated by the reflection position calculation unit 11, the type determination unit 12 determines that the obstacle O corresponding to the reflection position is a curbstone. C is determined.
  • the parking assist device 100 includes the pair of left and right sonars 4L and 4R provided in the vehicle 1 and the first threshold value Lth1 that differs from each other in the level values of the reflected waves received by the sonars 4L and 4R. And an obstacle detection control unit that determines whether the obstacle O present in the lateral determination target distance range ⁇ D with respect to the vehicle 1 is the wall W or the curb C by comparing with each of the second threshold value Lth2. 10 and an automatic parking control unit 20 that sets a guidance route for automatic parking according to the determination result by the obstacle detection control unit 10, and the automatic parking control unit 20 determines the result of automatic parking by parallel parking.
  • a guide route in which the cut of the vehicle 1 is larger than when the determination result indicates the wall W is set.
  • a guide route that avoids contact between the vehicle 1 and the wall W can be set, and when the obstacle O is the curb C, the number of times of turning back is set.
  • a pair of left and right sonars 4L and 4R in the front half of the vehicle 1 it is possible to shorten the travel distance required for detecting the obstacle O with respect to the apparatus of Patent Document 1 using Fr sonar and Rr sonar. it can.
  • FIG. FIG. 9 is a functional block diagram showing a state where the parking assist apparatus according to Embodiment 2 of the present invention is mounted on a vehicle. With reference to FIG. 9, the parking assistance apparatus 200 of Embodiment 2 is demonstrated. In FIG. 9, the same blocks as those in the functional block diagram of the first embodiment shown in FIG.
  • the reflection position calculation unit 41 calculates a first reflection position by executing a first reflection position calculation process similar to that of the reflection position calculation unit 11 shown in FIG.
  • the reflection position calculation unit 41 calculates the second reflection position by executing a second reflection position calculation process similar to that of the reflection position calculation unit 11 shown in FIG.
  • the reflection position calculation unit 41 is configured to output the first reflection position, The calculation process and the second reflection position calculation process are repeatedly executed alternately.
  • FIG. 10 shows an example of the reflection position calculated by the reflection position calculation unit 41.
  • the first reflection position and the second reflection position are alternately arranged along the obstacle O1.
  • the obstacle O1 existing within the determination target distance range ⁇ D is the wall W
  • the first reflection position and the second reflection position are alternately arranged along the obstacle O1.
  • the obstacle O1 existing within the determination target distance range ⁇ D is the curb C
  • only the first reflection position is arranged along the obstacle O1. That is, the reflection position corresponding to the obstacle O1 is the same as that described in the first embodiment with reference to FIG.
  • the obstacles O2 and O3 existing on the near side of the obstacle O1 are other vehicles V.
  • the path of the ultrasonic waves is a path along the direction of the sonars 4L and 4R, that is, the same path as the arrow A1 shown in FIG. . Therefore, when the other vehicle V exists within the determination target distance range ⁇ D, the level value of the reflected wave by the other vehicle V becomes a value equal to or higher than the second threshold value Lth2 shown in FIG. For this reason, the reflection position is calculated by both the first reflection position calculation process and the second reflection position calculation process. As a result, as shown in FIG. 10, the first reflection position and the second reflection position are alternately arranged along the obstacles O2 and O3.
  • the grouping processing unit 42 groups the reflection positions calculated by the reflection position calculation unit 41. Specifically, for example, when the distance between a plurality of adjacent reflection positions is a value equal to or less than a predetermined value (for example, 30 centimeters), the grouping processing unit 42 sets these reflection positions in the same group. To do.
  • a predetermined value for example, 30 centimeters
  • FIG. 11 shows an example of a group set by the grouping processing unit 42.
  • the grouping processing unit 42 groups the reflection positions shown in FIG. 10A, as shown in FIG. 11A, a group G1 corresponding to the obstacle O1, a group G2 corresponding to the obstacle O2, and a group G3 corresponding to the obstacle O3 are obtained. Is set.
  • the grouping processing unit 42 groups the reflection positions shown in FIG. 10B, as shown in FIG. 11B, a group G1 corresponding to the obstacle O1, a group G2 corresponding to the obstacle O2, and a group corresponding to the obstacle O3.
  • G3 is set.
  • the type determination unit 43 uses each of the grouping results obtained by the grouping processing unit 42 to each of one or more obstacles (three obstacles O1 to O3 in the example of FIG. 10) existing within the determination target distance range ⁇ D. The type is determined. Specifically, for example, according to whether or not each group includes the second reflection position, the type determination unit 43 determines whether the obstacle corresponding to the group is the curb C, the wall W, or another vehicle. It is determined whether it is V. In addition, according to the shape of each group, the type determination unit 43 determines whether the obstacle corresponding to the group is the curb C or the wall W, the other vehicle V in the parallel parking state, or the other vehicle in the parallel parking state. It is determined whether it is V.
  • the type determination unit 43 uses a combination of a determination result based on the presence / absence of the second reflection position and a determination result based on the shape of the group, so that the obstacle corresponding to each group is a curb C, a wall W, and other vehicles in a parallel parking state. It is determined whether the vehicle is V or another vehicle V in the parallel parking state.
  • the type determination unit 43 calculates, for each of one or more groups set by the grouping processing unit 42, a straight line connecting two adjacent reflection positions (hereinafter referred to as a “line between reflection positions”). At the same time, a normal vector for each straight line between reflection positions is calculated.
  • FIG. 12 shows an example of the straight line SL between the reflection positions and the normal vector NV.
  • FIG. 12A shows the straight line SL and the normal vector NV between the reflection positions in the group corresponding to the wall W.
  • FIG. 12B shows the straight line SL and the normal vector NV between the reflection positions in the group corresponding to the curb C.
  • FIG. 12C shows the straight line SL and the normal vector NV between the reflection positions in the group corresponding to the other vehicle V in the parallel parking state.
  • FIG. 12D shows the straight line SL and the normal vector NV between the reflection positions in the group corresponding to the other vehicle V in the parallel parking state.
  • FIG. 13 shows a curve corresponding to a histogram in which the direction indicated by the normal vector NV is on the horizontal axis and the number of normal vectors NV indicating each direction is on the vertical axis.
  • Curve C1 corresponds to the histogram in the group corresponding to wall W or curb C.
  • Curve C2 corresponds to the histogram in the group corresponding to the other vehicle V in the parallel parking state.
  • a curve C3 corresponds to a histogram in a group corresponding to the other vehicle V in the parallel parking state.
  • the wall W or the curb C has many straight parts. For this reason, as shown in FIGS. 12A and 12B, a plurality of reflection positions are arranged in a straight line, and substantially all normal vectors NV indicate the same direction. As a result, as shown in FIG. 13, the group corresponding to the wall W or the curb C is a value indicating the variation in the direction indicated by the normal vector NV (hereinafter referred to as “variation value”.
  • the distribution width DW1 of the curve C1 the curve
  • the ratio of the distribution width DW1 to the peak value P1 of C1, the variance of the curve C1, or the standard deviation of the curve C1 is a small value.
  • the side portion of the other vehicle V has many straight portions.
  • a plurality of reflection positions are linearly arranged along the side surface portion of the other vehicle V.
  • the shape of the nose portion at the front end portion and the rear end portion of the other vehicle V (hereinafter collectively referred to as “nose portion”), the shape of the nose portion, the calculation accuracy of the reflection position by the reflection position calculation unit 41, and the nature of the ultrasonic wave
  • the plurality of reflection positions are arranged in a curved line or in a straight line along a direction different from the straight line along the side surface of the other vehicle V.
  • the group corresponding to the other vehicle V in the parallel parking state has a variation value in the direction indicated by the normal vector NV (for example, the distribution width DW2 of the curve C2 and the distribution with respect to the peak value P2 of the curve C2).
  • the ratio of the width DW2, the variance of the curve C2, or the standard deviation of the curve C2) is larger than the group corresponding to the wall W or the curb C.
  • the size of the other vehicle V in the left-right direction (hereinafter referred to as “vehicle width”) is smaller than the size of the other vehicle V in the front-rear direction (hereinafter referred to as “full length”).
  • vehicle width the size of the other vehicle V in the front-rear direction
  • full length the size of the other vehicle V in the front-rear direction
  • full length the size of the other vehicle V in the front-rear direction
  • the group corresponding to the other vehicle V in the parallel parking state has a variation value in the direction indicated by the normal vector NV (for example, the distribution width DW3 of the curve C3 and the distribution with respect to the peak value P3 of the curve C3).
  • the ratio of the width DW3, the variance of the curve C3, or the standard deviation of the curve C3) is larger than the group corresponding to the other vehicle V in the parallel parking state.
  • the type determination unit 43 includes a threshold value that is larger than the variation value of the curve C1 and smaller than the variation value of the curve C2 (hereinafter referred to as “first distribution threshold”), larger than the variation value of the curve C2, and A threshold value (hereinafter referred to as “second distribution threshold value”) smaller than the variation value of the curve C3 is set in advance.
  • the type determination unit 43 calculates a variation value of each group, and compares the calculated variation value with each of the first distribution threshold value and the second distribution threshold value. If the calculated variation value is less than the first distribution threshold, the type determination unit 43 determines that the obstacle corresponding to the group is the wall W or the curb C.
  • the type determination unit 43 determines that the obstacle corresponding to the group is the other vehicle V in the parallel parking state. If the calculated variation value is a value equal to or greater than the second distribution threshold, the type determination unit 43 determines that the obstacle corresponding to the group is the other vehicle V in the parallel parking state.
  • the curves corresponding to the histogram in which the horizontal axis is the direction along the straight line SL between the reflection positions and the vertical axis is the number of straight lines SL between the reflection positions along each direction are the same as the curves C1 to C3 shown in FIG. It becomes the curve.
  • the type determination unit 43 compares each variation value in the direction along the straight line SL between the reflection positions with the first distribution threshold and the second distribution threshold instead of the variation value in the direction indicated by the normal vector NV. The type of the corresponding obstacle may be determined.
  • the horizontal axis represents the angle formed by a predetermined reference direction (for example, the traveling direction of the vehicle 1) and the straight line SL between the reflection positions
  • the vertical axis represents the number of straight lines SL between the reflection positions.
  • the curve to be is similar to the curves C1 to C3 shown in FIG.
  • the type determination unit 43 compares the angle variation value formed by the reference direction and the reflection position straight line SL with the first distribution threshold value and the second distribution threshold value instead of the variation value in the direction indicated by the normal vector NV.
  • the type of obstacle corresponding to each group may be determined.
  • FIG. 14 shows a table corresponding to the determination method based on the presence / absence of the second reflection position and the shape of the group.
  • FIG. 14A shows a table when the variation value in the direction indicated by the normal vector NV is used.
  • FIG. 14B shows a table in the case of using the variation value in the direction along the straight line SL between the reflection positions.
  • FIG. 14C shows a table in the case of using the variation value of the angle formed by the reference direction and the straight line SL between the reflection positions.
  • “Small” in the figure indicates that the variation value is less than the first distribution threshold.
  • “Medium” indicates that the variation value is not less than the first distribution threshold and less than the second distribution threshold.
  • “Large” indicates that the variation value is equal to or greater than the second distribution threshold.
  • the parking mode setting unit 51 uses the grouping result by the grouping processing unit 42 and the determination result by the type determining unit 43 to perform an automatic parking mode (hereinafter referred to as “parking mode”) executed by the vehicle control unit 54 described later. Is set. Specifically, for example, when the other vehicle V exists in the parallel parking state within the determination target distance range ⁇ D, the parking configuration setting unit 51 determines the parking configuration to be parallel parking. Moreover, when the other vehicle V exists in the parallel parking state within the determination target distance range ⁇ D, the parking mode setting unit 51 sets the parking mode to parallel parking.
  • the parking section setting unit 52 is a section in which the vehicle 1 can be parked according to the grouping result by the grouping processing unit 42, the determination result by the type determining unit 43, and the parking mode set by the parking mode setting unit 51 (hereinafter “Parking available section”)).
  • the parking section setting unit 52 sets the extracted parking available section as a section (hereinafter referred to as “parking target section”) that is a target of automatic parking executed by the vehicle control unit 54 described later.
  • the parking section setting unit 52 information indicating the total length and the vehicle width of the vehicle 1 is stored in advance.
  • the parking section setting unit 52 extracts a section where there is no obstacle such as the other vehicle V over a distance range larger than the total length of the vehicle 1 as a parkingable section.
  • the parking section setting unit 52 can park a section where there is no obstacle such as another vehicle V over a distance range larger than the vehicle width of the vehicle 1. Extract as The parking zone setting unit 52 sets the extracted parking available zone as the parking target zone.
  • the guide route setting unit 53 corresponds to the result of grouping by the grouping processing unit 42, the determination result by the type determining unit 43, the parking mode set by the parking mode setting unit 51, and the parking target zone set by the parking zone setting unit 52. In this case, a guidance route for automatic parking is set.
  • the guide route setting unit 53 sets a guide route for parallel parking. Since the parallel parking guidance route is the same as that described with reference to FIG. 6 in the first embodiment, illustration and description thereof are omitted. Moreover, when the parking mode is set to parallel parking, the guidance route setting unit 53 sets a guidance route for parallel parking.
  • the guide route for parallel parking is a normal guide route as shown by an arrow A7 in FIG.
  • the vehicle control unit 54 performs automatic parking by parallel parking or parallel parking by controlling the steering 5 of the vehicle 1 based on the guidance route set by the guidance route setting unit 53.
  • the vehicle control unit 54 may control the brake 6 provided in the vehicle 1 in addition to the steering 5. Further, the vehicle control unit 54 may control the torque of the engine 7 provided in the vehicle 1 as necessary in addition to the steering 5 and the brake 6.
  • the obstacle detection control unit 40 is configured by the reflection position calculation unit 41, the grouping processing unit 42, and the type determination unit 43.
  • the parking mode setting unit 51, the parking section setting unit 52, the guidance route setting unit 53, and the vehicle control unit 54 constitute an automatic parking control unit 50.
  • the obstacle detection control unit 40 and the automatic parking control unit 50 constitute a main part of the control device 60.
  • the sonar 4L, 4R and the control device 60 constitute a parking assist device 200.
  • control device 60 Since the hardware configuration of the main part of the control device 60 is the same as that described with reference to FIG. 7 in the first embodiment, illustration and description thereof are omitted.
  • control device 60 When a predetermined start condition is satisfied, for example, when an operation instructing execution of automatic parking is input to an operation input device (not shown), the control device 60 travels at a speed equal to or lower than the reference speed. If so, the process of step ST11 is started.
  • the reflection position calculation unit 41 calculates the reflection position. Specifically, for example, the reflection position calculation unit 41 repeatedly executes the first reflection position calculation process and the second reflection calculation unit alternately. For example, the reflection position calculation unit 41 repeatedly executes the reflection position calculation process until the vehicle 1 stops.
  • step ST12 the grouping processing unit 42 groups the reflection positions within the determination target distance range ⁇ D among the reflection positions calculated by the reflection position calculation unit 41 in step ST11. Specifically, for example, when the distance between a plurality of adjacent reflection positions is a value equal to or less than a predetermined value (for example, 30 centimeters), the grouping processing unit 42 sets these reflection positions in the same group. To do.
  • a predetermined value for example, 30 centimeters
  • the type determining unit 43 determines the type of obstacle corresponding to each of the one or more groups set by the grouping processing unit 42 in step ST12. Specifically, for example, based on the table shown in any one of FIGS. 14A to 14C, the type determination unit 43 has an obstacle corresponding to each group as a curb C, a wall W, and other vehicles V in a parallel parking state. Or the other vehicle V in the parallel parking state.
  • step ST14 the parking configuration setting unit 51 sets the parking configuration using the grouping result in step ST12 and the obstacle type determination result in step ST13. Specifically, for example, when the other vehicle V exists in the parallel parking state within the determination target distance range ⁇ D, the parking form setting unit 51 sets the parking form to parallel parking. Moreover, when the other vehicle V exists in the parallel parking state within the determination target distance range ⁇ D, the parking mode setting unit 51 sets the parking mode to parallel parking.
  • step ST15 the parking section setting unit 52 extracts a parking available section according to the grouping result in step ST12, the determination result of the obstacle type in step ST13, and the parking mode set in step ST14. Execute the process. Specifically, for example, when the parking mode is set to parallel parking, the parking section setting unit 52 selects a section where there is no obstacle such as another vehicle V over a distance range larger than the total length of the vehicle 1. It is extracted as a section where parking is possible. On the other hand, when the parking mode is set to parallel parking, the parking section setting unit 52 sets a section where there is no obstacle such as the other vehicle V over a distance range larger than the vehicle width of the vehicle 1 as a parkable section. Extract.
  • step ST16 the parking section setting unit 52 determines whether or not automatic parking by the vehicle control unit 54 is possible. That is, when a parking available section is extracted by the process of step ST15, the parking section setting unit 52 determines that automatic parking can be executed (step ST16 “YES”). On the other hand, when the parking available section is not extracted by the process of step ST15, the parking section setting unit 52 determines that execution of automatic parking is impossible (step ST16 “NO”).
  • step ST16 “YES” the parking section setting unit 52 sets the parking target section in step ST17. That is, the parking zone setting unit 52 sets the parking available zone extracted by the process of step ST15 as the parking target zone.
  • step ST18 the guidance route setting unit 53 determines the result of grouping in step ST12, the determination result of the type of obstacle in step ST13, the parking mode set in step ST14, and the parking object set in step ST17.
  • a guidance route for automatic parking is set according to the section. That is, when the parking mode is set to parallel parking, the guide route setting unit 53 sets a guide route for parallel parking as shown in FIG. On the other hand, when the parking mode is set to parallel parking, the guidance route setting unit 53 sets the guidance route for parallel parking as shown in FIG.
  • step ST19 the vehicle control unit 54 executes automatic parking by controlling the steering 5 and the like.
  • the vehicle control part 54 performs the automatic parking by parallel parking or parallel parking based on the guidance path
  • step ST16 “NO”) the processing of steps ST17 to ST19 is skipped.
  • the control device 60 displays on the display device (not shown) such as a liquid crystal display provided in the vehicle 1 an image indicating that there is no parking available section or that automatic parking is impossible. It may be made to do.
  • the control device 60 causes a sound output device (not shown) such as a speaker provided in the vehicle 1 to output a sound indicating that there is no parkable section or that automatic parking cannot be performed. It may be a thing.
  • the parking section setting unit 52 extracts a plurality of parking available sections in step ST15, and in step ST17, any one of the plurality of parking available sections (for example, the current position of the vehicle 1 is the most).
  • the closest parking possible section or the parking possible section where there is no obstacle such as the other vehicle V over the longest distance may be set as the parking target section.
  • the condition for selecting the parking available section that is the parking target section may be set in advance in the control device 60 or may be set by the user. Thereby, when there are a plurality of parking available sections, a parking available section more suitable for automatic parking can be set as the parking target section.
  • the types of obstacles determined by the type determining unit 43 are not limited to the four types of curb C, wall W, other vehicle V in the parallel parking state, or other vehicle V in the parallel parking state.
  • the type determination unit 43 is a step that allows an obstacle corresponding to the group to get over. May be determined.
  • FIG. 17 shows another example of the reflection position calculated by the reflection position calculation unit 41.
  • step difference S which the obstruction O4 which exists in this side rather than the obstructions O2 and O3 can get over.
  • the path of the ultrasonic waves is a path shifted downward from the directing direction of the sonars 4L and 4R, that is, similar to the arrow A2 shown in FIG. It becomes a route. Therefore, when the step S exists within the determination target distance range ⁇ D, the level value of the reflected wave by the step S is a value that is greater than or equal to the first threshold Lth1 and less than the second threshold Lth2. For this reason, while the reflection position is calculated by the first reflection position calculation process, the reflection position is not calculated by the second reflection position calculation process. As a result, as shown in FIG. 17, only the first reflection position is arranged along the obstacle O4.
  • FIG. 18 shows an example of the waveform of the reflected wave from the obstacles O1 to O4 shown in FIG.
  • WF1 indicates the waveform of the reflected wave by the obstacle O4, that is, the step S.
  • WF2 indicates the waveform of the reflected wave from the obstacle O2 or the obstacle O3, that is, the other vehicle V.
  • WF3 shows the waveform of the reflected wave from the obstacle O1, that is, the curb C.
  • the level value of the reflected wave due to the step S is a value that is not less than the first threshold value Lth1 and less than the second threshold value Lth2.
  • the level value of the reflected wave by the other vehicle V is a value equal to or greater than the second threshold value Lth2.
  • the level value of the reflected wave by the curb C is a value not less than the first threshold value Lth1 and less than the second threshold value Lth2.
  • the reflection position calculation unit 11 can calculate the reflection position by distinguishing the reflected wave from the obstacle O4 and the reflected waves from the obstacles O2 and O3. Similarly, the reflection position calculation unit 11 can calculate the reflection position by distinguishing between the reflected wave due to the obstacle O4 (step S) and the reflected wave due to the obstacle O1 (curbstone C).
  • FIG. 19 shows another example of the group set by the grouping processing unit 42.
  • the group G4 corresponds to the obstacle O4.
  • the type determining unit 43 determines the types of the obstacles O1 to O4 corresponding to the groups G1 to G4 based on the table shown in any of FIGS. 14A to 14C. Thereby, it is determined that the obstacle O1 and the obstacle O4 are the curb C, and the obstacle O2 and the obstacle O3 are determined to be the other vehicle V.
  • the type determination unit 43 presents the determination result for the obstacle O4 corresponding to the group G4 that exists on the near side of the groups G2 and G3 determined to correspond to the other vehicle V and includes only the first reflection position. Correct from curb C to step S.
  • the vehicle control unit 54 controls the torque of the engine 7 so that the vehicle 1 can get over the step S when executing automatic parking. It may be what you do.
  • the parking support apparatus 200 can employ various modifications similar to those described in the first embodiment.
  • the reflection position calculation unit 41 may calculate a low reflection position and a high reflection position instead of the first reflection position and the second reflection position.
  • the type determination unit 43 determines whether the group includes the group according to whether the reflection position included in each group is a low reflection position or a high reflection position. It is also possible to determine the type of obstacle corresponding to.
  • the obstacle detection control unit 40 groups the reflection positions of the reflected waves indicated by the comparison result between the level value and the first threshold value and the second threshold value.
  • Groups G1 to G3 corresponding to the obstacles O1 to O3 are set, and it is determined whether the obstacles O1 to O3 are walls W, curbs C, or other vehicles V according to the shapes of the groups G1 to G3. Thereby, it is possible to set an appropriate guidance route according to the types of the obstacles O1 to O3.
  • the automatic parking control unit 50 sets a parallel parking guidance route or a parallel parking guidance route according to the grouping result by the obstacle detection control unit 40. Thereby, it can prevent that the vehicle control part 54 performs the automatic parking by parallel parking with respect to the section for parallel parking, or performs the automatic parking by parallel parking with respect to the section for parallel parking. . That is, the occurrence of erroneous parking by the vehicle control unit 54 can be prevented.
  • FIG. 20 is a functional block diagram showing a state where the parking assistance apparatus according to Embodiment 3 of the present invention is mounted on a vehicle. With reference to FIG. 20, the parking assistance apparatus 200a of Embodiment 3 is demonstrated. In FIG. 20, blocks similar to those in the functional block diagram of the second embodiment shown in FIG.
  • the reflection position calculation unit 41 calculates the reflection position.
  • FIG. 21 shows an example of the reflection position calculated by the reflection position calculation unit 41.
  • FIG. 21A when the obstacle O1 existing in the determination target distance range ⁇ D is the wall W, the first reflection position and the second reflection position are alternately arranged along the obstacle O1.
  • FIG. 21B when the obstacle O1 existing within the determination target distance range ⁇ D is the curb C, only the first reflection position is arranged along the obstacle O1. That is, the reflection position corresponding to the obstacle O1 is the same as that described in the first embodiment with reference to FIG.
  • the obstacles O2 and O3 existing on the near side of the obstacle O1 are other vehicles V.
  • the first reflection position and the second reflection position are alternately arranged along the obstacles O2 and O3. Is done. That is, the reflection positions corresponding to the obstacles O2 and O3 are the same as those described with reference to FIG. 10 in the second embodiment.
  • the obstacle O5 existing between the obstacles O2 and O3 is a pole P that cannot be overcome.
  • the path of the ultrasonic waves is a path along the direction of the sonars 4L and 4R, that is, the same path as the arrow A1 shown in FIG. Therefore, when the pole P exists within the determination target distance range ⁇ D, the level value of the reflected wave by the pole P becomes a value equal to or greater than the second threshold value Lth2 shown in FIG. For this reason, the reflection position is calculated by both the first reflection position calculation process and the second reflection position calculation process. As a result, as shown in FIG. 21, the first reflection position and the second reflection position are alternately arranged along the obstacle O5.
  • the grouping processing unit 42 groups the reflection positions calculated by the reflection position calculation unit 41.
  • FIG. 22 shows an example of a group set by the grouping processing unit 42.
  • the grouping processing unit 42 groups the reflection positions shown in FIG. 21A, as shown in FIG. 22A, groups G1A and G1B corresponding to the obstacle O1, group G2 corresponding to the obstacle O2, and group G3 corresponding to the obstacle O3.
  • a group G5 corresponding to the obstacle O5 is set.
  • the grouping processing unit 42 groups the reflection positions shown in FIG. 21B, the groups G1A and G1B corresponding to the obstacle O1, the group G2 corresponding to the obstacle O2, and the obstacle O3 correspond to the obstacle O1, as shown in FIG. 22B.
  • a group G3 corresponding to the group G3 and the obstacle O5 is set.
  • the type determination unit 43a uses the grouping result obtained by the grouping processing unit 42 to provide one or more obstacles (four obstacles O1 to O3 and O5 in the example of FIG. 21) existing within the determination target distance range ⁇ D. Each type is determined. Specifically, for example, the type determination unit 43a determines whether or not the obstacle corresponding to the group is a pole P according to the width of each group. In addition, the type determination unit 43a determines whether the obstacle corresponding to the group is the curb C depending on whether or not the second reflection position is included in each group except the group determined to be the pole P. Whether it is a wall W or another vehicle V is determined.
  • the type determination unit 43a is the wall W or the other vehicle V in the parallel parking state according to the shape of each group. Or another vehicle V in the parallel parking state.
  • the type determination unit 43a combines the determination result based on the width of the group, the determination result based on the presence / absence of the second reflection position, and the determination result based on the shape of the group, so that the obstacle corresponding to each group is curb C, It is determined whether the vehicle is the wall W, the other vehicle V in the parallel parking state, the other vehicle V in the parallel parking state, or the pole P.
  • the type determination unit 43a calculates the width of each of one or more groups set by the grouping processing unit 42. Specifically, for example, the type determination unit 43a calculates the width W1A of the group G1A, the width W1B of the group G1B, the width W2 of the group G2, the width W3 of the group G3, and the width W5 of the group G5 shown in FIG. .
  • the width of the group corresponding to the pole P is smaller than the width of the group corresponding to the curb C, the wall W, the other vehicle V in the parallel parking state, or the other vehicle V in the parallel parking state.
  • the width W5 of the group G5 corresponding to the pole P is smaller than the widths W1A, W1B, W2, and W3 of the other groups G1A, G1B, G2, and G3.
  • the type determination unit 43a has a threshold value (hereinafter referred to as “first”) that is larger than the width W5 of the group G5 corresponding to the pole P and smaller than the widths W1A, W1B, W2, and W3 of the other groups G1A, G1B, G2, and G3. "1 width threshold”) is set in advance.
  • the type determination unit 43a compares the calculated width of each group with the first width threshold. If the calculated width is a value less than the first width threshold, the type determination unit 43a determines that the obstacle corresponding to the group is a pole P, and the calculated width is a value greater than or equal to the first width threshold. In this case, it is determined that the obstacle corresponding to the group is not the pole P.
  • FIG. 23 shows a table corresponding to the determination method based on the group width and the presence / absence of the second reflection position. “Small” in the figure indicates that the group width is a value less than the first width threshold. “Large” indicates that the group width is equal to or greater than the first width threshold.
  • the type determination unit 43a determines the obstacle W determined based on the table shown in FIG. 23 as the wall W or the other vehicle V based on the table shown in any of FIGS. 24A to 24C. It is determined whether the other vehicle V in the parking state or the other vehicle V in the parallel parking state.
  • the parking section setting unit 52a extracts a parking available section according to the grouping result by the grouping processing unit 42, the determination result by the type determining unit 43a, and the parking mode set by the parking mode setting unit 51. Moreover, the parking area setting part 52a sets the extracted parking available area to a parking object area.
  • the parking section setting unit 52a when the parking mode is set to parallel parking, the parking section setting unit 52a has an obstacle such as the other vehicle V or the pole P over a distance range larger than the total length of the vehicle 1. The section not to be extracted is extracted as a parking available section.
  • the parking zone setting unit 52a sets a zone where there is no obstacle such as the other vehicle V or the pole P over a distance range larger than the vehicle width of the vehicle 1. It is extracted as a section where parking is possible.
  • the parking section setting unit 52a sets the extracted parking available section as a parking target section.
  • the obstacle detection control unit 40a is configured by the reflection position calculation unit 41, the grouping processing unit 42, and the type determination unit 43a.
  • the parking mode setting unit 51, the parking section setting unit 52a, the guidance route setting unit 53, and the vehicle control unit 54 constitute an automatic parking control unit 50a.
  • the obstacle detection control unit 40a and the automatic parking control unit 50a constitute the main part of the control device 60a.
  • the sonar 4L, 4R and the control device 60a constitute a parking assist device 200a.
  • control device 60a Since the hardware configuration of the main part of the control device 60a is the same as that described with reference to FIG. 7 in the first embodiment, illustration and description thereof are omitted.
  • step ST13 the type determination unit 43a determines that the obstacle corresponding to each group is a curb C, a wall W, a column based on the table shown in FIG. 23 and the table shown in any of FIGS. 24A to 24C. It is determined whether the other vehicle V in the parking state, the other vehicle V in the parallel parking state, or the pole P.
  • step ST15 when the parking mode is set to parallel parking, the parking section setting unit 52a has an obstacle such as another vehicle V or a pole P over a distance range larger than the total length of the vehicle 1.
  • the section not to be extracted is extracted as a parkable section and the parking mode is set to parallel parking, a section where there is no obstacle such as the other vehicle V or the pole P over a distance range larger than the vehicle width of the vehicle 1 It is extracted as a section where parking is possible.
  • the type determining unit 43a compares the partial width of each group with a threshold instead of the overall width of each group as shown in FIG. It may be a thing. Specifically, for example, as shown in FIG. 25, the type determination unit 43a performs linear portion widths W1A ′, W1B ′, W2 ′, W3 ′, of the groups G1A, G1B, G2, G3, and G5. W5 ′ is calculated.
  • the type determination unit 43a includes a width W5 ′ of the linear portion of the group G5 corresponding to the pole P and the width of the linear portion of the other groups G1A, G1B, G2, G3.
  • Threshold values smaller than W1A ′, W1B ′, W2 ′, and W3 ′ are set in advance.
  • the type determination unit 43a determines whether or not the obstacle corresponding to the group is the pole P by comparing the width of the linear portion of each group with the threshold value.
  • the type determination unit 43a determines whether the obstacle corresponding to the group is the other vehicle V in the parallel parking state or the other vehicle V in the parallel parking state based on the width of each group instead of the shape of each group. May be used.
  • the width of the group corresponding to the other vehicle V in the parallel parking state is smaller than the width of the group corresponding to the other vehicle V in the parallel parking state.
  • the width of the group corresponding to the other vehicle V in the parallel parking state is larger than the width of the group corresponding to the other vehicle V in the parallel parking state.
  • a threshold (hereinafter referred to as “second width threshold”) is set in advance. First, the type determination unit 43a determines whether or not the obstacle corresponding to each group is a pole P by comparing the width of each group with the first width threshold.
  • the type determination unit 43a determines that the obstacle corresponding to the group is a curb C, a wall by a determination method based on the presence / absence of the second reflection position and the shape of the group. Whether it is W or other vehicle V is determined.
  • the type determination unit 43a compares the width of each group with the second width threshold for the group determined to be the other vehicle V, so that the obstacle corresponding to the group is the other vehicle V in the parallel parking state. It is determined whether the vehicle V is in the parallel parking state.
  • the parking support apparatus 200a can employ various modifications similar to those described in the first embodiment or the second embodiment.
  • the reflection position calculation unit 41 may calculate a low reflection position and a high reflection position instead of the first reflection position and the second reflection position.
  • the type determination unit 43a determines whether the reflection position included in each group is a low reflection position or a high reflection position. The type of the corresponding obstacle may be determined.
  • the obstacle detection control unit 40a is configured according to the widths W1A, W1B, W2, W3, and W5 of the groups G1A, G1B, G2, G3, and G5. It is determined whether or not O1 to O3 and O5 are poles P. By detecting the pole P with the obstacle detection control unit 40a, the automatic parking control unit 50a excludes the section where the pole P exists from the parking target section, or avoids the contact between the vehicle 1 and the pole P. Route can be set.
  • the parking assist device of the present invention can be used for automatic parking by parallel parking, for example.

Landscapes

  • Engineering & Computer Science (AREA)
  • Radar, Positioning & Navigation (AREA)
  • Remote Sensing (AREA)
  • Physics & Mathematics (AREA)
  • General Physics & Mathematics (AREA)
  • Mechanical Engineering (AREA)
  • Computer Networks & Wireless Communication (AREA)
  • Transportation (AREA)
  • Acoustics & Sound (AREA)
  • Chemical & Material Sciences (AREA)
  • Combustion & Propulsion (AREA)
  • Automation & Control Theory (AREA)
  • Multimedia (AREA)
  • Theoretical Computer Science (AREA)
  • Traffic Control Systems (AREA)
  • Control Of Driving Devices And Active Controlling Of Vehicle (AREA)
  • Measurement Of Velocity Or Position Using Acoustic Or Ultrasonic Waves (AREA)
  • Steering Control In Accordance With Driving Conditions (AREA)

Abstract

駐車支援装置(100)は、車両(1)に設けられた左右一対のソナー(4L,4R)と、ソナー(4L,4R)が受信した反射波のレベル値を互いに異なる第1閾値(Lth1)及び第2閾値(Lth2)の各々と比較することにより、車両(1)に対する側方の判定対象距離範囲(ΔD)内に存在する障害物(O)が壁(W)であるか縁石(C)であるかを判定する障害物検知制御部(10)と、障害物検知制御部(10)による判定結果に応じて、自動駐車用の誘導経路を設定する自動駐車制御部(20)とを備え、自動駐車制御部(20)は、縦列駐車による自動駐車において、判定結果が縁石(C)を示している場合、判定結果が壁(W)を示している場合に対して車両(1)の切り込みが大きい誘導経路を設定する。

Description

駐車支援装置
 本発明は、駐車支援装置に関する。
 従来、車両が駐車するときに当該車両のステアリング等を自動で制御する、いわゆる「自動駐車」の技術が開発されている。また、自動駐車において、車両に設けられたソナーを用いて当該車両の周辺に存在する障害物を検知し、当該障害物を回避した誘導経路を設定する技術が開発されている。
 例えば、特許文献1の車両Vは、車両側部のうちの前方に左右一対のFrソナー31が取り付けられており、かつ、車両側部のうちの後方に左右一対のRrソナー32が取り付けられている。Rrソナー32の検知可能範囲は、Frソナー31の検知可能範囲よりも下方に設定されている。ECU10は、Frソナー31及びRrソナー32、すなわち車両Vの両側部に2個ずつ設けられたソナーを用いることにより、他車両Va,Vb及び柱Fなどの乗り越え不可能な障害物と、縁石E,E1などの乗り越え可能な低障害物とを検知する。ECU10は、Frソナー31及びRrソナー32による検知結果を用いて、特許文献1の図6に示す如く自動駐車を実行する(特許文献1の図1、図2及び図6等参照)。
特開2014-101101号公報
 特許文献1には、縦列駐車において他車両の奥側に縁石が存在する場合の自動駐車について記載されている(特許文献1の段落[0045]、図6(d)等参照)。しかしながら、縦列駐車において他車両の奥側に存在する障害物は縁石に限定されるものではなく、例えば壁などの乗り越え不可能な障害物が存在する場合もある。他車両の奥側に壁が存在する状態にて、他車両の奥側に縁石が存在するときと同様の誘導経路による自動駐車を実行した場合、車両の隅部が壁と接触する可能性がある。このように、特許文献1の駐車支援装置は、縦列駐車による自動駐車を実行するとき、障害物が縁石であるか壁であるかに応じて適切な誘導経路を設定することができない問題があった。
 また、特許文献1の駐車支援装置は、車両の両側部に2個ずつ設けられたソナー、すなわち合計4個のソナーを用いて障害物及び低障害物を検知する。この構成は、FrソナーとRrソナー間の干渉を避ける観点から、FrソナーとRrソナー間の配置間隔を大きくすること、すなわちFrソナーとRrソナーとを車両の前後方向に対して互いにずらして配置することが求められる。このため、縦列駐車又は並列駐車による自動駐車において、車両が低速度にて走行しながら当該車両の側方に存在する障害物及び低障害物を検知するとき、検知に要する走行距離が長くなる問題があった。また、同一の障害物又は低障害物に対して、Frソナーによる検知のタイミングとRrソナーによる検知のタイミングとがずれるため、検知精度が低い問題があった。
 本発明は、上記のような課題を解決するためになされたものであり、縦列駐車による自動駐車を実行するとき、障害物が縁石であるか壁であるかに応じて適切な誘導経路を設定することができる駐車支援装置を提供することを目的とする。
 本発明の駐車支援装置は、車両に設けられた左右一対のソナーと、ソナーが受信した反射波のレベル値を互いに異なる第1閾値及び第2閾値の各々と比較することにより、車両に対する側方の判定対象距離範囲内に存在する障害物が壁であるか縁石であるかを判定する障害物検知制御部と、障害物検知制御部による判定結果に応じて、自動駐車用の誘導経路を設定する自動駐車制御部とを備え、自動駐車制御部は、縦列駐車による自動駐車において、判定結果が縁石を示している場合、判定結果が壁を示している場合に対して車両の切り込みが大きい誘導経路を設定するものである。
 本発明の駐車支援装置は、縦列駐車による自動駐車を実行するとき、障害物が縁石であるか壁であるかに応じて適切な誘導経路を設定することができる。
本発明の実施の形態1に係る駐車支援装置が車両に搭載された状態を示す機能ブロック図である。 図2Aは、本発明の実施の形態1に係る左ソナーによる超音波の放射パターンと、壁により反射される超音波の経路とを示す説明図である。図2Bは、本発明の実施の形態1に係る左ソナーによる超音波の放射パターンと、縁石により反射される超音波の経路とを示す説明図である。 車両と障害物間の距離に対する反射波のレベル値を示す特性図である。 図4Aは、本発明の実施の形態1に係る反射位置算出部が算出した反射位置を示す説明図である。図4Bは、本発明の実施の形態1に係る反射位置算出部が算出した他の反射位置を示す説明図である。 本発明の実施の形態1に係る種類判定部による判定方法に対応するテーブルを示す説明図である。 図6Aは、本発明の実施の形態1に係る誘導経路設定部が設定した縦列駐車用の誘導経路を示す説明図である。図6Bは、本発明の実施の形態1に係る誘導経路設定部が設定した縦列駐車用の他の誘導経路を示す説明図である。 図7Aは、本発明の実施の形態1に係る制御装置の要部を示すハードウェア構成図である。図7Bは、本発明の実施の形態1に係る制御装置の要部を示す他のハードウェア構成図である。 本発明の実施の形態1に係る制御装置の動作を示すフローチャートである。 本発明の実施の形態2に係る駐車支援装置が車両に搭載された状態を示す機能ブロック図である。 図10Aは、本発明の実施の形態2に係る反射位置算出部が算出した反射位置を示す説明図である。図10Bは、本発明の実施の形態2に係る反射位置算出部が算出した他の反射位置を示す説明図である。 図11Aは、本発明の実施の形態2に係るグルーピング処理部が設定したグループを示す説明図である。図11Bは、本発明の実施の形態2に係るグルーピング処理部が設定した他のグループを示す説明図である。 図12Aは、壁に対応するグループにおける反射位置間直線及び法線ベクトルを示す説明図である。図12Bは、縁石に対応するグループにおける反射位置間直線及び法線ベクトルを示す説明図である。図12Cは、縦列駐車状態の他車両に対応するグループにおける反射位置間直線及び法線ベクトルを示す説明図である。図12Dは、並列駐車状態の他車両に対応するグループにおける反射位置間直線及び法線ベクトルを示す説明図である。 各グループにおける法線ベクトルが示す方向のばらつきを示すヒストグラムに対応する曲線を示す特性図である。 図14Aは、本発明の実施の形態2に係る種類判定部による判定方法に対応するテーブルを示す説明図である。図14Bは、本発明の実施の形態2に係る種類判定部による判定方法に対応する他のテーブルを示す説明図である。図14Cは、本発明の実施の形態2に係る種類判定部による判定方法に対応する他のテーブルを示す説明図である。 本発明の実施の形態2に係る誘導経路設定部が設定した並列駐車用の誘導経路を示す説明図である。 本発明の実施の形態2に係る制御装置の動作を示すフローチャートである。 本発明の実施の形態2に係る反射位置算出部が算出した他の反射位置を示す説明図である。 段差による反射波の波形、他車両による反射波の波形、及び縁石による反射波の波形を示す特性図である。 本発明の実施の形態2に係るグルーピング処理部が設定した他のグループを示す説明図である。 本発明の実施の形態3に係る駐車支援装置が車両に搭載された状態を示す機能ブロック図である。 図21Aは、本発明の実施の形態3に係る反射位置算出部が算出した反射位置を示す説明図である。図21Bは、本発明の実施の形態3に係る反射位置算出部が算出した他の反射位置を示す説明図である。 図22Aは、本発明の実施の形態3に係るグルーピング処理部が設定したグループを示す説明図である。図22Bは、本発明の実施の形態3に係るグルーピング処理部が設定した他のグループを示す説明図である。 本発明の実施の形態3に係る種類判定部による判定方法に対応するテーブルを示す説明図である。 図24Aは、本発明の実施の形態3に係る種類判定部による判定方法に対応する他のテーブルを示す説明図である。図24Bは、本発明の実施の形態3に係る種類判定部による判定方法に対応する他のテーブルを示す説明図である。図24Cは、本発明の実施の形態3に係る種類判定部による判定方法に対応する他のテーブルを示す説明図である。 図25Aは、本発明の実施の形態3に係るグルーピング処理部が設定した他のグループを示す説明図である。図25Bは、本発明の実施の形態3に係るグルーピング処理部が設定した他のグループを示す説明図である。
 以下、この発明をより詳細に説明するために、この発明を実施するための形態について、添付の図面に従って説明する。
実施の形態1.
 図1は、本発明の実施の形態1に係る駐車支援装置が車両に搭載された状態を示す機能ブロック図である。図1を参照して、実施の形態1の駐車支援装置100について、四輪自動車からなる車両1に応用した例を中心に説明する。
 車輪速センサ2は、車両1の車輪の回転速度を検知して、この回転速度を示す信号を出力するものである。ヨーレートセンサ3は、車両1のヨーレートを検知して、このヨーレートを示す信号を出力するものである。
 左ソナー4Lは、例えば、車両1の左側部のうちの前半部に設けられた単一の超音波センサにより構成されている。右ソナー4Rは、例えば、車両1の右側部のうちの前半部に設けられた単一の超音波センサにより構成されている。以下、左ソナー4L及び右ソナー4Rを総称して単に「ソナー」ということがある。ソナー4L,4Rは、車両1の側方に向けて超音波を放射するとともに、車両1の側方に存在する障害物により反射された超音波(以下「反射波」という。)を受信するものである。
 図2に、左ソナー4Lによる超音波の放射パターンEPの一例を示す。図2に示す如く、左ソナー4Lは水平方向に沿う向きの指向性を有している。図2Aにおける矢印A1は、車両1の左方に壁Wが存在する場合において、左ソナー4Lの放射した超音波が壁Wにより反射されるときの超音波の経路を示している。当該経路は、左ソナー4Lの指向方向に沿う経路である。また、図2Bにおける矢印A2は、車両1の左方に縁石Cが存在する場合において、左ソナー4Lの放射した超音波が縁石Cにより反射されるときの超音波の経路を示している。当該経路は、左ソナー4Lの指向方向に対して下向きにずれた経路である。このため、車両1と縁石C間の距離D2が車両1と壁W間の距離D1と同等の値である場合、縁石Cによる反射波のレベル値は壁Wによる反射波のレベル値よりも小さい値となる。
 なお、右ソナー4Rは左ソナー4Lと同様の指向性を有しており、かつ、右ソナー4Rによる超音波の放射パターンは図2に示す放射パターンEPと同様のものである。このため、右ソナー4Rによる超音波の放射パターン等については図示及び説明を省略する。
 図3に、車両1と車両1の側方に存在する障害物との間の距離を横軸とし、かつ、ソナー4L,4Rが受信する当該障害物による反射波のレベル値を縦軸とした特性図を示す。図3における特性線CL1は、壁Wによる反射波のレベル値を示している。壁Wによる反射波のレベル値は、車両1と壁W間の距離が大きくなるにつれて次第に小さくなる。また、図3における特性線CL2は、縁石Cによる反射波のレベル値を示している。縁石Cによる反射波のレベル値は、略全体の距離範囲に亘り、壁Wによる反射波のレベル値よりも小さい値である。
 ここで、特性線CL2は、特性線CL1と異なり、車両1と縁石C間の距離が略2メートルの部位にレベル値のピークを有している。これは、車両1と縁石C間の距離が小さくなるにつれて、ソナー4L,4Rの指向方向と超音波の経路(すなわち図2Bに示す矢印A2に対応する経路)とのずれが次第に大きくなり、縁石Cがソナー4L,4Rによる検知可能エリアから外れていくためである。この結果、特性線CL2のピークを含む所定の距離範囲(図3の例では1~3メートルの距離範囲)ΔD内にて、縁石Cによる反射波のレベル値がLth1以上かつLth2未満の値となり、かつ、壁Wによる反射波のレベル値がLth2以上の値となる。図3に示すLth1は、反射位置算出部11に設定された第1閾値に対応している。図3に示すLth2は、反射位置算出部11に設定された第2閾値に対応している。
 反射位置算出部11は、第1閾値Lth1を用いて、ソナー4L,4Rの送信した超音波が反射された位置(以下「反射位置」という。)を算出する処理(以下「第1反射位置算出処理」という。)を実行するものである。すなわち、反射位置算出部11は、ソナー4L,4Rに超音波を送信させる。反射位置算出部11は、レベル値が第1閾値Lth1以上の反射波をソナー4L,4Rが受信したとき、ソナー4L,4Rが超音波を送信してからソナー4L,4Rが反射波を受信するまでの時間と超音波の伝搬速度との乗算により、超音波の往復伝搬距離を算出する。また、反射位置算出部11は、車輪速センサ2及びヨーレートセンサ3の出力信号を用いて、ソナー4L,4Rが超音波を送受信したときの車両1の位置(以下「自車位置」という。)を算出する。反射位置算出部11は、往復伝搬距離及び自車位置を用いて反射位置を算出する。具体的には、例えば、反射位置算出部11は、自車位置から車両1の側方に向けて往復伝搬距離の半分の距離だけ離れた位置を反射位置とするか、又はいわゆる「開口合成処理」により反射位置を算出する。以下、第1反射位置算出処理により算出された反射位置を「第1反射位置」ということがある。
 また、反射位置算出部11は、第2閾値Lth2を用いて反射位置を算出する処理(以下「第2反射位置算出処理」という。)を実行するものである。すなわち、反射位置算出部11は、ソナー4L,4Rに超音波を送信させる。反射位置算出部11は、レベル値が第2閾値Lth2以上の反射波をソナー4L,4Rが受信したとき、ソナー4L,4Rが超音波を送信してからソナー4L,4Rが反射波を受信するまでの時間と超音波の伝搬速度との乗算により、超音波の往復伝搬距離を算出する。また、反射位置算出部11は、車輪速センサ2及びヨーレートセンサ3の出力信号を用いて、ソナー4L,4Rが超音波を送受信したときの自車位置を算出する。反射位置算出部11は、往復伝搬距離及び自車位置を用いて反射位置を算出する。具体的には、例えば、反射位置算出部11は、自車位置から車両1の側方に向けて往復伝搬距離の半分の距離だけ離れた位置を反射位置とするか、又は開口合成処理により反射位置を算出する。以下、第2反射位置算出処理により算出された反射位置を「第2反射位置」ということがある。
 反射位置算出部11は、第1反射位置算出処理と第2反射位置算出処理とを互いに異なるタイミングにて実行するようになっている。具体的には、例えば、反射位置算出部11は、後述する車両制御部22が縦列駐車による自動駐車を実行する場合において、車両1が所定の基準速度(例えば10キロメートル毎時)以下の速度にて走行しているとき、第1反射位置算出処理と第2反射位置算出処理とを交互に繰り返し実行する。
 図4に、反射位置算出部11が算出した反射位置の一例を示す。図中、白丸(○)は第1反射位置を示しており、黒丸(●)は第2反射位置を示している。また、矢印A3は、基準速度以下の速度による車両1の走行経路を示している。図4における距離範囲ΔDは、図3における距離範囲ΔDと同様の距離範囲を示している。
 図4Aに示す如く、距離範囲ΔD内に存在する障害物Oが壁Wである場合、障害物Oに沿って第1反射位置と第2反射位置とが交互に配置される。すなわち、図3を参照して説明したように、距離範囲ΔD内に存在する壁Wによる反射波のレベル値は第2閾値Lth2以上の値となるため、第1反射位置算出処理及び第2反射位置算出処理の両処理により反射位置が算出される。
 他方、図4Bに示す如く、距離範囲ΔD内に存在する障害物Oが縁石Cである場合、障害物Oに沿って第1反射位置のみが配置される。すなわち、図3を参照して説明したように、距離範囲ΔD内に存在する縁石Cによる反射波のレベル値は第1閾値Lth1以上かつ第2閾値Lth2未満の値となるため、第1反射位置算出処理により反射位置が算出される一方、第2反射位置算出処理では反射位置が算出されない。
 種類判定部12は、反射位置算出部11が算出した反射位置を用いて、図3及び図4に示す距離範囲ΔD(以下「判定対象距離範囲」という。)内に存在する障害物Oの種類を判定するものである。具体的には、例えば、種類判定部12は、反射位置算出部11により算出された反射位置のうち、判定対象距離範囲ΔD内の反射位置に第1反射位置及び第2反射位置の両方が含まれている場合、当該反射位置に対応する障害物Oが壁Wであると判定する。また、種類判定部12は、判定対象距離範囲ΔD内の反射位置に第1反射位置のみが含まれている場合、当該反射位置に対応する障害物Oが縁石Cであると判定する。
 図5に、当該判定方法に対応するテーブルを示す。すなわち、種類判定部12は、図5に示すテーブルに基づき障害物の種類を判定するものである。
 なお、反射位置算出部11により判定対象距離範囲ΔD外の反射位置が算出される場合もある。この場合、種類判定部12は、判定対象距離範囲ΔD外に存在する障害物については種類判定の対象外とする。これは、第1に、自動駐車用の誘導経路を設定するための障害物検知においては、判定対象距離範囲ΔD内の障害物を種類判定の対象とすれば十分だからである。第2に、判定対象距離範囲ΔDの下限値よりも小さい距離範囲(図3及び図4の例では1メートル以下の距離範囲)においては、一般にソナー4L,4Rの検知精度が低く、かつ、判定対象距離範囲ΔDの上限値よりも大きい距離範囲(図3及び図4の例では3メートル以上の距離範囲)においては、壁Wによる反射波のレベル値と縁石Cによる反射波のレベル値との差分値が小さく、第1閾値Lth1及び第2閾値Lth2を用いて両者を識別することが難しいためである。
 誘導経路設定部21は、後述する車両制御部22が縦列駐車による自動駐車を実行するとき、自動駐車用の誘導経路を設定するものである。このとき、誘導経路設定部21は、種類判定部12による判定結果が壁Wを示しているか縁石Cを示しているかに応じて異なる誘導経路を設定するようになっている。具体的には、誘導経路設定部21は、判定結果が縁石Cを示している場合、判定結果が壁Wを示している場合に対して車両1の切り込みが大きい誘導経路を設定する。
 図6に、誘導経路設定部21が設定した誘導経路の一例を示す。図6Aにおける矢印A4,A5は、車両1が2台の他車両V間に縦列駐車をする場合において、他車両Vの奥側に存在する障害物Oが壁Wであるときの誘導経路を示している。他方、図6Bにおける矢印A6は、同様の場合において、他車両Vの奥側に存在する障害物Oが縁石Cであるときの誘導経路を示している。
 図6に示す如く、障害物Oが壁Wである場合の誘導経路(矢印A4)は、障害物Oが縁石Cである場合の誘導経路(矢印A6)よりも切り込みが小さい。これにより、車両1の隅部(図6Aの例では車両1の左側部のうちの後端部)が壁Wと接触するのを防ぐことができる。この場合、車両1を2台の他車両V間に切り込ませた後(矢印A4)、前後方向に切り返すことにより(矢印A5)、車両1の位置及び向きを調整することになる。
 他方、障害物Oが縁石Cである場合の誘導経路(矢印A6)は、障害物Oが壁Wである場合の誘導経路(矢印A4)よりも切り込みが大きい。図中、切り込みの途中で車両1の隅部(図6Bの例では車両1の左側部のうちの後端部)が障害物Oと重なっているが、このとき、縁石Cはリアバンパに対する下方の空間に入るため、縁石Cと車両1との接触は生じない。また、切り込みを大きくすることにより、切り込み後における切り返しの回数を低減して(図6Bの例では不要として)、駐車に要する時間を短縮することができる。
 車両制御部22は、誘導経路設定部21が設定した誘導経路に基づき、車両1のステアリング5を制御することにより、縦列駐車による自動駐車を実行するものである。なお、車両制御部22は、ステアリング5に加えて、車両1に設けられたブレーキ6を制御するものであっても良い。また、車両制御部22は、ステアリング5及びブレーキ6に加えて、必要に応じて、車両1に設けられたエンジン7のトルクを制御するものであっても良い。
 反射位置算出部11及び種類判定部12により、障害物検知制御部10が構成されている。誘導経路設定部21及び車両制御部22により、自動駐車制御部20が構成されている。障害物検知制御部10及び自動駐車制御部20により、制御装置30の要部が構成されている。ソナー4L,4R及び制御装置30により、駐車支援装置100が構成されている。
 図7に、制御装置30の要部のハードウェア構成の一例を示す。図7Aに示す如く、制御装置30は汎用のコンピュータにより構成されており、メモリ31及びプロセッサ32を有している。メモリ31には、当該コンピュータを図1に示す障害物検知制御部10及び自動駐車制御部20として機能させるためのプログラムが記憶されている。メモリ31に記憶されたプログラムをプロセッサ32が読み出して実行することにより、図1に示す障害物検知制御部10及び自動駐車制御部20の機能が実現される。
 メモリ31は、例えば、RAM(Random Access Memory)、ROM(Read Only Memory)、フラッシュメモリ、EPROM(Erasable Programmable Read Only Memory)若しくはEEPROM(Electrically Erasable Programmable Read-Only Memory)などの半導体メモリ、又はHDD(Hard Disk Drive)などの磁気ディスク装置により構成されている。プロセッサ32は、例えば、CPU(Central Processing Unit)、DSP(Digital Signal Processor)、マイクロコントローラ又はマイクロプロセッサなどにより構成されている。
 または、図7Bに示す如く、制御装置30は専用の処理回路33により構成されている。処理回路33は、例えば、ASIC(Application Specific Integrated Circuit)、FPGA(Field-Programmable Gate Array)若しくはシステムLSI(Large-Scale Integration)又はこれらを組み合わせたものである。
 なお、図1に示す障害物検知制御部10及び自動駐車制御部20の各部の機能それぞれを処理回路33で実現しても良いし、各部の機能をまとめて処理回路33で実現しても良い。具体的には、例えば、障害物検知制御部10の機能は第1のECU(Electronic Control Unit)に設けられた処理回路33により実現し、自動駐車制御部20の機能は第2のECUに設けられた他の処理回路33により実現したものであっても良い。また、図1に示す障害物検知制御部10及び自動駐車制御部20のうちの一部の機能を図7Aに示すメモリ31及びプロセッサ32により実現し、残余の機能を図7Bに示す処理回路33により実現したものでも良い。
 次に、図8のフローチャートを参照して、制御装置30の動作について説明する。制御装置30は、所定の開始条件が満たされた場合、例えば縦列駐車による自動駐車の実行を指示する操作が図示しない操作入力装置に入力された場合において、車両1が基準速度以下の速度にて走行しているとき、ステップST1の処理を開始する。なお、車両1の走行速度は、車輪速センサ2の出力信号を用いて算出するか、又は図示しないECUなどから取得することができる。
 まず、ステップST1にて、反射位置算出部11は反射位置を算出する。具体的には、例えば、反射位置算出部11は、第1反射位置算出処理と第2反射位置算出部とを交互に繰り返し実行する。反射位置算出部11は、例えば、車両1が停車するまで反射位置の算出処理を繰り返し実行する。
 次いで、ステップST2にて、種類判定部12は、ステップST1で反射位置算出部11が算出した反射位置を用いて、判定対象距離範囲ΔD内に存在する障害物Oの種類を判定する。具体的には、例えば、種類判定部12は、反射位置算出部11により算出された反射位置のうち、判定対象距離範囲ΔD内の反射位置に第1反射位置及び第2反射位置の両方が含まれている場合、当該反射位置に対応する障害物Oが壁Wであると判定する。また、種類判定部12は、判定対象距離範囲ΔD内の反射位置に第1反射位置のみが含まれている場合、当該反射位置に対応する障害物Oが縁石Cであると判定する。
 次いで、ステップST3にて、誘導経路設定部21は、ステップST2における障害物の種類の判定結果に応じて、縦列駐車用の誘導経路を設定する。具体的には、誘導経路設定部21は、判定結果が縁石Cを示している場合、判定結果が壁Wを示している場合に対して車両1の切り込みが大きい誘導経路を設定する。
 次いで、ステップST4にて、車両制御部22は、ステアリング5等を制御することにより自動駐車を実行する。このとき、車両制御部22は、ステップST3で誘導経路設定部21が設定した誘導経路に基づき、縦列駐車による自動駐車を実行する。これにより、図6に示す如く自動駐車が実行される。
 なお、判定対象距離範囲ΔDは、縁石Cによる反射波のレベル値が第1閾値Lth1以上かつ第2閾値Lth2未満の値となり、かつ、壁Wによる反射波のレベル値が第2閾値Lth2以上の値となる距離範囲であれば良く、1~3メートルの距離範囲に限定されるものではない。
 また、反射位置算出部11は、種類判定部12にて判定対象距離範囲ΔD内の障害物Oが壁Wであるか縁石Cであるかを判定できるような反射位置を算出するものであれば良く、第1反射位置算出処理と第2反射位置算出処理とを交互に繰り返し実行する構成に限定されるものではない。例えば、反射位置算出部11は、以下のように反射位置を算出するものであっても良い。
 すなわち、反射位置算出部11は、車両1が基準速度以下の速度にて走行しているとき、ソナー4L,4Rに超音波を複数回送信させる。反射位置算出部11は、各回の超音波に対して、レベル値が第1閾値Lth1以上かつ第2閾値Lth2未満の反射波を受信したとき、当該反射波に対応する反射位置(以下「低反射位置」という。)を算出する。また、反射位置算出部11は、各回の超音波に対して、レベル値が第2閾値Lth2以上の反射波を受信したとき、当該反射波に対応する反射位置(以下「高反射位置」という。)を算出する。
 この場合、種類判定部12は、反射位置算出部11により算出された反射位置のうち、判定対象距離範囲ΔD内の反射位置が高反射位置である場合、当該反射位置に対応する障害物Oが壁Wであると判定する。また、種類判定部12は、反射位置算出部11により算出された反射位置のうち、判定対象距離範囲ΔD内の反射位置が低反射位置である場合、当該反射位置に対応する障害物Oが縁石Cであると判定する。
 以上のように、実施の形態1の駐車支援装置100は、車両1に設けられた左右一対のソナー4L,4Rと、ソナー4L,4Rが受信した反射波のレベル値を互いに異なる第1閾値Lth1及び第2閾値Lth2の各々と比較することにより、車両1に対する側方の判定対象距離範囲ΔD内に存在する障害物Oが壁Wであるか縁石Cであるかを判定する障害物検知制御部10と、障害物検知制御部10による判定結果に応じて、自動駐車用の誘導経路を設定する自動駐車制御部20とを備え、自動駐車制御部20は、縦列駐車による自動駐車において、判定結果が縁石Cを示している場合、判定結果が壁Wを示している場合に対して車両1の切り込みが大きい誘導経路を設定する。これにより、障害物Oが壁Wである場合は、車両1と壁Wとの接触を回避した誘導経路を設定することができ、かつ、障害物Oが縁石Cである場合は、切り返しの回数を低減した誘導経路を設定することができる。すなわち、障害物Oが縁石Cであるか壁Wであるかに応じて適切な誘導経路を設定することができる。また、左右一対のソナー4L,4Rを車両1の前半部に設けることにより、Frソナー及びRrソナーを用いる特許文献1の装置に対して、障害物Oの検知に要する走行距離を短くすることができる。また、第1反射位置算出処理を実行するタイミングと第2反射位置算出処理を実行するタイミングとの時間間隔を小さくすることにより、Frソナー及びRrソナーを用いる特許文献1の装置に対して、障害物Oの検知精度を高めることができる。
実施の形態2.
 図9は、本発明の実施の形態2に係る駐車支援装置が車両に搭載された状態を示す機能ブロック図である。図9を参照して、実施の形態2の駐車支援装置200について説明する。なお、図9において、図1に示す実施の形態1の機能ブロック図と同様のブロックには同一符号を付して説明を省略する。
 反射位置算出部41は、図1に示す反射位置算出部11と同様の第1反射位置算出処理を実行することにより、第1反射位置を算出するものである。また、反射位置算出部41は、図1に示す反射位置算出部11と同様の第2反射位置算出処理を実行することにより、第2反射位置を算出するものである。反射位置算出部41は、例えば、後述する車両制御部54が縦列駐車又は並列駐車による自動駐車を実行する場合において、車両1が基準速度以下の速度にて走行しているとき、第1反射位置算出処理と第2反射位置算出処理とを交互に繰り返し実行するようになっている。
 図10に、反射位置算出部41が算出した反射位置の一例を示す。図10Aに示す如く、判定対象距離範囲ΔD内に存在する障害物O1が壁Wである場合、障害物O1に沿って第1反射位置と第2反射位置とが交互に配置される。他方、図10Bに示す如く、判定対象距離範囲ΔD内に存在する障害物O1が縁石Cである場合、障害物O1に沿って第1反射位置のみが配置される。すなわち、障害物O1に対応する反射位置は、実施の形態1にて図4を参照して説明したものと同様である。
 ここで、障害物O1よりも手前側に存在する障害物O2,O3は他車両Vである。一般に、ソナー4L,4Rの放射した超音波が他車両Vにより反射される場合、超音波の経路はソナー4L,4Rの指向方向に沿う経路、すなわち図2Aに示す矢印A1と同様の経路となる。したがって、他車両Vが判定対象距離範囲ΔD内に存在する場合、他車両Vによる反射波のレベル値は図3に示す第2閾値Lth2以上の値となる。このため、第1反射位置算出処理及び第2反射位置算出処理の両処理により反射位置が算出される。この結果、図10に示す如く、障害物O2,O3に沿って第1反射位置と第2反射位置とが交互に配置される。
 グルーピング処理部42は、反射位置算出部41が算出した反射位置をグルーピングするものである。具体的には、例えば、グルーピング処理部42は、互いに隣接する複数個の反射位置間の距離が所定値(例えば30センチメートル)以下の値である場合、これらの反射位置を同一のグループに設定する。
 図11に、グルーピング処理部42が設定したグループの一例を示す。図10Aに示す反射位置をグルーピング処理部42がグルーピングした場合、図11Aに示す如く、障害物O1に対応するグループG1、障害物O2に対応するグループG2、及び障害物O3に対応するグループG3が設定される。また、図10Bに示す反射位置をグルーピング処理部42がグルーピングした場合、図11Bに示す如く、障害物O1に対応するグループG1、障害物O2に対応するグループG2、及び障害物O3に対応するグループG3が設定される。
 種類判定部43は、グルーピング処理部42によるグルーピングの結果を用いて、判定対象距離範囲ΔD内に存在する1個以上の障害物(図10の例では3個の障害物O1~O3)の各々の種類を判定するものである。具体的には、例えば、種類判定部43は、各グループに第2反射位置が含まれているか否かに応じて、当該グループに対応する障害物が縁石Cであるか、壁W又は他車両Vであるかを判定する。また、種類判定部43は、各グループの形状に応じて、当該グループに対応する障害物が縁石C又は壁Wであるか、縦列駐車状態の他車両Vであるか、並列駐車状態の他車両Vであるかを判定する。種類判定部43は、第2反射位置の有無に基づく判定結果と、グループの形状に基づく判定結果との組み合わせにより、各グループに対応する障害物が縁石C、壁W、縦列駐車状態の他車両V、又は並列駐車状態の他車両Vのうちのいずれであるかを判定する。
 以下、グループの形状に基づく判定方法の具体例について説明する。まず、種類判定部43は、グルーピング処理部42が設定した1個以上のグループの各々について、互いに隣接する2個の反射位置間を繋ぐ直線(以下「反射位置間直線」という。)を算出するとともに、個々の反射位置間直線に対する法線ベクトルを算出する。
 図12に、反射位置間直線SL及び法線ベクトルNVの一例を示す。図12Aは、壁Wに対応するグループにおける反射位置間直線SL及び法線ベクトルNVを示している。図12Bは、縁石Cに対応するグループにおける反射位置間直線SL及び法線ベクトルNVを示している。図12Cは、縦列駐車状態の他車両Vに対応するグループにおける反射位置間直線SL及び法線ベクトルNVを示している。図12Dは、並列駐車状態の他車両Vに対応するグループにおける反射位置間直線SL及び法線ベクトルNVを示している。
 また、図13は、法線ベクトルNVが示す方向を横軸とし、かつ、各方向を示す法線ベクトルNVの個数を縦軸としたヒストグラムに対応する曲線を示している。曲線C1は、壁W又は縁石Cに対応するグループにおけるヒストグラムに対応している。曲線C2は、縦列駐車状態の他車両Vに対応するグループにおけるヒストグラムに対応している。曲線C3は、並列駐車状態の他車両Vに対応するグループにおけるヒストグラムに対応している。
 一般に、壁W又は縁石Cは直線状の部位が多い。このため、図12A及び図12Bに示す如く、複数個の反射位置が直線状に配置されて、略すべての法線ベクトルNVが同じ方向を示す。この結果、図13に示す如く、壁W又は縁石Cに対応するグループは、法線ベクトルNVが示す方向のばらつきを示す値(以下「ばらつき値」という。例えば、曲線C1の分布幅DW1、曲線C1のピーク値P1に対する分布幅DW1の比率、曲線C1の分散、又は曲線C1の標準偏差など)が小さい値となる。
 また、一般に、他車両Vの側面部は直線状の部位が多い。このため、図12Cに示す如く、複数個の反射位置が他車両Vの側面部に沿って直線状に配置される。しかしながら、他車両Vの前端部及び後端部(以下、総称して「ノーズ部」という。)においては、ノーズ部の形状、反射位置算出部41による反射位置の算出精度、及び超音波の性質などにより、複数個の反射位置が曲線状に、又は他車両Vの側面部に沿う直線と異なる方向に沿う直線状に配置される。この結果、図13に示す如く、縦列駐車状態の他車両Vに対応するグループは、法線ベクトルNVが示す方向のばらつき値(例えば、曲線C2の分布幅DW2、曲線C2のピーク値P2に対する分布幅DW2の比率、曲線C2の分散、又は曲線C2の標準偏差など)が、壁W又は縁石Cに対応するグループよりも大きい値となる。
 また、一般に、他車両Vの左右方向に対する大きさ(以下「車幅」という。)は、他車両Vの前後方向に対する大きさ(以下「全長」という。)よりも小さい。このため、並列駐車状態の他車両Vに対応する反射位置の配置(図12D)は、縦列駐車状態の他車両Vに対応する反射位置の配置(図12C)よりも直線状の部位が少ない。この結果、図13に示す如く、並列駐車状態の他車両Vに対応するグループは、法線ベクトルNVが示す方向のばらつき値(例えば、曲線C3の分布幅DW3、曲線C3のピーク値P3に対する分布幅DW3の比率、曲線C3の分散、又は曲線C3の標準偏差など)が、縦列駐車状態の他車両Vに対応するグループよりも大きい値となる。
 種類判定部43には、曲線C1のばらつき値よりも大きく、かつ、曲線C2のばらつき値よりも小さい閾値(以下「第1分布閾値」という。)と、曲線C2のばらつき値よりも大きく、かつ、曲線C3のばらつき値よりも小さい閾値(以下「第2分布閾値」という。)とが予め設定されている。種類判定部43は、各グループのばらつき値を算出し、算出したばらつき値を第1分布閾値及び第2分布閾値の各々と比較する。種類判定部43は、算出したばらつき値が第1分布閾値未満の値である場合、当該グループに対応する障害物が壁W又は縁石Cであると判定する。種類判定部43は、算出したばらつき値が第1分布閾値以上かつ第2分布閾値未満の値である場合、当該グループに対応する障害物が縦列駐車状態の他車両Vであると判定する。種類判定部43は、算出したばらつき値が第2分布閾値以上の値である場合、当該グループに対応する障害物が並列駐車状態の他車両Vであると判定する。
 なお、反射位置間直線SLに沿う方向を横軸とし、かつ、各方向に沿う反射位置間直線SLの個数を縦軸としたヒストグラムに対応する曲線は、図13に示す曲線C1~C3と同様の曲線となる。種類判定部43は、法線ベクトルNVが示す方向のばらつき値に代えて、反射位置間直線SLに沿う方向のばらつき値を第1分布閾値及び第2分布閾値と比較することにより、各グループに対応する障害物の種類を判定するものであっても良い。
 また、所定の基準方向(例えば車両1の走行方向)と反射位置間直線SLとがなす角度を横軸とし、かつ、当該角度をなす反射位置間直線SLの個数を縦軸としたヒストグラムに対応する曲線は、図13に示す曲線C1~C3と同様の曲線となる。種類判定部43は、法線ベクトルNVが示す方向のばらつき値に代えて、基準方向と反射位置間直線SLとがなす角度のばらつき値を第1分布閾値及び第2分布閾値と比較することにより、各グループに対応する障害物の種類を判定するものであっても良い。
 図14に、第2反射位置の有無及びグループの形状に基づく判定方法に対応するテーブルを示す。図14Aは、法線ベクトルNVが示す方向のばらつき値を用いる場合のテーブルを示している。図14Bは、反射位置間直線SLに沿う方向のばらつき値を用いる場合のテーブルを示している。図14Cは、基準方向と反射位置間直線SLとがなす角度のばらつき値を用いる場合のテーブルを示している。図中「小」は、ばらつき値が第1分布閾値未満の値であることを示している。「中」は、ばらつき値が第1分布閾値以上かつ第2分布閾値未満の値であることを示している。「大」は、ばらつき値が第2分布閾値以上の値であることを示している。
 駐車形態設定部51は、グルーピング処理部42によるグルーピングの結果、及び種類判定部43による判定結果を用いて、後述する車両制御部54が実行する自動駐車の形態(以下「駐車形態」という。)を設定するものである。具体的には、例えば、駐車形態設定部51は、判定対象距離範囲ΔD内に縦列駐車状態の他車両Vが存在する場合、駐車形態を縦列駐車に判定する。また、駐車形態設定部51は、判定対象距離範囲ΔD内に並列駐車状態の他車両Vが存在する場合、駐車形態を並列駐車に設定する。
 駐車区間設定部52は、グルーピング処理部42によるグルーピングの結果、種類判定部43による判定結果、及び駐車形態設定部51が設定した駐車形態に応じて、車両1の駐車が可能な区間(以下「駐車可能区間」という。)を抽出するものである。駐車区間設定部52は、抽出した駐車可能区間を、後述する車両制御部54が実行する自動駐車の対象となる区間(以下「駐車対象区間」という。)に設定するものである。
 具体的には、例えば、駐車区間設定部52には、車両1の全長及び車幅を示す情報が予め記憶されている。駐車区間設定部52は、駐車形態が縦列駐車に設定されている場合、車両1の全長よりも大きい距離範囲に亘って他車両V等の障害物が存在しない区間を駐車可能区間として抽出する。同様に、駐車区間設定部52は、駐車形態が並列駐車に設定されている場合、車両1の車幅よりも大きい距離範囲に亘って他車両V等の障害物が存在しない区間を駐車可能区間として抽出する。駐車区間設定部52は、抽出した駐車可能区間を駐車対象区間に設定する。
 誘導経路設定部53は、グルーピング処理部42によるグルーピングの結果、種類判定部43による判定結果、駐車形態設定部51が設定した駐車形態、及び駐車区間設定部52が設定した駐車対象区間に応じて、自動駐車用の誘導経路を設定するものである。
 すなわち、駐車形態が縦列駐車に設定されている場合、誘導経路設定部53は縦列駐車用の誘導経路を設定する。縦列駐車用の誘導経路は、実施の形態1にて図6を参照して説明したものと同様であるため、図示及び説明を省略する。また、駐車形態が並列駐車に設定されている場合、誘導経路設定部53は並列駐車用の誘導経路を設定する。並列駐車用の誘導経路は、図15に矢印A7で示す如く通常の誘導経路であるため、説明を省略する。
 車両制御部54は、誘導経路設定部53が設定した誘導経路に基づき、車両1のステアリング5を制御することにより、縦列駐車又は並列駐車による自動駐車を実行するものである。なお、車両制御部54は、ステアリング5に加えて、車両1に設けられたブレーキ6を制御するものであっても良い。さらに、車両制御部54は、ステアリング5及びブレーキ6に加えて、必要に応じて、車両1に設けられたエンジン7のトルクを制御するものであっても良い。
 反射位置算出部41、グルーピング処理部42及び種類判定部43により、障害物検知制御部40が構成されている。駐車形態設定部51、駐車区間設定部52、誘導経路設定部53及び車両制御部54により、自動駐車制御部50が構成されている。障害物検知制御部40及び自動駐車制御部50により、制御装置60の要部が構成されている。ソナー4L,4R及び制御装置60により、駐車支援装置200が構成されている。
 制御装置60の要部のハードウェア構成は、実施の形態1にて図7を参照して説明したものと同様であるため、図示及び説明を省略する。
 次に、図16のフローチャートを参照して、制御装置60の動作について説明する。制御装置60は、所定の開始条件が満たされた場合、例えば自動駐車の実行を指示する操作が図示しない操作入力装置に入力された場合において、車両1が基準速度以下の速度にて走行しているとき、ステップST11の処理を開始する。
 まず、ステップST11にて、反射位置算出部41は反射位置を算出する。具体的には、例えば、反射位置算出部41は、第1反射位置算出処理と第2反射算出部とを交互に繰り返し実行する。反射位置算出部41は、例えば、車両1が停車するまで反射位置の算出処理を繰り返し実行する。
 次いで、ステップST12にて、グルーピング処理部42は、ステップST11で反射位置算出部41が算出した反射位置のうち、判定対象距離範囲ΔD内の反射位置をグルーピングする。具体的には、例えば、グルーピング処理部42は、互いに隣接する複数個の反射位置間の距離が所定値(例えば30センチメートル)以下の値である場合、これらの反射位置を同一のグループに設定する。
 次いで、ステップST13にて、種類判定部43は、ステップST12でグルーピング処理部42が設定した1個以上のグループの各々に対応する障害物の種類を判定する。具体的には、例えば、種類判定部43は、図14A~図14Cのうちのいずれかに示すテーブルに基づき、各グループに対応する障害物が縁石C、壁W、縦列駐車状態の他車両V、又は並列駐車状態の他車両Vのうちのいずれであるかを判定する。
 次いで、ステップST14にて、駐車形態設定部51は、ステップST12におけるグルーピングの結果、及びステップST13における障害物の種類の判定結果を用いて、駐車形態を設定する。具体的には、例えば、駐車形態設定部51は、判定対象距離範囲ΔD内に縦列駐車状態の他車両Vが存在する場合、駐車形態を縦列駐車に設定する。また、駐車形態設定部51は、判定対象距離範囲ΔD内に並列駐車状態の他車両Vが存在する場合、駐車形態を並列駐車に設定する。
 次いで、ステップST15にて、駐車区間設定部52は、ステップST12におけるグルーピングの結果、ステップST13における障害物の種類の判定結果、及びステップST14で設定された駐車形態に応じて、駐車可能区間を抽出する処理を実行する。具体的には、例えば、駐車区間設定部52は、駐車形態が縦列駐車に設定されている場合、車両1の全長よりも大きい距離範囲に亘って他車両V等の障害物が存在しない区間を駐車可能区間として抽出する。他方、駐車区間設定部52は、駐車形態が並列駐車に設定されている場合、車両1の車幅よりも大きい距離範囲に亘って他車両V等の障害物が存在しない区間を駐車可能区間として抽出する。
 次いで、ステップST16にて、駐車区間設定部52は、車両制御部54による自動駐車の実行が可能であるか否かを判定する。すなわち、ステップST15の処理により駐車可能区間が抽出された場合、駐車区間設定部52は、自動駐車の実行が可能であると判定する(ステップST16“YES”)。他方、ステップST15の処理により駐車可能区間が抽出されなかった場合、駐車区間設定部52は、自動駐車の実行が不可能であると判定する(ステップST16“NO”)。
 自動駐車の実行が可能である場合(ステップST16“YES”)、ステップST17にて、駐車区間設定部52は駐車対象区間を設定する。すなわち、駐車区間設定部52は、ステップST15の処理により抽出された駐車可能区間を駐車対象区間に設定する。
 次いで、ステップST18にて、誘導経路設定部53は、ステップST12におけるグルーピングの結果、ステップST13における障害物の種類の判定結果、ステップST14で設定された駐車形態、及びステップST17で設定された駐車対象区間に応じて、自動駐車用の誘導経路を設定する。すなわち、駐車形態が縦列駐車に設定されている場合、誘導経路設定部53は、図6に示す如く縦列駐車用の誘導経路を設定する。他方、駐車形態が並列駐車に設定されている場合、誘導経路設定部53は、図15に示す如く並列駐車用の誘導経路を設定する。
 次いで、ステップST19にて、車両制御部54は、ステアリング5等を制御することにより自動駐車を実行する。このとき、車両制御部54は、ステップST18で設定された誘導経路に基づき、縦列駐車又は並列駐車による自動駐車を実行する。
 自動駐車の実行が不可能である場合(ステップST16“NO”)、ステップST17~ST19の処理はスキップされる。このとき、制御装置60は、車両1に設けられた液晶ディスプレイ等の表示装置(不図示)に、駐車可能区間が存在しないこと又は自動駐車の実行が不可能であることなどを示す画像を表示させるものであっても良い。または、制御装置60は、車両1に設けられたスピーカ等の音声出力装置(不図示)に、駐車可能区間が存在しないこと又は自動駐車の実行が不可能であることなどを示す音声を出力させるものであっても良い。
 なお、駐車区間設定部52は、ステップST15にて複数個の駐車可能区間を抽出し、ステップST17にて複数個の駐車可能区間のうちのいずれか1個(例えば、車両1の現在位置に最も近い駐車可能区間、又は最も長い距離反に亘り他車両V等の障害物が存在しない駐車可能区間)を駐車対象区間に設定するものであっても良い。このとき、駐車対象区間となる駐車可能区間を選択する条件は、制御装置60に予め設定されたものであっても良く、又はユーザにより設定されたものであっても良い。これにより、複数個の駐車可能区間が存在する場合において、より自動駐車に適した駐車可能区間を駐車対象区間に設定することができる。
 また、種類判定部43が判定する障害物の種類は、縁石C、壁W、縦列駐車状態の他車両V、又は並列駐車状態の他車両Vの4種類に限定されるものではない。例えば、種類判定部43は、他車両Vに対応するグループG2,G3よりも手前側に第1反射位置のみを含むグループが存在する場合、当該グループに対応する障害物が乗り越え可能な段差であると判定するものであっても良い。
 図17に、反射位置算出部41が算出した反射位置の他の例を示す。図17において、障害物O2,O3よりも手前側に存在する障害物O4が乗り越え可能な段差Sである。一般に、ソナー4L,4Rの放射した超音波が段差Sにより反射される場合、超音波の経路はソナー4L,4Rの指向方向よりも下向きにずれた経路、すなわち図2Bに示す矢印A2と同様の経路となる。したがって、段差Sが判定対象距離範囲ΔD内に存在する場合、段差Sによる反射波のレベル値は第1閾値Lth1以上かつ第2閾値Lth2未満の値となる。このため、第1反射位置算出処理により反射位置が算出される一方、第2反射位置算出処理では反射位置が算出されない。この結果、図17に示す如く、障害物O4に沿って第1反射位置のみが配置される。
 図18に、図17に示す障害物O1~O4による反射波の波形の一例を示す。図中、WF1は、障害物O4、すなわち段差Sによる反射波の波形を示している。WF2は、障害物O2又は障害物O3、すなわち他車両Vによる反射波の波形を示している。WF3は、障害物O1、すなわち縁石Cによる反射波の波形を示している。図18に示す如く、段差Sによる反射波のレベル値は、第1閾値Lth1以上かつ第2閾値Lth2未満の値である。他車両Vによる反射波のレベル値は、第2閾値Lth2以上の値である。縁石Cによる反射波のレベル値は、第1閾値Lth1以上かつ第2閾値Lth2未満の値である。
 なお、ソナー4L,4Rの放射した超音波が障害物O4(段差S)及び障害物O2,O3(他車両V)の両障害物により反射された場合、ソナー4L,4Rが障害物O4による反射波を受信するタイミングとソナー4L,4Rが障害物O2,O3による反射波を受信するタイミングとは互いに異なるタイミングとなる。このため、反射位置算出部11は、障害物O4による反射波と障害物O2,O3による反射波とを区別して反射位置を算出することができる。同様に、反射位置算出部11は、障害物O4(段差S)による反射波と障害物O1(縁石C)による反射波とを区別して反射位置を算出することができる。
 図19に、グルーピング処理部42が設定したグループの他の例を示す。図中、グループG4が障害物O4に対応している。種類判定部43は、図14A~図14Cのうちのいずれかに示すテーブルに基づき、グループG1~G4に対応する障害物O1~O4の種類を判定する。これにより、障害物O1及び障害物O4が縁石Cであると判定され、障害物O2及び障害物O3が他車両Vであると判定される。次いで、種類判定部43は、他車両Vに対応すると判定したグループG2,G3よりも手前側に存在し、かつ、第1反射位置のみを含むグループG4に対応する障害物O4について、判定結果を縁石Cから段差Sに修正する。
 また、他車両Vの手前側に段差Sが存在すると判定された場合、車両制御部54は、自動駐車を実行するとき、車両1が段差Sを乗り越えることができるようにエンジン7のトルクを制御するものであっても良い。
 そのほか、駐車支援装置200は、実施の形態1にて説明したものと同様の種々の変形例を採用することができる。例えば、反射位置算出部41は、第1反射位置及び第2反射位置に代えて、低反射位置及び高反射位置を算出するものであっても良い。種類判定部43は、各グループに第2反射位置が含まれているか否かに代えて、各グループに含まれる反射位置が低反射位置であるか高反射位置であるかに応じて、当該グループに対応する障害物の種類を判定するものであっても良い。
 以上のように、実施の形態2の駐車支援装置200において、障害物検知制御部40は、レベル値と第1閾値及び第2閾値との比較結果が示す反射波の反射位置をグルーピングすることにより障害物O1~O3に対応するグループG1~G3を設定し、グループG1~G3の形状に応じて障害物O1~O3が壁W又は縁石Cであるか他車両Vであるかを判定する。これにより、障害物O1~O3の種類に応じた適切な誘導経路を設定することができる。
 また、自動駐車制御部50は、障害物検知制御部40によるグルーピングの結果に応じて、縦列駐車用の誘導経路又は並列駐車用の誘導経路を設定する。これにより、車両制御部54が縦列駐車用の区間に対して並列駐車による自動駐車を実行したり、並列駐車用の区間に対して縦列駐車による自動駐車を実行したりするのを防ぐことができる。すなわち、車両制御部54による誤駐車の発生を防ぐことができる。
実施の形態3.
 図20は、本発明の実施の形態3に係る駐車支援装置が車両に搭載された状態を示す機能ブロック図である。図20を参照して、実施の形態3の駐車支援装置200aについて説明する。なお、図20において、図9に示す実施の形態2の機能ブロック図と同様のブロックには同一符号を付して説明を省略する。
 反射位置算出部41は、反射位置を算出するものである。図21に、反射位置算出部41が算出した反射位置の一例を示す。図21Aに示す如く、判定対象距離範囲ΔD内に存在する障害物O1が壁Wである場合、障害物O1に沿って第1反射位置と第2反射位置とが交互に配置される。他方、図21Bに示す如く、判定対象距離範囲ΔD内に存在する障害物O1が縁石Cである場合、障害物O1に沿って第1反射位置のみが配置される。すなわち、障害物O1に対応する反射位置は、実施の形態1にて図4を参照して説明したものと同様である。
 また、障害物O1よりも手前側に存在する障害物O2,O3は他車両Vである。図21に示す如く、判定対象距離範囲ΔD内に存在する障害物O2、O3が他車両Vである場合、障害物O2,O3に沿って第1反射位置と第2反射位置とが交互に配置される。すなわち、障害物O2,O3に対応する反射位置は、実施の形態2にて図10を参照して説明したものと同様である。
 ここで、障害物O2,O3間に存在する障害物O5は乗り越え不可能なポールPである。一般に、ソナー4L,4Rの放射した超音波がポールPにより反射される場合、超音波の経路はソナー4L,4Rの指向方向に沿う経路、すなわち図2Aに示す矢印A1と同様の経路となる。したがって、ポールPが判定対象距離範囲ΔD内に存在する場合、ポールPによる反射波のレベル値は図3に示す第2閾値Lth2以上の値となる。このため、第1反射位置算出処理及び第2反射位置算出処理の両処理により反射位置が算出される。この結果、図21に示す如く、障害物O5に沿って第1反射位置と第2反射位置とが交互に配置される。
 グルーピング処理部42は、反射位置算出部41が算出した反射位置をグルーピングするものである。図22に、グルーピング処理部42が設定したグループの一例を示す。図21Aに示す反射位置をグルーピング処理部42がグルーピングした場合、図22Aに示す如く、障害物O1に対応するグループG1A,G1B、障害物O2に対応するグループG2、障害物O3に対応するグループG3、及び障害物O5に対応するグループG5が設定される。また、図21Bに示す反射位置をグルーピング処理部42がグルーピングした場合、図22Bに示す如く、障害物O1に対応するグループG1A,G1B、障害物O2に対応するグループG2、障害物O3に対応するグループG3、及び障害物O5に対応するグループG5が設定される。
 種類判定部43aは、グルーピング処理部42によるグルーピングの結果を用いて、判定対象距離範囲ΔD内に存在する1個以上の障害物(図21の例では4個の障害物O1~O3,O5)の各々の種類を判定するものである。具体的には、例えば、種類判定部43aは、各グループの幅に応じて、当該グループに対応する障害物がポールPであるか否かを判定する。また、種類判定部43aは、ポールPであると判定したグループを除く各グループに第2反射位置が含まれているか否かに応じて、当該グループに対応する障害物が縁石Cであるか、壁W又は他車両Vであるかを判定する。さらに、種類判定部43aは、壁W又は他車両Vであると判定した各グループの形状に応じて、当該グループに対応する障害物が壁Wであるか、縦列駐車状態の他車両Vであるか、並列駐車状態の他車両Vであるかを判定する。種類判定部43aは、グループの幅に基づく判定結果と、第2反射位置の有無に基づく判定結果と、グループの形状に基づく判定結果との組み合わせにより、各グループに対応する障害物が縁石C、壁W、縦列駐車状態の他車両V、並列駐車状態の他車両V、又はポールPのうちのいずれであるかを判定する。
 以下、グループの幅に基づく判定方法の具体例について説明する。まず、種類判定部43aは、グルーピング処理部42が設定した1個以上のグループの各々の幅を算出する。具体的には、例えば、種類判定部43aは、図22に示すグループG1Aの幅W1A、グループG1Bの幅W1B、グループG2の幅W2、グループG3の幅W3、及びグループG5の幅W5を算出する。
 一般に、ポールPに対応するグループの幅は、縁石C、壁W、縦列駐車状態の他車両V、又は並列駐車状態の他車両Vに対応するグループの幅よりも小さい。図22の例においても、ポールPに対応するグループG5の幅W5は、他のグループG1A,G1B,G2,G3の幅W1A,W1B,W2,W3よりも小さい。
 種類判定部43aには、ポールPに対応するグループG5の幅W5よりも大きく、かつ、他のグループG1A,G1B,G2,G3の幅W1A,W1B,W2,W3よりも小さい閾値(以下「第1幅閾値」という。)が予め設定されている。種類判定部43aは、算出した各グループの幅を第1幅閾値と比較する。種類判定部43aは、算出した幅が第1幅閾値未満の値である場合、当該グループに対応する障害物がポールPであると判定し、算出した幅が第1幅閾値以上の値である場合、当該グループに対応する障害物がポールPでないと判定する。
 図23に、グループの幅及び第2反射位置の有無に基づく判定方法に対応するテーブルを示す。図中「小」は、グループの幅が第1幅閾値未満の値であることを示している。「大」は、グループの幅が第1幅閾値以上の値であることを示している。
 なお、グループの形状に基づく判定方法の具体例は、実施の形態2にて図12及び図13を参照して説明したものと同様であるため、説明を省略する。すなわち、種類判定部43aは、図23に示すテーブルに基づき壁W又は他車両Vであると判定した障害物について、図24A~図24Cのうちのいずれかに示すテーブルに基づき、壁W、縦列駐車状態の他車両V、又は並列駐車状態の他車両Vのうちのいずれであるか判定する。
 駐車区間設定部52aは、グルーピング処理部42によるグルーピングの結果、種類判定部43aによる判定結果、及び駐車形態設定部51が設定した駐車形態に応じて、駐車可能区間を抽出するものである。また、駐車区間設定部52aは、抽出した駐車可能区間を駐車対象区間に設定するものである。
 具体的には、例えば、駐車区間設定部52aは、駐車形態が縦列駐車に設定されている場合、車両1の全長よりも大きい距離範囲に亘って他車両V又はポールPなどの障害物が存在しない区間を駐車可能区間として抽出する。同様に、駐車区間設定部52aは、駐車形態が並列駐車に設定されている場合、車両1の車幅よりも大きい距離範囲に亘って他車両V又はポールPなどの障害物が存在しない区間を駐車可能区間として抽出する。駐車区間設定部52aは、抽出した駐車可能区間を駐車対象区間に設定する。
 反射位置算出部41、グルーピング処理部42及び種類判定部43aにより、障害物検知制御部40aが構成されている。駐車形態設定部51、駐車区間設定部52a、誘導経路設定部53及び車両制御部54により、自動駐車制御部50aが構成されている。障害物検知制御部40a及び自動駐車制御部50aにより、制御装置60aの要部が構成されている。ソナー4L,4R及び制御装置60aにより、駐車支援装置200aが構成されている。
 制御装置60aの要部のハードウェア構成は、実施の形態1にて図7を参照して説明したものと同様であるため、図示及び説明を省略する。
 制御装置60aの動作は、実施の形態2にて図16のフローチャートを参照して説明したものと同様であるため、図示及び説明を省略する。なお、ステップST13にて、種類判定部43aは、図23に示すテーブル及び図24A~図24Cのうちのいずれかに示すテーブルに基づき、各グループに対応する障害物が縁石C、壁W、縦列駐車状態の他車両V、並列駐車状態の他車両V、又はポールPのうちのいずれであるかを判定する。また、ステップST15にて、駐車区間設定部52aは、駐車形態が縦列駐車に設定されている場合、車両1の全長よりも大きい距離範囲に亘って他車両V又はポールPなどの障害物が存在しない区間を駐車可能区間として抽出し、駐車形態が並列駐車に設定されている場合、車両1の車幅よりも大きい距離範囲に亘って他車両V又はポールPなどの障害物が存在しない区間を駐車可能区間として抽出する。
 なお、種類判定部43aは、グループの幅に基づき障害物の種類を判定するとき、図22に示すような各グループの全体の幅に代えて、各グループの一部の幅を閾値と比較するものであっても良い。具体的には、例えば、種類判定部43aは、図25に示す如く、グループG1A,G1B,G2,G3,G5のうちの直線状の部位の幅W1A’,W1B’,W2’,W3’,W5’を算出する。種類判定部43aには、ポールPに対応するグループG5のうちの直線状の部位の幅W5’よりも大きく、かつ、他のグループG1A,G1B,G2,G3のうちの直線状の部位の幅W1A’,W1B’,W2’,W3’よりも小さい閾値が予め設定されている。種類判定部43aは、各グループのうちの直線状の部位の幅を当該閾値と比較することにより、当該グループに対応する障害物がポールPであるか否かを判定する。
 また、種類判定部43aは、各グループの形状に代えて各グループの幅に基づき、当該グループに対応する障害物が縦列駐車状態の他車両Vであるか並列駐車状態の他車両Vであるかを判定するものであっても良い。
 すなわち、一般に、並列駐車状態の他車両Vに対応するグループの幅は、縦列駐車状態の他車両Vに対応するグループの幅よりも小さい。種類判定部43aには、第1幅閾値に加えて、並列駐車状態の他車両Vに対応するグループの幅よりも大きく、かつ、縦列駐車状態の他車両Vに対応するグループの幅よりも小さい閾値(以下「第2幅閾値」という。)を予め設定しておく。まず、種類判定部43aは、各グループの幅を第1幅閾値と比較することにより、各グループに対応する障害物がポールPであるか否かを判定する。次いで、種類判定部43aは、ポールPであると判定したグループを除く各グループについて、第2反射位置の有無及びグループの形状に基づく判定方法により、当該グループに対応する障害物が縁石C、壁W又は他車両Vのうちのいずれであるかを判定する。次いで、種類判定部43aは、他車両Vであると判定したグループについて、各グループの幅を第2幅閾値と比較することにより、当該グループに対応する障害物が縦列駐車状態の他車両Vであるか並列駐車状態の他車両Vであるかを判定する。
 そのほか、駐車支援装置200aは、実施の形態1又は実施の形態2にて説明したものと同様の種々の変形例を採用することができる。例えば、反射位置算出部41は、第1反射位置及び第2反射位置に代えて、低反射位置及び高反射位置を算出するものであっても良い。種類判定部43aは、各グループに第2反射位置が含まれるか否かに代えて、各グループに含まれる反射位置が低反射位置であるか高反射位置であるかに応じて、当該グループに対応する障害物の種類を判定するものであっても良い。
 以上のように、実施の形態3の駐車支援装置200aにおいて、障害物検知制御部40aは、グループG1A,G1B,G2,G3,G5の幅W1A,W1B,W2,W3,W5に応じて障害物O1~O3,O5がポールPであるか否かを判定する。障害物検知制御部40aにてポールPを検知することにより、自動駐車制御部50aにてポールPが存在する区間を駐車対象区間から除外したり、車両1とポールPとの接触を回避した誘導経路を設定したりすることができる。
 なお、本願発明はその発明の範囲内において、各実施の形態の自由な組み合わせ、あるいは各実施の形態の任意の構成要素の変形、もしくは各実施の形態において任意の構成要素の省略が可能である。
 本発明の駐車支援装置は、例えば、縦列駐車による自動駐車に用いることができる。
 1 車両、2 車輪速センサ、3 ヨーレートセンサ、4L 左ソナー、4R 右ソナー、5 ステアリング、6 ブレーキ、7 エンジン、10 障害物検知制御部、11 反射位置算出部、12 種類判定部、20 自動駐車制御部、21 誘導経路設定部、22 車両制御部、30 制御装置、31 メモリ、32 プロセッサ、33 処理回路、40,40a 障害物検知制御部、41 反射位置算出部、42 グルーピング処理部、43,43a 種類判定部、50,50a 自動駐車制御部、51 駐車形態設定部、52,52a 駐車区間設定部、53 誘導経路設定部、54 車両制御部、60,60a 制御装置、100 駐車支援装置、200,200a 駐車支援装置。

Claims (4)

  1.  車両に設けられた左右一対のソナーと、
     前記ソナーが受信した反射波のレベル値を互いに異なる第1閾値及び第2閾値の各々と比較することにより、前記車両に対する側方の判定対象距離範囲内に存在する障害物が壁であるか縁石であるかを判定する障害物検知制御部と、
     前記障害物検知制御部による判定結果に応じて、自動駐車用の誘導経路を設定する自動駐車制御部と、を備え、
     前記自動駐車制御部は、縦列駐車による前記自動駐車において、前記判定結果が縁石を示している場合、前記判定結果が壁を示している場合に対して前記車両の切り込みが大きい前記誘導経路を設定する
     ことを特徴とする駐車支援装置。
  2.  前記障害物検知制御部は、前記レベル値と前記第1閾値及び前記第2閾値との比較結果が示す前記反射波の反射位置をグルーピングすることにより前記障害物に対応するグループを設定し、前記グループの形状に応じて前記障害物が壁又は縁石であるか他車両であるかを判定することを特徴とする請求項1記載の駐車支援装置。
  3.  前記障害物検知制御部は、前記グループの幅に応じて前記障害物がポールであるか否かを判定することを特徴とする請求項2記載の駐車支援装置。
  4.  前記自動駐車制御部は、前記グルーピングの結果に応じて、縦列駐車用の前記誘導経路又は並列駐車用の前記誘導経路を設定することを特徴とする請求項2記載の駐車支援装置。
PCT/JP2016/076623 2016-09-09 2016-09-09 駐車支援装置 WO2018047295A1 (ja)

Priority Applications (5)

Application Number Priority Date Filing Date Title
PCT/JP2016/076623 WO2018047295A1 (ja) 2016-09-09 2016-09-09 駐車支援装置
US16/324,659 US11161547B2 (en) 2016-09-09 2016-09-09 Parking assistance device
CN201680088967.7A CN110035930B (zh) 2016-09-09 2016-09-09 停车辅助装置
DE112016007206.6T DE112016007206T5 (de) 2016-09-09 2016-09-09 Parkassistenzvorrichtung
JP2018537948A JP6625228B2 (ja) 2016-09-09 2016-09-09 駐車支援装置

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
PCT/JP2016/076623 WO2018047295A1 (ja) 2016-09-09 2016-09-09 駐車支援装置

Publications (1)

Publication Number Publication Date
WO2018047295A1 true WO2018047295A1 (ja) 2018-03-15

Family

ID=61562832

Family Applications (1)

Application Number Title Priority Date Filing Date
PCT/JP2016/076623 WO2018047295A1 (ja) 2016-09-09 2016-09-09 駐車支援装置

Country Status (5)

Country Link
US (1) US11161547B2 (ja)
JP (1) JP6625228B2 (ja)
CN (1) CN110035930B (ja)
DE (1) DE112016007206T5 (ja)
WO (1) WO2018047295A1 (ja)

Cited By (2)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JPWO2021106030A1 (ja) * 2019-11-25 2021-06-03
WO2023175741A1 (ja) * 2022-03-15 2023-09-21 日立Astemo株式会社 外界認識装置

Families Citing this family (13)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
DE102018206751A1 (de) * 2018-05-02 2019-11-07 Continental Automotive Gmbh Konturerkennung eines fahrzeugs anhand von messdaten einer umfeldsensorik
DE102019114207A1 (de) * 2019-05-28 2020-12-03 Valeo Schalter Und Sensoren Gmbh Verfahren zum Betreiben eines Ultraschallsensors für ein Fahrzeug mit Bestimmung eines Freiraums, Recheneinrichtung sowie Ultraschallsensorvorrichtung
CN110488280B (zh) * 2019-08-29 2022-03-11 广州小鹏自动驾驶科技有限公司 一种停车位轮廓的修正方法及装置、车辆、存储介质
US11092688B1 (en) * 2020-03-20 2021-08-17 Aptiv Technologies Limited Spatial and temporal processing of ultrasonic sensor detections for mapping in vehicle-parking-assist functions
JP7506551B2 (ja) * 2020-08-04 2024-06-26 パナソニックオートモーティブシステムズ株式会社 障害物判定装置、車両および障害物判定方法
JP7367634B2 (ja) * 2020-08-06 2023-10-24 トヨタ自動車株式会社 制御装置、プログラム及び制御方法
DE102020126172A1 (de) * 2020-10-07 2022-04-07 Valeo Schalter Und Sensoren Gmbh Verfahren zum vermessen eines seitlichen umfelds eines fahrzeugs, messvorrichtung und fahrzeug
CN112562412B (zh) * 2020-12-07 2022-03-11 广州小鹏自动驾驶科技有限公司 一种数据处理的方法和装置
CN112606828B (zh) * 2020-12-11 2022-02-01 东风汽车集团有限公司 自动泊车控制装置、方法及车辆
KR20220141375A (ko) * 2021-04-12 2022-10-20 현대자동차주식회사 주차 제어 장치 및 그 방법
US20220379882A1 (en) * 2021-05-28 2022-12-01 Jaguar Land Rover Limited Apparatus and method for controlling vehicle movement
JPWO2023282070A1 (ja) * 2021-07-06 2023-01-12
CN114312760B (zh) * 2022-03-07 2022-06-21 坤泰车辆系统(常州)股份有限公司 带路沿车位的辅助泊车方法、电子设备和汽车

Citations (3)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP2008546577A (ja) * 2005-06-13 2008-12-25 ローベルト ボツシユ ゲゼルシヤフト ミツト ベシユレンクテル ハフツング 駐車指示を出力する方法および装置
JP2014074665A (ja) * 2012-10-04 2014-04-24 Nippon Soken Inc 物体検知装置
JP2014157501A (ja) * 2013-02-15 2014-08-28 Nippon Soken Inc 障害物検知装置

Family Cites Families (18)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US7697786B2 (en) * 2005-03-14 2010-04-13 Sarnoff Corporation Method and apparatus for detecting edges of an object
US9047779B2 (en) * 2010-05-19 2015-06-02 Mitsubishi Electric Corporation Vehicle rear view monitoring device
KR101912453B1 (ko) * 2012-02-17 2018-10-26 현대모비스 주식회사 장애물 검출 및 충돌 경보 장치 및 방법
KR20130124050A (ko) * 2012-05-04 2013-11-13 현대모비스 주식회사 장애물 형태 구분에 따른 목표 주차 위치 결정 기능을 갖는 자동 주차 보조 시스템 및 그 방법
JP5831415B2 (ja) * 2012-09-18 2015-12-09 アイシン精機株式会社 駐車支援装置
US9043069B1 (en) * 2012-11-07 2015-05-26 Google Inc. Methods and systems for scan matching approaches for vehicle heading estimation
JP2014101101A (ja) 2012-11-22 2014-06-05 Denso Corp 駐車支援装置
CN104736410B (zh) * 2012-11-27 2016-04-27 日产自动车株式会社 加速误操作判定装置、误加速操作抑制控制装置、加速误操作判定方法
CN104755344B (zh) * 2012-11-27 2016-05-04 日产自动车株式会社 车辆用加速抑制装置以及车辆用加速抑制方法
JP6181300B2 (ja) * 2014-09-05 2017-08-16 エスゼット ディージェイアイ テクノロジー カンパニー リミテッドSz Dji Technology Co.,Ltd 無人航空機の速度を制御するシステム
JP6275006B2 (ja) * 2014-09-12 2018-02-07 アイシン精機株式会社 駐車支援装置
KR101553868B1 (ko) * 2014-12-03 2015-09-17 현대모비스 주식회사 차량의 자동 주차 제어장치 및 그 방법
DE102015200939A1 (de) * 2015-01-21 2016-07-21 Robert Bosch Gmbh Verfahren und System zur Detektion von Objekten in der Umgebung eines Fahrzeugs
JP6544121B2 (ja) * 2015-07-31 2019-07-17 アイシン精機株式会社 駐車支援装置
JP6573795B2 (ja) * 2015-07-31 2019-09-11 アイシン精機株式会社 駐車支援装置、方法及びプログラム
KR102489386B1 (ko) * 2016-04-15 2023-01-18 주식회사 에이치엘클레무브 주차 지원 장치 및 그의 주차 제어 방법
KR102651860B1 (ko) * 2016-10-26 2024-03-27 주식회사 에이치엘클레무브 자동 주차 시스템 및 방법
JP6859906B2 (ja) * 2017-09-06 2021-04-14 トヨタ自動車株式会社 駐車支援装置

Patent Citations (3)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP2008546577A (ja) * 2005-06-13 2008-12-25 ローベルト ボツシユ ゲゼルシヤフト ミツト ベシユレンクテル ハフツング 駐車指示を出力する方法および装置
JP2014074665A (ja) * 2012-10-04 2014-04-24 Nippon Soken Inc 物体検知装置
JP2014157501A (ja) * 2013-02-15 2014-08-28 Nippon Soken Inc 障害物検知装置

Cited By (4)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JPWO2021106030A1 (ja) * 2019-11-25 2021-06-03
WO2021106030A1 (ja) * 2019-11-25 2021-06-03 三菱電機株式会社 障害物検知装置
JP7224491B2 (ja) 2019-11-25 2023-02-17 三菱電機株式会社 障害物検知装置
WO2023175741A1 (ja) * 2022-03-15 2023-09-21 日立Astemo株式会社 外界認識装置

Also Published As

Publication number Publication date
CN110035930A (zh) 2019-07-19
US11161547B2 (en) 2021-11-02
US20190217856A1 (en) 2019-07-18
CN110035930B (zh) 2021-09-17
JPWO2018047295A1 (ja) 2019-01-24
DE112016007206T5 (de) 2019-06-06
JP6625228B2 (ja) 2019-12-25

Similar Documents

Publication Publication Date Title
WO2018047295A1 (ja) 駐車支援装置
EP2025577B1 (en) Travel assistance device
JP6555067B2 (ja) 車線変更支援装置
US8742947B2 (en) Parking space monitoring device
US9905132B2 (en) Driving support apparatus for a vehicle
US8195363B2 (en) Steering control device for vehicle
US20160068187A1 (en) Parking assist device
US9085321B2 (en) Unparking control system and unparking control method using the same
WO2017060975A1 (ja) 駐車形態判定装置
US20100235053A1 (en) Parking assist device
JP5857900B2 (ja) 駐車支援装置
WO2014125810A1 (ja) 障害物検知装置
US10884125B2 (en) Parking assistance device
JP2011034297A (ja) 駐車空間認識装置
JP6289546B2 (ja) 駐車支援装置
JP6357050B2 (ja) 運転支援システム
JP2017151726A (ja) 衝突予測装置
JP5983276B2 (ja) 駐車支援装置
US11142187B2 (en) Parking assistance device
JPWO2018230344A1 (ja) 運転支援装置、運転支援方法及びコンピュータプログラム
JP6942254B2 (ja) 障害物検知装置又は運転支援装置
JP6953166B2 (ja) 電動車両の自動走行制御装置および自動走行制御方法
JP7344077B2 (ja) 衝突判定装置
JP5803564B2 (ja) 車両の操舵支援装置及び操舵支援方法
JP5048561B2 (ja) 車両用障害物監視装置

Legal Events

Date Code Title Description
WWE Wipo information: entry into national phase

Ref document number: 2018537948

Country of ref document: JP

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

Ref document number: 16915713

Country of ref document: EP

Kind code of ref document: A1

122 Ep: pct application non-entry in european phase

Ref document number: 16915713

Country of ref document: EP

Kind code of ref document: A1