WO2014125810A1 - 障害物検知装置 - Google Patents

障害物検知装置 Download PDF

Info

Publication number
WO2014125810A1
WO2014125810A1 PCT/JP2014/000705 JP2014000705W WO2014125810A1 WO 2014125810 A1 WO2014125810 A1 WO 2014125810A1 JP 2014000705 W JP2014000705 W JP 2014000705W WO 2014125810 A1 WO2014125810 A1 WO 2014125810A1
Authority
WO
WIPO (PCT)
Prior art keywords
point
distance
detection
obstacle
range
Prior art date
Application number
PCT/JP2014/000705
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 株式会社デンソー
Publication of WO2014125810A1 publication Critical patent/WO2014125810A1/ja

Links

Images

Classifications

    • GPHYSICS
    • G08SIGNALLING
    • G08GTRAFFIC CONTROL SYSTEMS
    • G08G1/00Traffic control systems for road vehicles
    • G08G1/16Anti-collision systems
    • G08G1/168Driving aids for parking, e.g. acoustic or visual feedback on parking space

Definitions

  • the present disclosure relates to an obstacle detection device that detects an obstacle existing around the host vehicle by using distance detection means such as an ultrasonic sensor that detects a distance from the host vehicle to the obstacle.
  • distance detection means such as an ultrasonic sensor that detects a distance from the host vehicle to the obstacle.
  • Patent Document 1 there is known a parking space detection device that detects a parking space using a distance detection means that detects a distance from an own vehicle to an obstacle such as a parked vehicle (see, for example, Patent Document 1).
  • a distance detection means that detects a distance from an own vehicle to an obstacle such as a parked vehicle
  • Patent Document 1 when the host vehicle is moving on the side of an obstacle (parked vehicle), the distance to the obstacle is sequentially detected by a distance measuring sensor. Then, the shape of the obstacle is estimated by performing curve approximation on the obtained point distance data of the detection distance, and the parking space is detected based on the estimated shape.
  • the detection distance may change greatly at the boundary between obstacles, the detection distance may change greatly due to noise such as road surface noise.
  • noise such as road surface noise.
  • the obstacle detection device is mounted on a vehicle, and when the vehicle is moving on the side of the obstacle, distance detection means that sequentially detects the distance to the obstacle, First determination means for determining the presence or absence of a large distance difference point that is a detection distance point at which a difference from a detection distance of an adjacent point in the point sequence of detection distances detected by the distance detection means is a predetermined amount or more. And when the first determination means determines that the distance difference large point is present, a second determination is made as to whether the position of the distance difference large point is a break of an obstacle or whether the distance difference large point is noise.
  • a determination unit and a grouping unit configured to group the point sequence of the detection distance with the large distance difference point as a boundary when the second determination unit determines that the obstacle is broken.
  • the second determination unit determines that the obstacle is a break, grouping is performed for each obstacle by grouping the break, that is, the distance difference large point as a boundary.
  • the drawing It is the figure which showed schematic structure of the parking assistance apparatus 1 which concerns on embodiment to this indication. It is the figure which illustrated the assumption scene of parking space detection. It is the flowchart which showed the basic procedure of parking space detection. It is a figure explaining the calculation method of a reflective point. It is the figure which illustrated the point sequence of the detection distance which does not have continuity. It is a figure of the scene where the pillar 82 was arrange
  • FIG. It is a figure which shows the point sequence of the detection distance containing a distance difference large point, and is a figure explaining the setting method of the assumption range of the previous distance point which concerns on Example 1.
  • FIG. It is the figure which illustrated the point sequence of the detection distance which has continuity. It is the figure which set the assumption range of the back distance point with respect to the point sequence of FIG. It is the figure which set the assumption range of the front distance point with respect to the point sequence of FIG.
  • S41 and S42 is a diagram illustrating a procedure for setting an assumed range according to the second embodiment.
  • FIG. 21 It is a figure which shows the point sequence of the detection distance containing a distance difference large point, and explains the setting method of the assumption range of the front distance point and back distance point which concern on Example 2.
  • FIG. It is a figure explaining the method of noise processing, illustrating the point sequence of detection distance.
  • FIG. 21 It is a figure for demonstrating the process of FIG. 21, and is a figure of the scene where the offset obstruction was arrange
  • FIG. 6 is a diagram illustrating a point sequence 9 that hardly changes in the depth direction within a frame 500; It is a figure of the scene where only the parked vehicle is arrange
  • FIG. 1 is a diagram illustrating a schematic configuration of a parking assistance device 1 to which the obstacle detection device of the present disclosure is applied.
  • the parking assist device 1 is mounted on the host vehicle 5 (see FIG. 2).
  • the parking assist device 1 includes a distance measuring sensor 2, a vehicle speed sensor 12, a steering angle sensor 13, and an ECU 11 connected thereto.
  • the distance measuring sensor 2 is mounted on the left and right side surfaces (the left side surface 51 in FIG. 2) of the host vehicle 5 as shown in FIG.
  • the distance measuring sensor 2 is a sensor that detects a distance to an obstacle such as a parked vehicle that is present on the side (side of the host vehicle 5). Specifically, the distance measuring sensor 2 exceeds the predetermined distance (for example, every 100 milliseconds) in the front direction of the distance measuring sensor 2 (on the left side of the host vehicle 5 in FIG. 2) based on an instruction from the ECU 11. Transmit exploration waves such as sound waves. The distance measuring sensor 2 receives the reflected wave reflected by the transmitted exploration wave hitting an obstacle.
  • the distance measuring sensor 2 calculates the distance to the obstacle based on the transmission timing of the exploration wave, the reception timing of the reflected wave, and the velocity of the exploration wave (sound velocity when the exploration wave is ultrasonic). Detection information (detection distance) detected by the distance measuring sensor 2 is input to the ECU 11. Note that the ECU 11 may calculate the detection distance.
  • the directivity ⁇ (directivity of the exploration wave) of the detection range 21 (see FIG. 2) of the distance measuring sensor 2 is, for example, about 70 ° to 120 °.
  • the maximum detection distance that can be detected by the distance measuring sensor 2 is, for example, about 4 m to 10 m.
  • the distance measuring sensor 2 may be any sensor that transmits an exploration wave and receives a reflected wave of the exploration wave, and uses a radio wave regardless of whether it uses a sound wave or a light wave. May be.
  • a sensor such as an ultrasonic sensor, a laser radar, or a millimeter wave radar can be used.
  • the vehicle speed sensor 12 is a sensor that detects the vehicle speed of the host vehicle 5.
  • the steering angle sensor 13 is a sensor that outputs the steering angle from the neutral position as the steering angle, with the steering position when the host vehicle 5 moves straight ahead as the neutral position (0 degree). Detection information (vehicle speed, steering angle) detected by the vehicle speed sensor 12 and the steering angle sensor 13 is input to the ECU 11.
  • the ECU 11 is mainly composed of a microcomputer including a CPU, a ROM, a RAM, and the like.
  • the ECU 11 executes a process for assisting parking in a parking space existing around the vehicle 5 (side) based on each detection information input from the distance measuring sensor 2, the vehicle speed sensor 12, and the steering angle sensor 13.
  • the ECU 11 includes a memory 111 such as a ROM or a RAM that stores various types of information necessary for processing executed by itself.
  • FIG. 3 is a flowchart showing the procedure.
  • FIG. 2 is a diagram illustrating an assumed scene in which the process of FIG. 3 is executed. Specifically, the side of two parked vehicles 61 and 62 arranged with the parking space 7 interposed therebetween is shown. The scene where the own vehicle 5 is moving is shown. An obstacle 81 such as a curb is arranged in the parking space 7.
  • the process of FIG. 3 may be started when, for example, a support switch (not shown) provided in the passenger compartment is turned on by the driver of the host vehicle 5 or is always executed in the background when the host vehicle 5 is at a low speed. May be.
  • the ECU 11 causes the distance measuring sensor 2 to sequentially detect the distance (S11). Further, based on the detection information of the vehicle speed sensor 12 and the steering angle sensor 13, the position (sensor position) of the distance measuring sensor 2 when the distance measuring sensor 2 detects the distance is calculated (S12). At this time, the moving distance of the distance measuring sensor 2 from the previous sensor position can be calculated from the vehicle speed and the elapsed time from the previous distance detection.
  • the moving direction of the distance measuring sensor 2 from the previous distance detection can be calculated from the steering angle.
  • the sensor position at the time of the current distance detection can be calculated from the movement distance, the movement direction, and the sensor position at the time of the previous distance detection.
  • the detection distance and sensor position detected in S11 and S12 are stored in the memory 111.
  • FIG. 2 illustrates a history of detection distances detected in S11, in other words, a point 9 (ranging point) that is separated from the sensor position detected in S12 by the detection distance in the front direction of the distance measuring sensor 2.
  • the point sequence of the distance measuring points 9 includes a distance measuring point 901 for the first parked vehicle 61, a distance measuring point 903 for the obstacle 81 in the parking space 7, and the second parking.
  • the detection distance history stored in the memory 111 is approximated by a curve using a quadratic function or the like (S13).
  • the point sequence of the distance measuring points 9 is approximated by a curve.
  • FIG. 2 shows an approximate curve 301 of a point sequence of the distance measuring points 901.
  • FIG. 4 is a diagram for explaining a method of calculating the reflection point, and shows a scene in which the host vehicle 5 is passing by the parked vehicle 6.
  • FIG. 4 includes a sensor position SenPos (n) and a detection distance L (n) at a certain time point, and a sensor position SenPos (n ⁇ 1) and a detection distance L (n ⁇ 1) at the previous time point.
  • a triangle 700 is illustrated. In S14, the position of the vertex 4 of the triangle 700 in FIG.
  • FIG. 2 illustrates a point sequence of the reflection points 4 for the first parked vehicle 61 calculated in S14. The point sequence of the reflection point 4 is detected on the outline of the parked vehicle 61.
  • the corner of the obstacle adjacent to the parking space is detected based on the point sequence of the reflection points calculated in S14 (S15).
  • the corner 611 of the first parked vehicle 61 is detected based on the point sequence of the reflection points 4
  • the parked vehicle 62 is based on the reflection point (not shown) with respect to the second parked vehicle 62.
  • the corner 621 is detected.
  • a coordinate system having an X axis corresponding to the left and right direction of the parking space 7 and a Y axis corresponding to the depth direction is set.
  • the X coordinate of the reflection point closest to the parking space 7 in the point sequence of the reflection points 4, that is, the reflection point having the largest X coordinate is set as the X coordinate of the corner 611.
  • the Y coordinate of the reflection point closest to the side passage in the point sequence of the reflection points 4, that is, the reflection point having the smallest Y coordinate is set as the Y coordinate of the corner 611.
  • the corner 621 of the second parked vehicle 62 is similarly calculated.
  • the space between the corners 611 and 621 detected in S15 is set as the parking space 7 (S16). Thereafter, the process of FIG. 3 is terminated. Thereafter, the ECU 11 determines whether or not the parking space 7 can be parked based on the detected width of the parking space 7 and the vehicle width of the host vehicle 5. When the ECU 11 determines that parking is possible, the ECU 11 calculates a route for the host vehicle 5 to move to the parking space 7 based on the positional relationship between the parking space 7 and the host vehicle 5. Then, ECU11 controls a steering motor and an engine, moves the own vehicle 5 to the parking space 7 according to the path
  • FIG. 5 illustrates a point sequence 9 (detection distance time-series data) including a detection distance point 91 (distance difference large point) having a large distance difference.
  • the distance difference large point 91 When the distance difference large point 91 is included in the detection distance point sequence 9, it is necessary to determine whether the distance difference large point 91 is a noise or an obstacle break. Otherwise, the point sequence 92 of the detection distance before the distance difference large point 91 and the point sequence 93 after the single difference may be grouped, or the obstacles may be different obstacles. This is because the point sequences 92 and 93 are grouped into one group.
  • FIG. 6 illustrates a scene where the distance difference is small regardless of the break of the obstacle.
  • FIG. 6 shows a scene in which the pillar 82 is disposed adjacent to the parked vehicle 63 and offset in the depth direction from the front surface of the parked vehicle 63 (surface on which distance detection is performed).
  • the detection distance point sequence 94 with respect to the parked vehicle 63 and the detection distance point sequence 95 with respect to the column 82 are detected to be continuous despite the break between the parked vehicle 63 and the column 82. Is done. That is, the difference between the end point 941 of the point sequence 94 and the end point 951 of the point sequence 95 is small. Even in such a case, it is necessary to distinguish and group the point sequences 94 and 95.
  • FIG. 7 is a diagram illustrating the scene, and in detail, shows a scene where two parked vehicles 63 and 64 are arranged adjacent to each other without being offset.
  • the detection distance point sequence 971 for the left parked vehicle 63 and the detection distance point sequence 972 for the right parked vehicle 64 continue in spite of the break of the parked vehicles 63 and 64. Is detected. That is, the difference between the end point 973 of the point sequence 971 and the end point 974 of the point sequence 972 is small. Even in such a case, it is necessary to group the point sequences 971 and 972 separately.
  • FIG. 8 shows a flowchart of the grouping process. 8 starts when, for example, a support switch (not shown) provided in the passenger compartment is turned on by the driver of the host vehicle 5, and is executed in parallel with the process of FIG. During the process of FIG. 8, the ECU 11 causes the distance measurement sensor 2 to perform distance detection every time the distance detection time t is updated in S31 described later, in other words, every time a predetermined distance detection interval dt elapses. .
  • the detected distance detected by the distance measuring sensor 2 and the sensor position calculated in S12 of FIG. 3 are associated with each other and stored in the memory 111 (see FIG. 1) (S21).
  • the presence / absence of a large distance difference point which is a detection distance point having a large distance difference, is determined from the detection distance point sequence (history) stored in the memory 111 (S22).
  • the point sequence of the detection distance the point of the detection distance where the difference from the detection distance of the adjacent point is a predetermined amount or more is set as the distance difference large point, and the presence / absence of the distance difference large point is determined. .
  • FIG. 1 the detected distance detected by the distance measuring sensor 2 and the sensor position calculated in S12 of FIG. 3 are associated with each other and stored in the memory 111 (see FIG. 1) (S21).
  • the presence / absence of a large distance difference point which is a detection distance point having a large distance difference
  • the point sequence of the detection distance the point of the detection distance where the difference from the detection distance of the adjacent point
  • the process proceeds to S23 to determine whether the distance difference large point is a noise or an obstacle break.
  • a point sequence of detection distances detected from a single obstacle has continuity between the points.
  • the fluctuation tendency (continuity) of the point sequence of the detection distance detected from one obstacle and the detection detected from other obstacles There is a difference in the variation tendency (continuity) of the point sequence of distance. Therefore, in S23, based on whether there is continuity between the point sequence of the detection distance before the distance difference large point and the point sequence of the subsequent detection distance, whether the distance difference large point is noise or not Determine if it is a break in the object.
  • FIG. 9 is a detailed flowchart of S23. The case where the process of FIG. 9 is applied to the point sequence of the detection distance of FIG. 5 will be described as an example.
  • FIG. 10 is a detailed flowchart of S41, and shows a procedure for setting an assumed range according to the first embodiment.
  • FIG. 11 is a diagram for explaining each process of FIG. 10 and shows a point sequence having the same detection distance as FIG. In the example of FIG. 11, the detection distance of the three points constituting the point sequence 92 tends to increase with time.
  • the difference B increase
  • the minimum detection distance point 922 and the maximum detection distance point 921 in the point sequence 92 is calculated.
  • the detection distance of the point sequence 92 increases with the passage of time, but as shown in FIG. 12, the detection distance of the point sequence 92 may decrease with the passage of time.
  • the horizontal line 413 passing through the end point 9a is set as the increment line of S51 on the assumption that the distance is equal to or less than the detection distance at the end point 9a of the point sequence 92.
  • the line 413 passing through the point 9a having a zero slope is set as the increment line.
  • the detection distance may decrease or increase with time.
  • the detection distance decreases (point 9b> point 9c), and then the detection distance increases (point 9c ⁇ point 9d).
  • the detection distance decreases (point 9b> point 9d).
  • a line 414 having a slope C / A passing through 9d is set as an incremental line.
  • the section of the point sequence 92 is a three-point section.
  • the section A ′ The difference B ′ between the minimum value of the detected distance and the detected distance value of the end point of the section A ′ (point 921 in the example of FIG. 11) is calculated as an increment.
  • a line passing through the end point of the slope B ′ / A ′ may be set as an incremental line.
  • a line (decrement line) indicating a decreasing tendency of the detected distance in the section of the point sequence 92 of the previous distance point is set in the area of the rear distance point 93 (S52).
  • the detection distance of the point sequence 92 increases with the passage of time, and the amount of decrease is zero.
  • the horizontal line 412 passing through the end point 921 is set as a decrement line, assuming that the distance is equal to or greater than the detection distance at the end point 921 of the point sequence 92 (S52). .
  • a line 415 connecting both end points of the point sequence 92 is set as a decrement line.
  • the entire section A is decreased by the difference D between the detection distance at the point 9b and the detection distance at the point 9d, in S52, for example, the slope ( ⁇ D / A) passing through the point 9d.
  • Line 416 is set as a decrement line.
  • the difference D ′ between the maximum value of the detection distance in the section A ′ and the detection distance value of the end point of the section A ′ is reduced. Calculate as minutes. Then, a line passing through the end point of the inclination ⁇ D ′ / A ′ may be set as a decrement line.
  • the increment line set in S51 and the decrement line set in S52 are limit lines where continuity is established with the point sequence 92 of the previous distance point.
  • the range 410 (refer FIG. 11) between these increment lines and decrement lines is set as an assumption range of the back distance point 93 (S53).
  • This assumed range 410 is a first continuity range in which continuity is established with the point sequence 92.
  • An increment line 411 in FIG. 11 is a line that gives an upper limit value of a detection distance at which continuity is established with the point sequence 92 of the previous distance point.
  • the decrement line 412 is a line that gives a lower limit value of the detection distance that establishes continuity with the point sequence 92 of the previous distance point.
  • the assumed range may be set by giving a predetermined margin to the range 410. Specifically, a range that is expanded from the range 410 by a predetermined amount d1 (see FIG. 11) up and down is assumed. May be set as Thereby, it is possible to prevent the point sequence 92 from being determined to be discontinuous even when there is no obstacle break.
  • an assumed range in which the front distance point 92 is assumed is represented by It sets based on continuity (fluctuation tendency) (S42).
  • a range in which continuity is established between the area of the previous distance points 92 and the point sequence 93 of the rear distance points is set as an assumed range (S42).
  • an assumed range is set based on the point sequence of the fixed interval (three-point interval in FIG. 5) immediately after the distance difference large point 91 in the point sequence 93 of the rear distance points.
  • FIG. 14 is a diagram for explaining each process of FIG. 10 with respect to the process of S42, and shows a point sequence having the same detection distance as FIG. 10, the line (incremental line) indicating the increasing tendency of the detection distance in the section of the point sequence 93 of the rear distance point is set in the area of the front distance point 92 (S51). Specifically, an incremental line is set in the same manner as the incremental line in the process of S41. In other words, in the example of FIG. 14, the detection distance of the point sequence 93 tends to increase with the passage of time.
  • the increment line 421 in FIG. 14 is a line that gives a lower limit value of the detection distance that establishes continuity with the point sequence 93 for the interval before the point sequence 93, that is, the interval of the previous distance point 92. It becomes.
  • a line (decrement line) indicating a decreasing tendency of the detection distance in the section of the point sequence 93 of the rear distance point is set in the area of the front distance point 92 (S52).
  • the detection distance of the point sequence 93 increases with the passage of time, and the amount of decrease is zero.
  • the horizontal line 422 passing through the end point 931 is set as a decrement line on the assumption that the distance is equal to or less than the detection distance at the end point 931 of the point sequence 93 (S52).
  • the decrement line 422 is a line that gives an upper limit value of the detection distance that establishes continuity with the point sequence 93 for the section of the previous distance point 92.
  • a range 420 between the increment line 421 and the decrement line 422 is set as an assumed range of the previous distance point (second continuity range in which continuity is established with the point sequence 93).
  • the assumed range may be set by giving a predetermined margin to the range 420. Specifically, a range that is expanded from the range 420 by a predetermined amount is set as the assumed range. Also good.
  • the rear distance point 931 (end point of the rear distance point point sequence 93) adjacent to the distance difference large point 91 is included in the assumed range 410 (see FIG. 11) set in S41. It is determined whether or not (S43). If it is not included (S43: No), it is determined that the back distance point does not have continuity with the point sequence of the previous distance point, that is, is discontinuous (S46). Then, the process of FIG. 9 is complete
  • the front distance point 921 (the end point of the point sequence 92 of the previous distance point) adjacent to the distance difference large point 91 is the assumed range 420 ( It is determined whether it is included (see FIG. 14) (S44). In the example of FIG. 14, it is determined that the previous distance point 921 is not included in the assumed range 420. In this case (S44: No), it is determined that the front distance point 921 does not have continuity with the point sequence 93 of the rear distance point, that is, is discontinuous (S46). Then, the process of FIG. 9 is complete
  • FIG. 15 shows a point sequence having a detection distance different from the point sequence of FIG. 5, although the fluctuation tendency is similar to that of FIG.
  • the increasing tendency of the point sequence 93 of the rear distance points is slightly different from that in FIG. 5, and the other tendency is the same as that in FIG. 5.
  • FIG. 16 shows an example in which the process of S41 of FIG. 9 (the process of FIG. 10) is applied to the point sequence of FIG.
  • S41 a range 430 between the increment line 431 set in S51 of FIG. 10 and the decrement line 432 set in S52 is set as an assumed range of the rear distance point 931.
  • FIG. 17 shows an example in which the process of S42 of FIG. 9 (the process of FIG. 10) is applied to the point sequence of FIG.
  • a range 440 between the increment line 441 set in S51 of FIG. 10 and the decrement line 442 set in S52 is set as an assumed range of the previous distance point 921.
  • FIG. 15 is a diagram for explaining the processing of FIG.
  • the point sequence of FIG. 19 includes two distance difference large points 91, a point sequence 92 of the previous distance point before the distance difference large point 91, and a point sequence 93 of the rear distance point after the distance difference large point 91. have.
  • the point sequence 92 is a point sequence in a certain section (three points in FIG. 19) immediately before the distance difference large point 91.
  • the point sequence 93 is a point sequence in a certain interval (three intervals in FIG. 19) immediately after the distance difference large point 91.
  • Estimatimated line of the rear distance point 93 is set based on the fluctuation tendency of the point sequence 92 (S61). Specifically, for example, in the sections other than the section of the point sequence 92, it is assumed that the detection distance varies linearly with the same tendency as the section of the point sequence 92.
  • a straight line 451 connecting both end points 921 and 922 of the point sequence 92 is set as an estimated line of the rear distance point 93.
  • linear approximation may be performed using all the points in the point sequence 92, and the obtained approximate straight line may be set as an estimated line.
  • a range within a predetermined distance from the estimated line 451 is set as an assumed range of the rear distance point 93 (S62).
  • a range 450 that is a predetermined amount d2 or less from the point 452 on the estimated line 451 at the position (time) of the end point 931 of the back distance point sequence 93 is assumed as the assumed range of the back distance point 931.
  • a single distance that provides an estimated value of the detection distance that establishes continuity with the point sequence 93 of the rear distance point for the area of the front distance point 92 is provided.
  • a line 461 (estimated line of the previous distance point 92) is set based on the fluctuation tendency of the point sequence 93 (S61). Specifically, as described above, a straight line connecting both end points 931 and 932 of the point sequence 93 and an approximate straight line obtained by linear approximation of the point sequence 93 are set as the estimation line 461.
  • a range 460 that is below a predetermined amount d2 from the point 462 on the estimated line 461 at the position (time) of the end point 921 of the point sequence 92 of the previous distance point is set as an assumed range of the previous distance point 921. (S62). Then, the process of FIG. 18 is complete
  • FIG. 20 is a diagram for explaining the noise processing method in S25, and shows the same point sequence as that in FIG. The details of S25 will be described with reference to FIG. 20.
  • S25 first, the section of the distance difference large point 91 is set to a point 921 of the detection distance immediately before the distance difference large point 91 (of the point sequence 92 of the previous distance point). (End point) and the next detection distance point 931 (the end point of the back distance point point sequence 93) are used for linear interpolation. Specifically, a straight line 100 connecting the points 921 and 931 is set as a linear interpolation line. Next, the distance difference large point 91 is corrected so as to be on the line 100 of the linear interpolation.
  • the distance difference large point 91 is corrected by holding the time when the distance difference large point 91 is detected, that is, by lowering the distance difference large point 91 directly below or directly above in the example of FIG. Do.
  • FIG. 20 shows the point 911 after correction. This makes it possible to remove noise from the detection distance point sequence without reducing the number of detection distance points.
  • the distance difference large point 91 may be invalidated (removed). According to this, since it is not necessary to perform linear interpolation or correction as shown in FIG. 20, noise can be easily removed.
  • the distance difference is assumed to be an obstacle break at the position of the distance difference large point.
  • Grouping of detection distances is performed with a large point as a boundary (S26). Specifically, the history (point sequence) of the detection distance before the distance difference large point is set as one obstacle group, and the history (point sequence) of the detection distance after the distance difference large point is set to other obstacles. Group.
  • the point sequence of FIG. 5 described above is a point sequence that is the target of grouping in S26 because there is a break in the obstacle.
  • the point sequence 92 of the front distance points forms one group
  • the point sequence 93 of the back distance points forms one group.
  • the distance difference large point 91 is a point (noise) that does not belong to either group.
  • the process proceeds to S27.
  • the scene is a scene where distance detection of a single obstacle continues (a scene without a break between obstacles), the scene shown in FIG. 6, or the scene shown in FIG.
  • S27 the presence / absence of an obstacle break is determined while distinguishing these scenes.
  • FIGS. 6 and 7 when two obstacles are arranged adjacent to each other, the variation tendency of the point sequence of the detection distance changes at the position of the break of the obstacle. In the scene of FIG.
  • the distance detection with respect to the parked vehicle 63 continues for a while after the host vehicle exceeds the front of the parked vehicle 63.
  • the value of the detection distance increases with the passage of time, in other words, as the host vehicle advances toward the column 82 side. That is, the point sequence 940 varies in an oblique direction from the corner 631 of the parked vehicle 63 toward the front surface 821 of the column 82.
  • the distance detection for the pillar 82 is started immediately.
  • a point of the detection distance is detected along the front surface 821 of the column 82 at first.
  • distance detection continues for a while, and the value of the detected distance during that time gradually increases as the host vehicle moves away from the column 82.
  • the variation tendency of the point sequence 940 (trend moving in an oblique direction) and the variation tendency of the point sequence 95 with respect to the column 82 (on the front surface 821). A tendency to change along the direction).
  • the detection distance point 951 at the position where the difference occurs is an inflection point of the detection distance point sequence.
  • an inflection point 973 is generated in the point sequence of the detection distance, but the variation tendency of the point sequence in the vicinity of the inflection point 973 (the shape of the point sequence) is different from the scene in FIG. 6. That is, in the scene of FIG. 7, if distance detection is performed in the order of the left parked vehicle 63 and the right parked vehicle 64, the parked vehicle 63 will remain for a while after the host vehicle has passed the front of the parked vehicle 63. The distance detection for continues. The value of the detection distance during that time gradually increases as the host vehicle leaves the parked vehicle 63. Thereafter, when the distance detection for the left parked vehicle 63 ends, the distance detection for the right parked vehicle 64 starts immediately.
  • the value of the detected distance gradually decreases as the host vehicle approaches the parked vehicle 64 until the host vehicle comes to the front of the parked vehicle 64. Thereafter, when the host vehicle comes to the front of the parked vehicle 64, a point of the detection distance is detected along the front of the parked vehicle 64.
  • a point sequence of detection distances with respect to the parked vehicle 63 and a point sequence of detection distances with respect to the parked vehicle 64 are V-shaped. Is formed. The point 973 of the V-shaped apex becomes an inflection point.
  • an inflection point occurs in the point sequence of the detection distance at the position of the obstacle break.
  • the scene of FIG. 6 and the scene of FIG. 7 are different in the pattern of inflection points, in other words, the shape of the point sequence around the inflection points. Therefore, in S27, processing for detecting the inflection point corresponding to the scene of FIG. 6 (processing of FIG. 21) and processing for detecting the inflection point corresponding to the scene of FIG. 7 (processing of FIG. 26) are performed in parallel. And run. First, an inflection point detection method in the scene of FIG. 6 will be described.
  • FIG. 21 is a detailed flowchart of S27, and is a flowchart of processing for detecting an inflection point in a scene where an offset obstacle is arranged adjacently (scene in FIG. 6).
  • FIG. 22 is a diagram for explaining the processing of FIG. 21, and is a diagram of the same scene as FIG.
  • a frame 500 search section
  • An inflection point is searched from within the frame 500. As shown in FIG.
  • the frame 500 has a predetermined width W1 ( For example, it is a frame having about 1 to 2 m.
  • the width in the depth direction (Y-axis direction) of the frame 500 is set to a sufficiently long finite length or infinite length so that all the detection distance points included in the left-right width W1 fall within the frame 500.
  • the setting position of the frame 500 is determined so that, for example, the latest detection distance point is located at the end of the frame 500.
  • the X axis and the Y axis are set at the start of the process in FIG. 8, for example.
  • the own vehicle position at the start of the process is the origin
  • the X axis is the traveling direction of the own vehicle
  • the direction perpendicular to the X axis Is set to a coordinate system having a Y axis.
  • the difference ⁇ L1 between the maximum value and the minimum value of the detection distance is calculated within the frame 500 (S82).
  • the difference ⁇ L1 between the detection distances 961 and 962 is calculated. Is done.
  • the difference ⁇ L1 is greater than or equal to a predetermined threshold value TH1 (S83). If it is less than the threshold value TH1 (S83: No), it is determined that there is no portion offset in the depth direction (Y-axis direction) in the point sequence in the frame 500, and the processing in FIG.
  • the point sequence 9 illustrated in FIG. 23 that is, the point sequence 9 that hardly fluctuates in the depth direction within the frame 500 (the difference ⁇ L1 is small) is erroneously determined as having an inflection point. Can be prevented.
  • a detection distance range in which the difference from the maximum detection distance is equal to or less than a predetermined amount is set in the frame 500 (S84). Specifically, as shown in FIG. 22, a position 501a of a certain amount (for example, about 10 cm) from the maximum detection distance point (maximum distance point) 962 in the Y-axis direction, and a distance maximal point 962 from the Y-axis direction. A range 501 between a certain amount (for example, about 10 cm) of the position 501b is set in the opposite direction (front side) (S84). Hereinafter, the range 501 is referred to as an in-frame range.
  • the width of the in-frame range 501 that is, the certain amount is not set too large. If it is too large, the detection distance point that fluctuates in the depth direction is also included in the in-frame range 501, and the presence or absence of the point sequence tendency of the offset obstacle (column 82) cannot be accurately determined.
  • the width W2 of the point sequence 963 included in the in-frame range 501 is calculated (S85). Specifically, the sensor positions when both end points 951 and 962 of the point sequence 963 are detected are read from the memory 111, and the difference between the two read sensor positions is calculated as the width W2 of the point sequence 963.
  • the point sequence width W2 is greater than or equal to a predetermined threshold value TH2 (S86). If it is less than the threshold TH2 (S86: No), it is determined that the scene is not an offset obstacle, and the process of FIG.
  • S86 the scene illustrated in FIG. 24, that is, the scene where only the parked vehicle 63 is arranged can be excluded. That is, in the example of FIG. 24, since the width W2 of the point sequence 963 included in the in-frame range 501 is small, the processes after S86 are not executed.
  • the point sequence width W2 is greater than or equal to the threshold value TH2 (S86: Yes)
  • the right end point 962 in the frame 500 is included in the in-frame range 501.
  • the end point 962 is also the maximum distance point with the maximum detection distance in the frame 500. If the end point is not included in the in-frame range 501 (S87: No), the process of FIG.
  • the scene illustrated in FIG. 25, that is, the scene where the two parked vehicles 63 and 64 are arranged without offset can be excluded.
  • FIG. 25 the scene where the two parked vehicles 63 and 64 are arranged without offset
  • both end points 964 in the frame 500 are outside the in-frame range 501 even if the width W2 of the point sequence included in the in-frame range 501 is not less than the threshold value TH2.
  • the processes after S87 are not executed. Note that the inflection point in the scene of FIG. 25 is detected by the process of FIG.
  • the end points is included in the in-frame range 501 (S87: Yes)
  • the end point 951 of the point sequence 963 included in the in-frame range 501 (the end point on the maximum distance point 961 side) is set as the inflection point (S88). Then, the process of FIG. 21 is complete
  • the process of S21 is repeatedly performed on condition that there is no distance difference large point every time the time is updated in S31 of FIG.
  • the frame 500 is set, for example, based on the latest detection distance point. Therefore, the frame 500 slides in the X-axis direction over time.
  • FIG. 26 is a detailed flowchart of S27, and is a flowchart of processing for detecting an inflection point in the scene of FIG. 7, that is, an inflection point in a scene where the two parked vehicles 63 and 64 are arranged without being offset.
  • FIG. 27 is a diagram for explaining the processing of FIG. 26, and is a diagram of the same scene as FIG. 26, first, a frame 600 having a predetermined width W3 (for example, about 1 m to 2 m) in the left-right direction, similar to the frame set in the previous S81, with respect to the point sequence of the detection distance (search (Section) is set (S91).
  • the frame 600 is set so that, for example, the point of the latest detection distance is located at the end in the frame 600.
  • the value Lmax of the point PosMax (maximum distance point) of the detection distance in the frame 600 and the value Ledge1 of one end point Edge1 (hereinafter referred to as the first end point) of the point sequence in the frame 600 is calculated (S92).
  • the difference between the detection distance of the point 973 and the detection distance of the point 975 is calculated.
  • a difference (Lmax ⁇ Ledge2) between the value Lmax of the maximum distance point PosMax and the value Edge2 of the other end point Edge2 (hereinafter referred to as the second end point) of the point sequence in the frame 600 is calculated (S93).
  • the difference between the detection distance of the point 973 and the detection distance of the point 976 is calculated.
  • a point sequence width W4 between the maximum distance point PosMax and the first end point Edge1 is calculated (S94). Specifically, the sensor position when the maximum distance point PosMax is detected and the sensor position when the first end point Edge1 is detected are read from the memory 111, and the difference between the two sensor positions is set as a point sequence width W4. calculate.
  • the point sequence width W5 between the maximum distance point PosMax and the second end point Edge2 is calculated (S95). Specifically, the sensor position when the maximum distance point PosMax is detected and the sensor position when the second end point Edge2 is detected are read from the memory 111, and the difference between the two sensor positions is set as a point sequence width W5. calculate.
  • the process of FIG. 26 is terminated assuming that the two obstacles are not adjacently arranged without offset.
  • the processing of S26 is repeatedly executed on condition that there is no large distance difference point every time the time is updated in S31 of FIG.
  • the setting of the frame 600 is set based on, for example, the latest detection distance point. Therefore, the frame 600 slides in the X-axis direction over time.
  • the detection distance when a distance difference large point having a large distance difference exists in the point sequence of the detection distance, it is determined whether the distance difference large point is noise or an obstacle break. it can. Therefore, even if noise is mixed in the point sequence of the detection distance, the detection distance can be accurately grouped. Further, when the distance difference is small, it is determined whether or not there is an inflection point in the detection distance point sequence. Therefore, even if there is an adjacent obstacle, it is possible to accurately detect the break of the obstacle. Moreover, since the presence or absence of the inflection point is determined without differentiating the history of the detection distance, the determination can be performed accurately.
  • the obstacle detection device is not limited to the above embodiment, and various modifications can be made without departing from the scope of the claims.
  • the scene where the parked vehicle and the pillar are arranged is described as an example of the detection scene of the inflection point of the offset obstacle, but the obstacle other than the parked vehicle and the pillar is arranged.
  • the present disclosure can be applied even in a scene.
  • the present invention can also be applied to a scene in which a curb is disposed adjacent to a parked vehicle, as in the scene of FIG.

Landscapes

  • Physics & Mathematics (AREA)
  • General Physics & Mathematics (AREA)
  • Traffic Control Systems (AREA)
  • Measurement Of Velocity Or Position Using Acoustic Or Ultrasonic Waves (AREA)

Abstract

 車両(5)に搭載される障害物検知装置(1)において、距離検知手段(2)は、車両が障害物(63、64、82)の側方を移動している時にその障害物までの距離を逐次検知する。第1の判定手段(S22)は、距離検知手段が検知した検知距離の点列の中で隣りの点の検知距離との差分が所定量以上となる検知距離の点である距離差分大点(91)の有無を判定する。第2の判定手段(S23、S24)は、第1の判定手段が距離差分大点が有ると判定した場合に、距離差分大点の位置が障害物の切れ目なのか距離差分大点がノイズなのかを判定する。グルーピング手段(S26)は、第2の判定手段が障害物の切れ目と判定した場合に、距離差分大点を境にして検知距離の点列のグルーピングを行う。

Description

障害物検知装置 関連出願の相互参照
 本開示は、2013年2月15日に出願された日本出願番号2013-28242号に基づくもので、ここにその記載内容を援用する。
 本開示は、自車両から障害物までの距離を検知する超音波センサなどの距離検知手段を用いて、自車両周囲に存在する障害物を検知する障害物検知装置に関する。
 従来、自車両から駐車車両等の障害物までの距離を検知する距離検知手段を用いて駐車空間を検知する駐車空間検知装置が知られている(例えば特許文献1参照)。例えば、特許文献1の駐車空間検知装置では、自車両が障害物(駐車車両)の側方を移動している時に測距センサによりその障害物までの距離を逐次検知する。そして、得られた検知距離の点列データに対して曲線近似を行うことにより障害物の形状を推定し、推定した形状に基づいて駐車空間を検知している。
特開2008-21039号公報
 ところで、例えば検知距離の点列を適切に曲線近似するためには、どこからどこまでが単一の障害物であるかを正しく区切ること、つまり検知距離の点列を障害物ごとにグルーピング(グループ化)することが重要である。障害物の切れ目では、通常、検知距離が大きく変化するので、その変化した位置を境にしてグルーピングを行うことが考えられる。なお、このグルーピングに関し、特許文献1では、所定基準長さ以上の検知距離の点列が検知され、かつ、その後所定距離以上点列が存在しなくなった段階で、障害物の検知が完了したとしている。
 しかし、障害物の切れ目では検知距離が大きく変化することがある一方で、路面ノイズなどのノイズによっても検知距離が大きく変化することがある。つまり、検知距離の点列に距離差分が大きい点(距離差分大点)が有ったからといって単純にグルーピングをしてしまうと、単一の障害物であるにもかかわらずノイズの位置で誤ってグルーピングをしてしまう可能性がある。このように、検知距離の点列にノイズが混在している場合には、検知距離のグルーピングが困難であった。
 本開示は上記点に鑑みてなされたものであり、検知距離の点列にノイズが混在していた場合であっても、検知距離の点列を障害物ごとにグルーピングすることができる障害物検知装置を提供することを目的とする。
 本開示の態様においては、障害物検知装置は車両に搭載されるものであり、前記車両が障害物の側方を移動している時にその障害物までの距離を逐次検知する距離検知手段と、前記距離検知手段が検知した検知距離の点列の中で隣りの点の検知距離との差分が所定量以上となる検知距離の点である距離差分大点の有無を判定する第1の判定手段と、前記第1の判定手段が前記距離差分大点が有ると判定した場合に前記距離差分大点の位置が障害物の切れ目なのか前記距離差分大点がノイズなのかを判定する第2の判定手段と、前記第2の判定手段が障害物の切れ目と判定した場合に、前記距離差分大点を境にして前記検知距離の点列のグルーピングを行うグルーピング手段と、を備える。
 本態様によれば、検知距離の点列に距離差分大点が有る場合には、その距離差分大点の位置が障害物の切れ目なのか、その距離差分大点がノイズなのかを判定する第2の判定手段を備えているので、検知距離の点列にノイズが混在した場合であっても、障害物の切れ目とノイズとを区別することができる。よって、第2の判定手段が障害物の切れ目と判定した場合に、その切れ目、つまり距離差分大点を境にしてグルーピングを行うことで、検知距離の点列を障害物ごとにグルーピングできる。
 本開示についての上記目的およびその他の目的、特徴や利点は、添付の図面を参照しながら下記の詳細な記述により、より明確になる。その図面は、
本開示に実施形態に係る駐車支援装置1の概略構成を示した図である。 駐車空間検知の想定場面を例示した図である。 駐車空間検知の基本的な手順を示したフローチャートである。 反射点の算出方法を説明する図である。 連続性を有しない検知距離の点列を例示した図である。 駐車車両63に隣接してオフセットした位置に柱82が配置された場面の図である。 隣接して2台の駐車車両63、64が配置された場面の図である。 グルーピング処理のフローチャートである。 S23の詳細のフローチャートである。 S41、S42の詳細のフローチャートであり、実施例1に係る想定範囲の設定手順を示した図である。 距離差分大点を含んだ検知距離の点列を示し、実施例1に係る後距離点の想定範囲の設定方法を説明する図である。 増分ライン、減分ラインの設定方法を説明する図であり、時間の経過とともに検知距離が減少する点列を例示した図である。 増分ライン、減分ラインの設定方法を説明する図であり、時間の経過とともに、検知距離が減少したり増加したりする点列を例示した図である。 距離差分大点を含んだ検知距離の点列を示し、実施例1に係る前距離点の想定範囲の設定方法を説明する図である。 連続性を有した検知距離の点列を例示した図である。 図15の点列に対して後距離点の想定範囲を設定した図である。 図15の点列に対して前距離点の想定範囲を設定した図である。 S41、S42の詳細のフローチャートであり、実施例2に係る想定範囲の設定手順を示した図である。 距離差分大点を含んだ検知距離の点列を示し、実施例2に係る前距離点および後距離点の想定範囲の設定方法を説明する図である。 検知距離の点列を例示し、ノイズ処理の方法を説明する図である。 S27の詳細のフローチャートであり、隣接してオフセット障害物が配置された場面での変曲点を検知する処理のフローチャートである。 図21の処理を説明するための図であり、隣接してオフセット障害物が配置された場面の図である。 枠500内で奥行き方向にほとんど変動していない点列9を例示した図である。 駐車車両のみが配置された場面の図である。 2台の駐車車両が配置された場面の図である。 S27の詳細のフローチャートであり、2台の駐車車両が配置された場面での変曲点を検知する処理のフローチャートである。 図26の処理を説明するための図であり、2台の駐車車両が配置された場面の図である。
 以下、本開示に係る障害物検知装置の実施形態を図面を参照しながら説明する。図1は、本開示の障害物検知装置が適用された駐車支援装置1の概略構成を示した図である。その駐車支援装置1は、自車両5(図2参照)に搭載されている。駐車支援装置1は、測距センサ2と車速センサ12と操舵角センサ13とそれらと接続したECU11とを備えている。
 測距センサ2は、図2に示すように、自車両5の左右側面(図2では左側面51)に搭載されている。測距センサ2は、その側方(自車両5の側方)に存在する駐車車両等の障害物までの距離を検知するセンサである。具体的には、測距センサ2は、ECU11からの指示に基づき、測距センサ2の正面方向(図2では自車両5の左側方)に所定間隔おきに(例えば100ミリ秒おきに)超音波等の探査波を送信する。測距センサ2は、送信した探査波が障害物に当たって反射した反射波を受信する。そして、測距センサ2は、探査波の送信タイミングと反射波の受信タイミングと探査波の速度(探査波が超音波の場合には音速)とに基づき、障害物までの距離を算出する。測距センサ2で検知された検知情報(検知距離)はECU11に入力される。なお、検知距離の算出はECU11が行っても良い。
 測距センサ2の検知範囲21(図2参照)の指向性φ(探査波の指向性)は例えば70°~120°程度となっている。また、測距センサ2が検知可能な最大検知距離は例えば4m~10m程度となっている。測距センサ2は、探査波を送信しその探査波の反射波を受信するセンサであれば良く、音波を用いるものであっても、光波を用いるものであっても、電波を用いるものであっても良い。測距センサ2としては、例えば超音波センサ、レーザレーダ、ミリ波レーダ等のセンサを用いることができる。
 図1の説明に戻り、車速センサ12は自車両5の車速を検知するセンサである。操舵角センサ13は、自車両5が直進移動するときのステアリングの位置を中立位置(0度)として、その中立位置からのステアリングの回転角度を操舵角として出力するセンサである。車速センサ12、操舵角センサ13で検知された検知情報(車速、操舵角)はECU11に入力される。
 ECU11は、CPU、ROM、RAM等から構成されたマイコンを主体として構成されている。ECU11は、測距センサ2、車速センサ12、操舵角センサ13から入力された各検知情報に基づき、自車両5の周囲(側方)に存在する駐車空間への駐車支援をする処理を実行する。また、ECU11は、自身が実行する処理に必要な各種情報を記憶するROM、RAM等のメモリ111を備えている。
 以下、ECU11が実行する処理の詳細を説明する。先ず、ECU11による駐車空間検知の基本的な手順を説明する。図3はその手順を示したフローチャートである。また、図2は、図3の処理が実行される想定場面を例示した図であり、詳細には、駐車空間7を間に挟んで配置された2台の駐車車両61、62の側方を自車両5が移動している場面を示している。また、駐車空間7内には縁石等の障害物81が配置されている。
 図3の処理は、例えば、車室内に設けられた支援スイッチ(図示外)が自車両5のドライバーによりオンされた時に開始しても良いし、自車両5の低速時にバックグランドで常時実行しても良い。図3の処理を開始すると、ECU11は、測距センサ2に逐次距離検知を行わせる(S11)。また、車速センサ12、操舵角センサ13の検知情報に基づき、測距センサ2が距離検知を行う時のその測距センサ2の位置(センサ位置)を算出する(S12)。このとき、車速と前回の距離検知からの経過時間とから、前回のセンサ位置からの測距センサ2の移動距離を算出できる。また、操舵角から、前回の距離検知からの測距センサ2の移動方向を算出できる。それら移動距離、移動方向と前回の距離検知時のセンサ位置とから、今回の距離検知時のセンサ位置を算出できる。S11、S12で検知された検知距離、センサ位置はメモリ111に蓄積する。
 図2には、S11で検知された検知距離の履歴、言い換えると、S12で検知されたセンサ位置から測距センサ2の正面方向に検知距離だけ離れた点9(測距点)を図示している。図2に示すように、測距点9の点列は、1台目の駐車車両61に対する測距点901と、駐車空間7内の障害物81に対する測距点903と、2台目の駐車車両62に対する測距点902とを含む。なお、測距センサ2の検知範囲21(図2参照)はある程度の指向性を有しているので、自車両5(厳密には測距センサ2)が障害物の正面領域に進入する少し前からその障害物に対する距離検知が開始され、その正面領域を通過した後もしばらくの間は距離検知が続く。そのために、図2の測距点901の点列の幅は、駐車車両61の幅よりも広くなっている。
 次に、検知距離の誤差による影響を低減するために、メモリ111に蓄積された検知距離の履歴を2次関数等で曲線近似する(S13)。図2の例では、測距点9の点列を曲線近似する。図2には、測距点901の点列の近似曲線301を図示している。
 次に、S13の曲線近似で平滑化した検知距離及びセンサ位置の履歴に基づいて、測距センサ2からの探査波が当たる障害物上の点、つまり障害物の輪郭点を反射点として算出する(S14)。ここで、図4は、反射点の算出方法を説明する図であり、自車両5が駐車車両6のそばを通過している場面を示している。図4には、ある時点におけるセンサ位置SenPos(n)及び検知距離L(n)と、一つ前の時点におけるセンサ位置SenPos(n-1)及び検知距離L(n-1)とで構成された三角形700を図示している。S14では、隣り合う2つの時点では、探査波は障害物の同一点で反射するとの仮定のもと、図4の三角形700の頂点4の位置を反射点の位置として算出する。つまり、三角測量の原理を利用して反射点を算出する。図2には、S14で算出された1台目の駐車車両61に対する反射点4の点列を図示している。その反射点4の点列は駐車車両61の輪郭上に検知される。
 次に、S14で算出した反射点の点列に基づいて、駐車空間に隣接する障害物のコーナーを検知する(S15)。図2の例では、反射点4の点列に基づいて1台目の駐車車両61のコーナー611を検知し、2台目の駐車車両62に対する反射点(図示外)に基づいてその駐車車両62のコーナー621を検知する。具体的には例えば、図2に示すように、駐車空間7の左右方向に対応したX軸、奥行き方向に対応したY軸を有した座標系を設定する。そして、反射点4の点列の中で最も駐車空間7寄り、つまり最もX座標が大きい反射点のX座標を、コーナー611のX座標とする。また、反射点4の点列の中で最も側方通路寄り、つまり最もY座標が小さい反射点のY座標を、コーナー611のY座標とする。2台目の駐車車両62のコーナー621も同様にして算出する。
 次に、S15で検知したコーナー611、621間を駐車空間7として設定する(S16)。その後、図3の処理を終了する。その後、ECU11は、検知した駐車空間7の幅と自車両5の車幅とに基づいて、その駐車空間7に駐車できるか否かを判断する。そして、ECU11は、駐車できると判断した場合には、駐車空間7と自車両5との位置関係に基づいて、自車両5が駐車空間7へ移動するための経路を算出する。その後、ECU11は、ステアリングモータ、エンジンを制御して、その経路にしたがって自車両5を駐車空間7まで移動させ、駐車を完了させる。
 以上で説明したように、駐車空間を検知するためには、図3のS13で検知距離の履歴を曲線近似する必要がある。このとき、図2の場面のように、異なる障害物が配置されている場合には、各障害物ごとに検知距離の履歴を区別して(グルーピングして)曲線近似をする必要がある。図2の例では、測距点901の点列と、測距点902の点列と、測距点903の点列とをグルーピングして、グルーピングした点列ごとに曲線近似をする必要がある。異なる障害物の検知距離の点が混在すると、近似曲線の精度が低下し、その結果、反射点やコーナーの検知精度が低下するためである。
 通常、障害物の切れ目では検知距離が大きく変動する。言い換えると、障害物の切れ目では検知距離の差分が大きくなる。したがって、検知距離の差分が大きくなる位置を境にして、検知距離のグルーピングを行う手法が考えられる。ところが、測距センサ2は、例えば路面に対して距離検知を行ってしまうこともある。この場合には、検知距離の点列にノイズの点が含まれることになり、そのノイズの点の位置で検知距離が大きく変動してしまう。ここで、図5は、距離差分が大きい検知距離の点91(距離差分大点)を含んだ検知距離の点列9(検知距離の時系列データ)を例示している。検知距離の点列9に距離差分大点91が含まれている場合には、その距離差分大点91がノイズなのか障害物の切れ目なのかを判断する必要がある。そうしないと、単一の障害物にもかかわらず距離差分大点91より手前の検知距離の点列92と後の点列93とをグルーピングしてしまったり、異なる障害物であるにもかかわらずそれら点列92、93を一つのグループとしてしまったりするためである。
 一方、場面によっては、障害物の切れ目にもかかわらず距離差分が大きくならない場合もある。図6は、障害物の切れ目にもかかわらず距離差分が小さい場面を例示している。詳細には、図6は、駐車車両63に隣接し、駐車車両63の前面(距離検知が行われる面)から奥行き方向にオフセットした位置に柱82が配置された場面を示している。図6の場面では、駐車車両63と柱82との切れ目にもかかわらず、駐車車両63に対する検知距離の点列94と、柱82に対する検知距離の点列95とが連続しているように検知される。つまり、点列94の端点941と、点列95の端点951との差分が小さくなっている。このような場合にも、それら点列94、95を区別してグルーピングする必要がある。
 さらに、場面によっては、障害物がオフセットした位置に配置されていなくても、距離差分が大きくならない場合もある。図7は、その場面を例示した図であり、詳細には、隣接して2台の駐車車両63、64がオフセットしないで配置された場面を示している。図7の場面では、駐車車両63、64の切れ目にもかかわらず、左側の駐車車両63に対する検知距離の点列971と右側の駐車車両64に対する検知距離の点列972とが連続しているように検知される。つまり、点列971の端点973と点列972の端点974との差分が小さくなっている。このような場合にも、それら点列971、972を区別してグルーピングする必要がある。
 そこで、ECU11は、図5や図6や図7の場合にも対応できる、検知距離を障害物ごとにグルーピングする処理(グルーピング処理)を実行している。以下、そのグルーピング処理の詳細を説明する。図8はグルーピング処理のフローチャートを示している。図8の処理は、例えば、車室内に設けられた支援スイッチ(図示外)が自車両5のドライバーによりオンされた時に開始し、図3の処理と並列して実行される。ECU11は、図8の処理中、後述するS31で距離検知時間tを更新する度に、言い換えると、所定の距離検知間隔dtが経過する度に、測距センサ2で距離検知を行わせている。
 図8の処理を開始すると、先ず、測距センサ2が検知した検知距離および図3のS12で算出されるセンサ位置を互いに関連付けてメモリ111(図1参照)に記憶する(S21)。次に、メモリ111に記憶された検知距離の点列(履歴)から距離差分が大きい検知距離の点である距離差分大点の有無を判定する(S22)。具体的には、検知距離の点列の中で、隣りの点の検知距離との差分が所定量以上となる検知距離の点を距離差分大点として、その距離差分大点の有無を判定する。図5の例では、2つの点91が、隣りの検知距離の点921、931との間で差分が所定量以上となっているとして、距離差分大点が有ると判定される。他方、図6、図7の例では、距離差分大点は無いと判定される。
 距離差分大点が有る場合には(差分:大)、S23に移行し、距離差分大点がノイズなのか障害物の切れ目なのかを判定する。単一の障害物から検知された検知距離の点列は各点間で連続性を有している。これに対し、複数の障害物から検知された検知距離の点列では、一の障害物から検知された検知距離の点列の変動傾向(連続性)と、他の障害物から検知された検知距離の点列の変動傾向(連続性)とに差異が生じる。そこで、S23では、距離差分大点より手前の検知距離の点列と、後の検知距離の点列との間で連続性が有るか否かに基づいて、距離差分大点がノイズなのか障害物の切れ目なのかを判定する。図9は、S23の詳細のフローチャートである。図9の処理を、図5の検知距離の点列に適用した場合を例に挙げて、説明する。
 図9の処理に移行すると、先ず、距離差分大点91より手前の検知距離の点(前距離点)の点列92との間で連続性が成立したとしたならば、距離差分大点91より後の検知距離の点93(後距離点)が存在すると想定される想定範囲を、点列92の連続性(変動傾向)に基づいて設定する(S41)。別の言い方をすると、後距離点93の領域に対して、前距離点の点列92との間で連続性が成立する範囲を想定範囲として設定する(S41)。また、S41では、前距離点の点列92のうち、距離差分大点91の直前の一定区間(図5では3点の区間)の点列に基づいて、想定範囲を設定する。本実施形態では、S41の想定範囲及び後述するS42の想定範囲の設定方法として2つの実施例を説明する。
(実施例1)
図10は、S41の詳細のフローチャートであり、実施例1に係る想定範囲の設定手順を示している。
 図10に処理に移行すると、先ず、前距離点の点列92の区間における検知距離の増加傾向を示したライン(増分ライン)を、後距離点93の領域に設定する(S51)。図11は、図10の各処理を説明するための図であり、図5と同じ検知距離の点列を示している。図11の例では、点列92を構成する3つの点は時間の経過にともない検知距離が増加する傾向となっている。S51では、例えば、点列92の中で最小の検知距離の点922と最大の検知距離の点921との差分B(増加分)を算出する。そして、点列92以外の区間では、時間の経過とともに最大で点列92の区間長A当たり増加分Bの割合で検知距離が線形に増加すると仮定して、それら点921、922を結んだライン411を増分ラインとして設定する。別の言い方をすると、傾きB/Aの点921を通るライン411を増分ラインとして設定する。
 なお、図11の例では、時間の経過とともに点列92の検知距離が増加しているが、図12に示すように、時間の経過とともに点列92の検知距離が減少する場合もある。この場合には、例えば、点列92より後の区間では、点列92の端点9aでの検知距離以下となると仮定して、その端点9aを通る水平ライン413をS51の増分ラインとして設定する。別の言い方をすると、図12の点列92では増加分がゼロとなっているので、傾きがゼロの点9aを通るライン413を増分ラインとして設定する。
 また、図13に示すように、時間の経過とともに、検知距離が減少したり増加したりする場合もある。図13の例では、時間の経過とともに、検知距離が減少し(点9b>点9c)、その後、検知距離が増加している(点9c<点9d)。区間A全体としては、検知距離は減少している(点9b>点9d)。この場合には、例えば、点列92より後の区間では、区間長A当たり、点9cと点9dの間の検知距離の増加分Cの割合で検知距離が線形に増加すると仮定して、点9dを通る傾きC/Aのライン414を増分ラインとして設定する。なお、図11、図12、図13の例では、点列92の区間が3点の区間となっているが、それ以上の点を有した区間A‘の場合には、その区間A‘での検知距離の最小値と、区間A‘の端点(図11の例では点921)の検知距離の値との差分B‘を増加分として算出する。そして、傾きB‘/A‘の端点を通るラインを増分ラインとして設定すれば良い。
 図10の説明に戻り、次に、前距離点の点列92の区間における検知距離の減少傾向を示したライン(減分ライン)を、後距離点93の領域に設定する(S52)。図11の例では、時間の経過とともに点列92の検知距離は増加しており、減少量がゼロとなっている。この場合には、例えば点列92より後の区間では、点列92の端点921での検知距離以上となると仮定して、その端点921を通る水平ライン412を減分ラインとして設定する(S52)。
 また、図12の例では、時間の経過とともに検知距離は減少しているので、例えば、点列92の両端点間を結ぶライン415を減分ラインとして設定する。また、図13の例では、区間A全体では、点9bでの検知距離と点9dでの検知距離の差分Dだけ減少しているので、S52では、例えば点9dを通る傾き(-D/A)のライン416を減分ラインとして設定する。なお、3点以上の点を有した区間A‘の場合には、例えば、その区間A‘での検知距離の最大値と、区間A‘の端点の検知距離の値との差分D‘を減少分として算出する。そして、傾き-D‘/A‘の端点を通るラインを減分ラインとして設定すれば良い。
 S51で設定した増分ライン、S52で設定した減分ラインは、前距離点の点列92との間で連続性が成立する限界ラインであると仮定する。そして、それら増分ライン、減分ライン間の範囲410(図11参照)を後距離点93の想定範囲として設定する(S53)。この想定範囲410は、点列92との間で連続性が成立する第1の連続性範囲である。なお、図11の増分ライン411は、前距離点の点列92との間で連続性が成立する検知距離の上限値を与えるラインである。減分ライン412は、前距離点の点列92との間で連続性が成立する検知距離の下限値を与えるラインである。また、S53では、範囲410に所定の余裕度を持たせて想定範囲を設定しても良く、具体的には、範囲410から上下に所定量d1(図11参照)だけ広げた範囲を想定範囲として設定しても良い。これにより、障害物の切れ目が無いにもかかわらず、点列92との間で不連続と判定されてしまうのを防止できる。S53の後、図10のフローチャートの処理を終了して、図9の処理に戻る。
 図9の処理に戻ると、次に、後距離点の点列93との間で連続性が成立したとしたならば、前距離点92が存在すると想定される想定範囲を、点列93の連続性(変動傾向)に基づいて設定する(S42)。別の言い方をすると、前距離点92の領域に対して、後距離点の点列93との間で連続性が成立する範囲を想定範囲として設定する(S42)。また、S42では、後距離点の点列93のうち、距離差分大点91直後の一定区間(図5では3点の区間)の点列に基づいて、想定範囲を設定する。
 S42では、S41と同様に、つまり図10のフローチャートの処理にしたがって、想定範囲を設定する。図14は、S42の処理に対する図10の各処理を説明するための図であり、図5と同じ検知距離の点列を示している。図10の処理に移行すると、先ず、後距離点の点列93の区間における検知距離の増加傾向を示したライン(増分ライン)を、前距離点92の領域に設定する(S51)。具体的には、S41の処理での増分ラインと同様にして、増分ラインを設定する。すなわち、図14の例では、時間の経過にともない点列93の検知距離が増加する傾向となっているので、S51では、例えば、点列93の中で検知距離の最小値と最大値の差分F(増加分)を算出する。そして、点列93以外の区間では、点列93の区間長E当たりに増加分Fの割合で検知距離が線形に変化すると仮定して、距離差分大点91に隣接する点列93の端点931を通る傾きF/Eのライン(直線)421を増分ラインとして設定する。なお、点列93の変動傾向が図12、図13の変動傾向と同様の場合には、図12、図13で説明ように、増分ラインを設定すれば良い。
 なお、図14の増分ライン421は、点列93より前の区間、つまり前距離点92の区間に対しては、点列93との間で連続性が成立する検知距離の下限値を与えるラインとなる。
 次に、後距離点の点列93の区間における検知距離の減少傾向を示したライン(減分ライン)を、前距離点92の領域に設定する(S52)。図14の例では、時間の経過とともに点列93の検知距離は増加しており、減少量がゼロとなっている。この場合には、例えば、点列93より前の区間では、点列93の端点931での検知距離以下となると仮定して、その端点931を通る水平ライン422を減分ラインとして設定する(S52)。なお、減分ライン422は、前距離点92の区間に対しては、点列93との間で連続性が成立する検知距離の上限値を与えるラインとなる。
 次に、増分ライン421と減分ライン422の間の範囲420を前距離点の想定範囲(点列93との間で連続性が成立する第2の連続性範囲)として設定する。また、S41と同様に、範囲420に所定の余裕度を持たせて想定範囲を設定しても良く、具体的には、範囲420から上下に所定量だけ広げた範囲を想定範囲として設定しても良い。
 なお、S41の処理とS42の処理はどちらを先に実行しても良い。図9の処理に戻ると、次に、距離差分大点91に隣接する後距離点931(後距離点の点列93の端点)がS41で設定した想定範囲410(図11参照)に含まれているか否かを判断する(S43)。含まれていなければ(S43:No)、前距離点の点列との間で後距離点が連続性を有しない、つまり不連続であると判定する(S46)。その後、図9の処理を終了する。図11の例では、後距離点931は、想定範囲410に含まれていると判断される。なお、点列93のうち端点931以外の点に対しては、想定範囲410に含まれているか否かの判断は行わない。前距離点の点列92から離れるほど、S41で設定した増分ライン411、減分ライン412の精度が低下するので、連続、不連続の誤判定を防止するためである。
 後距離点931が想定範囲410に含まれている場合には(S43:Yes)、距離差分大点91に隣接する前距離点921(前距離点の点列92の端点)が想定範囲420(図14参照)に含まれているか否かを判断する(S44)。図14の例では、前距離点921は想定範囲420に含まれていないと判断される。この場合には(S44:No)、後距離点の点列93との間で前距離点921が連続性を有しない、つまり不連続であると判定する(S46)。その後、図9の処理を終了する。
 一方、前距離点が想定範囲に含まれている場合には(S44:Yes)、後距離点の点列との間で前距離点が連続性を有すると判定する(S45)。その後、図9のフローチャートの処理を終了する。このように、図9では、後距離点が想定範囲に含まれ、かつ、前距離点が想定範囲に含まれている場合に、前距離点の点列と後距離点の点列との間で連続性を有すると判定され、それ以外では不連続と判定されることになる。結局、図5の例では、点列92と点列93との間に連続性が無い(不連続)と判定される。
 ここで、図15は、図5の点列と変動傾向が類似しているが、図5の点列とは異なる検知距離の点列を示している。図15では、後距離点の点列93の増加傾向が図5と若干異なっており、それ以外は図5と同じ変動傾向となっている。この図15の点列に対して、図9の処理を適用した例を説明する。図16は、図15の点列に対して図9のS41の処理(図10の処理)を適用した例を示している。図16に示すように、S41では、図10のS51で設定された増分ライン431と、S52で設定された減分ライン432の間の範囲430が後距離点931の想定範囲として設定される。
 図17は、図15の点列に対して図9のS42の処理(図10の処理)を適用した例を示している。図17に示すように、S42では、図10のS51で設定された増分ライン441と、S52で設定された減分ライン442の間の範囲440が前距離点921の想定範囲として設定される。
 そして、後距離点931は想定範囲430に含まれ(図16参照)、かつ、前距離点921も想定範囲440に含まれている(図17参照)。よって、図15の例では、点列92、93間で連続性が有ると判定されることになる。このように、図9、図10の処理により、検知距離の点列の細かい変動傾向を見極めた上で、連続、不連続を判定することができる。
(実施例2)
 次に、図9のS41、S42での想定範囲の設定方法の実施例2を説明する。図18は、S41、S42の詳細のフローチャートであり、実施例2に係る想定範囲の設定手順を示している。また、図19は、図18の処理を説明するための図であり、先に説明した図5、図15と同様の変動傾向を有した検知距離の点列を示している。図19の点列は、2つの距離差分大点91と、その距離差分大点91より手前の前距離点の点列92と、距離差分大点91より後の後距離点の点列93とを有している。点列92は、距離差分大点91の直前の一定区間(図19では3点の区間)の点列である。点列93は、距離差分大点91の直後の一定区間(図19では3点の区間)の点列である。
 S41で図18の処理に移行すると、先ず、後距離点93の領域に対して、前距離点の点列92との間で連続性が成立する検知距離の推定値を与える1本のライン451(後距離点93の推定ライン)を、点列92の変動傾向に基づいて設定する(S61)。具体的には、例えば、点列92の区間以外の区間では、点列92の区間と同様の傾向で線形に検知距離が変動すると仮定する。そして、例えば、点列92の両端点921、922を結ぶ直線451を、後距離点93の推定ラインとして設定する。または、点列92の全ての点を用いて直線近似を行い、得られた近似直線を推定ラインとして設定しても良い。
 次に、推定ライン451から所定距離以内の範囲を、後距離点93の想定範囲として設定する(S62)。具体的には、後距離点の点列93の端点931の位置(時間)での推定ライン451上の点452から上下に所定量d2以下となる範囲450を、後距離点931の想定範囲として設定する(S62)。その後、図18の処理を終了する。
 また、S42で図18の処理に移行すると、先ず、前距離点92の領域に対して、後距離点の点列93との間で連続性が成立する検知距離の推定値を与える1本のライン461(前距離点92の推定ライン)を、点列93の変動傾向に基づいて設定する(S61)。具体的には、上述したように、点列93の両端点931、932を結ぶ直線や、点列93を直線近似して得られた近似直線を推定ライン461として設定する。
 次に、前距離点の点列92の端点921の位置(時間)での推定ライン461上の点462から上下に所定量d2以下となる範囲460を、前距離点921の想定範囲として設定する(S62)。その後、図18の処理を終了する。
 その後、先に説明した図9のS43~S46の処理で、前距離点の点列92と、後距離点の点列93との間の連続性の有無が判定される。図19の例では、後距離点931が想定範囲450に含まれ、かつ、前距離点921が想定範囲460に含まれているので、連続と判定されることになる(S45)。
 図8の処理に戻ると、次に、S23の判定が連続性有りの判定か否かを判断する(S24)。連続性有りの場合(図9のS45で連続と判定した場合)には(S24:Yes)、距離差分大点の位置では障害物の切れ目となっておらず、距離差分大点はノイズであるとしてそのノイズを処理する(S25)。先に説明した図15の点列が、障害物の切れ目無しであり、S25でノイズ処理の対象となる点列である。
 ここで、図20は、S25によるノイズ処理の方法を説明する図であり、図15の点列と同じ点列を示している。図20を参照してS25の詳細を説明すると、S25では先ず、距離差分大点91の区間を、距離差分大点91の一つ前の検知距離の点921(前距離点の点列92の端点)と、一つ後の検知距離の点931(後距離点の点列93の端点)とを用いて線形補間する。具体的には、それら点921、931間を結ぶ直線100を線形補間のラインとして設定する。次に、その線形補間のライン100上にくるように、距離差分大点91を補正する。このとき、例えば、距離差分大点91が検知された時間を保持する形で、つまり図20の例では距離差分大点91を真下又は真上に降ろす形で、距離差分大点91の補正を行う。図20には、補正後の点911を示している。これによって、検知距離の点数を減らすことなく、検知距離の点列からノイズを除去することができる。
 また、S25では、距離差分大点91の補正に代えて、距離差分大点91を無効化(除去)しても良い。これによれば、図20のように線形補間や補正を行う必要がないので、簡単にノイズを除去できる。
 S25でノイズを処理した後、次に、例えば支援スイッチ(図示外)がオフにされたか、並列に実行されている図3の処理にて駐車空間の設定が完了したか等、図8の処理の終了条件が成立したか否かを判断する(S30)。終了条件が成立していない場合には(S30:No)、距離検知の時間を次の時間(t=t+dt)に更新する(S31)。そして、S21に戻って、更新後の時間で、S21以下の処理を実行する。終了条件を満たした場合、つまり、支援スイッチがオフにされた場合や駐車空間の設定が完了した場合などには(S30:Yes)、図8の処理を終了する。
 一方、S24において、連続性無しの場合(図9のS46で不連続と判定した場合)には(S24:No)、距離差分大点の位置で障害物の切れ目となっているとして、距離差分大点を境にして検知距離のグルーピングを行う(S26)。具体的には、距離差分大点より手前の検知距離の履歴(点列)を一の障害物のグループとし、距離差分大点より後の検知距離の履歴(点列)を他の障害物のグループとする。先に説明した図5の点列が、障害物の切れ目有りであり、S26でグルーピングの対象となる点列である。図5の例では、前距離点の点列92が一つのグループとなり、後距離点の点列93が一つのグループとなる。なお、距離差分大点91は、どちらのグループにも属さない点(ノイズ)となる。
 その後、図8の処理の終了条件が成立したか否かを判断し(S30)、成立していない場合には(S30:No)、時間を更新して(S31)、上述の処理を繰り返す。終了条件が成立した場合には(S30:Yes)、図8の処理を終了する。そして、図8の処理を終了した後の図13のS13では、図8の処理でグルーピングされた検知距離の履歴ごとに曲線近似が行われる。
 一方、S22において、検知距離の点列に距離差分大点が無い場合には(差分:小)、S27に移行する。この場合には、単一の障害物の距離検知が続いている場面(障害物の切れ目なしの場面)、図6の場面、又は図7の場面であると考えられる。S27では、それら場面を区別しつつ、障害物の切れ目の有無を判定している。具体的には、図6や図7のように、2つの障害物が隣接して配置されている場合には、障害物の切れ目の位置で検知距離の点列の変動傾向が変化する。図6の場面において、駐車車両63、柱82の順に距離検知が行われるとすると、自車両が駐車車両63の正面を超えた後もしばらくの間は駐車車両63に対する距離検知が続く。その間の検知距離の点列940では、時間の経過とともに、言い換えると自車両が柱82側に進行するにしたがって、検知距離の値が大きくなっていく。つまり、点列940は、駐車車両63のコーナー631から柱82の前面821に向かう斜め方向に変動する。
 その後、駐車車両63に対する距離検知が終了すると、直ぐに、柱82に対する距離検知が開始する。柱82に対する距離検知が開始すると、最初は、柱82の前面821に沿って検知距離の点が検知される。その後、自車両が柱82の正面を超えると、しばらくの間は距離検知が続き、その間の検知距離の値は、自車両が柱82から離れるにしたがい次第に大きくなっていく。
 このように、駐車車両63と柱82との境目(障害物の切れ目)では、点列940の変動傾向(斜め方向に推移する傾向)と、柱82に対する点列95の変動傾向(前面821に沿った方向に推移する傾向)とに差異が生じる。その差異が生じる位置の検知距離の点951は、検知距離の点列の変曲点となる。
 図7の場面でも検知距離の点列に変曲点973が生じるが、その変曲点973付近の点列の変動傾向(点列の形状)は、図6の場面とは異なっている。すなわち、図7の場面では、左側の駐車車両63、右側の駐車車両64の順で距離検知が行われるとすると、自車両が駐車車両63の正面を超えた後もしばらくの間は駐車車両63に対する距離検知が続く。その間の検知距離の値は、自車両が駐車車両63から離れるにしたがい次第に大きくなっていく。その後、左側の駐車車両63に対する距離検知が終了すると、直ぐに右側の駐車車両64に対する距離検知が開始する。右側の駐車車両64に対する距離検知が開始すると、自車両が駐車車両64の正面にくるまでは、自車両が駐車車両64に近づくにしたがい次第に検知距離の値が小さくなる。その後、自車両が駐車車両64の正面にきたときには、駐車車両64の前面に沿って検知距離の点が検知される。
 このように、左側の駐車車両63と右側の駐車車両64の境目(障害物の切れ目)では、駐車車両63に対する検知距離の点列と、駐車車両64に対する検知距離の点列とでV字状の点列が構成される。そのV字の頂点の点973が変曲点となる。
 このように、図6、図7の場面ではともに障害物の切れ目の位置で検知距離の点列に変曲点が生じる。また、図6の場面と、図7の場面とでは、上記したように変曲点のパターン、言い換えると変曲点周辺の点列の形状が異なっている。そこで、S27では、図6の場面に対応した変曲点を検知する処理(図21の処理)と、図7の場面に対応した変曲点を検知する処理(図26の処理)とを並列して実行する。先ず、図6の場面での変曲点の検知方法を説明する。
 図21は、S27の詳細のフローチャートであり、隣接してオフセット障害物が配置された場面(図6の場面)での変曲点を検知する処理のフローチャートである。図22は、図21の処理を説明するための図であり、図6と同じ場面の図である。図21の処理に移行すると、先ず、検知距離の点列に対して、変曲点を探索するための枠500(探索区間)を設定する(S81)。その枠500内から変曲点が探索される。図22に示すように、点列が推移する方向に対応した方向にX軸、そのX軸に直角にY軸を設定したとして、枠500は、X軸方向(左右方向)に所定幅W1(例えば1m~2m程度)を有した枠である。なお、枠500の奥行き方向(Y軸方向)の幅は、左右幅W1内に含まれる検知距離の点が全て枠500内に入るように、十分長い有限長又は無限長に設定されている。また、検知距離の点列のどの区間に枠500を設定するかは、例えば最新の検知距離の点が枠500内の端に位置するように、枠500の設定位置を決める。
 なお、X軸、Y軸は、例えば図8の処理開始時に設定し、具体的には例えば処理開始時における自車位置を原点、自車両の進行方向にX軸、そのX軸に直角な方向にY軸を有した座標系を設定する。
 次に、枠500内で検知距離の最大値と最小値の差分ΔL1を算出する(S82)。図22の例では、枠500内の右端の点962が検知距離の最大値であり、左端の点961の検知距離の最小値であるとして、それら点961、962の検知距離の差分ΔL1が算出される。
 次に、差分ΔL1が所定の閾値TH1以上か否かを判断する(S83)。閾値TH1未満の場合には(S83:No)、枠500内の点列には奥行き方向(Y軸方向)にオフセットした部分が無いとして、図21の処理を終了する。このS83の判断により、図23に例示する点列9、つまり枠500内で奥行き方向にほとんど変動していない(差分ΔL1が小さい)点列9に対して変曲点有りと誤判定してしまうのを防止できる。
 差分ΔL1が閾値TH1以上の場合には(S83:Yes)、検知距離の最大値との差分が所定量以下となる検知距離の範囲を枠500内に設定する(S84)。具体的には、図22に示すように、最大の検知距離の点(距離最大点)962からY軸方向に一定量(例えば10cm程度)の位置501aと、距離最大点962からY軸方向と反対方向(手前)に一定量(例えば10cm程度)の位置501bとの間の範囲501を設定する(S84)。以下、その範囲501を枠内範囲という。このとき、枠内範囲501の幅、つまり上記一定量を大きすぎないようにする。大きすぎると、奥行き方向に変動する検知距離の点も枠内範囲501に含まれてしまい、オフセット障害物(柱82)の点列傾向の有無を正確に判定できないためである。
 次に、枠内範囲501に含まれた点列963の幅W2を算出する(S85)。具体的には、点列963の両端点951、962を検知した時のセンサ位置をそれぞれメモリ111から読み出し、読み出した2つのセンサ位置の差分を点列963の幅W2として算出する。
 次に、点列幅W2が所定の閾値TH2以上か否かを判断する(S86)。閾値TH2未満の場合には(S86:No)、オフセット障害物が配置された場面ではないとして、図21の処理を終了する。このS86の判断により、図24に例示する場面、つまり駐車車両63のみが配置された場面を除外できる。つまり、図24の例では、枠内範囲501に含まれる点列963の幅W2が小さいので、S86以降の処理は実行されないことになる。
 点列幅W2が閾値TH2以上の場合には(S86:Yes)、次に、枠500内の点列のいずれかの端点が枠内範囲501に含まれているか否かを判断する(S87)。図22の例では、枠500内での右側の端点962が枠内範囲501に含まれている。なお、この端点962は、枠500内で検知距離が最大の距離最大点でもある。端点が枠内範囲501に含まれていない場合には(S87:No)、オフセット障害物が配置された場面ではないとして、図21の処理を終了する。このS87の判断により、図25に例示する場面、つまり2台の駐車車両63、64がオフセット無しで配置された場面を除外できる。図25の例では、枠内範囲501に含まれた点列の幅W2が仮に閾値TH2以上であったとしても、枠500内の両端点964がともに枠内範囲501外となっているため、S87以降の処理は実行されないことになる。なお、図25の場面での変曲点は後述する図26の処理で検知される。
 いずれかの端点が枠内範囲501に含まれている場合には(S87:Yes)、枠500内にオフセット障害物に係る変曲点が有ると判定する(S88)。そして、例えば枠内範囲501に含まれた点列963の端点951(距離最大点961側の端点)を変曲点とする(S88)。その後、図21の処理を終了する。
 なお、S21の処理は、図3のS31で時間が更新される度に、距離差分大点が無いことを条件として繰り返し実行される。そして、枠500の設定は例えば最新の検知距離の点を基準として設定される。そのため、枠500は、時間の経過とともにX軸方向にスライドしていくことになる。
 次に、図7の場面での変曲点の検知方法を説明する。図26は、S27の詳細のフローチャートであり、図7の場面での変曲点、つまり2台の駐車車両63、64がオフセットしないで配置された場面での変曲点を検知する処理のフローチャートである。図27は、図26の処理を説明するための図であり、図7と同じ場面の図である。図26の処理に移行すると、先ず、検知距離の点列に対して、先のS81で設定した枠と同様に、左右方向に所定幅W3(例えば1m~2m程度)を有した枠600(探索区間)を設定する(S91)。その枠600は、例えば最新の検知距離の点が枠600内の端に位置するように、設定される。
 次に、枠600内で検知距離の最大値の点PosMax(距離最大点)の値Lmaxと、枠600内の点列の一方の端点Edge1(以下、第1の端点という)の値Ledge1との差分(Lmax-Ledge1)を算出する(S92)。図27の例では、点973の検知距離と、点975の検知距離との差分が算出される。
 次に、距離最大点PosMaxの値Lmaxと、枠600内の点列のもう一方の端点Edge2(以下、第2の端点という)の値Ledge2との差分(Lmax-Ledge2)を算出する(S93)。図27の例では、点973の検知距離と、点976の検知距離の差分が算出される。
 次に、距離最大点PosMaxと第1の端点Edge1の間の点列幅W4を算出する(S94)。具体的には、距離最大点PosMaxを検知した時のセンサ位置と、第1の端点Edge1を検知した時のセンサ位置とをメモリ111から読み出し、それら2つのセンサ位置の差分を点列幅W4として算出する。
 次に、距離最大点PosMaxと第2の端点Edge2の間の点列幅W5を算出する(S95)。具体的には、距離最大点PosMaxを検知した時のセンサ位置と、第2の端点Edge2を検知した時のセンサ位置とをメモリ111から読み出し、それら2つのセンサ位置の差分を点列幅W5として算出する。
 次に、以下に示すS96~S101の全ての条件を満たすか否かを判断する。すなわち、S92で算出した差分(Lmax-Ledge1)が所定の閾値TH3以上か否かを判断する(S96)。また、S93で算出した差分(Lmax-Ledge2)が所定の閾値TH3以上か否かを判断する(S97)。また、第1の端点Edge1が距離最大点PosMaxと異なる点であるか否かを判断する(S98)。また、第2の端点Edge2が距離最大点PosMaxと異なる点であるか否かを判断する(S99)。また、S94で算出した点列幅W4が所定の閾値TH4以上か否かを判断する(S100)。また、S95で算出した点列幅W5が所定の閾値TH4以上か否かを判断する(S101)。
 S96~S101の条件を全て満たす場合には、枠600内の点列の形状がV字状であり、2つの障害物が隣接してオフセット無しで配置された場面であるとして、枠600内にその場面に係る変曲点があると判定する(S102)。そして、距離最大点PosMaxを変曲点とする(S102)。図27の例では、点973が変曲点として検知される。その後、図26の処理を終了する。
 これに対して、S96~S101の条件のうちの一つでも満たさない場合には、2つの障害物が隣接してオフセット無しで配置された場面ではないとして、図26の処理を終了する。なお、S26の処理は、図3のS31で時間が更新される度に、距離差分大点が無いことを条件として繰り返し実行される。そして、枠600の設定は例えば最新の検知距離の点を基準として設定される。そのため、枠600は、時間の経過とともにX軸方向にスライドしていくことになる。
 図8の処理に戻ると、次に、S27の判定結果に基づき検知距離の点列に変曲点が有るか否かを判断する(S28)。変曲点が有る場合、つまり図21のS88又は図26のS102で変曲点有りと判定した場合には(S28:Yes)、S88又はS102で検知した変曲点を境にして検知距離のグルーピングを行う(S29)。図6の例では、駐車車両63に対する検知距離の点列94でグルーピングが行われ、柱82に対する検知距離の点列95でグルーピングが行われる。また、図7の例では、左側の駐車車両63に対する検知距離の点列971でグルーピングが行われ、右側の駐車車両64に対する検知距離の点列972でグルーピングが行われる。その後、S30に移行し、図8の処理の終了条件が成立するまでは(S30:No)、上述の処理が繰り返される。そして、図8の処理を終了した後の図13のS13では、図8の処理でグルーピングされた検知距離の履歴ごとに曲線近似が行われる。
 S28において、変曲点が無い場合には(S28:No)、未だ障害物の切れ目は無いとして、グルーピングを行わないで、S30に移行し、図8の処理の終了条件が成立するまでは(S30:No)、上述の処理が繰り返される。
 以上説明したように、本実施形態によれば、検知距離の点列に距離差分が大きい距離差分大点が存在していた場合に、その距離差分大点がノイズか障害物の切れ目かを判定できる。よって、検知距離の点列にノイズが混在していたとしても、正確に検知距離のグルーピングを行うことができる。また、距離差分が小さい場合には、検知距離の点列に変曲点が有るか否かを判定するので、隣接障害物が有ったとしても正確に障害物の切れ目を検知できる。また、変曲点の有無を、検知距離の履歴を微分することなしに判定しているので、その判定を正確に行うことができる。なお、検知距離はいくらか誤差を有しているので、検知距離の履歴は変曲点の有無にかかわらず細かく変動する。そのため、検知距離の履歴の微分値を見たとしても、変曲点の有無を正確に検知できない。
(変形例)
 なお、本開示に係る障害物検知装置は上記実施形態に限定されるものではなく、特許請求の範囲の記載を逸脱しない限度で種々の変更が可能である。例えば、上記実施形態では、オフセット障害物の変曲点の検知場面として、駐車車両と柱とが配置された場面を例に挙げて説明したが、駐車車両、柱以外の障害物が配置された場面でも本開示を適用できる。例えば、図2の場面のように、駐車車両に隣接して縁石がオフセットして配置された場面でも適用できる。

 

Claims (15)

  1. 車両(5)に搭載される障害物検知装置(1)であって、
     前記車両(5)が障害物(63、64、82)の側方を移動している時にその障害物までの距離を逐次検知する距離検知手段(2)と、
     前記距離検知手段が検知した検知距離の点列の中で隣りの点の検知距離との差分が所定量以上となる検知距離の点である距離差分大点(91)の有無を判定する第1の判定手段(S22)と、
     前記第1の判定手段が前記距離差分大点が有ると判定した場合に前記距離差分大点の位置が障害物の切れ目なのか前記距離差分大点がノイズなのかを判定する第2の判定手段(S23、S24)と、
     前記第2の判定手段が障害物の切れ目と判定した場合に、前記距離差分大点を境にして前記検知距離の点列のグルーピングを行う第1のグルーピング手段(S26)と、
     を備える障害物検知装置。
  2.  前記第2の判定手段がノイズと判定した場合に、そのノイズを処理するノイズ処理手段(S25)を備える請求項1に記載の障害物検知装置。
  3.  前記第1の判定手段が前記距離差分大点が無いと判定した場合に、前記検知距離の点列の変曲点を検知する変曲点検知手段(S27)と、
     前記変曲点検知手段が検知した変曲点を境にして前記検知距離の点列のグルーピングを行う第2のグルーピング手段(S29)と、
     を備えることを特徴とする請求項1又は2に記載の障害物検知装置。
  4.  前記第2の判定手段は、前記距離差分大点より手前の前記検知距離の点である前距離点の点列(92)と、前記距離差分大点より後の前記検知距離の点である後距離点の点列(93)との間の連続性の有無に基づいて、障害物の切れ目なのかノイズなのかを判定する請求項1~3のいずれか1項に記載の障害物検知装置。
  5.  前記第2の判定手段は、
     前記前距離点の点列との間で連続性が成立する範囲である第1の連続性範囲(410、430、450)を、前記前距離点の点列の変動傾向に基づいて設定する第1範囲設定手段(S41)と、
     前記後距離点の点列との間で連続性が成立する範囲である第2の連続性範囲(420、440、460)を、前記後距離点の点列の変動傾向に基づいて設定する第2範囲設定手段(S42)と、
     前記後距離点が前記第1の連続性範囲に含まれ、かつ、前記前距離点が前記第2の連続性範囲に含まれた場合に障害物の切れ目ではないと判定する一方で、前記後距離点が前記第1の連続性範囲から外れることと、前記前距離点が前記第2の連続性範囲から外れることの少なくとも一方が成立する場合に障害物の切れ目と判定する切れ目判定手段(S43~S46)とを備える請求項4に記載の障害物検知装置。
  6.  前記第1範囲設定手段(S51~S53)は、前記後距離点の領域に対して前記前距離点の点列との間で連続性が成立する前記検知距離の下限値(412、432)及び上限値(411、431)を前記前距離点の点列の変動傾向に基づいて設定し、それら下限値、上限値で挟まれた第1範囲(410、430)を前記第1の連続性範囲として設定し、
     前記第2範囲設定手段(S51~S53)は、前記前距離点の領域に対して前記後距離点の点列との間で連続性が成立する前記検知距離の下限値(421、441)及び上限値(422、442)を前記後距離点の点列の変動傾向に基づいて設定し、それら下限値、上限値で挟まれた第2範囲(420、440)を前記第2の連続性範囲として設定する請求項5に記載の障害物検知装置。
  7.  前記第1範囲設定手段は、前記第1範囲を所定量だけ広げた範囲を前記第1の連続性範囲として設定し、
     前記第2範囲設定手段は、前記第2範囲を所定量だけ広げた範囲を前記第2の連続性範囲として設定する請求項6に記載の障害物検知装置。
  8.  前記第1範囲設定手段(S61、S62)は、前記後距離点の領域に対して前記前距離点の点列との間で連続性が成立する前記検知距離の推定値(451)を前記前距離点の点列の変動傾向に基づいて設定し、その推定値との差分が所定量以下となる範囲(450)を前記第1の連続性範囲として設定し、
     前記第2範囲設定手段(S61、S62)は、前記前距離点の領域に対して前記後距離点の点列との間で連続性が成立する前記検知距離の推定値(461)を前記後距離点の点列の変動傾向に基づいて設定し、その推定値との差分が所定量以下となる範囲(460)を前記第2の連続性範囲として設定する請求項5に記載の障害物検知装置。
  9.  前記第1範囲設定手段は、前記前距離点の点列より後の区間では、前記前距離点の点列の所定区間における変動量に応じた分だけ線形に前記検知距離が変動すると仮定して、前記第1の連続性範囲を設定し、
     前記第2範囲設定手段は、前記後距離点の点列より手前の区間では、前記後距離点の点列の所定区間における変動量に応じた分だけ線形に前記検知距離が変動すると仮定して、前記第2の連続性範囲を設定する請求項5~8のいずれか1項に記載の障害物検知装置。
  10.  前記ノイズ処理手段は、前記距離差分大点の区間を、前記距離差分大点の前後の前記検知距離の点(921、931)を用いて線形補間し、その線形補間した位置(911)にくるように前記距離差分大点を補正する請求項2に記載の障害物検知装置。
  11.  前記ノイズ処理手段は、前記距離差分大点を無効にする請求項2に記載の障害物検知装置。
  12.  前記車両の側方の方向を奥行き方向として、
     前記変曲点検知手段は、前記車両の側方に配置された第1障害物(63)と、前記第1障害物に隣接し前記第1障害物から前記奥行き方向にオフセットした位置に配置された第2障害物(82)とに対する前記検知距離の点列(94、95)の第1変曲点(951)を検知する第1の検知手段(S81~S88)を備える請求項3に記載の障害物検知装置。
  13.  前記第1の検知手段は、前記車両の進行方向に対応した第1方向に所定幅を有した枠(500)を前記第1方向にスライドさせながら前記検知距離の点列にあてはめ、前記枠内の前記検知距離の最大値と最小値の差分が所定量以上であり、かつ、前記枠内で前記最大値との差分が所定量以下となる前記検知距離の点列(963)の幅が所定値以上であり、かつ、前記枠内の前記検知距離の点列の端に位置するいずれかの端点(962)が前記幅を構成する点列に含まれている場合に、前記枠内に前記第1変曲点が存在するとして前記枠内からその第1変曲点を検知する請求項12に記載の障害物検知装置。
  14.  前記車両の側方の方向を奥行き方向として、
     前記変曲点検知手段は、前記車両の側方に配置された第1障害物(63)と、前記第1障害物に隣接し前記第1障害物から前記奥行き方向にオフセットしていない第3障害物(64)とに対する前記検知距離の点列(971、972)の第2変曲点(973)を検知する第2の検知手段(S91~S102)を備える請求項3、12、13のいずれか1項に記載の障害物検知装置。
  15.  前記第2の検知手段は、前記車両の進行方向に対応した第1方向に所定幅を有した枠(600)を前記第1方向にスライドさせながら前記検知距離の点列にあてはめ、
     前記枠内で最大の前記検知距離の点である距離最大点(973)の値と、前記枠内の前記検知距離の点列の一方の端点である第1の端点(975)の値との差分が所定の閾値以上となり、かつ、他方の端点である第2の端点(976)の値との差分が所定の閾値以上となり、かつ、
     前記距離最大点と前記第1の端点の間の前記検知距離の点列の幅が所定の閾値以上となり、かつ、
     前記距離最大点と前記第2の端点の間の前記検知距離の点列の幅が所定の閾値以上となり、かつ、
     前記距離最大点と前記第1の端点とが異なり、かつ、
     前記距離最大点と前記第2の端点とが異なる場合に前記距離最大点を前記第2変曲点とする請求項14に記載の障害物検知装置。
PCT/JP2014/000705 2013-02-15 2014-02-12 障害物検知装置 WO2014125810A1 (ja)

Applications Claiming Priority (2)

Application Number Priority Date Filing Date Title
JP2013-028242 2013-02-15
JP2013028242A JP5937980B2 (ja) 2013-02-15 2013-02-15 障害物検知装置

Publications (1)

Publication Number Publication Date
WO2014125810A1 true WO2014125810A1 (ja) 2014-08-21

Family

ID=51353823

Family Applications (1)

Application Number Title Priority Date Filing Date
PCT/JP2014/000705 WO2014125810A1 (ja) 2013-02-15 2014-02-12 障害物検知装置

Country Status (2)

Country Link
JP (1) JP5937980B2 (ja)
WO (1) WO2014125810A1 (ja)

Cited By (3)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP5843948B1 (ja) * 2014-11-27 2016-01-13 三菱電機株式会社 駐車支援装置および駐車支援方法
EP3124360A1 (en) * 2015-07-31 2017-02-01 Aisin Seiki Kabushiki Kaisha Parking assistance device
US11487007B2 (en) * 2016-09-02 2022-11-01 Denso Corporation Object detection device

Families Citing this family (8)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
KR101900228B1 (ko) 2015-12-17 2018-09-20 닛산 지도우샤 가부시키가이샤 주차 지원 방법 및 장치
CN110035930B (zh) * 2016-09-09 2021-09-17 三菱电机株式会社 停车辅助装置
WO2018134913A1 (ja) 2017-01-18 2018-07-26 三菱電機株式会社 駐車支援装置
US10884125B2 (en) * 2017-01-18 2021-01-05 Mitsubishi Electric Corporation Parking assistance device
JP6981928B2 (ja) * 2018-06-28 2021-12-17 日立Astemo株式会社 検知装置
WO2021106030A1 (ja) * 2019-11-25 2021-06-03 三菱電機株式会社 障害物検知装置
JP7310658B2 (ja) * 2020-03-06 2023-07-19 株式会社デンソー 物体認識装置
DE102020213321A1 (de) 2020-10-22 2022-04-28 Continental Automotive Gmbh Verfahren zum Erfassen eines Objekts in einer Umgebung eines Kraftfahrzeugs und Assistenzsystem

Citations (5)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP2006007875A (ja) * 2004-06-23 2006-01-12 Denso Corp 駐車支援装置
JP2009234294A (ja) * 2008-03-25 2009-10-15 Panasonic Electric Works Co Ltd 駐車空間監視装置
JP2010164349A (ja) * 2009-01-13 2010-07-29 Equos Research Co Ltd 制御装置
WO2011024220A1 (ja) * 2009-08-26 2011-03-03 三菱電機株式会社 駐車支援装置
JP2012086684A (ja) * 2010-10-20 2012-05-10 Aisin Seiki Co Ltd 駐車支援装置

Patent Citations (5)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP2006007875A (ja) * 2004-06-23 2006-01-12 Denso Corp 駐車支援装置
JP2009234294A (ja) * 2008-03-25 2009-10-15 Panasonic Electric Works Co Ltd 駐車空間監視装置
JP2010164349A (ja) * 2009-01-13 2010-07-29 Equos Research Co Ltd 制御装置
WO2011024220A1 (ja) * 2009-08-26 2011-03-03 三菱電機株式会社 駐車支援装置
JP2012086684A (ja) * 2010-10-20 2012-05-10 Aisin Seiki Co Ltd 駐車支援装置

Cited By (4)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP5843948B1 (ja) * 2014-11-27 2016-01-13 三菱電機株式会社 駐車支援装置および駐車支援方法
EP3124360A1 (en) * 2015-07-31 2017-02-01 Aisin Seiki Kabushiki Kaisha Parking assistance device
US9925919B2 (en) 2015-07-31 2018-03-27 Aisin Seiki Kabushiki Kaisha Parking assistance device
US11487007B2 (en) * 2016-09-02 2022-11-01 Denso Corporation Object detection device

Also Published As

Publication number Publication date
JP5937980B2 (ja) 2016-06-22
JP2014157501A (ja) 2014-08-28

Similar Documents

Publication Publication Date Title
JP5937980B2 (ja) 障害物検知装置
JP6363517B2 (ja) 車両の走行制御装置
US9102329B2 (en) Tracking control apparatus
WO2016117602A1 (ja) 車両制御装置及び車両制御方法
JP6430799B2 (ja) 車両の走行制御装置
JPWO2018047295A1 (ja) 駐車支援装置
US8862326B2 (en) Vehicle travel assisting device
JP6479295B2 (ja) 駐車支援装置
CN112816985B (zh) 后交叉碰撞检测系统和方法
CN109017776B (zh) 安装在车辆中的驾驶辅助系统
JP5918597B2 (ja) 駐車空間検知装置
WO2017145845A1 (ja) 衝突予測装置
JP5453765B2 (ja) 道路形状推定装置
JP2014094725A (ja) 駐車支援装置
JP5891188B2 (ja) 駐車空間検知装置
JP6330712B2 (ja) 障害物検出装置
JP6451565B2 (ja) 運転支援装置、及び運転支援方法
US11142187B2 (en) Parking assistance device
JP5880858B2 (ja) 駐車支援装置
KR101734726B1 (ko) 주차공간 탐지 방법 및 이를 실행하는 장치
JP5682302B2 (ja) 走行道路推定装置、方法およびプログラム
JP2019032607A (ja) 駐車支援装置
JP4905496B2 (ja) 物体検出装置
JP4046742B2 (ja) 道路形状推定装置
KR20210051872A (ko) 후방 교차 충돌 감지 시스템 및 방법

Legal Events

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

Ref document number: 14751055

Country of ref document: EP

Kind code of ref document: A1

NENP Non-entry into the national phase

Ref country code: DE

122 Ep: pct application non-entry in european phase

Ref document number: 14751055

Country of ref document: EP

Kind code of ref document: A1