WO2020105166A1 - 障害物検知装置 - Google Patents
障害物検知装置Info
- Publication number
- WO2020105166A1 WO2020105166A1 PCT/JP2018/043152 JP2018043152W WO2020105166A1 WO 2020105166 A1 WO2020105166 A1 WO 2020105166A1 JP 2018043152 W JP2018043152 W JP 2018043152W WO 2020105166 A1 WO2020105166 A1 WO 2020105166A1
- Authority
- WO
- WIPO (PCT)
- Prior art keywords
- obstacle
- road surface
- surface roughness
- vehicle
- height
- Prior art date
Links
Images
Classifications
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01S—RADIO DIRECTION-FINDING; RADIO NAVIGATION; DETERMINING DISTANCE OR VELOCITY BY USE OF RADIO WAVES; LOCATING OR PRESENCE-DETECTING BY USE OF THE REFLECTION OR RERADIATION OF RADIO WAVES; ANALOGOUS ARRANGEMENTS USING OTHER WAVES
- G01S13/00—Systems using the reflection or reradiation of radio waves, e.g. radar systems; Analogous systems using reflection or reradiation of waves whose nature or wavelength is irrelevant or unspecified
- G01S13/88—Radar or analogous systems specially adapted for specific applications
- G01S13/93—Radar or analogous systems specially adapted for specific applications for anti-collision purposes
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01S—RADIO DIRECTION-FINDING; RADIO NAVIGATION; DETERMINING DISTANCE OR VELOCITY BY USE OF RADIO WAVES; LOCATING OR PRESENCE-DETECTING BY USE OF THE REFLECTION OR RERADIATION OF RADIO WAVES; ANALOGOUS ARRANGEMENTS USING OTHER WAVES
- G01S15/00—Systems using the reflection or reradiation of acoustic waves, e.g. sonar systems
- G01S15/88—Sonar systems specially adapted for specific applications
- G01S15/93—Sonar systems specially adapted for specific applications for anti-collision purposes
Definitions
- the present invention relates to an obstacle detection device that detects an obstacle around a vehicle.
- the object detection device observes a temporal change in reflected wave intensity when a vehicle approaches an object using an ultrasonic sensor, and detects a low object when the reflected wave intensity changes from increase to decrease when approaching the object. I was determined.
- the object detection device according to Patent Document 1 Since the object detection device according to Patent Document 1 is configured as described above, the height of this obstacle cannot be determined unless the vehicle approaches the obstacle. Therefore, the object detection device according to Patent Document 1 has a problem that the height of the obstacle cannot be determined when the distance between the vehicle and the obstacle is substantially unchanged.
- the object detection device has a problem that the height of an obstacle located at a distance cannot be determined.
- the present invention was made to solve the above problems, and its purpose is to accurately determine the height of an obstacle.
- An obstacle detection device is an obstacle detection unit that detects the presence or absence of an obstacle in the vicinity of a vehicle using a feature amount that correlates with the magnitude of a reflected wave received by a distance measurement sensor provided in the vehicle. And an obstacle determination unit that determines the height of the obstacle detected by the obstacle detection unit by comparing the feature amount with a height determination threshold value, and detects the road surface roughness around the vehicle using the feature amount. And a threshold correction unit that reduces the height determination threshold when the road surface roughness detected by the road surface roughness detection unit is rough compared to when the road surface roughness is smooth.
- the height of the obstacle can be accurately determined.
- FIG. 3 is a block diagram showing a configuration example of an obstacle detection device according to the first embodiment.
- 7 is a graph showing an obstacle detection method by the obstacle detection unit according to the first embodiment.
- 7 is a graph showing an obstacle discrimination method by the obstacle discrimination unit of the first embodiment.
- 7 is a graph showing another example of the obstacle discrimination method by the obstacle discrimination unit of the first embodiment.
- FIG. 5A is a diagram showing a state of a search wave and a reflected wave when the surface roughness of the road surface is smooth
- FIG. 5B is a graph showing a reflection level of the road surface reflected wave.
- FIG. 6A is a diagram showing the states of the search wave and the reflected wave when the surface roughness of the road surface is rough
- FIG. 6B is a graph showing the reflection level of the road surface reflected wave.
- FIG. 7A is a diagram showing the states of the search wave and the reflected wave when the surface roughness of the road surface is smooth, and FIG. 7B is a graph showing the reflection levels of the road surface reflected wave and the obstacle reflected wave.
- FIG. 8A is a diagram showing the states of the search wave and the reflected wave when the surface roughness of the road surface is rough, and FIG. 8B is a graph showing the reflection levels of the road surface reflected wave and the obstacle reflected wave.
- FIG. 5 is a diagram showing a method of detecting the magnitude of road surface reflection by the road surface roughness detection unit of the first embodiment.
- FIG. 5 is a diagram showing a method of detecting the magnitude of road surface reflection by the road surface roughness detection unit of the first embodiment.
- FIG. 10 is a diagram showing another example of the method for detecting the magnitude of road surface reflection by the road surface roughness detection unit according to the first embodiment
- FIG. 10A is an example of mounting each distance measuring sensor
- FIGS. 10B and 10C are each distance measuring device. It is a waveform of the reflection level of the sensor.
- 5 is a graph showing a road surface roughness detection method by the road surface roughness detection unit of the first embodiment.
- 7 is a graph showing another example of the road surface roughness detection method by the road surface roughness detection unit of the first embodiment.
- 6 is a graph showing a method of correcting the height determination threshold value by the threshold value correction unit according to the first embodiment.
- 6 is a graph showing a method of correcting a feature quantity by the threshold value correction unit according to the first embodiment.
- FIG. 7 is a graph showing another example of a method of correcting the height determination threshold value by the threshold value correction unit according to the first embodiment.
- 6 is a graph showing an obstacle discrimination method in consideration of road surface roughness by the obstacle discrimination unit of the first embodiment.
- FIG. 5 is a diagram showing an example of state transition between an obstacle detection operation and a road surface roughness detection operation of the obstacle detection device according to the first embodiment.
- 3 is an overhead view showing an example of a surrounding environment at the time of starting the vehicle in the first embodiment.
- FIG. 3 is a flowchart showing an operation example of the obstacle detection device according to the first embodiment when the vehicle starts.
- FIG. 3 is an overhead view showing an example of a surrounding environment during forward traveling of the vehicle in the first embodiment.
- FIG. 3 is a flowchart showing an operation example of the obstacle detection device according to the first embodiment when the vehicle is traveling forward.
- FIG. 4 is a bird's-eye view showing an example of a surrounding environment in the automatic parking mode in the first embodiment.
- 7 is a flowchart showing an operation example of the obstacle detection device according to the first embodiment in an automatic parking mode.
- FIG. 3 is a bird's-eye view showing an example of a surrounding environment when the obstacle detection device according to the first embodiment travels in reverse.
- 3 is a flowchart showing an operation example of the obstacle detection device according to the first embodiment when the vehicle is traveling rearward.
- FIG. 5 is a graph showing a method for detecting a road surface roughness by using a distance measuring sensor that detects an obstacle, by the road surface roughness detecting unit according to the first embodiment.
- 27A and 27B are diagrams illustrating a hardware configuration example of the obstacle detection device according to the first embodiment.
- FIG. 1 is a block diagram showing a configuration example of an obstacle detection device 1 according to the first embodiment.
- the vehicle is equipped with an obstacle detection device 1, one or more distance measuring sensors 2, and a transmission / reception unit 3.
- a transmitting / receiving unit 3 is connected to the obstacle detection device 1, and one or more distance measuring sensors 2 are connected to the transmitting / receiving unit 3.
- the obstacle detection device 1 can appropriately acquire various information (hereinafter referred to as “vehicle information”) from the vehicle.
- vehicle information includes, for example, information indicating whether the ignition switch (IG) of the vehicle is on / off, information indicating whether the vehicle is in the automatic parking mode, or information indicating the shift position of the vehicle.
- IG ignition switch
- the vehicle is equipped with at least one distance measuring sensor 2.
- N distance measuring sensors 2-1 to 2-N (N is an arbitrary integer of 2 or more) are provided in the vehicle.
- the “distance measuring sensors 2-1 to 2-N” are used when it is necessary to distinguish between the plurality of distance measuring sensors 2, and the “distance measuring sensor 2” is used when distinction is not necessary.
- the distance measuring sensor 2 is a TOF (Time of Flight) type sensor, which transmits a “search wave” such as an ultrasonic wave, light, or a radio wave, and receives a “reflected wave” reflected by the search wave around the vehicle. ..
- search wave such as an ultrasonic wave, light, or a radio wave
- the transmitting / receiving unit 3 outputs a transmission signal to the distance measuring sensor 2 and causes the distance measuring sensor 2 to transmit a search wave corresponding to the transmission signal. Further, the transmission / reception unit 3 converts the reflected wave received by the distance measuring sensor 2 into a reception signal and outputs the reception signal to the obstacle detection unit 11 and the road surface roughness detection unit 13.
- the obstacle detection device 1 detects an obstacle around the vehicle and determines the height of the detected obstacle.
- an obstacle having a height high enough to contact the bumper of the vehicle is referred to as a “running obstacle”.
- the traveling obstacle is a wall or another vehicle that is parked.
- an obstacle having a height that is low enough not to contact the bumper of the vehicle and a height that is high enough to prevent the vehicle from getting over is referred to as a “road obstacle”.
- the road obstacle is a curb or a wheel clasp.
- an obstacle having a height that is low enough not to contact the bumper of the vehicle and a height that is low enough to allow the vehicle to get over it is referred to as a "road obstacle”.
- the road surface obstacle is a step or the like. That is, the traveling obstacle is an obstacle having a height higher than the road obstacle, and the road obstacle is an obstacle having a height higher than the road surface obstacle.
- the obstacle detection unit 11 compares the feature amount correlated with the magnitude of the reflected wave received by the distance measuring sensor 2 with a predetermined obstacle detection threshold value to detect the presence / absence of an obstacle around the vehicle. ..
- FIG. 2 is a graph showing an obstacle detection method by the obstacle detection unit 11 of the first embodiment.
- the horizontal axis of the graph is the propagation distance until the search wave transmitted from the distance measuring sensor 2 is reflected around the vehicle and received by the distance measuring sensor 2, and the vertical axis of the received signal output from the transmitting / receiving unit 3. It is the size, that is, the reflection level.
- the reflection level is one of the feature quantities that correlates with the magnitude of the reflected wave.
- the obstacle detection unit 11 determines that there is an obstacle when the reflection level exceeds a predetermined obstacle detection threshold Th1. In addition, the obstacle detection unit 11 may calculate the distance from the distance measuring sensor 2 to the obstacle based on the propagation distance when the reflection level exceeds the obstacle detection threshold Th1.
- the obstacle detection unit 11 detects the width of a portion whose reflection level exceeds the obstacle detection threshold Th1 as a “wave width”. Alternatively, when detecting an obstacle, the obstacle detection unit 11 may detect the waveform area of a portion whose reflection level exceeds the obstacle detection threshold Th1 as “area”. Alternatively, when detecting an obstacle, the obstacle detection unit 11 may detect the maximum value of the reflection level as a “peak value”.
- the wave width, the area, and the crest value are feature quantities that correlate with the magnitude of the reflected wave.
- the feature amount is an instantaneous value such as a wave width of a reflected wave obtained when one distance measuring sensor 2 transmits and receives once, or It may be an average value, a dispersion value, a median value, or the like of the wave widths of a plurality of reflected waves obtained when one distance measuring sensor 2 transmits and receives a plurality of times.
- the characteristic amount is transmitted and received at least once by each of the N range-finding sensors 2-1 to 2-N. It may be an average value, a dispersion value, a median value or the like of the wave widths of the plurality of reflected waves obtained in this case.
- the obstacle detection unit 11 notifies the obstacle determination unit 12 of whether or not an obstacle is detected. Further, when the obstacle detecting unit 11 detects the obstacle, the obstacle discriminating unit 12 obtains the distance to the obstacle and the wave width, the area, or the crest value, which is the characteristic amount correlated with the magnitude of the reflected wave. Notify to. Note that the obstacle detection unit 11 may notify the road surface roughness detection unit 13 of whether or not an obstacle has been detected, as described in FIG. 18 and subsequent figures.
- the obstacle determination unit 12 compares the feature amount detected by the obstacle detection unit 11 with a predetermined height determination threshold value, and the obstacle detection unit The height of the obstacle detected by 11 is determined.
- FIG. 3 is a graph showing an obstacle discrimination method by the obstacle discrimination unit 12 of the first embodiment.
- the obstacle discrimination method of FIG. 3 is an example in which the height discrimination threshold Th10 is used to determine whether the obstacle is a low obstacle or a high obstacle.
- the horizontal axis of the graph is the first characteristic amount
- the vertical axis is the second characteristic amount.
- the first feature amount and the second feature amount are arbitrary combinations of instantaneous values, average values, variance values, median values, etc. of the feature amounts.
- the first feature amount is an average value of wave widths detected from a plurality of reflected waves
- the second feature amount is a dispersion value of wave widths detected from a plurality of reflected waves. Further, in the graph of FIG.
- a height determination threshold Th10 according to a combination of the first feature amount and the second feature amount is set in advance.
- the obstacle determining unit 12 determines that the obstacle detecting unit 11 The obstacle detected by is determined to be a low obstacle.
- the obstacle discriminating unit 12 includes the characteristic amount 32a detected by the obstacle detecting unit 11 in the range 32 in which the first characteristic amount and the second characteristic amount are equal to or higher than the height discriminating threshold Th10, The obstacle detected by the detection unit 11 is determined to be a high obstacle.
- FIG. 4 is a graph showing another example of the obstacle discrimination method by the obstacle discrimination unit 12 of the first embodiment.
- the obstacle discrimination method of FIG. 4 uses the first height discrimination threshold Th11 and the second height discrimination threshold Th12 which is larger than the first height discrimination threshold Th11 to determine whether the obstacle is a road surface obstacle or a road obstacle. This is an example in which it is determined whether the vehicle is an obstacle or a traveling obstacle. Similar to FIG. 3, also in FIG. 4, the horizontal axis of the graph is the first feature amount and the vertical axis is the second feature amount.
- a first height determination threshold Th11 and a second height determination threshold Th12 corresponding to the combination of the first feature amount and the second feature amount are predetermined.
- the obstacle determination unit 12 determines whether the obstacle is detected.
- the obstacle detected by the detection unit 11 is determined to be a road surface obstacle.
- the obstacle discrimination unit 12 detects the obstacle detection unit 11 in a range 42 in which the first feature amount and the second feature amount are equal to or greater than the first height determination threshold Th11 and smaller than the second height determination threshold Th12.
- the obstacle detected by the obstacle detection unit 11 is determined to be a road obstacle.
- the obstacle discriminating unit 12 includes the characteristic amount 43a detected by the obstacle detecting unit 11 in the range 43 in which the first characteristic amount and the second characteristic amount are equal to or larger than the second height discriminating threshold Th12.
- the obstacle detected by the obstacle detection unit 11 is determined to be a traveling obstacle.
- the obstacle determination unit 12 causes the obstacle detected by the obstacle detection unit 11. Is a road obstacle or a road obstacle.
- the threshold correction unit 14 described below may correct the height determination threshold Th10 or the first height determination threshold Th11 and the second height determination threshold Th12.
- FIG. 5A is a diagram showing the states of the search wave 52 and the reflected wave 53 when the road surface 51 has a smooth surface roughness
- FIG. 5B is a graph showing the reflection level of the road surface reflected wave 54
- FIG. 6A is a diagram showing the states of the search wave 62 and the reflected wave 63 when the surface roughness of the road surface 61 is rough
- FIG. 6B is a graph showing the reflection level of the road surface reflected wave 64.
- the vertical axis of the graph represents the reflection level and the horizontal axis represents the propagation distance.
- the reflection level of the reflected wave 53 reflected by the road surface 51, that is, the road surface reflected wave 54 is small (FIG. 5B).
- the reflection level of the reflected wave 63 reflected by the road surface 61, that is, the road surface reflected wave 64 is high (FIG. 6B).
- FIG. 7A is a diagram showing the states of the search wave 52 and the reflected wave 53 when the road surface 51 has a smooth surface roughness
- FIG. 7B shows the reflection levels of the road surface reflected wave 54 and the obstacle reflected wave 56. It is a graph.
- FIG. 8A is a diagram showing the states of the search wave 62 and the reflected wave 63 when the road surface 61 has a rough surface
- FIG. 8B is a graph showing the reflection levels of the road surface reflected wave 64 and the obstacle reflected wave 66. is there. 7B and 8B, the vertical axis of the graph represents the reflection level and the horizontal axis represents the propagation distance.
- the obstacles 55 and 65 are road surface obstacles of the same height. As indicated by an arrow in FIG.
- a part of the search wave 52 is specularly reflected on the smooth road surface 51 and then reflected by the obstacle 55 to return to the distance measuring sensor 2.
- a part of the search wave 62 is diffusely reflected on the rough road surface 61, and then a part of the reflected wave diffusely reflected is reflected by the obstacle 65 and returns to the distance measuring sensor 2.
- the search wave 62 is diffused on the road surface 61, so that the reflected wave 63 reflected by the obstacle 65, that is, the reflection level of the obstacle reflected wave 66 is the reflection level reflected by the obstacle 55.
- the reflection level of the wave 53 that is, the obstacle reflection wave 56, it is significantly reduced.
- the reflection level of the reflected waves 53, 63 reflected by the obstacles 55, 65 changes depending on the surface roughness of the road surfaces 51, 61.
- the reflection level of a curb on a smooth concrete paved road surface 51 in an indoor parking lot tends to be much higher than the reflection level of a curb on a rough road surface 61 like an asphalt pavement in an outdoor parking lot.
- the surface roughness of the road surface is not considered in the height determination of the obstacle, the following three problems occur.
- the obstacle determination unit 12 determines the height of the obstacle.
- the height discrimination threshold Th10, or the first height discrimination threshold Th11 and the second height discrimination threshold Th12 are tuned on an asphalt road surface, the concrete road surface is reflected by an obstacle more than when tuning. The reflection level of the reflected wave increases. Therefore, the obstacle determination unit 12 erroneously determines the height of the obstacle.
- the height discrimination threshold Th10, or the first height discrimination threshold Th11 and the second height discrimination threshold Th12 are tuned on a concrete road surface, they are reflected by an obstacle on the asphalt road surface more than at the time of tuning. The reflection level of the reflected wave becomes smaller. Therefore, the obstacle determination unit 12 erroneously determines the height of the obstacle.
- the obstacle discrimination unit 12 The height discrimination accuracy is low and it is not practical.
- the road surface roughness detection unit 13 detects the surface roughness of the road surface
- the threshold value correction unit 14 determines the height determination threshold Th10 or the first height according to the surface roughness of the road surface.
- the discrimination threshold Th11 and the second height discrimination threshold Th12 are corrected.
- the road surface roughness detection unit 13 compares the feature amount that is correlated with the magnitude of the reflected wave received by the distance measuring sensor 2 with a predetermined road surface roughness detection threshold value to determine the surface roughness of the road surface around the vehicle. Detect. As a preparation for detecting the surface roughness of the road surface, the road surface roughness detection unit 13 first detects the magnitude of road surface reflection as follows.
- FIG. 9 is a graph showing a method for detecting the magnitude of road surface reflection by the road surface roughness detection unit 13 according to the first embodiment.
- the horizontal axis of the graph is the propagation distance of the search wave and the reflected wave transmitted from the distance measuring sensor 2, and the vertical axis is the magnitude of the received signal output from the transmission / reception unit 3, that is, the reflection level.
- the reflection level is one of the feature quantities that correlates with the magnitude of the reflected wave.
- the first road surface reflection detection threshold Th21, the second road surface reflection detection threshold Th22 smaller than the first road surface reflection detection threshold Th21, and the third road surface reflection detection threshold Th23 smaller than the second road surface reflection detection threshold Th22 are road surfaces.
- the roughness detection unit 13 has a predetermined value.
- the road surface roughness detection unit 13 detects a wave width, an area, or a crest value at which the reflection level exceeds the first road surface reflection detection threshold Th21, and determines the value of the road surface reflection. Similarly, the road surface roughness detection unit 13 detects a wave width, an area, or a crest value whose reflection level exceeds the second road surface reflection detection threshold Th22 or the third road surface reflection detection threshold Th23, and determines the magnitude of road surface reflection. Satoshi In addition, the road surface roughness detection unit 13 has a first road surface reflection detection threshold Th21, a second road surface reflection detection threshold Th22, and a reflection level obtained when one distance measuring sensor 2 transmits and receives once.
- the magnitude of the road surface reflection may be detected by gradually changing the third road surface reflection detection threshold Th23.
- the road surface roughness detection unit 13 sets the first road surface reflection detection threshold Th21, the second road surface reflection detection threshold Th22, and the third road surface reflection for the three distance measuring sensors 2-1 to 2-3.
- the detection threshold value Th23 is assigned to each of the distance measurement sensors 2-1 to 2-3, and the reflection level of each reflected wave obtained when the distance measurement sensors 2-1 to 2-3 transmit and receive is compared with the road surface reflection detection threshold value assigned to each distance measurement sensor. The size may be detected.
- FIG. 10 is a diagram showing another example of the method for detecting the magnitude of road surface reflection by the road surface roughness detection unit 13 according to the first embodiment
- FIG. 10A is a view showing how the distance measuring sensors 2-1 and 2-2 are attached.
- the distance measuring sensor 2-1 attached at a low position transmits the search wave 71.
- the search wave 71 is reflected on the road surface, and a part of the reflected wave 72 that is reflected is received by the distance measuring sensor 2-1.
- a part of the reflected wave 73 reflected is received by the distance measuring sensor 2-2 attached at a position higher than the distance measuring sensor 2-1.
- 10B is a graph of the reflection level of the reflected wave 72 received by the distance measuring sensor 2-1 and FIG.
- 10C is a graph of the reflection level of the reflected wave 73 received by the distance measuring sensor 2-2.
- the incident angle is 0 degrees in the horizontal direction in front of the distance measuring sensors 2-1 and 2-2
- the reception sensitivity is poor as the incident angle of the reflected waves 72 and 73 is large. Therefore, when the distance measuring sensors 2-1 and 2-2 have different mounting heights in the vehicle as shown in FIG. 10A, the distance measuring sensor 2-2 mounted at a position higher than the distance measuring sensor 2-1. Since the incident angle of the reflected wave 73 is larger, the sensitivity is worse.
- the road surface roughness detection unit 13 compares the predetermined road surface reflection detection threshold Th24 with the reflection levels of the reflected waves 72 and 73 to utilize the difference in sensitivity between the distance measuring sensors 2-1 and 2-2. It is possible to detect the magnitude of road surface reflection.
- the road surface roughness detection unit 13 determines that the road surface reflection is large when the reflection levels of the two distance measuring sensors 2-1 and 2-2 are both equal to or higher than the road surface reflection detection threshold Th24.
- the reflection level of the distance measurement sensor 2-1 is equal to or higher than the road surface reflection detection threshold Th24 and the reflection level of the distance measurement sensor 2-2 is lower than the road surface reflection detection threshold Th24
- the road surface roughness detection unit 13 determines that the road surface reflection is medium. Judge as the degree.
- the road surface roughness detection unit 13 determines that the road surface reflection is small when the reflection levels of the two distance measuring sensors 2-1 and 2-2 are both smaller than the road surface reflection detection threshold Th24. In the case of FIGS. 10B and 10C, the road surface reflection is moderate.
- the feature of the method shown in FIG. 10 is that only one road surface reflection detection threshold value is required.
- the road surface roughness detection unit 13 may detect the magnitude of road surface reflection by a method other than the methods shown in FIGS. 9 and 10. For example, when detecting the magnitude of road surface reflection, the road surface roughness detection unit 13 converts the transmitted sound pressure when the distance measuring sensor 2 transmits a search wave or the reflected wave received by the distance measuring sensor 2 into a reception signal. The transmission / reception unit 3 is instructed to change the reception gain in stepwise. Then, the road surface roughness detection unit 13 compares each reflection level when the transmission sound pressure is changed stepwise or when the reception gain is changed stepwise with the road surface reflection detection threshold Th24, and the road surface reflection is detected. Estimate the size of.
- the road surface roughness detection unit 13 may integrate the waveform of the reflection level to detect the waveform area of the road surface reflection, and estimate the magnitude of the road surface reflection according to the size of the detected waveform area.
- the road surface roughness detection unit 13 may frequency analyze the waveform of the reflection level to calculate the power spectrum, and estimate the magnitude of the road surface reflection according to the magnitude of the calculated power spectrum.
- the road surface roughness detection unit 13 detects the surface roughness of the road surface by comparing the detected road surface reflection magnitude with a predetermined road surface roughness detection threshold value.
- the road surface roughness detecting unit 13 may use an instantaneous value of the magnitude of road surface reflection, or may use statistical values such as an average value, a variance value, and a median value.
- the instantaneous value indicating the magnitude of the road surface reflection and the statistical values such as the average value, the variance value, and the median value are characteristic values that correlate with the magnitude of the reflected wave received by the distance measuring sensor 2.
- the road surface roughness detection unit 13 notifies the threshold value correction unit 14 of the detected surface roughness of the road surface.
- FIG. 11 is a graph showing a road surface roughness detection method by the road surface roughness detection unit 13 according to the first embodiment.
- the road surface roughness detection method of FIG. 11 is an example of detecting road surface roughness on a one-dimensional straight line, and the first feature amount is an instantaneous value of the magnitude of road surface reflection, or an average value, a variance value, or a center value. It is a statistical value such as a value.
- a first road surface roughness detection threshold Th31 and a second road surface roughness detection threshold Th32 corresponding to the first characteristic amount are predetermined.
- the road surface roughness detection unit 13 determines that the surface roughness of the road surface is smooth when the range 81 smaller than the first road surface roughness detection threshold Th31 includes the feature amount corresponding to the detected road surface reflection magnitude. judge. On the other hand, the road surface roughness detection unit 13 includes a feature amount corresponding to the detected road surface reflection in a range 82 that is equal to or larger than the first road surface roughness detection threshold Th31 and smaller than the second road surface roughness detection threshold Th32. If so, it is determined that the surface roughness of the road surface is medium. In addition, the road surface roughness detection unit 13 detects the surface roughness of the road surface when the range 83 that is equal to or larger than the second road surface roughness detection threshold Th32 includes the feature amount corresponding to the detected road surface reflection magnitude. Is judged to be rough.
- FIG. 12 is a graph showing another example of the road surface roughness detecting method by the road surface roughness detecting unit 13 of the first embodiment.
- the road surface roughness detection method of FIG. 12 is an example of detecting road surface roughness in a two-dimensional feature amount space, where the horizontal axis is the first feature amount and the vertical axis is the second feature amount.
- the first feature amount and the second feature amount are arbitrary combinations of the instantaneous value, the average value, the variance value, the median value, etc. of the magnitudes of road surface reflections.
- the first feature amount is an average value of the magnitudes of road surface reflections detected from a plurality of reflected waves
- the second feature amount is a variance value of the magnitudes of road surface reflections detected from a plurality of reflected waves. is there.
- a first road surface roughness detection threshold Th33 and a second road surface roughness detection threshold Th34 corresponding to a combination of the first feature amount and the second feature amount are predetermined.
- the road surface roughness detection unit 13 includes the feature amount corresponding to the detected road surface reflection in a range 91 in which the first feature amount and the second feature amount are smaller than the first road surface roughness detection threshold Th33. In this case, it is determined that the surface roughness of the road surface is smooth.
- the road surface roughness detection unit 13 detects the detected road surface reflection in a range 92 in which the first feature amount and the second feature amount are equal to or larger than the first road surface roughness detection threshold Th33 and smaller than the second road surface roughness detection threshold Th34.
- the feature amount corresponding to the size of is included, the surface roughness of the road surface is determined to be medium.
- the road surface roughness detection unit 13 includes the feature amount corresponding to the detected road surface reflection amount in the range 93 in which the first feature amount and the second feature amount are equal to or greater than the second road surface roughness detection threshold Th34. If it is, it is determined that the surface roughness of the road surface is rough.
- the road surface roughness detection unit 13 classifies the road surface roughness into three stages using two road surface roughness detection thresholds having different values. Not limited. The road surface roughness detection unit 13 may classify the road surface roughness into two stages using one road surface roughness detection threshold value, or may use four road surface roughness detection threshold values using three or more road surface roughness detection threshold values. It may be classified into more than one stage.
- the threshold value correction unit 14 corrects the height determination threshold value, which is predetermined for the obstacle determination unit 12, according to the surface roughness of the road surface detected by the road surface roughness detection unit 13. At this time, the threshold correction unit 14 determines the correction amount so that the height determination threshold is smaller when the surface roughness of the road surface is rougher than when it is smooth.
- FIG. 13 is a graph showing a method of correcting the height determination threshold value by the threshold value correction unit 14 according to the first embodiment.
- FIG. 13 shows an example of correcting the height determination threshold Th10 in the graph shown in FIG.
- the height determination threshold Th10 is a value tuned on a smooth road surface.
- the threshold correction unit 14 corrects the height determination threshold Th10 to be small.
- the obstacle determination unit 12 determines the height of the obstacle on the rough road surface by using the corrected height determination threshold Th10a. As a result, the obstacle having the feature amount 31a is discriminated as a low obstacle before correction, but is correctly discriminated as a high obstacle after correction.
- the height discrimination threshold Th10 is a value tuned on a smooth road surface
- the height discrimination threshold Th10 is corrected to be small according to the detection result that the road surface is rough.
- the height determination threshold Th10 is a value tuned on a rough road surface
- the height determination threshold Th10 is corrected to be large when a detection result that the road surface is smooth is obtained.
- FIG. 14 is a graph showing a method of correcting a feature amount by the threshold value correction unit 14 according to the first embodiment. Similar to FIG. 13, also in FIG. 14, it is assumed that the road surface roughness detection unit 13 has obtained a detection result that the road surface is rough. Therefore, the threshold correction unit 14 relatively reduces the height determination threshold Th10 by correcting the feature amount 31a to be large. The obstacle determination unit 12 compares the height determination threshold Th10 with the corrected feature amount 31b to determine the height of the obstacle on the rough road surface. Although the height discrimination threshold Th10 is corrected in the example of FIG. 13, the same effect as that of the example of FIG. 13 can be obtained by correcting the characteristic amount 31a correlated with the magnitude of the reflected wave as in the example of FIG. Be done.
- FIG. 15 is a graph showing another example of the method of correcting the height determination threshold value by the threshold value correction unit 14 of the first embodiment.
- FIG. 15 shows an example in which the first height discrimination threshold Th11 and the second height discrimination threshold Th12 of the graph shown in FIG. 4 are corrected.
- the threshold correction unit 14 has the first height discrimination threshold Th11 and the second height when the surface roughness of the road surface is rough, as compared with the case where the surface roughness is smooth.
- the discrimination threshold Th12 is reduced.
- the obstacle discriminating unit 12 discriminates the height of the obstacle on the rough road surface by using the corrected first height discrimination threshold Th11a and the corrected second height discrimination threshold Th12a.
- the reflected wave reflected by a low obstacle is not easily affected by the surface roughness of the road surface, and the reflected wave reflected by a high obstacle is easily affected by the surface roughness of the road surface. Therefore, in order to discriminate between the road obstacle and the traveling obstacle, which are high obstacles, based on the correction amount of the first height discrimination threshold Th11 for discriminating the road obstacle and the road obstacle which are low obstacles. It is preferable to increase the correction amount of the second height determination threshold Th12. This further improves the accuracy of height discrimination.
- the threshold correction unit 14 may correct the feature amount according to the surface roughness of the road surface as in FIG.
- the threshold value correction unit 14 corrects either the height determination threshold value or the feature amount according to the surface roughness of the road surface.
- the height may be determined in the feature amount space in which the surface roughness of the road surface is one-dimensionally added as one feature amount.
- FIG. 16 is a graph showing an obstacle discrimination method in consideration of road surface roughness by the obstacle discrimination unit 12 of the first embodiment.
- the third feature amount that is the surface roughness of the road surface is added to the two-dimensional feature amount space of the first feature amount and the second feature amount shown in FIG. 4.
- a planar height determination threshold Th10b is set in advance for the three-dimensional feature amount space in FIG.
- the height determination threshold Th10b divides the three-dimensional feature amount space into a space corresponding to a low obstacle (a range including the feature amount 31a) and a space corresponding to a high obstacle (a range including the feature amount 32a). To do.
- the obstacle discriminating unit 12 detects an obstacle in the three-dimensional feature space of FIG. 16 based on the feature amount detected by the obstacle detecting unit 11 and the surface roughness of the road surface detected by the road surface roughness detecting unit 13.
- the characteristic amount of the object is plotted, and the height of the obstacle is discriminated by comparing the plotted characteristic amount with the height discrimination threshold Th10b. In this case, the correction processing by the threshold correction unit 14 becomes unnecessary.
- FIG. 16 shows an example in which one height determination threshold is set in the three-dimensional feature amount space, but a plurality of height determination thresholds may be set.
- FIG. 17 is a diagram showing an example of state transition between the obstacle detection operation and the road surface roughness detection operation of the obstacle detection device 1 according to the first exemplary embodiment.
- the road surface roughness be detected during a period in which obstacle detection is not performed. More specifically, the road surface roughness is detected during a period in which the vehicle periphery monitoring function using the distance measuring sensor 2 is not performed, or a period in which no obstacle is detected around the vehicle. Thus, the driving support operation using the peripheral monitoring function is not disturbed.
- the detection timing of the road surface roughness is preferably a period during which the vehicle is stopped or traveling at a low speed, but may be during a period during which the vehicle is normally traveling.
- FIGS. 18 to 25 specific examples of the detection timing of the road surface roughness will be shown in FIGS. 18 to 25.
- FIG. 18 is a bird's-eye view showing an example of the surrounding environment at the time of vehicle start in the first embodiment.
- four distance measuring sensors 2-1 to 2-4 are attached to the front side of the vehicle 100
- four distance measuring sensors 2-5 to 2-8 are attached to the rear side of the vehicle.
- Each of the distance measuring sensors 2-1 to 2-8 has a range 101 to 108.
- FIG. 19 is a flowchart showing an operation example of the obstacle detection device 1 according to the first embodiment when the vehicle starts. It is assumed that the obstacle detection device 1 acquires vehicle information through a CAN (Controller Area Network) or the like while performing the operation shown in the flowchart of FIG.
- vehicle information includes information indicating on / off of the ignition switch, information indicating a shift position, and the like.
- the obstacle detection device 1 instructs the transceiver unit 3 to start distance measurement by the distance measurement sensors 2-1 to 2-8 (step ST2). Then, the obstacle detection unit 11 detects the presence / absence of an obstacle around the vehicle 100 using the feature amount that correlates with the magnitude of the reflected wave received by the distance measuring sensors 2-1 to 2-8.
- the distance measuring sensors 2-1 and 2-5 detect the parked vehicle 111
- the distance measuring sensors 2-6 and 2-7 detect the wheel clasp 115
- the distance measuring sensor 2-8 detects the wheel.
- the clasp 114 is detected.
- step ST3 “YES”) the road surface roughness detection unit 13 does not detect an obstacle, the distance measuring sensor 2 (hereinafter, “obstacle non-detection sensor”). It is determined whether or not (step ST4).
- the road surface roughness detection unit 13 determines that the distance measuring sensors 2-2, 2-3, 2-4 are obstacle non-detection sensors according to whether or not the obstacle detection unit 11 detects an obstacle. ..
- the obstacle non-detection sensor is present (step ST4 “YES”), the road surface roughness detection unit 13 measures the distance by the distance measurement sensors 2-2, 2-3, 2-4 which are the obstacle non-detection sensors.
- the transmitter / receiver 3 is instructed (step ST5). Then, the road surface roughness detecting unit 13 uses the feature amount that correlates with the magnitude of the reflected wave received by the distance measuring sensors 2-2, 2-3, 2-4, which are non-obstacle detecting sensors, to detect the road surface. The surface roughness is detected (step ST6).
- the threshold value correction unit 14 corrects the height determination threshold value of the obstacle determination unit 12 according to the surface roughness of the road surface detected by the road surface roughness detection unit 13 (step ST7). After that, the obstacle discrimination unit 12 discriminates the height of the obstacle detected by the obstacle detection unit 11 using the corrected height discrimination threshold value. On the other hand, when the shift position is not the parking (P) (step ST3 “NO”) or when there is no obstacle non-detection sensor (step ST4 “NO”), the threshold correction unit 14 causes the obstacle determination unit 12 to detect the obstacle. The height discrimination threshold is not corrected. After that, the obstacle discrimination unit 12 discriminates the height of the obstacle detected by the obstacle detection unit 11 by using a predetermined height discrimination threshold value before correction.
- the obstacle detection device 1 detects the road surface roughness when the shift position is parking, but when the obstacle is not detected around the vehicle 100, the shift position is parked.
- the road surface roughness may be detected.
- FIG. 20 is a bird's-eye view showing an example of the surrounding environment during forward traveling of the vehicle in the first embodiment.
- the vehicle 100 is traveling forward in the arrow direction.
- On the left side of this vehicle 100 are on-street parking vehicles 116 and 117 and a curb 118.
- a traveling vehicle 119 exists in the opposite lane on the right side of the vehicle 100.
- FIG. 21 is a flowchart showing an operation example of the obstacle detection device 1 according to the first embodiment when the vehicle travels forward. It is assumed that the obstacle detection device 1 acquires vehicle information through the CAN or the like while performing the operation shown in the flowchart of FIG.
- the vehicle information includes information indicating a shift position and the like.
- the obstacle detection device 1 instructs the transmission / reception unit 3 to start distance measurement by the distance measurement sensors 2-1 to 2-8 (step ST11). Then, the obstacle detection unit 11 detects the presence / absence of an obstacle around the vehicle 100 using the feature amount that correlates with the magnitude of the reflected wave received by the distance measuring sensors 2-1 to 2-8. In the example of FIG. 20, the distance measuring sensors 2-1 and 2-5 detect the parked vehicle 117 on the road, and the distance measuring sensor 2-4 detects the traveling vehicle 119.
- the road surface roughness detection unit 13 detects the distance measuring sensor 2 not used for the surroundings monitoring function (hereinafter, “there is no function work”). It is determined whether or not there is a "sensor”) (step ST13).
- a surroundings monitoring function for example, a frontal monitoring function, an entrainment prevention function, and an overtaking vehicle monitoring function are implemented. Therefore, the distance measuring sensors 2-6 and 2-7 attached to the rear side of the vehicle 100 are not used for the peripheral monitoring function. Therefore, in step ST13, the road surface roughness detecting unit 13 determines that the distance measuring sensors 2-6 and 2-7 are functionally workless sensors.
- the road surface roughness detection unit 13 determines whether the sensor that does not work functionally is an obstacle non-detection sensor (step ST14). .. In this step ST14, the road surface roughness detecting unit 13 determines whether the distance measuring sensors 2-6 and 2-7 are functionally non-working sensors and non-obstacles depending on whether the obstacle detecting unit 11 detects an obstacle. Judge as a detection sensor.
- the road surface roughness detection unit 13 is a sensor that does not functionally work and an obstacle non-detection sensor when a sensor that does not functionally work and an obstacle non-detection sensor exists (step ST14 “YES”).
- the transmitter / receiver 3 is instructed to perform distance measurement by the distance measuring sensors 2-6 and 2-7 (step ST15). Then, the road surface roughness detection unit 13 determines a feature amount that correlates with the magnitude of the reflected wave received by the distance measuring sensors 2-6 and 2-7, which are sensors that have no functional work and that are non-obstacle detection sensors. Then, the surface roughness of the road surface is detected (step ST16).
- the threshold correction unit 14 corrects the height discrimination threshold of the obstacle discrimination unit 12 according to the surface roughness of the road surface detected by the road surface roughness detection unit 13 (step ST17).
- step ST12 “NO” when the shift position is not the drive (D) (step ST12 “NO”), there is no sensor that has no functional work (step ST13 “NO”), or when there is no obstacle non-detection sensor (step ST14). “NO”), the threshold correction unit 14 does not correct the height determination threshold of the obstacle determination unit 12.
- FIG. 22 is a bird's-eye view showing an example of the surrounding environment in the automatic parking mode in the first embodiment.
- the vehicle 100 in this example uses the distance measuring sensor 2 in the parking slot 120 sandwiched between the on-road parking vehicle 116 and the on-road parking vehicle 117 while traveling forward in the arrow direction during the automatic parking mode in which parking is performed automatically. Are trying to detect.
- FIG. 23 is a flowchart showing an operation example of the obstacle detection device 1 according to the first embodiment in the automatic parking mode. It is assumed that the obstacle detection device 1 is acquiring vehicle information through the CAN or the like while performing the operation shown in FIG.
- the vehicle information includes information indicating whether or not the vehicle is in the automatic driving mode.
- the obstacle detection device 1 instructs the transmission / reception unit 3 to start distance measurement by the distance measurement sensors 2-1 to 2-8 (step ST21). Then, the obstacle detection unit 11 detects the presence / absence of an obstacle around the vehicle 100 using the feature amount that correlates with the magnitude of the reflected wave received by the distance measuring sensors 2-1 to 2-8. In the example of FIG. 22, the distance measuring sensors 2-1 and 2-5 detect the on-road parked vehicle 117, and the distance measuring sensor 2-4 detects the traveling vehicle 119.
- step ST22 “YES”) the road surface roughness detection unit 13 determines whether or not there is a sensor that is not used for the peripheral monitoring function and has no functional work (step). ST23).
- the vehicle 100 performs, for example, forward monitoring, entanglement prevention, and an overtaking vehicle monitoring function as peripheral monitoring functions. Therefore, the distance measuring sensors 2-6 and 2-7 attached to the rear side of the vehicle 100 are not used for the peripheral monitoring function. Therefore, in step ST23, the road surface roughness detection unit 13 determines that the distance measuring sensors 2-6 and 2-7 are functionally sensors with no work.
- the road surface roughness detection unit 13 determines whether the sensor that does not functionally work is an obstacle non-detection sensor (step ST24). .. In this step ST24, the road surface roughness detecting unit 13 determines whether the distance measuring sensors 2-6 and 2-7 are functionally non-working sensors and non-obstacles depending on whether the obstacle detecting unit 11 detects an obstacle. Judge as a detection sensor.
- steps ST25 to ST27 is substantially the same as the operation of steps ST15 to ST17 of FIG. 21, the description thereof will be omitted.
- FIG. 24 is a bird's-eye view showing an example of the surrounding environment of the obstacle detection device 1 according to the first embodiment during vehicle backward travel.
- the vehicle 100 is traveling backward in the direction of the arrow while attempting to park in the parking slot having the wheel clasp 126.
- FIG. 25 is a flowchart showing an operation example of the obstacle detection device 1 according to the first embodiment when the vehicle is traveling rearward. It is assumed that the obstacle detection device 1 acquires vehicle information through the CAN or the like while performing the operation shown in FIG.
- the vehicle information includes information indicating a shift position and the like.
- the obstacle detection device 1 instructs the transmission / reception unit 3 to start distance measurement by the distance measurement sensors 2-1 to 2-8 (step ST31). Then, the obstacle detection unit 11 detects the presence / absence of an obstacle around the vehicle 100 using the feature amount that correlates with the magnitude of the reflected wave received by the distance measuring sensors 2-1 to 2-8. In the example of FIG. 24, the distance measuring sensor 2-5 detects the parked vehicle 121.
- step ST32 “YES”) the road surface roughness detection unit 13 determines whether or not there is a sensor that is not used for the peripheral monitoring function and has no functional work. The determination is made (step ST33).
- a peripheral monitoring function for example, rearward monitoring, entanglement prevention, and an overtaking vehicle monitoring function are performed. Therefore, the distance measuring sensors 2-2 and 2-3 attached to the front side of the vehicle 100 are not used for the peripheral monitoring function. Therefore, in step ST33, the road surface roughness detection unit 13 determines that the distance measuring sensors 2-2 and 2-3 are functionally workless sensors.
- the road surface roughness detection unit 13 determines whether the sensor that does not functionally work is an obstacle non-detection sensor (step ST34). .. In this step ST34, the road surface roughness detecting unit 13 determines whether the distance measuring sensors 2-2 and 2-3 are functionally non-working sensors and non-obstacles depending on whether the obstacle detecting unit 11 detects an obstacle. Judge as a detection sensor.
- steps ST35 to ST37 Since the operation of steps ST35 to ST37 is substantially the same as the operation of steps ST15 to ST17 of FIG. 21, the description thereof will be omitted.
- the road surface roughness detection unit 13 detects the road surface roughness by using the distance measuring sensor 2 that does not detect an obstacle, but The road surface roughness may be detected by using the distance measuring sensor 2 that detects
- the road surface roughness detection unit 13 detects an obstacle in the distance measurement sensors 2-1 to 2-N provided in the vehicle 100, which is located at a distance greater than a predetermined distance (for example, 1 m).
- the distance measuring sensor 2 that is operating is specified.
- the road surface roughness detecting unit 13 uses the feature amount corresponding to within the predetermined distance among the feature amounts correlated with the magnitude of the reflected wave received by the specified distance measuring sensor 2 to detect the road surface. Detect surface roughness.
- FIG. 26 is a graph showing a method in which the road surface roughness detection unit 13 according to the first embodiment detects road surface roughness by using the distance measuring sensor 2 that detects an obstacle.
- the obstacle detection unit 11 detects an obstacle at the site of the obstacle reflected wave 130 using the reflection level of the reflected wave received by the distance measuring sensor 2.
- the road surface roughness detection unit 13 sets the propagation distance corresponding to the predetermined distance within the road surface roughness detection range 131. Set. Then, the road surface roughness detecting unit 13 detects the magnitude of road surface reflection and the surface roughness of the road surface using the reflection level of the road surface reflected wave 132 included in the road surface roughness detection range 131.
- FIGA and 27B are diagrams illustrating a hardware configuration example of the obstacle detection device 1 according to the first embodiment.
- the functions of the obstacle detection unit 11, the obstacle determination unit 12, the road surface roughness detection unit 13, and the threshold value correction unit 14 in the obstacle detection device 1 are realized by a processing circuit. That is, the obstacle detection device 1 includes a processing circuit for realizing the above function.
- the processing circuit may be the processing circuit 200 as dedicated hardware, or may be the processor 201 that executes the program stored in the memory 202.
- the processing circuit 200 may be, for example, a single circuit, a composite circuit, a programmed processor, a parallel programmed processor, or an ASIC (Application Specific Integrated Circuit). ), FPGA (Field Programmable Gate Array), or a combination thereof.
- the functions of the obstacle detection unit 11, the obstacle discrimination unit 12, the road surface roughness detection unit 13, and the threshold value correction unit 14 may be realized by a plurality of processing circuits 200, or the functions of the respective units may be combined into one processing circuit. It may be realized by 200.
- the functions of the obstacle detection unit 11, the obstacle determination unit 12, the road surface roughness detection unit 13, and the threshold value correction unit 14 are software, firmware, or It is realized by a combination of software and firmware.
- the software or firmware is described as a program and stored in the memory 202.
- the processor 201 realizes the function of each unit by reading and executing the program stored in the memory 202. That is, the obstacle detection device 1 includes the memory 202 for storing the program that, when executed by the processor 201, results in the steps shown in the flowchart of FIG. 19 and the like being executed. It can also be said that this program causes a computer to execute the procedure or method of the obstacle detection unit 11, the obstacle determination unit 12, the road surface roughness detection unit 13, and the threshold value correction unit 14.
- the processor 201 is a CPU (Central Processing Unit), a processing device, a computing device, a microprocessor, or the like.
- the memory 202 may be a RAM (Random Access Memory), a ROM (Read Only Memory), an EPROM (Erasable Programmable ROM), or a nonvolatile or volatile semiconductor memory such as a flash memory, a hard disk or a flexible disk. Magnetic disk, or an optical disk such as a CD (Compact Disc) or a DVD (Digital Versatile Disc).
- the obstacle detection threshold, the height determination threshold, the road surface reflection detection threshold, the road surface roughness detection threshold, and the correction amount of the height determination threshold according to the road surface roughness are stored in the memory 202.
- the functions of the obstacle detection unit 11, the obstacle determination unit 12, the road surface roughness detection unit 13, and the threshold value correction unit 14 are partially realized by dedicated hardware and partially realized by software or firmware. You may do it.
- the processing circuits in the obstacle detection unit 11, the obstacle determination unit 12, the road surface roughness detection unit 13, and the threshold value correction unit 14 perform the above-described functions by hardware, software, firmware, or a combination thereof. Can be realized.
- the obstacle detection device 1 includes the obstacle detection unit 11, the obstacle determination unit 12, the road surface roughness detection unit 13, and the threshold correction unit 14.
- the obstacle detection unit 11 detects the presence / absence of an obstacle in the vicinity of the vehicle by using a feature amount that correlates with the magnitude of the reflected wave received by the distance measuring sensor 2 provided in the vehicle.
- the obstacle determination unit 12 compares the feature amount with the height determination threshold Th10 to determine the height of the obstacle detected by the obstacle detection unit 11.
- the road surface roughness detection unit 13 detects the road surface roughness around the vehicle by using the feature amount.
- the threshold value correction unit 14 reduces the height determination threshold Th10 when the road surface roughness detected by the road surface roughness detection unit 13 is rough as compared to when the road surface roughness is smooth.
- the obstacle detection device 1 determines the height of the obstacle by comparing the feature amount with the height determination threshold Th10, and thus determines the height of the obstacle even if the vehicle does not approach the obstacle. it can. Further, since the obstacle detection device 1 optimizes the height determination threshold Th10 according to the road surface condition, the height of the obstacle can be accurately determined.
- the obstacle detection device 1 can determine the height of the obstacle without the vehicle approaching the obstacle, when the vehicle travels in a direction parallel to the obstacle as shown in FIGS. 20 and 22, The height of the obstacle can be accurately determined. Further, the obstacle detection device 1 determines the height of the obstacle by using the result of transmitting and receiving the search waves at different times by the single distance measuring sensor 2 in addition to using the plurality of distance measuring sensors 2. it can. Further, the obstacle detection device 1 can determine whether the obstacle existing inside the parking slot is a wall, a curb or a step as shown in FIG. If it is possible to determine whether the obstacle existing behind the parking slot is higher or lower than the bumper of the vehicle, it is possible to optimize the guide route and the parking position of the vehicle in the automatic parking mode.
- the vehicle can suppress unnecessary warnings or brakes for low obstacles that do not collide with the bumper, and can park the vehicle at appropriate clearances for the low obstacles to facilitate passengers getting on and off. , The convenience of passengers is improved. Further, when the obstacle detection device 1 detects a parking slot in the automatic parking mode as shown in FIG. 22, even if there is a parking slot partitioned by curbs having two steps, the height of the curb is high. Can be correctly detected, and as a result, the parking slot can be correctly detected.
- the obstacle detection device 1 can determine the height of the obstacle without the vehicle approaching the obstacle, the obstacle detection device 1 can detect the height of the obstacle from a distance farther than that of the conventional object detection device according to Patent Document 1. It can be determined. Therefore, the vehicle can avoid the collision by speeding up and optimizing the automatic driving, thereby improving the convenience of the occupant.
- the obstacle detection device 1 uses a plurality of distance measuring sensors 2, there is no restriction on the height at which the distance measuring sensors 2 are mounted on the vehicle, so that the designability and the designability are improved.
- the obstacle determination unit 12 of the first embodiment compares the feature amount with the first height determination threshold Th11 to determine whether the obstacle is a road surface obstacle or a road obstacle
- the feature amount and the first A configuration may be used in which it is determined whether the obstacle is a road obstacle or a traveling obstacle by comparing with a second height determination threshold Th12 that is larger than the first height determination threshold Th11.
- the threshold value correction unit 14 reduces at least one of the first height determination threshold value Th11 and the second height determination threshold value Th12 compared to when the road surface roughness is smooth.
- the threshold correction unit 14 sets the correction amount of the second height determination threshold Th12 to be larger than the correction amount of the first height determination threshold Th11, so that the road surface obstacle, the road obstacle, and the traveling obstacle. Can be determined more accurately.
- the road surface roughness detection unit 13 of the first embodiment does not detect an obstacle among the distance measurement sensors 2-1 to 2-N provided on the vehicle, and is used for monitoring the surroundings of the vehicle.
- the distance measuring sensor 2 that is not used is specified, and the feature amount that correlates with the magnitude of the reflected wave received by the specified distance measuring sensor 2 is compared with one or more road surface roughness detection thresholds to determine the road surface roughness. Classify into two or more stages.
- the obstacle detection device 1 can detect the road surface roughness and correct the height determination threshold without interfering with the driving support operation or the like that uses the peripheral monitoring function.
- the road surface roughness detecting unit 13 of the first embodiment detects an obstacle located at a distance farther than a predetermined distance among the distance measuring sensors 2-1 to 2-N provided on the vehicle.
- the distance measuring sensor 2 which is present, the characteristic amount corresponding to within the predetermined distance among the characteristic amounts correlated with the magnitude of the reflected wave received by the specified distance measuring sensor 2 and one or more road surfaces.
- the road surface roughness is classified into two or more stages by comparing with the roughness detection threshold value.
- the obstacle detection device 1 can perform the obstacle detection and the road surface roughness detection at the same time without interfering with the driving support operation or the like using the peripheral monitoring function.
- the obstacle detection device according to the present invention can be applied to, for example, surrounding monitoring, collision avoidance, or parking assistance control.
Landscapes
- Engineering & Computer Science (AREA)
- Radar, Positioning & Navigation (AREA)
- Remote Sensing (AREA)
- Physics & Mathematics (AREA)
- Computer Networks & Wireless Communication (AREA)
- General Physics & Mathematics (AREA)
- Acoustics & Sound (AREA)
- Electromagnetism (AREA)
- Measurement Of Velocity Or Position Using Acoustic Or Ultrasonic Waves (AREA)
- Traffic Control Systems (AREA)
- Radar Systems Or Details Thereof (AREA)
Abstract
障害物検知部(11)は、車両に設けられている測距センサ(2)が受信した反射波の大きさに相関する特徴量を用いて車両の周辺における障害物の有無を検知する。障害物判別部(12)は、特徴量と高さ判別閾値(Th10)とを比較して障害物検知部(11)により検知された障害物の高さを判別する。路面粗さ検知部(13)は、特徴量を用いて車両の周辺の路面粗さを検知する。閾値補正部(14)は、路面粗さ検知部(13)により検知された路面粗さが粗い場合、滑らかな場合に比べて高さ判別閾値(Th10)を小さくする。
Description
この発明は、車両周辺の障害物を検知する障害物検知装置に関するものである。
以下の2つの理由から、車両の周辺にある障害物の高さを検出するための技術が求められている。
(1)車両進退時に、障害物が車両のバンパに衝突する高い障害物か、バンパに衝突しない低い障害物か否かを判別し、低い障害物に対する不必要な警報又はブレーキを抑圧するため
(2)車両駐車時に、バンパに衝突しない低い障害物に対して車両を適切なクリアランスで駐車し、乗員の乗り降りを容易にするため
(1)車両進退時に、障害物が車両のバンパに衝突する高い障害物か、バンパに衝突しない低い障害物か否かを判別し、低い障害物に対する不必要な警報又はブレーキを抑圧するため
(2)車両駐車時に、バンパに衝突しない低い障害物に対して車両を適切なクリアランスで駐車し、乗員の乗り降りを容易にするため
特許文献1に係る物体検知装置は、超音波センサを用いて車両が物体に接近したときの反射波強度の時間変化を観測し、接近時に反射波強度が増加から減少に変化した場合に低い物体と判定していた。
特許文献1に係る物体検知装置は以上のように構成されているので、車両が障害物に接近しないとこの障害物の高さを判別できない。そのため、特許文献1に係る物体検知装置は、車両と障害物との距離がほぼ変化しない場合には、障害物の高さを判別できないという課題があった。
また、反射波強度が増加から減少に変化するのは、車両が障害物に1m~2mまで接近したときである。そのため、特許文献1に係る物体検知装置は、遠方に位置する障害物の高さを判別できないという課題があった。車両を自動制御する際、車両から1m~2mの近距離で障害物の高さを判別したとしても、衝突回避が困難である。
この発明は、上記のような課題を解決するためになされたもので、障害物の高さを精度よく判別することを目的とする。
この発明に係る障害物検知装置は、車両に設けられている測距センサが受信した反射波の大きさに相関する特徴量を用いて車両の周辺における障害物の有無を検知する障害物検知部と、特徴量と高さ判別閾値とを比較して障害物検知部により検知された障害物の高さを判別する障害物判別部と、特徴量を用いて車両の周辺の路面粗さを検知する路面粗さ検知部と、路面粗さ検知部により検知された路面粗さが粗い場合、滑らかな場合に比べて高さ判別閾値を小さくする閾値補正部とを備えるものである。
この発明によれば、障害物の高さを精度よく判別することができる。
以下、この発明をより詳細に説明するために、この発明を実施するための形態について、添付の図面に従って説明する。
実施の形態1.
図1は、実施の形態1に係る障害物検知装置1の構成例を示すブロック図である。車両には、障害物検知装置1、1個以上の測距センサ2、及び送受信部3が搭載されている。障害物検知装置1には、送受信部3が接続されており、送受信部3には、1個以上の測距センサ2が接続されている。また、図示は省略するが、障害物検知装置1は、車両から種々の情報(以下、「車両情報」と称する)を適宜取得可能である。車両情報は、例えば、車両のイグニッションスイッチ(IG)のオンオフを示す情報、車両が自動駐車モードであるか否かを示す情報、又は車両のシフトポジションを示す情報を含む。
実施の形態1.
図1は、実施の形態1に係る障害物検知装置1の構成例を示すブロック図である。車両には、障害物検知装置1、1個以上の測距センサ2、及び送受信部3が搭載されている。障害物検知装置1には、送受信部3が接続されており、送受信部3には、1個以上の測距センサ2が接続されている。また、図示は省略するが、障害物検知装置1は、車両から種々の情報(以下、「車両情報」と称する)を適宜取得可能である。車両情報は、例えば、車両のイグニッションスイッチ(IG)のオンオフを示す情報、車両が自動駐車モードであるか否かを示す情報、又は車両のシフトポジションを示す情報を含む。
車両には、少なくとも1個の測距センサ2が設けられている。図1の例では、N個の測距センサ2-1~2-N(Nは2以上の任意の整数)が車両に設けられている。以下では、複数の測距センサ2それぞれの区別が必要な場合に「測距センサ2-1~2-N」を用い、区別が不要な場合に「測距センサ2」を用いる。測距センサ2は、TOF(Time of Flight)方式のセンサであり、超音波、光、又は電波等の「探索波」を送信し、探索波が車両周辺で反射した「反射波」を受信する。
送受信部3は、測距センサ2に送信信号を出力し、送信信号に応じた探索波を測距センサ2から送信させる。また、送受信部3は、測距センサ2が受信した反射波を受信信号に変換し、障害物検知部11及び路面粗さ検知部13へ出力する。
障害物検知装置1は、車両の周辺にある障害物を検知し、検知した障害物の高さを判別する。ここで、障害物のうち、車両のバンパに接触する程度に高い高さを有する障害物を「走行障害物」という。走行障害物は、壁又は駐車中の他車両等である。また、障害物のうち、車両のバンパに接触しない程度に低い高さを有し、かつ、車両が乗り越えられない程度に高い高さを有する障害物を「路上障害物」という。路上障害物は、縁石又は輪留め等である。また、障害物のうち、車両のバンパに接触しない程度に低い高さを有し、かつ車両が乗り越えられる程度に低い高さを有する障害物を「路面障害物」という。路面障害物は、段差等である。すなわち、走行障害物は路上障害物よりも高い高さを有する障害物であり、路上障害物は路面障害物よりも高い高さを有する障害物である。
障害物検知部11は、測距センサ2が受信した反射波の大きさに相関する特徴量と、予め定められた障害物検知閾値とを比較し、車両の周辺における障害物の有無を検知する。
図2は、実施の形態1の障害物検知部11による障害物検知方法を示すグラフである。グラフの横軸は測距センサ2から送信された探索波が車両周辺で反射して測距センサ2で受信されるまでの伝搬距離であり、縦軸は送受信部3から出力された受信信号の大きさ、すなわち反射レベルである。反射レベルは、反射波の大きさに相関する特徴量の1つである。障害物検知部11は、反射レベルが予め定められた障害物検知閾値Th1を超えている場合、障害物ありと判定する。また、障害物検知部11は、反射レベルが障害物検知閾値Th1を超えたときの伝搬距離に基づいて、測距センサ2から障害物までの距離を算出してもよい。
また、障害物検知部11は、障害物を検知した場合、反射レベルが障害物検知閾値Th1を超えている部位の幅を「波幅」として検知する。または、障害物検知部11は、障害物を検知した場合、反射レベルが障害物検知閾値Th1を超えている部位の波形面積を「面積」として検知してもよい。または、障害物検知部11は、障害物を検知した場合、反射レベルの最大値を「波高値」として検知してもよい。波幅、面積、及び波高値は、反射波の大きさに相関する特徴量である。なお、例えば、車両に1個の測距センサ2が設けられている場合、特徴量は、1個の測距センサ2が1回送受信した場合に得られる反射波の波幅等の瞬時値、又は、1個の測距センサ2が複数回送受信した場合に得られる複数の反射波の波幅等の平均値、分散値、若しくは中央値等であってもよい。また、例えば、車両にN個の測距センサ2-1~2-Nが設けられている場合、特徴量は、N個の測距センサ2-1~2-Nそれぞれが1回以上送受信した場合に得られる複数の反射波の波幅等の平均値、分散値、又は中央値等であってもよい。
障害物検知部11は、障害物の検知有無を障害物判別部12へ通知する。また、障害物検知部11は、障害物を検知した場合、障害物までの距離と、反射波の大きさに相関する特徴量である波幅、面積、又は波高値とを、障害物判別部12へ通知する。
なお、障害物検知部11は、図18以降で説明するように、障害物の検知有無を路面粗さ検知部13へ通知してもよい。
なお、障害物検知部11は、図18以降で説明するように、障害物の検知有無を路面粗さ検知部13へ通知してもよい。
障害物判別部12は、障害物検知部11により障害物が検知された場合、障害物検知部11により検知された特徴量と予め定められた高さ判別閾値とを比較し、障害物検知部11により検知された障害物の高さを判別する。
図3は、実施の形態1の障害物判別部12による障害物判別方法を示すグラフである。図3の障害物判別方法は、高さ判別閾値Th10により、障害物が低い障害物又は高い障害物のいずれであるかを判別する例である。グラフの横軸は第1特徴量、縦軸は第2特徴量である。第1特徴量及び第2特徴量は、特徴量の瞬時値、平均値、分散値、又は中央値等のうちの任意の組み合わせである。例えば、第1特徴量は、複数の反射波から検知された波幅の平均値であり、第2特徴量は、複数の反射波から検知された波幅の分散値である。また、図3のグラフには、第1特徴量と第2特徴量との組み合わせに応じた高さ判別閾値Th10が、予め定められている。障害物判別部12は、第1特徴量及び第2特徴量が高さ判別閾値Th10より小さい範囲31に、障害物検知部11により検知された特徴量31aが含まれる場合、障害物検知部11により検知された障害物を低い障害物と判別する。一方、障害物判別部12は、第1特徴量及び第2特徴量が高さ判別閾値Th10以上である範囲32に、障害物検知部11により検知された特徴量32aが含まれる場合、障害物検知部11により検知された障害物を高い障害物と判別する。
図4は、実施の形態1の障害物判別部12による障害物判別方法の別の例を示すグラフである。図4の障害物判別方法は、第一の高さ判別閾値Th11と、第一の高さ判別閾値Th11より大きい第二の高さ判別閾値Th12とにより、障害物が路面障害物、路上障害物、又は走行障害物のいずれであるかを判別する例である。図3と同様、図4においても、グラフの横軸は第1特徴量、縦軸は第2特徴量である。図4のグラフには、第1特徴量と第2特徴量との組み合わせに応じた第一の高さ判別閾値Th11と第二の高さ判別閾値Th12とが、予め定められている。障害物判別部12は、第1特徴量及び第2特徴量が第一の高さ判別閾値Th11より小さい範囲41に、障害物検知部11により検知された特徴量41aが含まれる場合、障害物検知部11により検知された障害物を路面障害物と判別する。一方、障害物判別部12は、第1特徴量及び第2特徴量が第一の高さ判別閾値Th11以上かつ第二の高さ判別閾値Th12より小さい範囲42に、障害物検知部11により検知された特徴量42aが含まれる場合、障害物検知部11により検知された障害物を路上障害物と判別する。また、障害物判別部12は、第1特徴量及び第2特徴量が第二の高さ判別閾値Th12以上である範囲43に、障害物検知部11により検知された特徴量43aが含まれる場合、障害物検知部11により検知された障害物を走行障害物と判別する。
なお、図3の高さ判別閾値Th10が図4の第一の高さ判別閾値Th11と同じ値に設定されている場合、障害物判別部12は、障害物検知部11により検知された障害物が路面障害物か路上障害物かを判別することになる。また、図3の高さ判別閾値Th10が図4の第二の高さ判別閾値Th12と同じ値に設定されている場合、障害物判別部12は、障害物検知部11により検知された障害物が路上障害物か走行障害物かを判別することになる。
また、実施の形態1においては、後述する閾値補正部14により、高さ判別閾値Th10、又は、第一の高さ判別閾値Th11と第二の高さ判別閾値Th12が補正される場合がある。
また、実施の形態1においては、後述する閾値補正部14により、高さ判別閾値Th10、又は、第一の高さ判別閾値Th11と第二の高さ判別閾値Th12が補正される場合がある。
次に、路面の表面粗さが、反射波の大きさに相関する特徴量に及ぼす影響を説明する。
図5Aは、路面51の表面粗さが滑らかである場合の探索波52と反射波53の様子を示す図であり、図5Bは、路面反射波54の反射レベルを示すグラフである。図6Aは、路面61の表面粗さが粗い場合の探索波62と反射波63の様子を示す図であり、図6Bは、路面反射波64の反射レベルを示すグラフである。図5B及び図6Bにおいて、グラフの縦軸は反射レベル、横軸は伝搬距離である。路面51の表面粗さがコンクリート路面のように滑らかな平坦である場合(図5A)、路面51で反射した反射波53、すなわち路面反射波54の反射レベルは小さい(図5B)。これに対し、路面61の表面粗さがアスファルト路面のように粗い場合(図6A)、路面61で反射した反射波63、すなわち路面反射波64の反射レベルは大きい(図6B)。
図7Aは、路面51の表面粗さが滑らかである場合の探索波52と反射波53の様子を示す図であり、図7Bは、路面反射波54と障害物反射波56の反射レベルを示すグラフである。図8Aは、路面61の表面粗さが粗い場合の探索波62と反射波63の様子を示す図であり、図8Bは、路面反射波64と障害物反射波66の反射レベルを示すグラフである。図7B及び図8Bにおいて、グラフの縦軸は反射レベル、横軸は伝搬距離である。障害物55,65は、同じ高さの路面障害物である。図7Aに矢印で示されるように、探索波52の一部は、滑らかな路面51で鏡面反射した後、障害物55で反射して測距センサ2へ戻る。図8Aに矢印で示されるように、探索波62の一部は、粗い路面61で拡散反射した後、拡散反射した反射波の一部が障害物65で反射して測距センサ2へ戻る。図8Aのように路面61が粗い場合、路面61で探索波62が拡散するため、障害物65で反射した反射波63、すなわち障害物反射波66の反射レベルは、障害物55で反射した反射波53、すなわち障害物反射波56の反射レベルに比べて著しく低下する。
このように、障害物55,65で反射した反射波53,63の反射レベルは、路面51,61の表面粗さによって変化する。例えば、屋内駐車場のコンクリート舗装された滑らかな路面51上にある縁石の反射レベルは、屋外駐車場のアスファルト舗装のような粗い路面61上にある縁石の反射レベルに比べて非常に大きくなる傾向がある。そのため、障害物の高さ判別において路面の表面粗さを考慮しない場合、次の3つの問題が生じる。
(1)高さ判別閾値Th10、又は、第一の高さ判別閾値Th11と第二の高さ判別閾値Th12がアスファルト路面上でチューニングされた場合、コンクリート路面上ではチューニング時よりも障害物で反射した反射波の反射レベルが大きくなる。そのため、障害物判別部12が障害物の高さを誤判別する。
(2)高さ判別閾値Th10、又は、第一の高さ判別閾値Th11と第二の高さ判別閾値Th12がコンクリート路面上でチューニングされた場合、アスファルト路面上ではチューニング時よりも障害物で反射した反射波の反射レベルが小さくなる。そのため、障害物判別部12が障害物の高さを誤判別する。
(3)路面の表面粗さによる障害物反射波の反射レベル変化量は大きい。そのため、高さ判別閾値Th10、又は、第一の高さ判別閾値Th11と第二の高さ判別閾値Th12がアスファルト路面とコンクリート路面の両方を考慮してチューニングされた場合、障害物判別部12による高さ判別の精度が低く実用に耐えない。
(2)高さ判別閾値Th10、又は、第一の高さ判別閾値Th11と第二の高さ判別閾値Th12がコンクリート路面上でチューニングされた場合、アスファルト路面上ではチューニング時よりも障害物で反射した反射波の反射レベルが小さくなる。そのため、障害物判別部12が障害物の高さを誤判別する。
(3)路面の表面粗さによる障害物反射波の反射レベル変化量は大きい。そのため、高さ判別閾値Th10、又は、第一の高さ判別閾値Th11と第二の高さ判別閾値Th12がアスファルト路面とコンクリート路面の両方を考慮してチューニングされた場合、障害物判別部12による高さ判別の精度が低く実用に耐えない。
そこで、実施の形態1では、路面粗さ検知部13が路面の表面粗さを検知し、閾値補正部14が路面の表面粗さに応じて高さ判別閾値Th10、又は、第一の高さ判別閾値Th11と第二の高さ判別閾値Th12を補正する。
路面粗さ検知部13は、測距センサ2が受信した反射波の大きさに相関する特徴量と、予め定められた路面粗さ検知閾値とを比較し、車両周辺の路面の表面粗さを検知する。
路面粗さ検知部13は、路面の表面粗さを検知する準備として、まず、以下のようにして路面反射の大きさを検知する。
路面粗さ検知部13は、路面の表面粗さを検知する準備として、まず、以下のようにして路面反射の大きさを検知する。
図9は、実施の形態1の路面粗さ検知部13による路面反射の大きさを検知する方法を示すグラフである。グラフの横軸は測距センサ2から送信された探索波及び反射波の伝搬距離であり、縦軸は送受信部3から出力された受信信号の大きさ、すなわち反射レベルである。反射レベルは、反射波の大きさに相関する特徴量の1つである。第一の路面反射検知閾値Th21、第一の路面反射検知閾値Th21より小さい第二の路面反射検知閾値Th22、及び第二の路面反射検知閾値Th22より小さい第三の路面反射検知閾値Th23が、路面粗さ検知部13に予め定められている。なお、これらの路面反射検知閾値は、障害物検知閾値Th1より小さい。路面粗さ検知部13は、反射レベルが第一の路面反射検知閾値Th21を超えている波幅、面積、又は波高値を検知し、路面反射の大きさとする。同様に、路面粗さ検知部13は、反射レベルが第二の路面反射検知閾値Th22又は第三の路面反射検知閾値Th23を超えている波幅、面積、又は波高値を検知し、路面反射の大きさとする。なお、路面粗さ検知部13は、1個の測距センサ2が1回送受信した場合に得られる反射レベルに対して、第一の路面反射検知閾値Th21、第二の路面反射検知閾値Th22、及び第三の路面反射検知閾値Th23を段階的に変化させて路面反射の大きさを検知してもよい。または、路面粗さ検知部13は、3個の測距センサ2-1~2-3に対して第一の路面反射検知閾値Th21、第二の路面反射検知閾値Th22、及び第三の路面反射検知閾値Th23をそれぞれ割り当て、測距センサ2-1~2-3それぞれが送受信した場合に得られる各反射波の反射レベルを各測距センサに割り当てた路面反射検知閾値と比較して路面反射の大きさを検知してもよい。
図10は、実施の形態1の路面粗さ検知部13による路面反射の大きさを検知する方法の別の例を示す図であり、図10Aは測距センサ2-1,2-2の取り付け例を示す。ここでは、低い位置に取り付けられた測距センサ2-1が探索波71を送信する。この探索波71は路面で反射し、反射した一部の反射波72が測距センサ2-1で受信される。また、反射した一部の反射波73が、測距センサ2-1より高い位置に取り付けられた測距センサ2-2で受信される。図10Bは、測距センサ2-1が受信した反射波72の反射レベルのグラフ、図10Cは測距センサ2-2が受信した反射波73の反射レベルのグラフである。測距センサ2-1,2-2の正面の水平方向を入射角0度とすると、反射波72,73の入射角が大きいほど受信感度が悪い。そのため、図10Aのように測距センサ2-1と測距センサ2-2の車両における取り付け高さが異なる場合、測距センサ2-1よりも高い位置に取り付けられた測距センサ2-2のほうが反射波73の入射角が大きいので感度が悪い。そのため、路面粗さ検知部13が予め定められた路面反射検知閾値Th24と反射波72,73の反射レベルとを比較することにより、測距センサ2-1,2-2の感度の違いを利用して路面反射の大きさを検知することが可能である。図10の例では、路面粗さ検知部13は、2つの測距センサ2-1,2-2の反射レベルがいずれも路面反射検知閾値Th24以上である場合、路面反射が大きいと判定する。また、路面粗さ検知部13は、測距センサ2-1の反射レベルが路面反射検知閾値Th24以上かつ測距センサ2-2の反射レベルが路面反射検知閾値Th24より小さい場合、路面反射が中程度と判定する。また、路面粗さ検知部13は、2つの測距センサ2-1,2-2の反射レベルがいずれも路面反射検知閾値Th24より小さい場合、路面反射が小さいと判定する。図10B及び図10Cの場合、路面反射は中程度である。図10に示される方法の特徴は、路面反射検知閾値が1つでよいことである。
なお、路面粗さ検知部13は、図9及び図10に示される方法以外の方法によって、路面反射の大きさを検知してもよい。例えば、路面粗さ検知部13は、路面反射の大きさを検知する際、測距センサ2が探索波を送信するときの送信音圧又は測距センサ2が受信した反射波を受信信号に変換するときの受信ゲインを段階的に変化させるように送受信部3に指示する。そして、路面粗さ検知部13は、段階的に送信音圧を変化させた場合の、又は段階的に受信ゲインを変化させた場合の各反射レベルを路面反射検知閾値Th24と比較し、路面反射の大きさを推定する。
または、路面粗さ検知部13は、反射レベルの波形を積分して路面反射の波形面積を検知し、検知した波形面積の大きさに応じて路面反射の大きさを推定してもよい。
または、路面粗さ検知部13は、反射レベルの波形を周波数解析してパワースペクトルを算出し、算出したパワースペクトルの大きさに応じて路面反射の大きさを推定してもよい。
または、路面粗さ検知部13は、反射レベルの波形を周波数解析してパワースペクトルを算出し、算出したパワースペクトルの大きさに応じて路面反射の大きさを推定してもよい。
次に、路面粗さ検知部13は、検知した路面反射の大きさと予め定められた路面粗さ検知閾値とを比較し、路面の表面粗さを検知する。ここで、路面粗さ検知部13は、路面反射の大きさの瞬時値を用いてもよいし、平均値、分散値、及び中央値等の統計値を用いてもよい。路面反射の大きさを示す瞬時値、並びに、平均値、分散値及び中央値等の統計値は、測距センサ2が受信した反射波の大きさに相関する特徴値である。路面粗さ検知部13は、検知した路面の表面粗さを、閾値補正部14へ通知する。
図11は、実施の形態1の路面粗さ検知部13による路面粗さ検知方法を示すグラフである。図11の路面粗さ検知方法は、一次元の直線上で路面粗さを検知する例であり、第1特徴量は、路面反射の大きさの瞬時値、又は、平均値、分散値若しくは中央値等の統計値である。また、図11のグラフには、第1特徴量に応じた第一の路面粗さ検知閾値Th31と第二の路面粗さ検知閾値Th32とが、予め定められている。路面粗さ検知部13は、第一の路面粗さ検知閾値Th31より小さい範囲81に、検知した路面反射の大きさに相当する特徴量が含まれている場合、路面の表面粗さが滑らかと判定する。一方、路面粗さ検知部13は、第一の路面粗さ検知閾値Th31以上かつ第二の路面粗さ検知閾値Th32より小さい範囲82に、検知した路面反射の大きさに相当する特徴量が含まれている場合、路面の表面粗さが中程度と判定する。また、路面粗さ検知部13は、第二の路面粗さ検知閾値Th32以上である範囲83に、検知した路面反射の大きさに相当する特徴量が含まれている場合、路面の表面粗さが粗いと判定する。
図12は、実施の形態1の路面粗さ検知部13による路面粗さ検知方法の別の例を示すグラフである。図12の路面粗さ検知方法は、二次元特徴量空間上で路面粗さを検知する例であり、横軸は第1特徴量、縦軸は第2特徴量である。第1特徴量及び第2特徴量は、路面反射の大きさの瞬時値、平均値、分散値、又は中央値等のうちの任意の組み合わせである。例えば、第1特徴量は、複数の反射波から検知された路面反射の大きさの平均値であり、第2特徴量は、複数の反射波から検知された路面反射の大きさの分散値である。また、図12のグラフには、第1特徴量と第2特徴量との組み合わせに応じた第一の路面粗さ検知閾値Th33と第二の路面粗さ検知閾値Th34とが、予め定められている。路面粗さ検知部13は、第1特徴量及び第2特徴量が第一の路面粗さ検知閾値Th33より小さい範囲91に、検知した路面反射の大きさに相当する特徴量が含まれている場合、路面の表面粗さが滑らかと判定する。一方、路面粗さ検知部13は、第1特徴量及び第2特徴量が第一の路面粗さ検知閾値Th33以上かつ第二の路面粗さ検知閾値Th34より小さい範囲92に、検知した路面反射の大きさに相当する特徴量が含まれている場合、路面の表面粗さが中程度と判定する。また、路面粗さ検知部13は、第1特徴量及び第2特徴量が第二の路面粗さ検知閾値Th34以上である範囲93に、検知した路面反射の大きさに相当する特徴量が含まれている場合、路面の表面粗さが粗いと判定する。
なお、図11及び図12の路面粗さ検知方法では、路面粗さ検知部13は、値が異なる2個の路面粗さ検知閾値を用いて路面粗さを3段階に分類したが、これに限定されない。路面粗さ検知部13は、1個の路面粗さ検知閾値を用いて路面粗さを2段階に分類してもよいし、3個以上の路面粗さ検知閾値を用いて路面粗さを4段階以上に分類してもよい。
次に、閾値補正部14は、障害物判別部12に対して予め定められている高さ判別閾値を、路面粗さ検知部13により検知された路面の表面粗さに応じて補正する。このとき、閾値補正部14は、路面の表面粗さが粗い場合、滑らかな場合に比べて高さ判別閾値が小さくなるように補正量を決定する。
図13は、実施の形態1の閾値補正部14による高さ判別閾値の補正方法を示すグラフである。図13では、図3に示されたグラフの高さ判別閾値Th10を補正する例を示す。いま、障害物判別部12が、高さ判別閾値Th10を用いて、障害物の高さを判別しようとしている。この高さ判別閾値Th10は、滑らかな路面上でチューニングされた値であるものとする。このとき、路面粗さ検知部13において路面が粗いという検知結果が得られていたとすると、閾値補正部14は、高さ判別閾値Th10が小さくなるように補正する。障害物判別部12は、補正後の高さ判別閾値Th10aを用いて、粗い路面上の障害物の高さを判別する。これにより、特徴量31aをもつ障害物は、補正前は低い障害物と判別されるが、補正後は高い障害物と正しく判別される。
図13では、高さ判別閾値Th10が滑らかな路面上でチューニングされた値であるものと仮定したため、路面が粗いという検知結果に応じてこの高さ判別閾値Th10が小さくなるように補正された。一方、高さ判別閾値Th10が粗い路面上でチューニングされた値である場合、路面が滑らかであるという検知結果が得られたときにはこの高さ判別閾値Th10が大きくなるように補正される。
図14は、実施の形態1の閾値補正部14による特徴量の補正方法を示すグラフである。図13と同様に図14でも、路面粗さ検知部13において路面が粗いという検知結果が得られているものとする。そのため、閾値補正部14は、特徴量31aが大きくなるように補正することで、相対的に高さ判別閾値Th10を小さくする。障害物判別部12は、高さ判別閾値Th10と補正後の特徴量31bとを比較して、粗い路面上の障害物の高さを判別する。図13の例では高さ判別閾値Th10を補正したが、この図14の例のように反射波の大きさに相関する特徴量31aを補正することでも、図13の例と同様の効果が得られる。
図15は、実施の形態1の閾値補正部14による高さ判別閾値の補正方法の別の例を示すグラフである。図15では、図4に示されたグラフの第一の高さ判別閾値Th11と第二の高さ判別閾値Th12とを補正する例を示す。閾値補正部14は、高さ判別閾値が複数ある場合も図13と同様に、路面の表面粗さが粗い場合、滑らかな場合に比べて第一の高さ判別閾値Th11と第二の高さ判別閾値Th12とを小さくする。障害物判別部12は、補正後の第一の高さ判別閾値Th11aと補正後の第二の高さ判別閾値Th12aとを用いて、粗い路面上の障害物の高さを判別する。なお、低い障害物で反射する反射波は路面の表面粗さの影響を受けにくく、高い障害物で反射する反射波は路面の表面粗さの影響を受けやすい。そのため、低い障害物である路面障害物と路上障害物とを判別するための第一の高さ判別閾値Th11の補正量より、高い障害物である路上障害物と走行障害物とを判別するための第二の高さ判別閾値Th12の補正量を大きくすることが好ましい。これにより、高さ判別の精度がより向上する。
図15において、閾値補正部14は、図14と同様に路面の表面粗さに応じて特徴量を補正してもよい。
なお、図13、図14及び図15では、閾値補正部14が路面の表面粗さに応じて高さ判別閾値又は特徴量のいずれか一方を補正するようにしたが、障害物判別部12が路面の表面粗さを特徴量の1つとして一次元追加した特徴量空間内で高さ判別を行ってもよい。図16は、実施の形態1の障害物判別部12による路面粗さを考慮した障害物判別方法を示すグラフである。図16では、図4に示された第1特徴量と第2特徴量の二次元特量空間に対して、路面の表面粗さである第3特徴量が追加されている。また、図16の三次元特徴量空間に対して、面状の高さ判別閾値Th10bが予め定められている。この高さ判別閾値Th10bは、三次元特徴量空間を低い障害物に対応する空間(特徴量31aが含まれる範囲)と高い障害物に対応する空間(特徴量32aが含まれる範囲)とに分割する。障害物判別部12は、障害物検知部11により検知された特徴量と路面粗さ検知部13により検知された路面の表面粗さとに基づいて、図16の三次元特徴量空間上に障害物がもつ特徴量をプロットし、プロットした特徴量と高さ判別閾値Th10bとを比較して障害物の高さを判別する。この場合、閾値補正部14による補正処理が不要となる。なお、図16では三次元特徴量空間に1つの高さ判別閾値が定められている例を示したが、複数の高さ判別閾値が定められていてもよい。
次に、路面粗さの検知タイミングについて説明する。図17は、実施の形態1に係る障害物検知装置1の障害物検知動作と路面粗さ検知動作との状態遷移例を示す図である。図17に示されるように、路面粗さの検知は、障害物検知が実施されていない期間に行われることが望ましい。より具体的には、路面粗さの検知が、測距センサ2を用いた車両の周辺監視機能が実施されていない期間、又は車両の周辺に障害物が検知されていない期間等に実施されることで、周辺監視機能を利用した運転支援動作が妨げられないようにする。なお、路面粗さの検知タイミングは、車両が停車又は低速走行している期間が望ましいが、通常走行している期間であってもよい。以下、路面粗さの検知タイミングの具体例を図18~図25に示す。
(1)車両発進時
図18は、実施の形態1における車両発進時の周辺環境例を示す俯瞰図である。この例では、車両100の前側に4個の測距センサ2-1~2-4が取り付けられており、車両の後ろ側にも4個の測距センサ2-5~2-8が取り付けられている。各測距センサ2-1~2-8は、測域101~108をもつ。また、車両100の周辺に駐車車両111,112,113、及び輪留め114,115が存在する。
図18は、実施の形態1における車両発進時の周辺環境例を示す俯瞰図である。この例では、車両100の前側に4個の測距センサ2-1~2-4が取り付けられており、車両の後ろ側にも4個の測距センサ2-5~2-8が取り付けられている。各測距センサ2-1~2-8は、測域101~108をもつ。また、車両100の周辺に駐車車両111,112,113、及び輪留め114,115が存在する。
図19は、実施の形態1に係る障害物検知装置1の車両発進時の動作例を示すフローチャートである。障害物検知装置1は、図19のフローチャートに示される動作を行っている間、CAN(Controller Area Network)等を通じて車両情報を取得しているものとする。車両情報には、イグニッションスイッチのオンオフを示す情報、及びシフトポジションを示す情報等が含まれる。
障害物検知装置1は、車両100のイグニッションスイッチがオンになった場合(ステップST1)、測距センサ2-1~2-8による測距開始を送受信部3に指示する(ステップST2)。そして、障害物検知部11は、測距センサ2-1~2-8が受信した反射波の大きさに相関する特徴量を用いて、車両100の周辺の障害物の有無を検知する。図18の例では、測距センサ2-1,2-5により駐車車両111が検知され、測距センサ2-6,2-7により輪留め115が検知され、測距センサ2-8により輪留め114が検知される。
路面粗さ検知部13は、車両100のシフトポジションがパーキング(P)である場合(ステップST3“YES”)、障害物を検知していない測距センサ2(以下、「障害物非検知センサ」と称する)があるか否かを判定する(ステップST4)。このステップST4において、路面粗さ検知部13は、障害物検知部11による障害物の検知の有無に従い、測距センサ2-2,2-3,2-4を障害物非検知センサと判定する。路面粗さ検知部13は、障害物非検知センサが存在する場合(ステップST4“YES”)、障害物非検知センサである測距センサ2-2,2-3,2-4による測距を送受信部3に指示する(ステップST5)。そして、路面粗さ検知部13は、障害物非検知センサである測距センサ2-2,2-3,2-4が受信した反射波の大きさに相関する特徴量を用いて、路面の表面粗さを検知する(ステップST6)。
閾値補正部14は、路面粗さ検知部13により検知された路面の表面粗さに応じて、障害物判別部12の高さ判別閾値を補正する(ステップST7)。その後、障害物判別部12は、補正後の高さ判別閾値を用いて、障害物検知部11が検知した障害物の高さを判別する。
これに対し、シフトポジションがパーキング(P)でない場合(ステップST3“NO”)、又は障害物非検知センサがない場合(ステップST4“NO”)、閾値補正部14は、障害物判別部12の高さ判別閾値を補正しない。その後、障害物判別部12は、予め定められた、補正前の高さ判別閾値を用いて、障害物検知部11が検知した障害物の高さを判別する。
これに対し、シフトポジションがパーキング(P)でない場合(ステップST3“NO”)、又は障害物非検知センサがない場合(ステップST4“NO”)、閾値補正部14は、障害物判別部12の高さ判別閾値を補正しない。その後、障害物判別部12は、予め定められた、補正前の高さ判別閾値を用いて、障害物検知部11が検知した障害物の高さを判別する。
なお、図19のフローチャートでは、障害物検知装置1は、シフトポジションがパーキングである場合に路面粗さを検知するが、車両100の周辺に障害物が検知されていない場合にはシフトポジションがパーキングでなくとも路面粗さを検知してもよい。
(2)車両前進走行時
図20は、実施の形態1における車両前進走行時の周辺環境例を示す俯瞰図である。この例では、車両100が矢印方向に前進走行している。この車両100の左側に路上駐車車両116,117と縁石118が存在する。また、車両100の右側の対向車線には走行車両119が存在する。
図20は、実施の形態1における車両前進走行時の周辺環境例を示す俯瞰図である。この例では、車両100が矢印方向に前進走行している。この車両100の左側に路上駐車車両116,117と縁石118が存在する。また、車両100の右側の対向車線には走行車両119が存在する。
図21は、実施の形態1に係る障害物検知装置1の車両前進走行時の動作例を示すフローチャートである。障害物検知装置1は、図21のフローチャートに示される動作を行っている間、CAN等を通じて車両情報を取得しているものとする。車両情報には、シフトポジションを示す情報等が含まれる。
障害物検知装置1は、測距センサ2-1~2-8による測距開始を送受信部3に指示する(ステップST11)。そして、障害物検知部11は、測距センサ2-1~2-8が受信した反射波の大きさに相関する特徴量を用いて、車両100の周辺の障害物の有無を検知する。図20の例では、測距センサ2-1,2-5により路上駐車車両117が検知され、測距センサ2-4により走行車両119が検知される。
路面粗さ検知部13は、車両100のシフトポジションがドライブ(D)である場合(ステップST12“YES”)、周辺監視機能に使用されていない測距センサ2(以下、「機能上仕事のないセンサ」と称する)があるか否かを判定する(ステップST13)。車両100は、前進走行している場合、周辺監視機能として、例えば、前方監視、巻き込み防止、及び追い越し車両監視機能を実施する。そのため、車両100の後ろ側に取り付けられた測距センサ2-6,2-7は周辺監視機能に使用されない。したがって、ステップST13において、路面粗さ検知部13は、測距センサ2-6,2-7を機能上仕事のないセンサと判定する。
路面粗さ検知部13は、機能上仕事のないセンサが存在する場合(ステップST13“YES”)、機能上仕事のないセンサが障害物非検出センサであるか否かを判定する(ステップST14)。このステップST14において、路面粗さ検知部13は、障害物検知部11による障害物の検知の有無に従い、測距センサ2-6,2-7を機能上仕事のないセンサ、かつ、障害物非検出センサと判定する。路面粗さ検知部13は、機能上仕事のないセンサ、かつ、障害物非検出センサが存在する場合(ステップST14“YES”)、機能上仕事のないセンサ、かつ、障害物非検出センサである測距センサ2-6,2-7による測距を送受信部3に指示する(ステップST15)。そして、路面粗さ検知部13は、機能上仕事のないセンサ、かつ、障害物非検出センサである測距センサ2-6,2-7が受信した反射波の大きさに相関する特徴量を用いて、路面の表面粗さを検知する(ステップST16)。
閾値補正部14は、路面粗さ検知部13により検知された路面の表面粗さに応じて、障害物判別部12の高さ判別閾値を補正する(ステップST17)。これに対し、シフトポジションがドライブ(D)でない場合(ステップST12“NO”)、機能上仕事のないセンサがない場合(ステップST13“NO”)、又は障害物非検知センサがない場合(ステップST14“NO”)、閾値補正部14は、障害物判別部12の高さ判別閾値を補正しない。
(3)自動駐車モード時
図22は、実施の形態1における自動駐車モード時の周辺環境例を示す俯瞰図である。この例における車両100は、駐車を自動で行う自動駐車モード中に矢印方向に前進走行しながら、路上駐車車両116と路上駐車車両117とに挟まれた駐車スロット120を、測距センサ2を用いて検知しようとしている。
図22は、実施の形態1における自動駐車モード時の周辺環境例を示す俯瞰図である。この例における車両100は、駐車を自動で行う自動駐車モード中に矢印方向に前進走行しながら、路上駐車車両116と路上駐車車両117とに挟まれた駐車スロット120を、測距センサ2を用いて検知しようとしている。
図23は、実施の形態1に係る障害物検知装置1の自動駐車モード時の動作例を示すフローチャートである。障害物検知装置1は、図23に示される動作を行っている間、CAN等を通じて車両情報を取得しているものとする。車両情報には、自動運転モードであるか否かを示す情報等が含まれる。
障害物検知装置1は、測距センサ2-1~2-8による測距開始を送受信部3に指示する(ステップST21)。そして、障害物検知部11は、測距センサ2-1~2-8が受信した反射波の大きさに相関する特徴量を用いて、車両100の周辺の障害物の有無を検知する。図22の例では、測距センサ2-1,2-5により路上駐車車両117が検知され、測距センサ2-4により走行車両119が検知される。
路面粗さ検知部13は、車両100が自動駐車モードである場合(ステップST22“YES”)、周辺監視機能に使用されていない、機能上仕事のないセンサがあるか否かを判定する(ステップST23)。車両100は、自動駐車モードである場合、周辺監視機能として、例えば、前方監視、巻き込み防止、及び追い越し車両監視機能を実施する。そのため、車両100の後ろ側に取り付けられた測距センサ2-6,2-7は周辺監視機能に使用されない。したがって、ステップST23において、路面粗さ検知部13は、測距センサ2-6,2-7を機能上仕事のないセンサと判定する。
路面粗さ検知部13は、機能上仕事のないセンサが存在する場合(ステップST23“YES”)、機能上仕事のないセンサが障害物非検出センサであるか否かを判定する(ステップST24)。このステップST24において、路面粗さ検知部13は、障害物検知部11による障害物の検知の有無に従い、測距センサ2-6,2-7を機能上仕事のないセンサ、かつ、障害物非検出センサと判定する。
ステップST25~ST27の動作は、図21のステップST15~ST17の動作と略同じであるため、説明を省略する。
(4)車両後退走行時
図24は、実施の形態1に係る障害物検知装置1の車両後退走行時の周辺環境例を示す俯瞰図である。この例では、車両100が、矢印方向へ後退走行しながら、輪留め126のある駐車スロットに駐車しようとしている。なお、車両100の周辺には、駐車車両121,122,123,124、及び輪留め125,126,127,128が存在する。
図24は、実施の形態1に係る障害物検知装置1の車両後退走行時の周辺環境例を示す俯瞰図である。この例では、車両100が、矢印方向へ後退走行しながら、輪留め126のある駐車スロットに駐車しようとしている。なお、車両100の周辺には、駐車車両121,122,123,124、及び輪留め125,126,127,128が存在する。
図25は、実施の形態1に係る障害物検知装置1の車両後走行時の動作例を示すフローチャートである。障害物検知装置1は、図25に示される動作を行っている間、CAN等を通じて車両情報を取得しているものとする。車両情報には、シフトポジションを示す情報等が含まれる。
障害物検知装置1は、測距センサ2-1~2-8による測距開始を送受信部3に指示する(ステップST31)。そして、障害物検知部11は、測距センサ2-1~2-8が受信した反射波の大きさに相関する特徴量を用いて、車両100の周辺の障害物の有無を検知する。図24の例では、測距センサ2-5により駐車車両121が検知される。
路面粗さ検知部13は、車両100のシフトポジションがリバース(R)である場合(ステップST32“YES”)、周辺監視機能に使用されていない、機能上仕事のないセンサがあるか否かを判定する(ステップST33)。車両100は、後退走行している場合、周辺監視機能として、例えば、後方監視、巻き込み防止、及び追い越し車両監視機能を実施する。そのため、車両100の前側に取り付けられた測距センサ2-2,2-3は周辺監視機能に使用されない。したがって、ステップST33において、路面粗さ検知部13は、測距センサ2-2,2-3を機能上仕事のないセンサと判定する。
路面粗さ検知部13は、機能上仕事のないセンサが存在する場合(ステップST33“YES”)、機能上仕事のないセンサが障害物非検出センサであるか否かを判定する(ステップST34)。このステップST34において、路面粗さ検知部13は、障害物検知部11による障害物の検知の有無に従い、測距センサ2-2,2-3を機能上仕事のないセンサ、かつ、障害物非検出センサと判定する。
ステップST35~ST37の動作は、図21のステップST15~ST17の動作と略同じであるため、説明を省略する。
なお、図19、図21、図23、及び図25のフローチャートにおいて、路面粗さ検知部13は、障害物を検知していない測距センサ2を用いて路面粗さを検知するが、障害物を検知している測距センサ2を用いて路面粗さを検知してもよい。例えば、路面粗さ検知部13は、車両100に設けられている測距センサ2-1~2-Nのうち、予め定められた距離(例えば、1m)より離れた距離にある障害物を検知している測距センサ2を特定する。そして、路面粗さ検知部13は、特定した測距センサ2が受信した反射波の大きさに相関する特徴量のうち、上記予め定められた距離以内に相当する特徴量を用いて、路面の表面粗さを検知する。
図26は、実施の形態1の路面粗さ検知部13が、障害物を検知している測距センサ2を用いて路面粗さを検知する方法を示すグラフである。図26のグラフにおいて、障害物検知部11は、測距センサ2が受信した反射波の反射レベルを用いて、障害物反射波130の部位に障害物を検知したとする。路面粗さ検知部13は、検知された障害物の距離が予め定められた距離より離れた距離である場合、この予め定められた距離以内に相当する伝搬距離を、路面粗さ検知範囲131に設定する。そして、路面粗さ検知部13は、路面粗さ検知範囲131に含まれる路面反射波132の反射レベルを用いて、路面反射の大きさを検知すると共に路面の表面粗さを検知する。
最後に、実施の形態1に係る障害物検知装置1のハードウェア構成を説明する。図27A及び図27Bは、実施の形態1に係る障害物検知装置1のハードウェア構成例を示す図である。障害物検知装置1における障害物検知部11、障害物判別部12、路面粗さ検知部13、及び閾値補正部14の機能は、処理回路により実現される。即ち、障害物検知装置1は、上記機能を実現するための処理回路を備える。処理回路は、専用のハードウェアとしての処理回路200であってもよいし、メモリ202に格納されるプログラムを実行するプロセッサ201であってもよい。
図27Aに示されるように、処理回路が専用のハードウェアである場合、処理回路200は、例えば、単一回路、複合回路、プログラム化したプロセッサ、並列プログラム化したプロセッサ、ASIC(Application Specific Integrated Circuit)、FPGA(Field Programmable Gate Array)、又はこれらを組み合わせたものが該当する。障害物検知部11、障害物判別部12、路面粗さ検知部13、及び閾値補正部14の機能を複数の処理回路200で実現してもよいし、各部の機能をまとめて1つの処理回路200で実現してもよい。
図27Bに示されるように、処理回路がプロセッサ201である場合、障害物検知部11、障害物判別部12、路面粗さ検知部13、及び閾値補正部14の機能は、ソフトウェア、ファームウェア、又はソフトウェアとファームウェアとの組み合わせにより実現される。ソフトウェア又はファームウェアはプログラムとして記述され、メモリ202に格納される。プロセッサ201は、メモリ202に格納されたプログラムを読みだして実行することにより、各部の機能を実現する。即ち、障害物検知装置1は、プロセッサ201により実行されるときに、図19等のフローチャートで示されるステップが結果的に実行されることになるプログラムを格納するためのメモリ202を備える。また、このプログラムは、障害物検知部11、障害物判別部12、路面粗さ検知部13、及び閾値補正部14の手順又は方法をコンピュータに実行させるものであるとも言える。
ここで、プロセッサ201とは、CPU(Central Processing Unit)、処理装置、演算装置、又はマイクロプロセッサ等のことである。
メモリ202は、RAM(Random Access Memory)、ROM(Read Only Memory)、EPROM(Erasable Programmable ROM)、又はフラッシュメモリ等の不揮発性もしくは揮発性の半導体メモリであってもよいし、ハードディスク又はフレキシブルディスク等の磁気ディスクであってもよいし、CD(Compact Disc)又はDVD(Digital Versatile Disc)等の光ディスクであってもよい。
障害物検知閾値、高さ判別閾値、路面反射検知閾値、路面粗さ検知閾値、及び路面粗さに応じた高さ判別閾値の補正量等は、メモリ202に格納される。
メモリ202は、RAM(Random Access Memory)、ROM(Read Only Memory)、EPROM(Erasable Programmable ROM)、又はフラッシュメモリ等の不揮発性もしくは揮発性の半導体メモリであってもよいし、ハードディスク又はフレキシブルディスク等の磁気ディスクであってもよいし、CD(Compact Disc)又はDVD(Digital Versatile Disc)等の光ディスクであってもよい。
障害物検知閾値、高さ判別閾値、路面反射検知閾値、路面粗さ検知閾値、及び路面粗さに応じた高さ判別閾値の補正量等は、メモリ202に格納される。
なお、障害物検知部11、障害物判別部12、路面粗さ検知部13、及び閾値補正部14の機能について、一部を専用のハードウェアで実現し、一部をソフトウェア又はファームウェアで実現するようにしてもよい。このように、障害物検知部11、障害物判別部12、路面粗さ検知部13、及び閾値補正部14における処理回路は、ハードウェア、ソフトウェア、ファームウェア、又はこれらの組み合わせによって、上述の機能を実現することができる。
以上のように、実施の形態1に係る障害物検知装置1は、障害物検知部11と、障害物判別部12と、路面粗さ検知部13と、閾値補正部14とを備える。障害物検知部11は、車両に設けられている測距センサ2が受信した反射波の大きさに相関する特徴量を用いて、車両の周辺における障害物の有無を検知する。障害物判別部12は、特徴量と高さ判別閾値Th10とを比較して障害物検知部11により検知された障害物の高さを判別する。路面粗さ検知部13は、特徴量を用いて、車両の周辺の路面粗さを検知する。閾値補正部14は、路面粗さ検知部13により検知された路面粗さが粗い場合、滑らかな場合に比べて高さ判別閾値Th10を小さくする。このように、障害物検知装置1は、特徴量と高さ判別閾値Th10とを比較して障害物の高さを判別するので、車両が障害物に接近せずとも障害物の高さを判別できる。また、障害物検知装置1は、路面状態に応じて高さ判別閾値Th10を最適化するので、障害物の高さを精度よく判別できる。
また、障害物検知装置1は、車両が障害物に接近せずとも障害物の高さを判別できるので、図20及び図22のように車両が障害物と平行な方向に走行する場合に、精度よく障害物の高さを判別できる。また、障害物検知装置1は、複数の測距センサ2を用いる以外にも、単一の測距センサ2で異なる時間に探索波を送受信した結果を用いても、障害物の高さを判別できる。
さらに、障害物検知装置1は、図22のように駐車スロットの奥に存在する障害物が、壁か縁石か段差かを判別できる。駐車スロットの奥に存在する障害物が車両のバンパよりも高いか低いかを判別できると、自動駐車モードにおいて車両の誘導経路の最適化及び駐車位置の最適化が可能となる。その結果、車両は、バンパに衝突しない低い障害物に対する不必要な警告又はブレーキを抑圧でき、また、当該低い障害物に対して車両を適切なクリアランスで駐車して乗員の乗り降りを容易にできるため、乗員の利便性が向上する。
また、障害物検知装置1は、図22のように自動駐車モードにおいて駐車スロットを検知する際、2段の高さを有する縁石で仕切られた駐車スロットが存在していたとしてもその縁石の高さを正しく検知でき、結果として駐車スロットを正しく検知できる。
さらに、障害物検知装置1は、図22のように駐車スロットの奥に存在する障害物が、壁か縁石か段差かを判別できる。駐車スロットの奥に存在する障害物が車両のバンパよりも高いか低いかを判別できると、自動駐車モードにおいて車両の誘導経路の最適化及び駐車位置の最適化が可能となる。その結果、車両は、バンパに衝突しない低い障害物に対する不必要な警告又はブレーキを抑圧でき、また、当該低い障害物に対して車両を適切なクリアランスで駐車して乗員の乗り降りを容易にできるため、乗員の利便性が向上する。
また、障害物検知装置1は、図22のように自動駐車モードにおいて駐車スロットを検知する際、2段の高さを有する縁石で仕切られた駐車スロットが存在していたとしてもその縁石の高さを正しく検知でき、結果として駐車スロットを正しく検知できる。
また、障害物検知装置1は、車両が障害物に接近せずとも障害物の高さを判別できるので、特許文献1に係る物体検知装置のような従来のものよりも遠方から障害物の高さを判別できる。そのため、車両は、自動運転をより高速化及び最適化して衝突回避でき、よって乗員の利便性が向上する。
また、障害物検知装置1が複数の測距センサ2を用いる場合、測距センサ2を車両に取り付ける高さの制約がないため、デザイン性及び設計容易性が向上する。
また、実施の形態1の障害物判別部12は、特徴量と第一の高さ判別閾値Th11とを比較して障害物が路面障害物か路上障害物かを判別すると共に、特徴量と第一の高さ判別閾値Th11より大きい第二の高さ判別閾値Th12とを比較して障害物が路上障害物か走行障害物かを判別する構成であってもよい。
この場合、閾値補正部14は、路面粗さが粗い場合、滑らかな場合に比べて第一の高さ判別閾値Th11又は第二の高さ判別閾値Th12の少なくとも一方を小さくする。この構成により、障害物検知装置1は、路面障害物、路上障害物、及び走行障害物を精度よく判別できる。
また、閾値補正部14は、第一の高さ判別閾値Th11の補正量よりも第二の高さ判別閾値Th12の補正量を大きくすることにより、路面障害物、路上障害物、及び走行障害物をより精度よく判別できる。
この場合、閾値補正部14は、路面粗さが粗い場合、滑らかな場合に比べて第一の高さ判別閾値Th11又は第二の高さ判別閾値Th12の少なくとも一方を小さくする。この構成により、障害物検知装置1は、路面障害物、路上障害物、及び走行障害物を精度よく判別できる。
また、閾値補正部14は、第一の高さ判別閾値Th11の補正量よりも第二の高さ判別閾値Th12の補正量を大きくすることにより、路面障害物、路上障害物、及び走行障害物をより精度よく判別できる。
また、実施の形態1の路面粗さ検知部13は、車両に設けられている測距センサ2-1~2-Nのうち、障害物を検知しておらず、かつ、車両の周辺監視に使用されていない測距センサ2を特定し、特定した測距センサ2が受信した反射波の大きさに相関する特徴量と1つ以上の路面粗さ検知閾値とを比較して路面粗さを2段階以上に分類する。この構成により、障害物検知装置1は、周辺監視機能を利用する運転支援動作等を妨げることなく、路面粗さを検知して高さ判別閾値を補正できる。
また、実施の形態1の路面粗さ検知部13は、車両に設けられている測距センサ2-1~2-Nのうち、予め定められた距離より離れた距離にある障害物を検知している測距センサ2を特定し、特定した測距センサ2が受信した反射波の大きさに相関する特徴量のうちの上記予め定められた距離以内に相当する特徴量と1つ以上の路面粗さ検知閾値とを比較して路面粗さを2段階以上に分類する。この構成により、障害物検知装置1は、周辺監視機能を利用する運転支援動作等を妨げることなく、障害物検知と路面粗さ検知とを同時に実施できる。
なお、本発明はその発明の範囲内において、実施の形態の任意の構成要素の変形、又は実施の形態の任意の構成要素の省略が可能である。
この発明に係る障害物検知装置は、例えば、周辺監視、衝突回避、又は駐車支援に係る制御に応用することができる。
1 障害物検知装置、2,2-1~2-8,2-N 測距センサ、3 送受信部、11 障害物検知部、12 障害物判別部、13 路面粗さ検知部、14 閾値補正部、31,32,41,42,43,81,82,83,91,92,93 範囲、31a,31b,32a,41a,42a,43a 特徴量、51,61 路面、52,62,71 探索波、53,63,72,73 反射波、54,64,132 路面反射波、55,65 障害物、56,66,130 障害物反射波、100 車両、101~108 測域、111,112,113,121,122,123,124 駐車車両、114,115,125,126,127,128 輪留め、116,117 路上駐車車両、118 縁石、119 走行車両、120 駐車スロット、131 路面粗さ検知範囲、200 処理回路、201 プロセッサ、202 メモリ、Th1 障害物検知閾値、Th10,Th10a,Th10b 高さ判別閾値、Th11,Th11a 第一の高さ判別閾値、Th12,Th12a 第二の高さ判別閾値、Th21 第一の路面反射検知閾値、Th22 第二の路面反射検知閾値、Th23 第三の路面反射検知閾値
Th24 路面反射検知閾値、Th31,Th33 第一の路面粗さ検知閾値、Th32,Th34 第二の路面粗さ検知閾値。
Th24 路面反射検知閾値、Th31,Th33 第一の路面粗さ検知閾値、Th32,Th34 第二の路面粗さ検知閾値。
Claims (6)
- 車両に設けられている測距センサが受信した反射波の大きさに相関する特徴量を用いて前記車両の周辺における障害物の有無を検知する障害物検知部と、
前記特徴量と高さ判別閾値とを比較して前記障害物検知部により検知された前記障害物の高さを判別する障害物判別部と、
前記特徴量を用いて前記車両の周辺の路面粗さを検知する路面粗さ検知部と、
前記路面粗さ検知部により検知された前記路面粗さが粗い場合、滑らかな場合に比べて前記高さ判別閾値を小さくする閾値補正部とを備える障害物検知装置。 - 前記障害物判別部は、前記特徴量と第一の高さ判別閾値とを比較して前記障害物が路面障害物か路上障害物かを判別すると共に、前記特徴量と前記第一の高さ判別閾値より大きい第二の高さ判別閾値とを比較して前記障害物が前記路上障害物か走行障害物かを判別し、
前記閾値補正部は、前記路面粗さが粗い場合、滑らかな場合に比べて前記第一の高さ判別閾値又は前記第二の高さ判別閾値の少なくとも一方を小さくすることを特徴とする請求項1記載の障害物検知装置。 - 前記閾値補正部は、前記第一の高さ判別閾値及び前記第二の高さ判別閾値の双方を補正する場合、前記第一の高さ判別閾値の補正量よりも前記第二の高さ判別閾値の補正量を大きくすることを特徴とする請求項2記載の障害物検知装置。
- 前記路面粗さ検知部は、前記車両に設けられている前記測距センサのうち、前記障害物を検知しておらず、かつ、前記車両の周辺監視に使用されていない測距センサを特定し、特定した前記測距センサが受信した反射波の大きさに相関する特徴量と1つ以上の路面粗さ検知閾値とを比較して前記路面粗さを2段階以上に分類することを特徴とする請求項1記載の障害物検知装置。
- 前記路面粗さ検知部は、前記車両に設けられている前記測距センサのうち、予め定められた距離より離れた距離にある前記障害物を検知している測距センサを特定し、特定した前記測距センサが受信した反射波の大きさに相関する特徴量のうちの前記予め定められた距離以内に相当する特徴量と1つ以上の路面粗さ検知閾値とを比較して前記路面粗さを2段階以上に分類することを特徴とする請求項1記載の障害物検知装置。
- 前記路面粗さ検知部は、前記車両が自動駐車モードである場合、又は前記車両のシフトポジションがパーキング、ドライブ、若しくはリバースである場合、前記路面粗さを検知することを特徴とする請求項1記載の障害物検知装置。
Priority Applications (2)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
PCT/JP2018/043152 WO2020105166A1 (ja) | 2018-11-22 | 2018-11-22 | 障害物検知装置 |
JP2020551594A JP6811913B2 (ja) | 2018-11-22 | 2018-11-22 | 障害物検知装置 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
PCT/JP2018/043152 WO2020105166A1 (ja) | 2018-11-22 | 2018-11-22 | 障害物検知装置 |
Publications (1)
Publication Number | Publication Date |
---|---|
WO2020105166A1 true WO2020105166A1 (ja) | 2020-05-28 |
Family
ID=70773117
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
PCT/JP2018/043152 WO2020105166A1 (ja) | 2018-11-22 | 2018-11-22 | 障害物検知装置 |
Country Status (2)
Country | Link |
---|---|
JP (1) | JP6811913B2 (ja) |
WO (1) | WO2020105166A1 (ja) |
Cited By (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US20220089148A1 (en) * | 2020-09-18 | 2022-03-24 | Hyundai Mobis Co., Ltd. | Parking control apparatus and parking control method |
WO2023032523A1 (ja) * | 2021-09-06 | 2023-03-09 | ローム株式会社 | 音波処理装置、および超音波システム |
US20240092322A1 (en) * | 2022-09-18 | 2024-03-21 | Honda Motor Co., Ltd. | Control device for automatic stop of vehicle |
Citations (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JPH068488Y2 (ja) * | 1988-08-31 | 1994-03-02 | 三菱自動車工業株式会社 | 路面状態検出装置 |
JPH095449A (ja) * | 1995-06-20 | 1997-01-10 | Sumitomo Electric Ind Ltd | 路面状態検出装置及び車両用制御手段 |
JP2014074665A (ja) * | 2012-10-04 | 2014-04-24 | Nippon Soken Inc | 物体検知装置 |
JP2018072105A (ja) * | 2016-10-27 | 2018-05-10 | 株式会社Soken | 物体検知装置 |
Family Cites Families (10)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JPH02293611A (ja) * | 1989-05-09 | 1990-12-04 | Nissan Motor Co Ltd | 路面状態検出装置 |
JP5893869B2 (ja) * | 2011-08-18 | 2016-03-23 | 三菱重工業株式会社 | 計測装置、計測方法、及びプログラム |
JP2013061690A (ja) * | 2011-09-10 | 2013-04-04 | Denso Corp | 車両用障害物検出システム |
JP6040096B2 (ja) * | 2013-05-20 | 2016-12-07 | 国立大学法人 東京大学 | 路面状態推定装置 |
JP2015014579A (ja) * | 2013-07-08 | 2015-01-22 | 本田技研工業株式会社 | 物体検知装置 |
JP6252549B2 (ja) * | 2015-05-29 | 2017-12-27 | 株式会社デンソー | 物体検出装置 |
JP2017215195A (ja) * | 2016-05-31 | 2017-12-07 | 富士通テン株式会社 | レーダ装置及びターゲット検出方法 |
JP2018077178A (ja) * | 2016-11-11 | 2018-05-17 | 株式会社デンソー | 測距装置 |
JP2018173282A (ja) * | 2017-03-31 | 2018-11-08 | パナソニックIpマネジメント株式会社 | 障害物検知装置 |
JP6415642B1 (ja) * | 2017-06-12 | 2018-10-31 | 三菱電機株式会社 | 衝突回避装置 |
-
2018
- 2018-11-22 JP JP2020551594A patent/JP6811913B2/ja active Active
- 2018-11-22 WO PCT/JP2018/043152 patent/WO2020105166A1/ja active Application Filing
Patent Citations (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JPH068488Y2 (ja) * | 1988-08-31 | 1994-03-02 | 三菱自動車工業株式会社 | 路面状態検出装置 |
JPH095449A (ja) * | 1995-06-20 | 1997-01-10 | Sumitomo Electric Ind Ltd | 路面状態検出装置及び車両用制御手段 |
JP2014074665A (ja) * | 2012-10-04 | 2014-04-24 | Nippon Soken Inc | 物体検知装置 |
JP2018072105A (ja) * | 2016-10-27 | 2018-05-10 | 株式会社Soken | 物体検知装置 |
Cited By (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US20220089148A1 (en) * | 2020-09-18 | 2022-03-24 | Hyundai Mobis Co., Ltd. | Parking control apparatus and parking control method |
US11801831B2 (en) * | 2020-09-18 | 2023-10-31 | Hyundai Mobis Co., Ltd. | Parking control apparatus and parking control method |
WO2023032523A1 (ja) * | 2021-09-06 | 2023-03-09 | ローム株式会社 | 音波処理装置、および超音波システム |
US20240092322A1 (en) * | 2022-09-18 | 2024-03-21 | Honda Motor Co., Ltd. | Control device for automatic stop of vehicle |
Also Published As
Publication number | Publication date |
---|---|
JPWO2020105166A1 (ja) | 2021-02-15 |
JP6811913B2 (ja) | 2021-01-13 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
US9903942B2 (en) | Obstacle detection device | |
US10656269B2 (en) | Adjacent vehicle detection device | |
US10302760B2 (en) | Vehicle water detection system | |
WO2020105166A1 (ja) | 障害物検知装置 | |
US20100302069A1 (en) | Object classification method, parking assistance method, and parking assistance system | |
US20170299717A1 (en) | Method for detecting at least one object in a surrounding area of a motor vehicle, driver assistance system and motor vehicle | |
JP3119142B2 (ja) | 車載レーダ装置 | |
WO2016081488A1 (en) | Lane assistance system responsive to extremely fast approaching vehicles | |
JP7122101B2 (ja) | 車両用障害物検知装置 | |
JP2007504543A (ja) | 自動車において障害物までの距離を検出する装置及び方法 | |
CN111679281B (zh) | 一种提高超声波传感器探测性能的方法 | |
JP6613223B2 (ja) | 走行制御装置 | |
JP2023064009A (ja) | 車両制御装置、車両、車両制御方法および車両制御プログラム | |
JP6599075B2 (ja) | 障害物検出装置 | |
JP7127969B2 (ja) | レーダ装置及び信号処理方法 | |
CN111016885B (zh) | 自动泊车车位探测方法、电子雷达系统以及存储介质 | |
JP3475745B2 (ja) | 車間距離警報装置 | |
JP7199436B2 (ja) | 障害物検知装置及び運転支援装置 | |
WO2020008536A1 (ja) | 障害物検知装置 | |
JP7195447B2 (ja) | 障害物検知装置 | |
WO2022113516A1 (ja) | 障害物検出装置および車両 | |
WO2023171072A1 (ja) | 障害物検知装置、障害物検知方法及びプログラム | |
US20230266455A1 (en) | Radar control device and method | |
WO2020105093A1 (ja) | 障害物検出装置 | |
KR20220102843A (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: 18940981 Country of ref document: EP Kind code of ref document: A1 |
|
ENP | Entry into the national phase |
Ref document number: 2020551594 Country of ref document: JP Kind code of ref document: A |
|
NENP | Non-entry into the national phase |
Ref country code: DE |
|
122 | Ep: pct application non-entry in european phase |
Ref document number: 18940981 Country of ref document: EP Kind code of ref document: A1 |