WO2022030186A1 - 車両および障害物検知装置 - Google Patents

車両および障害物検知装置 Download PDF

Info

Publication number
WO2022030186A1
WO2022030186A1 PCT/JP2021/026027 JP2021026027W WO2022030186A1 WO 2022030186 A1 WO2022030186 A1 WO 2022030186A1 JP 2021026027 W JP2021026027 W JP 2021026027W WO 2022030186 A1 WO2022030186 A1 WO 2022030186A1
Authority
WO
WIPO (PCT)
Prior art keywords
obstacle
sound wave
reliability
object determination
determination area
Prior art date
Application number
PCT/JP2021/026027
Other languages
English (en)
French (fr)
Inventor
慎吾 河原
鉄兵 柴田
Original Assignee
パナソニックIpマネジメント株式会社
Priority date (The priority date is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the date listed.)
Filing date
Publication date
Priority claimed from JP2020132025A external-priority patent/JP6994676B1/ja
Priority claimed from JP2021056608A external-priority patent/JP7108946B1/ja
Application filed by パナソニックIpマネジメント株式会社 filed Critical パナソニックIpマネジメント株式会社
Priority to DE112021004117.7T priority Critical patent/DE112021004117T5/de
Priority to CN202180060130.2A priority patent/CN116134500A/zh
Publication of WO2022030186A1 publication Critical patent/WO2022030186A1/ja
Priority to US17/978,724 priority patent/US20230052064A1/en

Links

Images

Classifications

    • GPHYSICS
    • G01MEASURING; TESTING
    • G01SRADIO DIRECTION-FINDING; RADIO NAVIGATION; DETERMINING DISTANCE OR VELOCITY BY USE OF RADIO WAVES; LOCATING OR PRESENCE-DETECTING BY USE OF THE REFLECTION OR RERADIATION OF RADIO WAVES; ANALOGOUS ARRANGEMENTS USING OTHER WAVES
    • G01S15/00Systems using the reflection or reradiation of acoustic waves, e.g. sonar systems
    • G01S15/88Sonar systems specially adapted for specific applications
    • G01S15/93Sonar systems specially adapted for specific applications for anti-collision purposes
    • G01S15/931Sonar systems specially adapted for specific applications for anti-collision purposes of land vehicles
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B60VEHICLES IN GENERAL
    • B60TVEHICLE BRAKE CONTROL SYSTEMS OR PARTS THEREOF; BRAKE CONTROL SYSTEMS OR PARTS THEREOF, IN GENERAL; ARRANGEMENT OF BRAKING ELEMENTS ON VEHICLES IN GENERAL; PORTABLE DEVICES FOR PREVENTING UNWANTED MOVEMENT OF VEHICLES; VEHICLE MODIFICATIONS TO FACILITATE COOLING OF BRAKES
    • B60T7/00Brake-action initiating means
    • B60T7/12Brake-action initiating means for automatic initiation; for initiation not subject to will of driver or passenger
    • B60T7/22Brake-action initiating means for automatic initiation; for initiation not subject to will of driver or passenger initiated by contact of vehicle, e.g. bumper, with an external object, e.g. another vehicle, or by means of contactless obstacle detectors mounted on the vehicle
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B60VEHICLES IN GENERAL
    • B60WCONJOINT CONTROL OF VEHICLE SUB-UNITS OF DIFFERENT TYPE OR DIFFERENT FUNCTION; CONTROL SYSTEMS SPECIALLY ADAPTED FOR HYBRID VEHICLES; ROAD VEHICLE DRIVE CONTROL SYSTEMS FOR PURPOSES NOT RELATED TO THE CONTROL OF A PARTICULAR SUB-UNIT
    • B60W10/00Conjoint control of vehicle sub-units of different type or different function
    • B60W10/04Conjoint control of vehicle sub-units of different type or different function including control of propulsion units
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B60VEHICLES IN GENERAL
    • B60WCONJOINT CONTROL OF VEHICLE SUB-UNITS OF DIFFERENT TYPE OR DIFFERENT FUNCTION; CONTROL SYSTEMS SPECIALLY ADAPTED FOR HYBRID VEHICLES; ROAD VEHICLE DRIVE CONTROL SYSTEMS FOR PURPOSES NOT RELATED TO THE CONTROL OF A PARTICULAR SUB-UNIT
    • B60W10/00Conjoint control of vehicle sub-units of different type or different function
    • B60W10/04Conjoint control of vehicle sub-units of different type or different function including control of propulsion units
    • B60W10/06Conjoint control of vehicle sub-units of different type or different function including control of propulsion units including control of combustion engines
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B60VEHICLES IN GENERAL
    • B60WCONJOINT CONTROL OF VEHICLE SUB-UNITS OF DIFFERENT TYPE OR DIFFERENT FUNCTION; CONTROL SYSTEMS SPECIALLY ADAPTED FOR HYBRID VEHICLES; ROAD VEHICLE DRIVE CONTROL SYSTEMS FOR PURPOSES NOT RELATED TO THE CONTROL OF A PARTICULAR SUB-UNIT
    • B60W10/00Conjoint control of vehicle sub-units of different type or different function
    • B60W10/18Conjoint control of vehicle sub-units of different type or different function including control of braking systems
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B60VEHICLES IN GENERAL
    • B60WCONJOINT CONTROL OF VEHICLE SUB-UNITS OF DIFFERENT TYPE OR DIFFERENT FUNCTION; CONTROL SYSTEMS SPECIALLY ADAPTED FOR HYBRID VEHICLES; ROAD VEHICLE DRIVE CONTROL SYSTEMS FOR PURPOSES NOT RELATED TO THE CONTROL OF A PARTICULAR SUB-UNIT
    • B60W30/00Purposes of road vehicle drive control systems not related to the control of a particular sub-unit, e.g. of systems using conjoint control of vehicle sub-units, or advanced driver assistance systems for ensuring comfort, stability and safety or drive control systems for propelling or retarding the vehicle
    • B60W30/08Active safety systems predicting or avoiding probable or impending collision or attempting to minimise its consequences
    • B60W30/085Taking automatic action to adjust vehicle attitude in preparation for collision, e.g. braking for nose dropping
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B60VEHICLES IN GENERAL
    • B60WCONJOINT CONTROL OF VEHICLE SUB-UNITS OF DIFFERENT TYPE OR DIFFERENT FUNCTION; CONTROL SYSTEMS SPECIALLY ADAPTED FOR HYBRID VEHICLES; ROAD VEHICLE DRIVE CONTROL SYSTEMS FOR PURPOSES NOT RELATED TO THE CONTROL OF A PARTICULAR SUB-UNIT
    • B60W30/00Purposes of road vehicle drive control systems not related to the control of a particular sub-unit, e.g. of systems using conjoint control of vehicle sub-units, or advanced driver assistance systems for ensuring comfort, stability and safety or drive control systems for propelling or retarding the vehicle
    • B60W30/08Active safety systems predicting or avoiding probable or impending collision or attempting to minimise its consequences
    • B60W30/09Taking automatic action to avoid collision, e.g. braking and steering
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B60VEHICLES IN GENERAL
    • B60WCONJOINT CONTROL OF VEHICLE SUB-UNITS OF DIFFERENT TYPE OR DIFFERENT FUNCTION; CONTROL SYSTEMS SPECIALLY ADAPTED FOR HYBRID VEHICLES; ROAD VEHICLE DRIVE CONTROL SYSTEMS FOR PURPOSES NOT RELATED TO THE CONTROL OF A PARTICULAR SUB-UNIT
    • B60W30/00Purposes of road vehicle drive control systems not related to the control of a particular sub-unit, e.g. of systems using conjoint control of vehicle sub-units, or advanced driver assistance systems for ensuring comfort, stability and safety or drive control systems for propelling or retarding the vehicle
    • B60W30/18Propelling the vehicle
    • B60W30/18009Propelling the vehicle related to particular drive situations
    • B60W30/181Preparing for stopping
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B60VEHICLES IN GENERAL
    • B60WCONJOINT CONTROL OF VEHICLE SUB-UNITS OF DIFFERENT TYPE OR DIFFERENT FUNCTION; CONTROL SYSTEMS SPECIALLY ADAPTED FOR HYBRID VEHICLES; ROAD VEHICLE DRIVE CONTROL SYSTEMS FOR PURPOSES NOT RELATED TO THE CONTROL OF A PARTICULAR SUB-UNIT
    • B60W40/00Estimation or calculation of non-directly measurable driving parameters for road vehicle drive control systems not related to the control of a particular sub unit, e.g. by using mathematical models
    • B60W40/02Estimation or calculation of non-directly measurable driving parameters for road vehicle drive control systems not related to the control of a particular sub unit, e.g. by using mathematical models related to ambient conditions
    • GPHYSICS
    • G01MEASURING; TESTING
    • G01SRADIO DIRECTION-FINDING; RADIO NAVIGATION; DETERMINING DISTANCE OR VELOCITY BY USE OF RADIO WAVES; LOCATING OR PRESENCE-DETECTING BY USE OF THE REFLECTION OR RERADIATION OF RADIO WAVES; ANALOGOUS ARRANGEMENTS USING OTHER WAVES
    • G01S15/00Systems using the reflection or reradiation of acoustic waves, e.g. sonar systems
    • G01S15/87Combinations of sonar systems
    • G01S15/876Combination of several spaced transmitters or receivers of known location for determining the position of a transponder or a reflector
    • G01S15/878Combination of several spaced transmitters or receivers of known location for determining the position of a transponder or a reflector wherein transceivers are operated, either sequentially or simultaneously, both in bi-static and in mono-static mode, e.g. cross-echo mode
    • GPHYSICS
    • G01MEASURING; TESTING
    • G01SRADIO DIRECTION-FINDING; RADIO NAVIGATION; DETERMINING DISTANCE OR VELOCITY BY USE OF RADIO WAVES; LOCATING OR PRESENCE-DETECTING BY USE OF THE REFLECTION OR RERADIATION OF RADIO WAVES; ANALOGOUS ARRANGEMENTS USING OTHER WAVES
    • G01S3/00Direction-finders for determining the direction from which infrasonic, sonic, ultrasonic, or electromagnetic waves, or particle emission, not having a directional significance, are being received
    • G01S3/80Direction-finders for determining the direction from which infrasonic, sonic, ultrasonic, or electromagnetic waves, or particle emission, not having a directional significance, are being received using ultrasonic, sonic or infrasonic waves
    • G01S3/802Systems for determining direction or deviation from predetermined direction
    • G01S3/808Systems for determining direction or deviation from predetermined direction using transducers spaced apart and measuring phase or time difference between signals therefrom, i.e. path-difference systems
    • GPHYSICS
    • G08SIGNALLING
    • G08GTRAFFIC CONTROL SYSTEMS
    • G08G1/00Traffic control systems for road vehicles
    • G08G1/16Anti-collision systems
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B60VEHICLES IN GENERAL
    • B60TVEHICLE BRAKE CONTROL SYSTEMS OR PARTS THEREOF; BRAKE CONTROL SYSTEMS OR PARTS THEREOF, IN GENERAL; ARRANGEMENT OF BRAKING ELEMENTS ON VEHICLES IN GENERAL; PORTABLE DEVICES FOR PREVENTING UNWANTED MOVEMENT OF VEHICLES; VEHICLE MODIFICATIONS TO FACILITATE COOLING OF BRAKES
    • B60T2210/00Detection or estimation of road or environment conditions; Detection or estimation of road shapes
    • B60T2210/30Environment conditions or position therewithin
    • B60T2210/32Vehicle surroundings
    • B60W2420/408
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B60VEHICLES IN GENERAL
    • B60WCONJOINT CONTROL OF VEHICLE SUB-UNITS OF DIFFERENT TYPE OR DIFFERENT FUNCTION; CONTROL SYSTEMS SPECIALLY ADAPTED FOR HYBRID VEHICLES; ROAD VEHICLE DRIVE CONTROL SYSTEMS FOR PURPOSES NOT RELATED TO THE CONTROL OF A PARTICULAR SUB-UNIT
    • B60W2420/00Indexing codes relating to the type of sensors based on the principle of their operation
    • B60W2420/54Audio sensitive means, e.g. ultrasound
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B60VEHICLES IN GENERAL
    • B60WCONJOINT CONTROL OF VEHICLE SUB-UNITS OF DIFFERENT TYPE OR DIFFERENT FUNCTION; CONTROL SYSTEMS SPECIALLY ADAPTED FOR HYBRID VEHICLES; ROAD VEHICLE DRIVE CONTROL SYSTEMS FOR PURPOSES NOT RELATED TO THE CONTROL OF A PARTICULAR SUB-UNIT
    • B60W2520/00Input parameters relating to overall vehicle dynamics
    • B60W2520/10Longitudinal speed
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B60VEHICLES IN GENERAL
    • B60WCONJOINT CONTROL OF VEHICLE SUB-UNITS OF DIFFERENT TYPE OR DIFFERENT FUNCTION; CONTROL SYSTEMS SPECIALLY ADAPTED FOR HYBRID VEHICLES; ROAD VEHICLE DRIVE CONTROL SYSTEMS FOR PURPOSES NOT RELATED TO THE CONTROL OF A PARTICULAR SUB-UNIT
    • B60W2520/00Input parameters relating to overall vehicle dynamics
    • B60W2520/10Longitudinal speed
    • B60W2520/105Longitudinal acceleration
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B60VEHICLES IN GENERAL
    • B60WCONJOINT CONTROL OF VEHICLE SUB-UNITS OF DIFFERENT TYPE OR DIFFERENT FUNCTION; CONTROL SYSTEMS SPECIALLY ADAPTED FOR HYBRID VEHICLES; ROAD VEHICLE DRIVE CONTROL SYSTEMS FOR PURPOSES NOT RELATED TO THE CONTROL OF A PARTICULAR SUB-UNIT
    • B60W2540/00Input parameters relating to occupants
    • B60W2540/10Accelerator pedal position
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B60VEHICLES IN GENERAL
    • B60WCONJOINT CONTROL OF VEHICLE SUB-UNITS OF DIFFERENT TYPE OR DIFFERENT FUNCTION; CONTROL SYSTEMS SPECIALLY ADAPTED FOR HYBRID VEHICLES; ROAD VEHICLE DRIVE CONTROL SYSTEMS FOR PURPOSES NOT RELATED TO THE CONTROL OF A PARTICULAR SUB-UNIT
    • B60W2540/00Input parameters relating to occupants
    • B60W2540/12Brake pedal position
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B60VEHICLES IN GENERAL
    • B60WCONJOINT CONTROL OF VEHICLE SUB-UNITS OF DIFFERENT TYPE OR DIFFERENT FUNCTION; CONTROL SYSTEMS SPECIALLY ADAPTED FOR HYBRID VEHICLES; ROAD VEHICLE DRIVE CONTROL SYSTEMS FOR PURPOSES NOT RELATED TO THE CONTROL OF A PARTICULAR SUB-UNIT
    • B60W2554/00Input parameters relating to objects
    • B60W2554/20Static objects
    • GPHYSICS
    • G01MEASURING; TESTING
    • G01SRADIO DIRECTION-FINDING; RADIO NAVIGATION; DETERMINING DISTANCE OR VELOCITY BY USE OF RADIO WAVES; LOCATING OR PRESENCE-DETECTING BY USE OF THE REFLECTION OR RERADIATION OF RADIO WAVES; ANALOGOUS ARRANGEMENTS USING OTHER WAVES
    • G01S15/00Systems using the reflection or reradiation of acoustic waves, e.g. sonar systems
    • G01S15/88Sonar systems specially adapted for specific applications
    • G01S15/93Sonar systems specially adapted for specific applications for anti-collision purposes
    • G01S15/931Sonar systems specially adapted for specific applications for anti-collision purposes of land vehicles
    • G01S2015/937Sonar systems specially adapted for specific applications for anti-collision purposes of land vehicles sensor installation details
    • G01S2015/938Sonar systems specially adapted for specific applications for anti-collision purposes of land vehicles sensor installation details in the bumper area

Definitions

  • This disclosure relates to vehicles and obstacle detection devices.
  • Patent Document 1 An obstacle detection device mounted on a vehicle and detecting an obstacle by using the reflection of sound waves is known.
  • the obstacle detection device mounted on the vehicle and detecting the obstacle by using the reflection of the sound wave is still required to detect the obstacle appropriately.
  • the present disclosure provides vehicles and obstacle detection devices capable of improving the accuracy of obstacle detection results.
  • the vehicle according to the present disclosure is coupled to the first wheel and the second wheel arranged along a predetermined direction, the first wheel and the second wheel, and can be moved by the first wheel and the second wheel.
  • the transmitting unit transmits a first sound wave
  • the receiving unit uses a first reflected sound wave corresponding to the first sound wave as the received sound wave.
  • the position of at least the first obstacle is obtained based on the first sound wave and the first reflected sound wave, and the stationary identical object determination region and the vehicle body are determined based on the position of the first obstacle.
  • a moving same object determination area at a position farther than the stationary identical object determination area is set as a reference, then the transmitting unit transmits a second sound wave, and the receiving unit receives the first.
  • the second reflected sound wave corresponding to the two transmitted sound waves is received as the received sound wave, the position of the second obstacle is obtained based on the second transmitted sound wave and the second reflected sound wave, and the second obstacle is obtained.
  • the reliability of the second obstacle is set as the first reliability, and the position of the second obstacle is defined as the first reliability.
  • the reliability of the second obstacle is set to a second reliability higher than the first reliability, and the second. Based on the reliability of the obstacle and the position of the second obstacle, the vehicle body is braked and / or the acceleration of the vehicle body is suppressed.
  • FIG. 1 is a schematic diagram showing an example of a vehicle provided with the obstacle detection device according to the first embodiment.
  • FIG. 2 is a block diagram showing an example of the configuration of a vehicle including the obstacle detection device according to the first embodiment.
  • FIG. 3 is a schematic diagram showing an example of a case where the obstacle detection device according to the first embodiment identifies the position of an obstacle.
  • FIG. 4 is a schematic diagram showing an example of a case where the obstacle detection device according to the first embodiment specifies an angle of an obstacle.
  • FIG. 5 is a schematic diagram showing an example of a case where the obstacle detection device according to the first embodiment determines the same object for an obstacle facing the vehicle.
  • FIG. 1 is a schematic diagram showing an example of a vehicle provided with the obstacle detection device according to the first embodiment.
  • FIG. 2 is a block diagram showing an example of the configuration of a vehicle including the obstacle detection device according to the first embodiment.
  • FIG. 3 is a schematic diagram showing an example of a case where the obstacle detection device according to the first
  • FIG. 6 is a schematic diagram showing an example of a case where the obstacle detection device according to the first embodiment determines the same object for an obstacle obliquely arranged with respect to the vehicle.
  • FIG. 7 is a flow chart showing an example of a processing procedure in the obstacle detection device according to the first embodiment.
  • FIG. 8 is a schematic diagram showing an example of a case where the vehicle according to the comparative example determines the same object for an obstacle.
  • FIG. 9 is a state transition diagram showing a state transition related to the reliability of the obstacle detected by the obstacle detection device according to the first embodiment.
  • FIG. 10 is a schematic diagram showing an example of a case where the obstacle detection device according to the second embodiment determines the same object for a stationary obstacle.
  • FIG. 11 is a schematic diagram showing an example of a case where the obstacle detection device according to the second embodiment determines the same object for a moving obstacle.
  • FIG. 12 is a state transition diagram showing a state transition related to the reliability of the obstacle detected by the obstacle detection device according to the second embodiment.
  • FIG. 1 is a schematic diagram showing a vehicle 1 provided with an obstacle detection device 100 according to the first embodiment.
  • the vehicle 1 includes a vehicle body 2 and two pairs of wheels 3 (a pair of front tires 3f and a pair of rear tires 3r) coupled to the vehicle body 2 along the traveling direction.
  • the traveling direction of the vehicle 1 it is also possible to regard the traveling direction of the vehicle 1 as a predetermined direction.
  • the vehicle body 2 is a front end portion F which is an end portion on the front tire 3f side, a rear end portion R which is an end portion on the rear tire 3r side, and an end portion in the width direction of the vehicle body 2 between the front tire 3f and the rear tire 3r. It has a certain side end S.
  • the vehicle body 2 has a substantially rectangular shape when viewed from above. It is also possible to regard each of the four corners as an end in a substantially rectangular shape.
  • the front bumper 4f is provided near the lower end of the vehicle body 2 at the front end F of the vehicle body 2
  • the rear bumper 4r is provided near the lower end of the vehicle body 2 at the rear end R of the vehicle body 2.
  • the front bumper 4f covers the entire front surface and a part of the side surface at the front end portion F of the vehicle body 2
  • the rear bumper 4r covers the entire rear surface and a part of the side surface at the rear end portion R of the vehicle body 2. cover.
  • the front bumper 4f and the rear bumper 4r form a pair of bumpers 4.
  • the transmitting / receiving section 5 is arranged at a predetermined end of the vehicle body 2, and the transmitting / receiving section 5 as a transmitting section transmits a sound wave and receives the reflected sound wave of the transmitted sound wave as a receiving section.
  • the transmission / reception unit 5 is composed of at least a transmission / reception unit 5f arranged at the front end portion F and a transmission / reception unit 5r arranged at the rear end portion R.
  • the transmission / reception unit 5f is arranged in the front bumper 4f, and the transmission / reception unit 5r is arranged in the rear bumper 4r.
  • the transmission / reception unit 5 may be arranged at at least one of the both side end portions S of the vehicle 1 or may be arranged at at least one of the four corner portions of the vehicle 1.
  • the transmission / reception unit 5f includes transmission / reception devices 51a to 51d.
  • the number of the wave transmitting / receiving device 51 is not limited to four and is arbitrary.
  • the transmission / reception devices 51a to 51d may be arranged on the front bumper 4f at predetermined distance intervals.
  • Each of the transmission / reception devices 51a to 51d transmits the transmitted sound wave at a predetermined cycle, and receives the reflected sound wave at a predetermined cycle at a timing different from the transmission timing. That is, each of the transmission / reception devices 51a to 51d is configured so that the transmission / reception timing and the reception timing are alternately alternated.
  • the transmission / reception devices 51a to 51d when any one of the adjacent transmission / reception devices 51a, 51b, the transmission / reception devices 51b, 51c, and the transmission / reception devices 51c, 51d are in the wave transmission state, any one of them. May be configured to be in a wave receiving state.
  • the transmission / reception unit 5r includes transmission / reception devices 52a to 52d.
  • the number of the wave transmitting / receiving device 52 is not limited to four and is arbitrary.
  • the transmission / reception devices 52a to 52d are arranged on the rear bumper 4r at predetermined distance intervals.
  • the predetermined distance interval between the transmission / reception devices 51a to 51d and the predetermined distance interval between the transmission / reception devices 52a to 52d may be the same or different.
  • Each of the transmission / reception devices 52a to 52d transmits the transmitted sound wave at a predetermined cycle, and receives the reflected sound wave at a predetermined cycle at a timing different from the transmission timing. That is, each of the transmission / reception devices 52a to 52d is configured so that the transmission / reception timing and the reception timing are alternately alternated. Of the transmission / reception devices 52a to 52d, when any one of the adjacent transmission / reception devices 52a, 52b, the transmission / reception devices 52b, 52c, and the transmission / reception devices 52c, 52d are in the wave transmission state, any one of them. May be configured to be in a wave receiving state.
  • the transmission / reception unit 5 configured as described above is included in the obstacle detection device 100.
  • the obstacle detection device 100 is mounted on the vehicle body 2 and detects obstacles and the like around the vehicle 1 by sound waves such as ultrasonic waves.
  • the vehicle 1 can travel in the traveling direction by using the wheels 3 arranged along the traveling direction.
  • the wheel 3 is composed of a pair of wheels 3 (front tire 3f) arranged in the front half of the vehicle 1 and a pair of wheels 3 (rear tire 3r) arranged in the latter half of the vehicle 1.
  • the vehicle 1 can move forward or backward along the traveling direction by switching gears or the like, and can also turn left or right by steering the front tire 3f.
  • the vehicle 1 is a four-wheeled vehicle having four wheels, but the present invention is not limited to this. It may be a three-wheeled vehicle, a two-wheeled vehicle, or a vehicle using five or more wheels.
  • the traveling direction of the vehicle 1, that is, the arrangement direction of the two pairs of wheels 3 is the X direction
  • the front tire 3f side has a positive value
  • the rear tire 3r side has a negative value
  • the direction orthogonal to the horizontal plane with respect to the X direction is the Y direction
  • the left side has a positive value in the Y direction
  • the right side has a negative value with respect to the positive direction in the X direction.
  • the vertical direction orthogonal to the X direction and the Y direction is the Z direction
  • the upward direction is a positive value
  • the downward direction is a negative value.
  • FIG. 2 is a block diagram showing a configuration of a vehicle 1 including an obstacle detection device 100 according to the first embodiment. As shown in FIG. 2, the vehicle 1 includes an obstacle detection device 100 and a driving support device 200.
  • the obstacle detection device 100 includes transmission / reception units 5f, 5r and an ECU (Electronic Control Unit) 10, and detects obstacles in the vicinity of the vehicle 1.
  • the driving support device 200 includes an ECU 10 and a vehicle control device 20, and assists the driver in driving the vehicle 1.
  • the ECU 10 as a control circuit is configured as a computer equipped with a CPU (Central Processing Unit) 11, a RAM (Random Access Memory) 12, and a ROM (Read Only Memory) 13. Further, the ECU 10 includes various parts of the vehicle control device 20, transmission / reception parts 5f and 5r, and an I / O (Input / Output) port 15 capable of transmitting and receiving various information.
  • a CPU Central Processing Unit
  • RAM Random Access Memory
  • ROM Read Only Memory
  • Each configuration of the RAM 12, the ROM 13, the storage device 14, and the I / O port 15 of the ECU 10 is configured to be capable of transmitting and receiving various information to and from the CPU 11 via the internal bus.
  • the ECU 10 detects an obstacle in the vicinity of the vehicle 1 based on the wave transmission sound wave and the reflected sound wave in the transmission / reception units 5f and 5r by executing the program installed in the ROM 13 by the CPU 11. do. Further, the ECU 10 outputs a signal instructing the vehicle 1 to control the vehicle 1 to the vehicle control device 20 based on the detection result of the obstacle.
  • the vehicle control device 20 includes a vehicle speed sensor 21, an accelerator sensor 22, a brake sensor 23, a brake actuator 24, and an engine controller 25.
  • the vehicle speed sensor 21 detects the speed of the vehicle.
  • the accelerator sensor 22 detects the amount of operation of the accelerator pedal by the driver.
  • the brake sensor 23 detects the amount of operation of the brake pedal by the driver.
  • the brake actuator 24 as a braking unit applies braking to at least one of the front tire 3f and the rear tire 3r.
  • the engine controller 25 as a drive unit controls the output of an engine (not shown) based on the detection result of the accelerator sensor 22 during normal driving, and executes acceleration / deceleration control of the vehicle 1.
  • the vehicle control device 20 acquires information indicating the state of each part of the vehicle 1 by the vehicle speed sensor 21, the accelerator sensor 22, the brake sensor 23, and the like.
  • the vehicle control device 20 controls the vehicle 1 so as to avoid obstacles detected by the ECU 10 by controlling at least one of the brake actuator 24 and the engine controller 25 based on these information and the signal received from the ECU 10. do.
  • the vehicle 1 is provided with an engine and an engine controller 25, but the present invention is not limited to this.
  • the vehicle 1 is controlled so as to avoid an obstacle detected by the ECU 10 by controlling at least one of the brake actuator 24 and the motor controller so as to include an electric motor and a motor controller for controlling the electric motor. You can do it.
  • the vehicle control device 20 controls the brake actuator 24 to apply braking to the vehicle body 2 to avoid a collision between the vehicle 1 and an obstacle.
  • the vehicle control device 20 suppresses the output of the engine for several seconds by the engine controller 25 and suppresses the acceleration of the vehicle body 2 in order to avoid a collision between the vehicle 1 and an obstacle. May be good.
  • the accelerator pedal of the vehicle 1 is of a type that is electronically controlled, and the vehicle control device 20 may be provided with a mechanism for controlling the opening degree of the accelerator pedal.
  • the vehicle control device 20 controls the opening degree of the accelerator pedal by the accelerator pedal control mechanism as a drive unit to accelerate the vehicle body 2. By suppressing the above, the collision between the vehicle 1 and the obstacle may be avoided.
  • the vehicle control device 20 has at least one of a function of braking the vehicle body 2 and a function of suppressing the acceleration of the vehicle body 2, so that the driving support device 200 can be used as an acceleration suppression device and a collision when the pedal is pressed incorrectly. It may be configured to function as a damage mitigation brake or the like. Acceleration suppression device and collision damage mitigation brake when pedal is mistakenly pressed are used to drive the driver to avoid collision with nearby obstacles when the driver accidentally depresses the accelerator pedal too hard. It is a function to provide support.
  • the position of the obstacle is a position in the top view, that is, a position in the planes in the X and Y directions, that is, the position in the XY plane.
  • the angle of the obstacle is an angle with respect to the traveling direction of the vehicle 1 in the normal direction of the surface that reflects the transmitted sound wave in the obstacle. This angle is also an angle in the top view, that is, an angle in the XY plane.
  • the obstacle detection device 100 identifies the position and angle of an obstacle existing in front of the vehicle 1 based on the sound wave and the reflected sound wave of the wave transmission / reception unit 5f at the front end of the vehicle body 2. The case of doing so will be described. However, the position and angle of the obstacle behind the vehicle 1 may be specified in the same manner as the method described below based on the transmitted sound wave and the reflected sound wave of the wave transmitting / receiving unit 5r at the rear end of the vehicle body 2. can.
  • FIG. 3 is a schematic diagram when the obstacle detection device 100 according to the first embodiment specifies the position of the obstacle OB.
  • the obstacle detection device 100 detects the obstacle OB from the sound waves transmitted and reflected by the wave transmission / reception devices 51a to 51d of the wave transmission / reception unit 5f.
  • the position of the obstacle OB is specified based on the transmitted sound wave and the reflected sound wave of the two adjacent wave transmitting / receiving devices 51 among the plurality of transmitting / receiving devices 51 included in the transmitting / receiving unit 5f.
  • FIG. 3 shows a case where two adjacent wave transmission / reception devices 51b and 51c are used.
  • the transmitting / receiving device 51c transmits a transmitted sound wave toward the front of the vehicle 1 at an angle within a predetermined range.
  • the angle in the predetermined range is on the XY plane, and the traveling direction, that is, the X direction is the reference.
  • the transmitted sound waves Rct and Rbt will be described.
  • the transmitted sound wave Rct hits the surface SR of the obstacle OB and is reflected.
  • the reflected sound wave Rcr to which the wave transmission sound wave Rct is reflected reaches the wave transmission / reception device 51c through the same path as the wave transmission sound wave Rct, and is received by the wave transmission / reception device 51c.
  • the obstacle detection device 100 calculates the flight time from the transmission timing of the transmission sound wave Rct to the reception timing of the reflected sound wave Rcr, and the flight distance related to the transmission sound wave Rct and the reflected sound wave Rcr from the speed of sound, and this flight distance. Is divided by 2 to be the distance from the wave transmitting / receiving device 51c to the obstacle OB.
  • the obstacle detection device 100 can set a virtual circle CRc having a radius of the distance from the wave transmission / reception device 51c to the obstacle OB.
  • the transmitted sound wave Rbt hits the surface SR of the obstacle OB and is reflected, becomes a reflected sound wave Rbr, and reaches the transmitting / receiving device 51b.
  • the incident angle based on the normal direction of the surface SR of the transmitted sound wave Rbt and the reflection angle based on the normal direction of the surface SR of the reflected sound wave Rbr are the same.
  • the obstacle detection device 100 calculates the flight time from the transmission timing of the transmission sound wave Rbt to the reception timing of the reflected sound wave Rbr, and the flight distance related to the transmission sound wave Rbt and the reflected sound wave Rbr from the sound velocity, and this flight distance.
  • the value obtained by subtracting the value of the radius of the virtual circle CRc is defined as the distance from the reflected position of the reflected sound wave Rbr on the surface SR of the obstacle OB to the receiving / receiving device 51b which is the receiving position of the reflected sound wave Rbr.
  • the obstacle detection device 100 sets a virtual circle CRb whose radius is the distance from the reflection position of the reflected sound wave Rbr on the surface SR of the obstacle OB to the transmission / reception device 51b which is the receiving position of the reflected sound wave Rbr. be able to.
  • the obstacle detection device 100 uses the intersection of the two virtual circles CRc and CRb on the transmission direction side of the transmission sound waves Rct and Rbt as the distance measuring point MS representing the position coordinates of the obstacle OB. Thereby, the position of the obstacle OB can be specified based on the transmitted sound waves Rct and Rbt and the reflected sound waves Rcr and Rbr of the transmitting and receiving unit 5f.
  • FIG. 4 is a schematic diagram showing a case where the obstacle detection device 100 according to the first embodiment specifies the angles of obstacles OBc and OBd.
  • the obstacle detection device 100 identifies the angles of the obstacles OBc and OBd with respect to the traveling direction of the vehicle 1 from the respective positions of the obstacles OBc and OBd.
  • a positive objective region FA used for determining whether or not the obstacles OBc and OBd are facing the vehicle 1 is set in the transmission / reception unit 5f of the obstacle detection device 100.
  • the positive objective region FA includes the positive objective regions FAab and FAcd.
  • the positive objective region FAab is set for the transmission / reception devices 51a and 51b among the transmission / reception devices 51a to 51d of the transmission / reception unit 5f.
  • the obstacle detection device 100 determines that the obstacle is with respect to the vehicle 1. Judge that they are facing each other.
  • the positive objective region FAcd is set for the transmission / reception devices 51c and 51d among the transmission / reception devices 51a to 51d of the transmission / reception unit 5f.
  • the obstacle detection device 100 detects the obstacle with respect to the vehicle 1. Judge that they are facing each other.
  • the obstacle detection device 100 faces the obstacle with respect to the vehicle 1. It is determined that there is.
  • the obstacle detection device 100 identifies the position of the obstacle OBc in the same manner as described above, and calculates the AF point MSc representing the position coordinates of the obstacle OBc. Further, the obstacle detection device 100 determines whether or not the calculated ranging point MSc is in the positive objective region FA.
  • the obstacle detection device 100 determines the normal direction of the surface SRc as the first surface of the obstacle OBc facing the vehicle 1 side based on whether or not the distance measuring point MSc is in the positive objective region FA.
  • the angle of NRc is determined with reference to the X direction of the vehicle 1.
  • the AF point MSc is in the positive objective region FA.
  • the obstacle detection device 100 assumes that the surface SRc of the obstacle OBc faces the vehicle 1. Therefore, the obstacle detection device 100 sets 0 ° with respect to the X direction of the vehicle 1 as the angle of the normal direction NRc of the surface SRc of the obstacle OBc. In this way, the obstacle detection device 100 sets the angle of the obstacle OBc based on the position of the obstacle OBc.
  • the obstacle detection device 100 sets a value tilted by a predetermined angle with respect to the X direction of the vehicle 1 as the angle of the normal direction NRd of the surface SRd of the obstacle OBd.
  • the value of this angle is the angle formed by the line segment from the position of the center to the AF point MSd with respect to the X direction of the vehicle 1. In this way, the obstacle detection device 100 sets the angle of the obstacle OBd based on the position of the obstacle OBd.
  • the normal direction NRd of the surface SRd of the obstacle OBd is tilted to the right (toward the ⁇ Y direction) with respect to the + X direction of the vehicle 1 by a predetermined angle.
  • the angle of the normal direction NRd is set to a positive value in the counterclockwise direction and a negative value in the clockwise direction with respect to the traveling direction (+ X direction) of the vehicle 1. Therefore, the angle of the normal direction NRd in FIG. 4 is a negative angle ⁇ ( ⁇ itself is a positive value). That is, as the distance measuring point MSd of the obstacle OBd deviates from the positive objective region FA toward the ⁇ Y direction of the vehicle 1, the angle ⁇ becomes smaller and the absolute value of the angle ⁇ becomes larger. ..
  • the distance measuring point indicating the position of a predetermined obstacle (not shown) is off the + Y direction side of the vehicle 1 with respect to the normal objective region FA, that is, the obstacle is located on the left front side of the vehicle 1. If so, the normal direction of the surface of the obstacle facing the vehicle 1 side is tilted to the left from the + X direction of the vehicle 1, that is, to the left (+ Y direction) toward the + X direction of the vehicle 1 by a predetermined angle. It will be. Further, the angle in the normal direction at this time is a positive angle + ⁇ ( ⁇ itself is a positive value). That is, as the distance measuring point of the obstacle deviates to the outside of the positive objective region FA toward the + Y direction of the vehicle 1, the angle + ⁇ becomes larger as a positive value, and the absolute value of the angle + ⁇ also becomes larger.
  • FIG. 5 is a schematic diagram showing how the obstacle detection device 100 determines the same object for the obstacle OBc facing the vehicle 1.
  • the obstacle detection device 100 detects the obstacle OBc at a predetermined cycle.
  • the obstacle detection device 100 calculates the position of the obstacle OBc as the estimated point ESc based on the previous data detected last time, and sets the same object determination area SAc from the estimated point ESc.
  • the same object determination region SAc is a rectangle having a pair of long sides and a pair of short sides, but the present invention is not limited to this. It may be a square, a parallelogram, or just a quadrangle. Alternatively, it may simply have a predetermined shape.
  • the previous data is the position coordinates of the obstacle OBc and the angle with respect to the vehicle 1 calculated based on the transmitted sound wave and the reflected sound wave transmitted and received before the transmitted sound wave to be transmitted from now on.
  • the obstacle detection device 100 calculates the estimated point ESc from these previous data.
  • the estimated point ESc is the obstacle detected last time from the vehicle 1 at the present time based on the coordinates of the obstacle OBc detected last time and the movement amount and turning angle of the vehicle 1 from the time of the previous detection to the present. It is obtained by calculating the relative position of the OBc to the coordinates. This estimation point ESc estimates the position of an obstacle that will be detected by the next transmitted sound wave.
  • the same object determination region SAc is a rectangular region having a pair of long sides and a pair of short sides with the calculated estimated point ESc as the center point.
  • the length of the pair of long sides is determined according to the distance from the vehicle 1 (distance in the X direction).
  • the same object determination area SAc is set so as to correspond to the angle of the obstacle OBc detected and identified last time. That is, the orientation of the same object determination region SAc is set to follow the orientation of the obstacle OBc. More specifically, a pair of long sides of the same object determination region SAc are parallel to the surface SRc of the obstacle OBc facing the vehicle 1, and with respect to the normal direction NRc of the surface SRc of the obstacle OBc.
  • the same object determination region SAc is set so as to be orthogonal to each other.
  • the obstacle detection device 100 sends a wave transmission sound wave for the next measurement. If the reflected sound wave is received as the received sound wave in response to this transmitted sound wave, it means that there is an obstacle in the vicinity of the vehicle 1. However, at this point, it is still unclear whether the obstacle detected this time is the same as the obstacle OBc detected last time.
  • the obstacle detection device 100 calculates the position coordinates of the distance measuring point MSc representing the position of the obstacle based on the current wave transmission sound wave and reflected sound wave. Further, the obstacle detection device 100 determines whether or not the distance measuring point MSc calculated this time is within the same object determination area SAc set based on the previous data.
  • the obstacle detection device 100 determines that the previously detected obstacle OBc and the currently detected obstacle are not the same object. , The obstacle detected this time is set to the reliability RL1.
  • the obstacle detection device 100 determines that the previously detected obstacle OBc and the currently detected obstacle are the same object.
  • the obstacle detected this time has a reliability RL2 higher than the reliability RL1.
  • the obstacle detection device 100 performs such identification determination for obstacles detected a plurality of times until a predetermined reliability is obtained, and when the predetermined reliability is obtained, the data is operated. Output to the support device 200.
  • the driving support device 200 may control the vehicle 1 based on the data. Further, in order to avoid a collision with an obstacle, the obstacle detection device 100 sends at least one of a signal for braking the vehicle body 2 of the vehicle 1 and a signal for suppressing the acceleration of the vehicle body 2 to the driving support device 200. You may output it.
  • the obstacle detection device 100 detects the obstacle by the first wave transmission sound wave and the corresponding reflected sound wave, and calculates the position coordinates and the angle of the obstacle.
  • the obstacle detection device 100 detects the obstacle by the second wave transmission sound wave and the corresponding reflected sound wave, and calculates the position coordinates of the obstacle.
  • the obstacle detection device 100 calculates an estimated point based on the position coordinates and the angle of the obstacle detected by the first wave transmission sound wave and the reflected sound wave, and determines the same object determination area based on the calculated estimated point. Set.
  • the obstacle detection device 100 determines whether or not the position coordinates of the obstacle detected by the second transmitted sound wave and the reflected sound wave are within the same object determination region based on the first transmitted sound wave and the reflected sound wave. Is determined.
  • the obstacle detection device 100 detects the obstacles for the first time and the second time, respectively. Is determined to be the same object, and the obstacle detected the second time is set as the reliability RL2. Further, the obstacle detection device 100 calculates the angle of the obstacle detected for the second time.
  • the obstacle detection device 100 detects the obstacle by the third wave transmission sound wave and the corresponding reflected sound wave, and calculates the position coordinates of the obstacle.
  • the obstacle detection device 100 calculates an estimated point based on the position coordinates and the angle of the obstacle detected by the second wave transmission sound wave and the reflected sound wave, and determines the same object determination area based on the calculated estimated point. Set.
  • the obstacle detection device 100 determines whether or not the position coordinates of the obstacle detected by the third transmitted sound wave and the reflected sound wave are within the same object determination region based on the second transmitted sound wave and the reflected sound wave. Is determined.
  • the obstacle detection device 100 detects the obstacle at the second time and the third time, respectively. Is determined to be the same object, and the obstacle detected the third time is set to the reliability RL3 higher than the reliability RL2.
  • the obstacle detection device 100 determines that the obstacles detected by the first to third transmission sound waves and the reflected sound waves are the same two times in a row, and detects the third time. It is assumed that a predetermined reliability has been obtained for the obstacle because the obstacle has a reliability of RL3. Then, the obstacle detection device 100 issues an instruction to the driving support device 200 to control the vehicle 1 based on the obstacle detected the third time.
  • the position coordinates of the obstacle detected the second time are outside the same object determination area set the first time, or the position coordinates of the obstacle detected the third time are set the second time. If it is outside the same object judgment area, the accumulation of reliability is canceled. The obstacle detection device 100 again accumulates the reliability from that point, and determines the same object until the reliability RL3 is obtained.
  • the obstacle detection device 100 determines the obstacle detected the second time with the reliability RL2. , RL1 with lower reliability than RL3. Then, if it is determined that the obstacle detected the third time is the same as the obstacle detected the second time, the obstacle detection device 100 determines the obstacle detected the third time as the reliability RL2. And. After that, the same thing is determined until the reliability RL3 is obtained.
  • the obstacle detection device 100 sets the obstacle detected the third time as the reliability RL1. do. Then, if it is determined that the obstacle detected the fourth time is the same as the obstacle detected the third time, the obstacle detection device 100 determines the obstacle detected the fourth time as the reliability RL2. And. After that, the same thing is determined until the reliability RL3 is obtained.
  • the obstacle detection device 100 returns to the reliability RL1 every time it is determined that the obstacle detected a predetermined number of times is not the same as the previous obstacle.
  • the reliability is the reliability RL1 and the obstacle detected this time (at a predetermined number of times) is determined to be the same as the previous obstacle, the reliability is increased to the reliability RL2.
  • the reliability is RL1 if it is determined that the obstacle detected this time (at a predetermined number of times) is not the same as the obstacle before that, the reliability remains the reliability RL1.
  • the reliability is the reliability RL2, if the obstacle detected this time (at a predetermined number of times) is determined to be the same as the previous obstacle, the reliability is increased to the reliability RL3.
  • the reliability returns to the reliability RL1.
  • the reliability is the reliability RL3 and the obstacle detected this time (at a predetermined number of times) is determined to be the same as the previous obstacle, the reliability remains the reliability RL3. If it is determined that the obstacle detected this time (at a predetermined number of times) is not the same as the obstacle before that, the reliability returns to the reliability RL1.
  • the obstacle detection device 100 has three levels of reliability of reliability RL1, reliability RL2, and reliability RL3, but is not limited to this, and is not limited to this, and has two levels of reliability RL1 and reliability RL2. It may have reliability.
  • the reliability is the reliability RL1
  • the reliability is the reliability RL2
  • the reliability remains the reliability RL2. If it is determined that the obstacle detected this time (at a predetermined number of times) is not the same as the previous obstacle in the same case where the reliability is RL2, the reliability is returned to the reliability RL1. May be good.
  • FIG. 6 is a schematic diagram showing a case where the obstacle detection device 100 according to the first embodiment determines the same object for an obstacle OBd obliquely arranged with respect to the vehicle 1. As shown in FIG. 6, the same object determination of the obstacle OBd is performed in the same manner as the same object determination of the obstacle OBc described above.
  • the obstacle detection device 100 calculates the estimated point ESd based on the previous data and sets the same object determination area SAd from the estimated point ESd when performing the same object determination.
  • the same object determination area SAd is set to correspond to the angle of the obstacle OBd previously detected and identified. That is, the pair of long sides of the same object determination region SAd is parallel to the surface SRd of the obstacle OBd facing the vehicle 1 side, and is orthogonal to the normal direction NRd of the surface SRd of the obstacle OBd.
  • the same thing determination area SAd is set in.
  • the obstacle detection device 100 sends a wave transmission sound wave to perform this measurement. If the reflected sound wave corresponding to the transmitted sound wave is received, it means that an obstacle is detected in the vicinity of the vehicle 1.
  • the obstacle detection device 100 calculates the position coordinates of the range-finding point MSd in the obstacle based on the current wave transmission sound wave and the reflected sound wave, and determines whether or not the range-finding point MSd is in the same object determination region SAd. judge.
  • the ranging point MSd moves with the movement of the vehicle 1.
  • the AF point MSd shifts to the back side of the surface SRd of the obstacle OBd, that is, to the side away from the vehicle 1.
  • the same object determination region SAd is set to correspond to the angle of the obstacle OBd, so that the obstacle detected by the current wave transmission sound wave and the reflected sound wave is the obstacle OBd detected last time. If it is the same as the same object, even if the AF point MSd shifts to the back side, there is a high possibility that the object remains within the same object determination region SAd.
  • the depth of the same object determination areas SAc and SAd that is, the distance of the pair of short sides functions as the threshold value for the same object determination.
  • the obstacle detection device 100 sets the obstacle detected this time as the reliability RL1, and the distance measuring point MSd is inside the same object determination area SAd. In this case, the obstacle detected this time is set to the reliability RL2.
  • the obstacle detection device 100 performs such an same object determination for obstacles detected a plurality of times until a predetermined reliability is obtained, and when the predetermined reliability is obtained, the vehicle of the driving support device 200 Let the control device 20 control the vehicle 1.
  • the transmitting / receiving unit 5f transmits the first transmitted sound wave, and receives the first reflected sound wave corresponding to the first transmitted sound wave as the received sound wave.
  • the obstacle detection device 100 is based on the first wave transmission sound wave and the first reflected sound wave, and has a first angle with respect to the X direction of the vehicle 1 in the normal direction of the surface of the first obstacle facing the vehicle 1. And the position of the first obstacle. Further, the obstacle detection device 100 sets a first identical object determination region corresponding to the first angle of the first obstacle based on the first angle and the position of the first obstacle.
  • the transmitting / receiving unit 5f transmits the second transmitted sound wave, and receives the second reflected sound wave corresponding to the second transmitted sound wave as the received sound wave.
  • the obstacle detection device 100 has a second angle with respect to the X direction of the vehicle 1 in the normal direction of the surface of the second obstacle facing the vehicle 1 side based on the second wave transmission sound wave and the second reflected sound wave. , The position of the second obstacle is obtained.
  • the obstacle detection device 100 sets the reliability of the second obstacle to the reliability RL2 higher than the reliability RL1.
  • the obstacle detection device 100 sets a second identical object determination region corresponding to the second angle of the second obstacle based on the second angle and the position of the second obstacle.
  • the transmitting / receiving unit 5f transmits the third transmitted sound wave, and receives the third reflected sound wave corresponding to the third transmitted sound wave as the received sound wave.
  • the obstacle detection device 100 obtains the position of the third obstacle based on the third wave transmission sound wave and the third reflected sound wave.
  • the obstacle detection device 100 sets the reliability of the third obstacle to the reliability RL3 higher than the reliability RL2. Further, when the reliability of the third obstacle is the reliability RL3, the obstacle detection device 100 brakes the vehicle body 2 based on the position of the third obstacle and / or suppresses the acceleration of the vehicle body 2. Output the signal as follows.
  • the obstacle detection device 100 sets the reliability of the third obstacle as the reliability RL1. Further, when the reliability of the third obstacle is the reliability RL1, the obstacle detection device 100 does not brake the vehicle body 2 based on the position of the third obstacle and / or suppresses the acceleration of the vehicle body 2. Output a signal so as not to. That is, the obstacle detection device 100 outputs a signal to the vehicle control device 20 so that the vehicle 1 normally travels.
  • FIG. 9 is a state transition diagram showing a state transition related to the reliability of the obstacle detected by the obstacle detection device 100.
  • the obstacle detection device 100 has the lowest reliability RL0 (ST1) when there is no obstacle detection coordinate at the beginning. In ST1, if there is no detection coordinate (TR12), the state of ST1 continues. In ST1, when there are detection coordinates (TR11), the reliability becomes the reliability RL1 (ST2) higher than the reliability RL0. In ST2, as described with reference to FIGS. 5 and 6, when the same thing determination is established (TR21), the reliability becomes the reliability RL2 (ST3) higher than the reliability RL1. When the detection coordinates are lost in ST2 (TR23), the process returns to ST1. In ST3, when the same thing determination is established as described with reference to FIGS.
  • the reliability becomes the reliability RL3 (ST4) higher than the reliability RL2.
  • the process returns to ST1.
  • ST3 although there are detection coordinates, if the same thing determination is not established (TR33), the process returns to ST2.
  • the reliability continues to be the reliability RL3 (ST4).
  • the detection coordinates are lost (TR44)
  • the process returns to ST1.
  • the detection coordinates are lost (TR44)
  • the process returns to ST1.
  • the process returns to ST2.
  • FIG. 7 is a flow chart showing a processing procedure in the obstacle detection device 100 according to the first embodiment.
  • the obstacle detection device 100 determines whether or not any of the transmission / reception devices 51 and 52 of the transmission / reception unit 5 has received the reflected sound wave corresponding to the transmission / reception sound wave (step). S101).
  • step S101 When any of the transmitting / receiving devices 51 and 52 received the reflected sound wave (step S101: Yes), the obstacle detection device 100 reflected the transmitted sound wave based on the transmitted sound wave and the reflected sound wave. The position coordinates of the obstacle are calculated (step S102).
  • the obstacle detection device 100 is an obstacle detected last time by the transmitted / received sound wave and the reflected sound wave from the position coordinates of the obstacle detected based on the transmitted / received sound wave and the reflected sound wave last time.
  • An estimated point is calculated by estimating the position coordinates when the object is detected again (step S103).
  • the obstacle detection device 100 is when the reflected sound wave corresponding to the transmitted sound wave transmitted last time is not obtained, that is, when the obstacle is not detected by the transmission of the transmitted sound wave last time. May calculate an estimated point from the position coordinates of an obstacle detected based on the transmitted and received sound waves and the reflected sound waves two times before.
  • the obstacle detection device 100 determines whether or not the position coordinates calculated in the process of step S102 are within the same object determination area set based on the estimation point calculated in step S103, and is detected last time or two times before. The same object is determined for the obstacle and the obstacle detected this time (step S104).
  • the obstacle detection device 100 determines the reliability of the obstacle detected this time. It is determined whether or not a predetermined reliability has been reached (step S105).
  • the obstacle detection device 100 is determined to be the same object twice in a row in the same object determination process in step S104, and the reliability of the obstacle detected this time becomes the reliability RL3. Determine if it has been reached. That is, in the above example, the predetermined reliability in step S105 is defined as the reliability RL3.
  • step S105 When the reliability of the obstacle detected this time does not reach the predetermined reliability (step S105: No), the obstacle detection device 100 calculates the obstacle detected this time in the process of step S102. The angle of the obstacle detected this time is determined based on the position coordinates (step S107).
  • the obstacle detection device 100 is detected this time based on whether or not the position coordinates of the obstacle detected this time are within the positive objective region FA and how far they are out of the positive objective region FA. Determine the angle of the obstacle.
  • the obstacle detection device 100 returns to the process of step S101.
  • step S104 When it is determined in the process of step S104 that the obstacle detected last time or two times before is not the same as the obstacle detected this time (step S104: No), the obstacle detection device 100 is detected this time. With respect to the obstacle, the angle of the obstacle detected this time is determined based on the position coordinates calculated in the process of step S102 (step S108).
  • the obstacle detection device 100 returns to the process of step S101.
  • step S109 if none of the transmission / reception devices 51 and 52 has received the reflected sound wave (step S101: No), the obstacle detection device 100 determines whether or not the previous data exists. (Step S109).
  • step S109 If the previous data exists (step S109: Yes), the obstacle detection device 100 estimates the position coordinates of the obstacle at the present time (step S110), and the obstacle detected last time is based on the estimated position coordinates. The angle of the object is determined (step S111).
  • the obstacle detection device 100 returns to the process of step S101.
  • step S109 If the previous data does not exist (step S109: No), the obstacle detection device 100 invalidates the information such as the position, angle, and reliability of the obstacle acquired up to the previous time (step S112).
  • the obstacle detection device 100 returns to the process of step S101.
  • step S105 when the reliability of the obstacle detected this time reaches a predetermined reliability (step S105: Yes), the obstacle detection device 100 is based on the obstacle detected this time. At least one of the signal for braking the vehicle body 2 and the signal for suppressing the acceleration of the vehicle body 2 is output to the vehicle control device 20 of the driving support device 200 (step S106).
  • the obstacle detection device 100 returns to the process of step S101.
  • the coordinate estimation process in steps S103 and S110 described above does not necessarily have to be performed at the timing shown in FIG. 7.
  • the obstacle detection device 100 may continuously execute the coordinate estimation process in a predetermined cycle, and may refer to the most recently estimated coordinates at the timing of performing the processes of steps S104 and S111.
  • the obstacle detection device 100 may perform the above steps S101 to S112 in a time-division manner.
  • the position of the obstacle with respect to the vehicle 1 can be specified and controlled by the driving support device 200 as the vehicle 1 changes its position from time to time.
  • the driver may be notified of obstacle detection information, distance information to the obstacle, and the like. Notification of this information to the driver can be performed by displaying a warning on a navigation device, a head-up display, or the like. Alternatively, the information may be notified to the driver by sounding an alarm sound or blinking or lighting the LED lamp.
  • the predetermined reliability in step S105 is set to the reliability RL3, but the present invention is not limited to this, and the predetermined reliability in step S105 may be set to the reliability RL2.
  • the same object determination region SAd corresponding to the angle of the obstacle OBd is set based on the angle and the position of the obstacle OBd. That is, the same object determination region SAd is arranged so that the orthogonal direction of the long side of the same object determination region is along the normal direction NRd of the surface SRd facing the vehicle 1 side of the obstacle OBd.
  • the depth of the same object determination region SAd that is, the same object determination accuracy of the obstacle OBd located diagonally to the vehicle 1 can be improved without widening the threshold value. That is, for example, the threshold value for determining the same object can be narrowed to the extent that the resolution of the transmission / reception unit 5 allows. Therefore, it is possible to suppress erroneous determination that items that are not the same are the same, and it is possible to suppress erroneous control or unnecessary control of the vehicle 1.
  • the angles of the obstacles OBc and OBd are determined based on the positions of the obstacles OBc and OBd with respect to the vehicle 1.
  • the position of the obstacle OBc is within the normal objective region FA used for determining whether or not the obstacle OBc faces the vehicle 1, the surface of the obstacle OBc facing the vehicle 1 side. It is assumed that the angle of NRc in the normal direction of SRc is 0 ° with respect to the X direction of the vehicle 1.
  • the position of the obstacle OBd is outside the normal objective region FA used for determining whether or not the obstacle OBd faces the vehicle 1, the surface of the obstacle OBd facing the vehicle 1 side. It is assumed that the angle of NRd in the normal direction of SRd is tilted by a predetermined angle with respect to the X direction of the vehicle 1.
  • the depths of the same object determination regions SAc and SAd that is, the threshold values, are aligned between the obstacle OBc facing the vehicle 1 and the obstacle OBd oblique to the vehicle 1. It is possible to determine the same object with the same accuracy for each obstacle OBc and OBd.
  • the angle + ⁇ of the obstacle OBd increases as the position of the obstacle OBd deviates to the outside of the positive objective region FA toward the + Y direction of the vehicle 1. It shall be large. Further, it is assumed that the angle ⁇ of the obstacle becomes smaller as the position of the obstacle deviates from the positive objective region FA toward the ⁇ Y direction of the vehicle 1.
  • the angle of the obstacle OBd can be determined more accurately, and the same object determination area SAd can be set more appropriately. Therefore, the accuracy of the same object determination is further improved.
  • the obstacle detection device 100 determines that the plurality of obstacles detected at different timings are the same twice in a row, and the reliability of the predetermined obstacle is determined.
  • An example of controlling the vehicle 1 when the reliability reaches RL3 has been described.
  • the obstacle detection device 100 determines that the obstacle is the same three times in a row or more in a row, the obstacle detection device 100 determines that the obstacle has reached a predetermined reliability and determines that the obstacle 1 has reached a predetermined reliability. Control may be performed.
  • FIGS. 5, 6 and 9 the case where the obstacle is stationary has been described, but the present invention is not limited to this.
  • the above techniques can be applied even when obstacles move.
  • the obstacle detection device 110 according to the second embodiment is basically the same as the obstacle detection device 100 according to the first embodiment in terms of the technical features of FIGS. 1 to 4 and 7. , The description is omitted here.
  • FIG. 10 is a schematic diagram showing how the obstacle detection device 110 determines the same object for the stationary obstacle OBs that are stationary.
  • the surface SRs of the obstacle OBs face the vehicle 1.
  • “stationary” means that the vehicle is absolutely stationary, and when the vehicle 1 is moving forward, for example, the stationary obstacles OBs are the vehicles as a relative positional relationship with the vehicle 1. It means approaching 1.
  • the obstacle detection device 110 detects obstacles OBs at a predetermined cycle.
  • the obstacle detection device 110 calculates the position of the stationary obstacle OBs as the stationary estimation point ESs based on the previous data detected last time, and sets the stationary identical object determination region SAs from the stationary estimation point ESs.
  • the resting same object determination region SAs is a rectangle having a pair of long sides and a pair of short sides.
  • the present invention is not limited to this, and may be a square, a parallelogram, or a mere quadrangle. Alternatively, it may simply have a predetermined shape.
  • the obstacle detection device 110 calculates the position of the moving obstacle OBm as the moving estimated point ESm based on the previous data detected last time, and sets the moving same object determination area SAm from the moving estimated point ESm.
  • the movement of the moving obstacle OBm means that the obstacle is absolutely moving. If the moving obstacle OBm is moving in the same direction as the vehicle 1 at the same speed, the relative positional relationship between the vehicle 1 and the moving obstacle OBm is stationary. As an example of the moving obstacle OBm, another vehicle traveling in front of the vehicle 1 during a traffic jam can be considered.
  • the moving identical object determination region SAm is a rectangle having a pair of long sides and a pair of short sides, but the present invention is not limited to this. It may be a square, a parallelogram, or just a quadrangle. Alternatively, it may simply have a predetermined shape.
  • the previous data is the position coordinates of the obstacle OBs or the obstacle OBm calculated based on the transmitted sound wave and the reflected sound wave transmitted and received before the transmitted sound wave to be transmitted from now on.
  • the obstacle detection device 110 calculates the static estimation point ESs and the movement estimation point ESm from these previous data.
  • the stationary estimation point ESs is the vehicle 1 at the present time based on the coordinates of the stationary obstacle OBs and the moving obstacle OBm detected last time, and the movement amount and turning angle of the vehicle 1 from the time of the previous detection to the present. It can be obtained by calculating the relative positions of the previously detected stationary obstacles OBs and moving obstacles OBm with respect to the coordinates.
  • the stationary estimation points ESs estimate the positions of stationary obstacles that will be detected by the next transmitted sound wave.
  • the static identical object determination region SAs is a rectangular region having a pair of long sides and a pair of short sides, with the calculated static estimation point ESs as the center point.
  • the length of the pair of long sides is determined according to the distance from the vehicle 1 (distance in the X direction).
  • the movement estimation point ESm is the vehicle 1 at the present time based on the coordinates of the stationary obstacle OBs and the moving obstacle OBm detected last time, and the movement amount and turning angle of the vehicle 1 from the time of the previous detection to the present. It can be obtained by calculating the relative positions of the previously detected stationary obstacles OBs and moving obstacles OBm with respect to the coordinates.
  • This movement estimation point ESm estimates the position of a moving obstacle that will be detected by the next wave transmission sound wave. Since the moving same object determination area SAm is premised on the movement of the moving obstacle OBm, it is set at a position farther than the stationary identical object determination area SAs with respect to the vehicle 1.
  • the moving identical object determination region SAm is a rectangular region having a pair of long sides and a pair of short sides with the calculated movement estimation point ESm as the center point.
  • the length of the pair of long sides is determined according to the distance from the vehicle 1 (distance in the X direction).
  • the obstacle detection device 110 sends a wave transmission sound wave for the next measurement.
  • the obstacle detection device 110 calculates the position coordinates of the ranging point MSe representing the position of the obstacle based on the current wave transmission sound wave and the reflected sound wave.
  • the obstacle detection device 110 determines whether or not the distance measuring point MSe calculated this time is within the stationary identical object determination area SAs set based on the previous data, and whether or not it is within the moving identical object determination area SAm. , Is determined.
  • the stationary identical object determination area SAs and the moving identical object determination area SAm are set so as to be separated from each other and overlap each other, but the present invention is not limited to this.
  • the stationary identical object determination area SAs and the moving identical object determination area SAm may be set so as to partially overlap each other (not shown). However, even in this case, the portion of the moving identical object determination region SAm that does not overlap with the stationary identical object determination region SAs is set at a position farther than the stationary identical object determination region SAs with respect to the vehicle 1.
  • FIG. 11 is a schematic diagram showing how the obstacle detection device 110 determines the same object for the moving obstacle OBm. It is the same as FIG. 10 except that the moving obstacle OBm is moving. In FIG. 11, it is assumed that the surface SRm of the obstacle OBm faces the vehicle 1.
  • the obstacle detection device 110 calculates the position coordinates of the ranging point MSe representing the position of the obstacle based on the current wave transmission sound wave and the reflected sound wave. Next, the obstacle detection device 110 determines whether or not the distance measuring point MSe calculated this time is within the stationary identical object determination area SAs set based on the previous data, and whether or not it is within the moving identical object determination area SAm. , Is determined.
  • FIG. 12 is a state transition diagram showing a state transition related to the reliability of the obstacle detected by the obstacle detection device 110.
  • ST1, ST2, TR11, TR12, TR23, TR34, and TR44 are basically the same as the state transition diagram shown in FIG. 9, and the description thereof will be omitted here.
  • the obstacle detection device 110 performs the static identical object determination shown in FIG. 10 and the moving identical object determination shown in FIG. 11 in each of the states of ST1 to ST6. It is executed, and the states of ST1 to ST6 are changed according to the result. Since the reliability RL1 is assigned to ST1, the reliability RL2 is assigned to ST3 and ST5, and the reliability RL3 is assigned to ST4 and ST6, the state of the obstacle detection device 110 is changed from ST2 to ST2. With the transition in ST6, the reliability is uniquely determined by the reliability RL1 to RL3.
  • the obstacle detection device 110 obtains the stationary identical object determination area SAs assumed to be the position of the stationary obstacle and the moving identical object determination area SAm assumed to be the position of the moving obstacle.
  • the reliability of the obstacle detection result is managed by using the stationary same object determination area SAs
  • the reliability of the obstacle detection result is managed by using the moving same object determination area SAm.
  • the driving support device 200 that receives the input of the obstacle detection result and the reliability can control the vehicle 1 in consideration of the reliability.
  • the vehicle 1 may be braked and / or the acceleration of the vehicle body may be suppressed only when an obstacle is detected and the reliability is RL3.
  • the brake actuator 24 may be used to apply the brake to the vehicle 1.
  • the obstacle detection device 110 may be mounted by superimposing the functions of the obstacle detection device 100.
  • the obstacle detection device 110 performs both the static identical object determination shown in FIG. 11 and the moving identical object determination shown in FIG. 12 as an example.
  • C1 With the first wheel A second wheel arranged in a predetermined direction along the rotation direction of the first wheel, and A vehicle body coupled to the first wheel and the second wheel and movable by the first wheel and the second wheel.
  • a wave transmitting unit arranged at a predetermined end of the vehicle body and transmitting a wave transmitting sound wave, and a wave transmitting unit.
  • a vehicle provided with a receiving portion arranged at the predetermined end of the vehicle body and receiving a receiving sound wave. The wave transmitting unit transmits the first wave transmitting sound wave, and the first wave transmitting sound wave is transmitted.
  • the receiving unit receives the first reflected sound wave corresponding to the first transmitted sound wave as the received sound wave, and receives the first reflected sound wave. Based on the first wave transmission sound wave and the first reflected sound wave, the position of the first obstacle is obtained, and the angle of the normal direction of the first surface of the first obstacle with respect to the predetermined direction is determined. Ask, Based on the position and the angle of the first obstacle, the same object determination region corresponding to the angle of the first obstacle is set. Next, the wave transmitting unit transmits a second wave transmitting sound wave, and the second wave transmitting sound wave is transmitted. The receiving unit receives the second reflected sound wave corresponding to the second transmitted sound wave as the received sound wave, and receives the second reflected sound wave.
  • the position of the second obstacle is obtained based on the second wave transmission sound wave and the second reflected sound wave.
  • the reliability of the second obstacle is set as the first reliability.
  • the reliability of the second obstacle is set to a second reliability higher than the first reliability. Braking the vehicle body and / or suppressing acceleration of the vehicle body based on the reliability of the second obstacle and the position of the second obstacle.
  • vehicle. (C2) The vehicle described in C1 In addition, it is equipped with a control circuit.
  • the control circuit Based on the first wave transmission sound wave and the first reflected sound wave, the position of the first obstacle is obtained, and the angle of the normal direction of the first surface of the first obstacle with respect to the predetermined direction is determined. Ask, Based on the position and the angle of the first obstacle, the same object determination region corresponding to the angle of the first obstacle is set. The position of the second obstacle is obtained based on the second wave transmission sound wave and the second reflected sound wave. When the position of the second obstacle is outside the same object determination region, the reliability of the second obstacle is set as the first reliability. When the position of the second obstacle is within the same object determination region, the reliability of the second obstacle is set to a second reliability higher than the first reliability.
  • vehicle. (C3) The vehicle described in C1 or C2.
  • the same object determination region has a pair of long sides and a pair of short sides.
  • the same object determination region is arranged so that the orthogonal direction of the long side of the same object determination region is along the normal direction of the first obstacle.
  • vehicle. (C4) The vehicle according to any one of C1 to C3.
  • the angle of the first obstacle in the normal direction of the first surface is When the normal direction of the first surface is the same as the predetermined direction of the vehicle, it is 0 degrees. When the normal direction of the first surface is to the left of the predetermined direction of the vehicle, it is an angle of a positive value. When the normal direction of the first surface is to the right of the predetermined direction of the vehicle, it is an angle of a negative value.
  • the wave transmitting unit transmits the first wave transmitting sound wave, and the first wave transmitting sound wave is transmitted.
  • the receiving unit receives the first reflected sound wave corresponding to the first transmitted sound wave as the received sound wave, and receives the first reflected sound wave.
  • the position of the first obstacle is obtained, and the first is the normal direction of the first surface of the first obstacle, with reference to the predetermined direction.
  • Find the angle Based on the position of the first obstacle and the first angle, a first identical object determination region corresponding to the first angle of the first obstacle is set.
  • the wave transmitting unit transmits a second wave transmitting sound wave, and the second wave transmitting sound wave is transmitted.
  • the receiving unit receives the second reflected sound wave corresponding to the second transmitted sound wave as the received sound wave, and receives the second reflected sound wave.
  • the position of the second obstacle is obtained based on the second wave transmission sound wave and the second reflected sound wave, and the second angle with respect to the predetermined direction in the normal direction of the first surface of the second obstacle. Seeking, When the position of the second obstacle is within the first same object determination region, the reliability of the second obstacle is set to a second reliability higher than the first reliability. Based on the position of the second obstacle and the second angle, a second identical object determination region corresponding to the second angle of the second obstacle is set.
  • the wave transmitting unit transmits a third wave transmitting sound wave, and the third wave transmitting sound wave is transmitted.
  • the receiving unit receives the third reflected sound wave corresponding to the third transmitted sound wave as the received sound wave, and receives the third reflected sound wave.
  • the position of the third obstacle is obtained based on the third wave transmission sound wave and the third reflected sound wave.
  • the reliability of the third obstacle is set to a third reliability higher than the second reliability.
  • the reliability of the third obstacle is the third reliability
  • braking is applied to the vehicle body based on the position of the third obstacle, and / or acceleration of the vehicle body is suppressed.
  • vehicle. (C6) The vehicle described in C5
  • the reliability of the third obstacle is defined as the first reliability.
  • the reliability of the third obstacle is the first reliability, the vehicle body is not braked and / or the acceleration of the vehicle body is not suppressed based on the position of the third obstacle. vehicle.
  • (C7) The vehicle according to any one of C1 to C6.
  • the predetermined end of the vehicle is the end of the vehicle in the predetermined direction.
  • vehicle. (C8) The vehicle according to any one of C1 to C7. With more bumpers, The wave transmitting portion and the receiving portion are arranged on the bumper. vehicle.
  • C9 The vehicle according to any one of C1 to C8.
  • a third wheel and a fourth wheel arranged in the predetermined direction in a direction along the rotation direction of the third wheel are provided.
  • the third wheel and the fourth wheel are coupled to the vehicle body.
  • the vehicle body is movable by the first wheel, the second wheel, the third wheel, and the fourth wheel. vehicle.
  • (C10) The vehicle according to any one of C1 to C9, further comprising a braking unit that applies braking to at least one of the first wheel and the second wheel.
  • a drive unit that drives at least one of the first wheel and the second wheel, To prepare vehicle.
  • a wave transmitting unit arranged at a predetermined end of the vehicle body and transmitting a wave transmitting sound wave, and a wave transmitting unit.
  • a receiving portion arranged at the predetermined end of the vehicle body and receiving a receiving sound wave is provided.
  • the wave transmitting unit transmits the first wave transmitting sound wave, and the first wave transmitting sound wave is transmitted.
  • the receiving unit receives the first reflected sound wave corresponding to the first transmitted sound wave as the received sound wave, and receives the first reflected sound wave.
  • the position of the first obstacle is obtained, and the angle of the normal direction of the first surface of the first obstacle with respect to the predetermined direction is determined.
  • Ask Based on the position and the angle of the first obstacle, the same object determination region corresponding to the angle of the first obstacle is set.
  • the wave transmitting unit transmits a second wave transmitting sound wave, and the second wave transmitting sound wave is transmitted.
  • the receiving unit receives the second reflected sound wave corresponding to the second transmitted sound wave as the received sound wave, and receives the second reflected sound wave.
  • the position of the second obstacle is obtained based on the second wave transmission sound wave and the second reflected sound wave.
  • the reliability of the second obstacle is set as the first reliability.
  • the reliability of the second obstacle is set to a second reliability higher than the first reliability. Based on the reliability of the second obstacle and the position of the second obstacle, the vehicle body is braked and / or a signal is output so as to suppress the acceleration of the vehicle body.
  • Obstacle detection device (C12) The obstacle detection device according to C11.
  • the control circuit Based on the first wave transmission sound wave and the first reflected sound wave, the position of the first obstacle is obtained, and the angle of the normal direction of the first surface of the first obstacle with respect to the predetermined direction is determined. Ask, Based on the position and the angle of the first obstacle, the same object determination region corresponding to the angle of the first obstacle is set. The position of the second obstacle is obtained based on the second wave transmission sound wave and the second reflected sound wave. When the position of the second obstacle is outside the same object determination region, the reliability of the second obstacle is set as the first reliability. When the position of the second obstacle is within the same object determination region, the reliability of the second obstacle is set to a second reliability higher than the first reliability. Obstacle detection device.
  • the obstacle detection device according to C11 or C12.
  • the same object determination region has a pair of long sides and a pair of short sides.
  • the same object determination region is arranged so that the orthogonal direction of the long side of the same object determination region is along the normal direction of the first obstacle.
  • Obstacle detection device. (C14) The obstacle detection device according to any one of C11 to C13.
  • the angle of the first obstacle in the normal direction of the first surface is When the normal direction of the first surface is the same as the predetermined direction of the vehicle, it is 0 degrees. When the normal direction of the first surface is to the left of the predetermined direction of the vehicle, it is an angle of a positive value.
  • the wave transmitting unit transmits the first wave transmitting sound wave, and the first wave transmitting sound wave is transmitted.
  • the receiving unit receives the first reflected sound wave corresponding to the first transmitted sound wave as the received sound wave, and receives the first reflected sound wave. Based on the first wave transmission sound wave and the first reflected sound wave, the position of the first obstacle is obtained, and the first is the normal direction of the first surface of the first obstacle, with reference to the predetermined direction. Find the angle, Based on the position of the first obstacle and the first angle, a first identical object determination region corresponding to the first angle of the first obstacle is set. Next, the wave transmitting unit transmits a second wave transmitting sound wave, and the second wave transmitting sound wave is transmitted. The receiving unit receives the second reflected sound wave corresponding to the second transmitted sound wave as the received sound wave, and receives the second reflected sound wave.
  • the position of the second obstacle is obtained based on the second wave transmission sound wave and the second reflected sound wave, and the second angle with respect to the predetermined direction in the normal direction of the first surface of the second obstacle. Seeking, When the position of the second obstacle is within the first same object determination region, the reliability of the second obstacle is set to a second reliability higher than the first reliability. Based on the position of the second obstacle and the second angle, a second identical object determination region corresponding to the second angle of the second obstacle is set.
  • the wave transmitting unit transmits a third wave transmitting sound wave, and the third wave transmitting sound wave is transmitted.
  • the receiving unit receives the third reflected sound wave corresponding to the third transmitted sound wave as the received sound wave, and receives the third reflected sound wave.
  • the position of the third obstacle is obtained based on the third wave transmission sound wave and the third reflected sound wave.
  • the reliability of the third obstacle is set to a third reliability higher than the second reliability.
  • the reliability of the third obstacle is the third reliability, a signal is given to brake the vehicle body based on the position of the third obstacle and / or suppress the acceleration of the vehicle body.
  • Obstacle detection device (C16) The obstacle detection device according to C15.
  • the reliability of the third obstacle is defined as the first reliability.
  • Obstacle detection device When the reliability of the third obstacle is the first reliability, the vehicle body is not braked based on the position of the third obstacle and / or the acceleration of the vehicle body is not suppressed. Output a signal, Obstacle detection device.
  • C17 The obstacle detection device according to any one of C11 to C16.
  • the predetermined end of the vehicle is the end of the vehicle in the predetermined direction.
  • Obstacle detection device. (C18) The obstacle detection device according to any one of C11 to C17. With more bumpers, The wave transmitting portion and the receiving portion are arranged on the bumper. Obstacle detection device.
  • C19 The obstacle detection device according to any one of C11 to C18.
  • the vehicle further comprises a third wheel and a fourth wheel arranged in the predetermined direction along the direction of rotation of the third wheel.
  • the third wheel and the fourth wheel are coupled to the vehicle body.
  • the vehicle body is movable by the first wheel, the second wheel, the third wheel, and the fourth wheel.
  • Obstacle detection device (C20) The obstacle detection device according to any one of C11 to C19, wherein the vehicle further includes a braking unit that brakes at least one of the first wheel and the second wheel.
  • a drive unit that drives at least one of the first wheel and the second wheel, To prepare Obstacle detection device.

Abstract

本開示にかかる車両は、第1送波音波および第1反射音波の第1障害物の位置に基づき、第1障害物の静止同一物判定領域と、車体を基準に静止同一物判定領域よりも遠い位置の移動同一物判定領域とを設定し、第2送波音波および第2反射音波の第2障害物の位置が、静止同一物判定領域外であり、かつ移動同一物判定領域外である場合、第2障害物の信頼度を第1信頼度とし、第2障害物の位置が、静止同一物判定領域内である、又は移動同一物判定領域内である場合、第2障害物の信頼度を、第1信頼度より高い第2信頼度とし、第2障害物の信頼度と、第2障害物の位置とに基づいて、車体に制動をかけ、及び/又は車体の加速を抑制する。

Description

車両および障害物検知装置
 本開示は、車両および障害物検知装置に関する。
 車両に搭載され、音波の反射を用いて障害物を検知する障害物検知装置が知られている(特許文献1)。
特開2016-081449号公報
 ところで、車両に搭載され、音波の反射を用いて障害物を検知する障害物検知装置は、障害物を適切に検知することが、引き続き求められている。
 本開示は、障害物の検出結果の精度を高めることができる車両および障害物検知装置を提供する。
 本開示にかかる車両は、所定の方向に沿って配置された第1車輪及び第2車輪と、前記第1車輪及び前記第2車輪に結合され、前記第1車輪及び前記第2車輪によって移動可能な車体と、前記車体の所定の端部に配置され、送波音波を送波する送波部と、前記車体の前記所定の端部に配置され、受波音波を受波する受波部と、を備える車両であって、前記送波部は、第1送波音波を送波し、前記受波部は、前記第1送波音波に対応する第1反射音波を、前記受波音波として受波し、前記第1送波音波および前記第1反射音波に基づき、少なくとも第1障害物の位置を求め、前記第1障害物の前記位置に基づき、静止同一物判定領域と、前記車体を基準に前記静止同一物判定領域よりも遠い位置の移動同一物判定領域とを設定し、次に、前記送波部は、第2送波音波を送波し、前記受波部は、前記第2送波音波に対応する第2反射音波を、前記受波音波として受波し、前記第2送波音波および前記第2反射音波に基づき第2障害物の位置を求め、前記第2障害物の前記位置が、前記静止同一物判定領域外であり、かつ前記移動同一物判定領域外である場合、前記第2障害物の信頼度を第1信頼度とし、前記第2障害物の前記位置が、前記静止同一物判定領域内である、又は前記移動同一物判定領域内である場合、前記第2障害物の信頼度を、前記第1信頼度より高い第2信頼度とし、前記第2障害物の前記信頼度と、前記第2障害物の前記位置とに基づいて、前記車体に制動をかけ、及び/又は前記車体の加速を抑制する。
図1は、第1の実施形態にかかる障害物検知装置を備える車両の一例を示す模式図である。 図2は、第1の実施形態にかかる障害物検知装置を備える車両の構成の一例を示すブロック図である。 図3は、第1の実施形態にかかる障害物検知装置が障害物の位置を特定する場合の一例を示す模式図である。 図4は、第1の実施形態にかかる障害物検知装置が障害物の角度を特定する場合の一例を示す模式図である。 図5は、第1の実施形態にかかる障害物検知装置が車両に正対する障害物について同一物判定をする場合の一例を示す模式図である。 図6は、第1の実施形態にかかる障害物検知装置が車両に対して斜めに配置される障害物について同一物判定をする場合の一例を示す模式図である。 図7は、第1の実施形態にかかる障害物検知装置における処理の手順の一例を示すフロー図である。 図8は、比較例にかかる車両が障害物について同一物判定をする場合の一例を示す模式図である。 図9は、第1の実施形態にかかる障害物検知装置の検出した障害物の信頼度に係る状態遷移を示す状態遷移図である。 図10は、第2の実施形態にかかる障害物検知装置が静止した障害物について同一物判定をする場合の一例を示す模式図である。 図11は、第2の実施形態にかかる障害物検知装置が移動している障害物について同一物判定をする場合の一例を示す模式図である。 図12は、第2の実施形態にかかる障害物検知装置の検出した障害物の信頼度に係る状態遷移を示す状態遷移図である。
 以下、図面を参照しながら、本開示にかかる車両および障害物検知装置の実施形態について説明する。
[第1の実施形態]
 第1の実施形態の例について図面を用いて説明する。
(車両の構成)
 図1は、第1の実施形態にかかる障害物検知装置100を備える車両1を示す模式図である。図1に示すように、車両1は、車体2と、進行方向に沿って車体2に結合された2対の車輪3(1対のフロントタイヤ3f及び1対のリアタイヤ3r)とを備える。ここで、車両1の進行方向を所定の方向と捉えることも可能である。
 車体2は、フロントタイヤ3f側の端部である前端部F、リアタイヤ3r側の端部である後端部R、及びフロントタイヤ3fとリアタイヤ3rとの間の車体2の幅方向の端部である側端部Sとを有する。車体2は上面視で略矩形をしている。略矩形状において、4つある角部の一つ一つを端部と捉えることも可能である。
 図1(a)に示すように、フロントバンパー4fは、車体2の前端部Fにおいて車体2の下端付近に設けられ、リアバンパー4rは、車体2の後端部Rにおいて車体2の下端付近に設けられている。図1(b)に示すように、フロントバンパー4fは車体2の前端部Fにおいて前面全体と側面の一部を覆い、リアバンパー4rは車体2の後端部Rにおいて後面全体と側面の一部を覆う。フロントバンパー4f及びリアバンパー4rは1対のバンパー4を構成する。
 送受波部5は、車体2の所定の端部に配置され、送波部としての送受波部5は音波を送波し、送波音波の反射音波を受波部として受波する。送受波部5は、少なくとも前端部Fに配置された送受波部5fと、後端部Rに配置された送受波部5rとから構成される。
 送受波部5fはフロントバンパー4fに配置され、送受波部5rは、リアバンパー4rに配置される。送受波部5は、車両1の両側端部Sの少なくとも一方に配置されていてもよいし、車両1の4つの角部の少なくとも一つに配置されてもよい。
 送受波部5fは、送受波装置51a~51dを備える。ただし、送受波装置51の数は4個に限らず任意である。送受波装置51a~51dは、フロントバンパー4fに所定の距離間隔で配置されるようにしても良い。
 各々の送受波装置51a~51dは、所定の周期で送波音波を送波し、送波のタイミングとは異なるタイミングの所定の周期で反射音波を受波する。つまり、各々の送受波装置51a~51dは、送波タイミングと受波タイミングとが交互に入れ替わるように構成されている。送受波装置51a~51dのうち、隣り合う送受波装置51a,51b同士、送受波装置51b,51c同士、及び送受波装置51c,51d同士のいずれか一方が送波状態にあるとき、いずれか他方が受波状態となるよう構成されていてもよい。
 送受波部5rは、送受波装置52a~52dを備える。ただし、送受波装置52の数は4個に限らず任意である。送受波装置52a~52dは、リアバンパー4rに所定の距離間隔で配置される。なお、送受波装置51a~51dの所定の距離間隔と、送受波装置52a~52dの所定の距離間隔とは、同じでも良いし、異なっても良い。
 各々の送受波装置52a~52dは、所定の周期で送波音波を送波し、送波のタイミングとは異なるタイミングの所定の周期で反射音波を受波する。つまり、各々の送受波装置52a~52dは、送波タイミングと受波タイミングとが交互に入れ替わるように構成されている。送受波装置52a~52dのうち、隣り合う送受波装置52a,52b同士、送受波装置52b,52c同士、及び送受波装置52c,52d同士のいずれか一方が送波状態にあるとき、いずれか他方が受波状態となるよう構成されていてもよい。
 上記のように構成される送受波部5は、障害物検知装置100に含まれる。障害物検知装置100は車体2に搭載され、超音波等の音波により車両1の周囲の障害物等を検知する。
 車両1は、進行方向に沿って配置された車輪3を用いて進行方向に走行することが可能である。車輪3は、車両1の前半部に配置された一対の車輪3(フロントタイヤ3f)と、車両1の後半部に配置された一対の車輪3(リアタイヤ3r)とから構成される。車両1は、進行方向に沿って、ギアの切り替え等により前進または後退することができ、フロントタイヤ3fの転舵により右左折することもできる。ここで車両1は4輪を有する4輪車であるが、これに限らない。3輪車でも、2輪車でも、或いは5輪以上を用いる車両であっても良い。
 本明細書では、車両1の進行方向、即ち2対の車輪3の配置方向をX方向とし、フロントタイヤ3f側は正の値を、リアタイヤ3r側は負の値をとるものとする。また、X方向に対し、水平面上に直交する方向をY方向とし、X方向の正の向きに対して左側はY方向の正の値を、右側は負の値をとるものとする。また、X方向およびY方向に直交する上下方向をZ方向とし、上方向は正の値を、下方向は負の値をとるものとする。
(障害物検知装置の構成)
 図2は、第1の実施形態にかかる障害物検知装置100を備える車両1の構成を示すブロック図である。図2に示すように、車両1は障害物検知装置100と運転支援装置200とを備える。
 障害物検知装置100は、送受波部5f,5r及びECU(Electronic Cotrol Unit)10を備え、車両1の近傍の障害物を検知する。運転支援装置200は、ECU10及び車両制御装置20を備え、運転者による車両1の運転を支援する。
 制御回路としてのECU10は、CPU(Central Processing Unit)11、RAM(Random Access Memory)12、及びROM(Read Only Memory)13を備えたコンピュータとして構成されている。また、ECU10は、車両制御装置20の各部および送受波部5f,5rと、各種情報の送受信が可能なI/O(Input/Output)ポート15を備えている。
 ECU10のRAM12、ROM13、記憶装置14、及びI/Oポート15の各構成は、内部バスを介してCPU11と各種情報の送受信が可能に構成されている。
 ECU10は、ROM13にインストールされているプログラムをCPU11が実行することにより、送受波部5f,5rにおける送波音波および反射音波に基づいて、車両1の近傍に障害物がある場合にはそれを検知する。また、ECU10は、障害物の検知結果に基づいて、車両1への制御を行うよう指示する信号を車両制御装置20へと出力する。
 車両制御装置20は、車速センサ21、アクセルセンサ22、ブレーキセンサ23、ブレーキアクチュエータ24、及びエンジンコントローラ25を備える。
 車速センサ21は車両の速度を検知する。アクセルセンサ22は、運転者によるアクセルペダルの操作量を検知する。ブレーキセンサ23は、運転者によるブレーキペダルの操作量を検知する。
 制動部としてのブレーキアクチュエータ24は、フロントタイヤ3f及びリアタイヤ3rの少なくともいずれかに制動をかける。駆動部としてのエンジンコントローラ25は、通常走行時はアクセルセンサ22の検知結果に基づいて、図示しないエンジンの出力制御を行って、車両1の加減速制御を実行する。
 車両制御装置20は、車速センサ21、アクセルセンサ22、及びブレーキセンサ23等により車両1の各部の状態を示す情報を取得する。車両制御装置20は、これらの情報およびECU10から受信した信号に基づいて、ブレーキアクチュエータ24及びエンジンコントローラ25の少なくともいずれかを制御することで、ECU10が検知した障害物を回避するよう車両1を制御する。ここで車両1は、エンジンとエンジンコントローラ25とを備えるようにしたが、これに限らない。電動モータと、それを制御するモータコントローラとを備えるようにして、ブレーキアクチュエータ24及びモータコントローラの少なくともいずれかを制御することで、ECU10が検知した障害物を回避するように車両1を制御するようにしても良い。
 すなわち、車両制御装置20は、ブレーキアクチュエータ24を制御して車体2に制動をかけることで、車両1と障害物との衝突回避を図る。これに替えて、または加えて、車両制御装置20は、エンジンコントローラ25によりエンジンの出力を数秒間抑制させ、車体2の加速を抑制することで、車両1と障害物との衝突回避を図ってもよい。
 また、車両1のアクセルペダルが電子制御されるタイプであり、車両制御装置20がアクセルペダルの開度を制御する機構を備える場合もあり得る。このような場合には、上記のエンジン出力の抑制に替えて、または加えて、車両制御装置20は、駆動部としてのアクセルペダル制御機構によって、アクセルペダルの開度を制御して車体2の加速を抑制することで、車両1と障害物との衝突回避を図ってもよい。
 このように、車両制御装置20が、車体2に制動をかける機能および車体2の加速を抑制する機能の少なくともいずれかを有することで、運転支援装置200が、ペダル踏み間違い時加速抑制装置、衝突被害軽減ブレーキ等として機能するように構成されていてもよい。ペダル踏み間違い時加速抑制装置および衝突被害軽減ブレーキ等は、運転者が誤ってアクセルペダルを強く踏み込み過ぎてしまったような場合に、近傍の障害物への衝突を回避するよう運転者への運転支援を行う機能である。
(障害物検知装置の位置特定)
 次に、図3及び図4を用いて、第1の実施形態の障害物検知装置100が障害物の位置および角度を特定する手法について説明する。ここで障害物の位置とは、上面視における位置であり、即ち、X方向とY方向の面、即ちXY面における位置である。また、ここで障害物の角度とは、障害物において送波音波を反射する面の法線方向の、車両1の進行方向を基準にした角度である。この角度についても、上面視における角度であり、即ち、XY面における角度である。
 図3及び図4において、障害物検知装置100が、車体2の前端部の送受波部5fの送波音波および反射音波に基づいて、車両1の前方に存在する障害物の位置および角度を特定する場合について説明する。ただし、車体2の後端部の送受波部5rの送波音波および反射音波に基づく、車両1の後方の障害物の位置および角度の特定も、以下に説明する手法と同様に実施することができる。
 図3は、第1の実施形態にかかる障害物検知装置100が障害物OBの位置を特定する場合の模式図である。
 図3に示すように、車両1の前方に障害物OBがあるものとする。障害物OBは、車両1の側に向いた第1の面としての面SRを有している。障害物検知装置100は、送受波部5fの送受波装置51a~51dによる送波音波および反射音波から障害物OBを検知する。
 このとき、送受波部5fが備える複数の送受波装置51のうち、隣り合う2つの送受波装置51の送波音波および反射音波に基づいて、障害物OBの位置が特定される。図3では、隣り合う2つの送受波装置51b,51cが用いられる場合について示す。
 送受波装置51cは、車両1の前方に向け所定範囲の角度で送波音波を送波する。ここで、所定範囲の角度とは、XY面におけるもので、進行方向即ちX方向が基準である。これらの送波音波のうち、送波音波Rct,Rbtについて説明する。
 送波音波Rctは、障害物OBの面SRに当って反射される。送波音波Rctが反射された反射音波Rcrは、送波音波Rctと同じ経路を通って送受波装置51cへと到達し、送受波装置51cによって受波される。
 障害物検知装置100は、送波音波Rctの送波タイミングから反射音波Rcrの受波タイミングまでの飛翔時間と、音速から送波音波Rctと反射音波Rcrに係る飛翔距離を算出し、この飛翔距離を2で除した値を送受波装置51cから障害物OBまでの距離とする。ここで、障害物検知装置100は、送受波装置51cから障害物OBまでの距離を半径とする仮想円CRcを設定することができる。
 次に、送波音波Rbtは、障害物OBの面SRに当って反射し、反射音波Rbrとなって送受波装置51bへと到達する。ここで、送波音波Rbtの面SRの法線方向を基準にした入射角と、反射音波Rbrの面SRの法線方向を基準にした反射角は、一致する。
 障害物検知装置100は、送波音波Rbtの送波タイミングから反射音波Rbrの受波タイミングまでの飛翔時間と、音速から送波音波Rbtと反射音波Rbrに係る飛翔距離を算出し、この飛翔距離から仮想円CRcの半径の値を減じた値を、障害物OBの面SRにおける反射音波Rbrの反射位置から反射音波Rbrの受波位置である送受波装置51bまでの距離とする。ここで、障害物検知装置100は、障害物OBの面SRにおける反射音波Rbrの反射位置から反射音波Rbrの受波位置である送受波装置51bまでの距離を半径とする仮想円CRbを設定することができる。
 障害物検知装置100は、2つの仮想円CRc,CRbの交点のうち、送波音波Rct,Rbtの送波方向側の交点を、障害物OBの位置座標を表す測距点MSとする。これにより、送受波部5fの送波音波Rct,Rbt及び反射音波Rcr,Rbrに基づいて、障害物OBの位置を特定することができる。
 図4は、第1の実施形態にかかる障害物検知装置100が障害物OBc,OBdの角度を特定する場合を示す模式図である。
 図4に示すように、車両1の前方に2つの障害物OBc,OBdがあるものとする。障害物検知装置100は、障害物OBc,OBdのそれぞれの位置から、障害物OBc,OBdの車両1の進行方向を基準にした角度をそれぞれ特定する。
 ここで、障害物検知装置100の送受波部5fには、障害物OBc,OBdが車両1に対して正対しているか否かの判定に用いる正対物領域FAが設定されている。正対物領域FAは、正対物領域FAab,FAcdを含む。
 正対物領域FAabは、送受波部5fの送受波装置51a~51dのうち、送受波装置51a,51bに対して設定されている。送受波装置51a,51bの送波音波および反射音波に基づいて、正対物領域FAab内に位置する障害物が検知された場合、障害物検知装置100は、その障害物が、車両1に対して正対していると判定する。
 正対物領域FAcdは、送受波部5fの送受波装置51a~51dのうち、送受波装置51c,51dに対して設定されている。送受波装置51c,51dの送波音波および反射音波に基づいて、正対物領域FAcd内に位置する障害物が検知された場合、障害物検知装置100は、その障害物が、車両1に対して正対していると判定する。
 すなわち、正対物領域FAab,FAcdが重なり合う領域も含め、正対物領域FA内に位置する障害物が検知された場合、障害物検知装置100は、その障害物が、車両1に対して正対していると判定する。
 次に、障害物検知装置100は、上記と同様に障害物OBcの位置を特定し、障害物OBcの位置座標を表す測距点MScを算出する。また、障害物検知装置100は、算出した測距点MScが正対物領域FA内にあるか否かを判定する。
 また、障害物検知装置100は、測距点MScが正対物領域FA内にあるか否かに基づいて、障害物OBcの車両1側に向いた第1の面としての面SRcの法線方向NRcの角度を、車両1のX方向を基準に決定する。
 図4において、測距点MScは正対物領域FA内にある。この場合、障害物検知装置100は、障害物OBcの面SRcが、車両1に対して正対しているものとする。従って、障害物検知装置100は、障害物OBcの面SRcの法線方向NRcの角度として、車両1のX方向に対して0°を設定する。このように、障害物検知装置100は、障害物OBcの位置に基づいて障害物OBcの角度を設定する。
 図4において、測距点MSdは正対物領域FA外にある。この場合、障害物検知装置100は、障害物OBdの面SRdの法線方向NRdの角度として、車両1のX方向に対して所定角度傾いた値を設定する。この角度の値は、車両1のX方向に対して、センタの位置から測距点MSdへの線分がなす角度となる。このように、障害物検知装置100は、障害物OBdの位置に基づいて障害物OBdの角度を設定する。
 図4において、障害物OBdの面SRdの法線方向NRdは、車両1の+X方向を基準に右寄り(-Y方向寄り)に所定角度傾いている。ここで、法線方向NRdの角度は、車両1の進行方向(+X方向)を基準に、反時計回りを正値とし、時計回りを負値とする。従って、図4における法線方向NRdの角度は、負値の角度-θ(θ自体は正値)である。即ち、障害物OBdの測距点MSdが、車両1の-Y方向へと向かって正対物領域FAの外側に外れていくほど、角度-θは小さくなり、角度-θの絶対値は大きくなる。
 また、図示しない所定の障害物の位置を表す測距点が、正対物領域FAに対して車両1の+Y方向側に外れていた場合、つまり、その障害物が車両1の左前方に位置していた場合、障害物の車両1側に向いた面の法線方向は、車両1の+X方向より左向き、つまり、車両1の+X方向に向かって左寄り(+Y方向寄り)に所定角度傾いていることになる。また、このときの法線方向の角度は、正値の角度+θ(θ自体は正値)である。即ち、上記障害物の測距点が、車両1の+Y方向へと向かって正対物領域FAの外側に外れていくほど、角度+θは正値として大きくなり、角度+θの絶対値も大きくなる。
(障害物検知装置の判定)
 図5は、障害物検知装置100が車両1に正対する障害物OBcについて同一物判定をする様子を示す模式図である。
 障害物検知装置100は、所定の周期で障害物OBcの検知を行う。障害物検知装置100は、前回に検知した前回データに基づき障害物OBcの位置を推定点EScとして算出し、推定点EScから同一物判定領域SAcを設定する。ここで、同一物判定領域SAcは、1対の長辺と1対の短辺を有する長方形であるが、これに限らない。正方形、平行四辺形、単なる四角形であっても良い。或いは、単に所定の形状を有するものであっても良い。
 前回データとは、これから送波される送波音波の前に送波され、受波された送波音波および反射音波に基づいて算出された障害物OBcの位置座標および車両1に対する角度である。障害物検知装置100は、これらの前回データから推定点EScを算出する。
 推定点EScは、前回検知した障害物OBcの座標と、前回検知時から現在までの車両1の移動量と旋回角度とをもとに、現在の時点での車両1から、前回検知した障害物OBcの座標への相対位置を算出することで得られる。この推定点EScは、次回送波する送波音波によって検知されるであろう障害物の位置を推定したものである。
 同一物判定領域SAcは、算出した推定点EScを中心点に置く、1対の長辺と1対の短辺とを有する矩形領域である。1対の長辺の長さは、車両1からの距離(X方向距離)に応じて決まる。
 同一物判定領域SAcは、前回検知され特定された障害物OBcの角度に対応するように設定される。つまり、同一物判定領域SAcの向きが、障害物OBcの向きに沿うように設定される。より具体的には、同一物判定領域SAcの1対の長辺が、障害物OBcの車両1側に向いた面SRcに対して平行となり、障害物OBcの面SRcの法線方向NRcに対して直交するように、同一物判定領域SAcが設定される。
 障害物検知装置100は、次に測定を行うため送波音波を送波する。この送波音波に対応して、受波音波として反射音波が受波されれば、車両1の近傍に障害物があることを意味する。ただし、この時点で、今回検知された障害物が、前回検知された障害物OBcと同一物であるか否かは未だ不明である。
 障害物検知装置100は、今回の送波音波および反射音波に基づいて、障害物の位置を表す測距点MScの位置座標を算出する。また、障害物検知装置100は、今回算出した測距点MScが、前回データに基づき設定した同一物判定領域SAc内にあるか否かを判定する。
 障害物検知装置100は、今回の測距点MScが同一物判定領域SAc外にあった場合には、前回検知された障害物OBcと今回検知された障害物とが同一物ではないと判定し、今回検知された障害物を信頼度RL1とする。
 障害物検知装置100は、今回の測距点MScが同一物判定領域SAc内にあった場合には、前回検知された障害物OBcと今回検知された障害物とが同一物であると判定し、今回検知された障害物を信頼度RL1よりも高い信頼度RL2とする。
 障害物検知装置100は、複数回検知された障害物について、このような同一物判定を所定の信頼度が得られるまで行って、所定の信頼度が得られた場合に、それらのデータを運転支援装置200へ出力する。運転支援装置200は、それらのデータに基づいて車両1の制御を行うようにしても良い。また、障害物検知装置100は、障害物との衝突を回避するため、車両1の車体2に制動をかけさせる信号および車体2の加速を抑制させる信号の少なくともいずれかを、運転支援装置200へ出力するようにしても良い。
 以下に、2回連続で同一物であるとの判定がなされた場合に、所定の信頼度が得られたものとして、車両1への制御を行う場合について説明する。
 この場合、障害物検知装置100は、1回目の送波音波、及びそれに対応する反射音波により障害物を検知し、その障害物の位置座標および角度を算出する。
 次に、障害物検知装置100は、2回目の送波音波、及びそれに対応する反射音波により障害物を検知し、その障害物の位置座標を算出する。
 また、障害物検知装置100は、1回目の送波音波および反射音波により検知された障害物の位置座標および角度に基づいて推定点を算出し、算出した推定点に基づいて同一物判定領域を設定する。
 次に、障害物検知装置100は、2回目の送波音波および反射音波により検知された障害物の位置座標が、1回目の送波音波および反射音波に基づく同一物判定領域内にあるか否かを判定する。
 2回目に検知された障害物の位置座標が、1回目に設定された同一物判定領域内にある場合には、障害物検知装置100は、1回目と2回目とにそれぞれ検知された障害物は同一物であると判定して、2回目に検知された障害物を信頼度RL2とする。また、障害物検知装置100は、2回目に検知された障害物の角度を算出する。
 次に、障害物検知装置100は、3回目の送波音波、及びそれに対応する反射音波により障害物を検知し、その障害物の位置座標を算出する。
 また、障害物検知装置100は、2回目の送波音波および反射音波により検知された障害物の位置座標および角度に基づいて推定点を算出し、算出した推定点に基づいて同一物判定領域を設定する。
 次に、障害物検知装置100は、3回目の送波音波および反射音波により検知された障害物の位置座標が、2回目の送波音波および反射音波に基づく同一物判定領域内にあるか否かを判定する。
 3回目に検知された障害物の位置座標が、2回目に設定された同一物判定領域内にある場合には、障害物検知装置100は、2回目と3回目とにそれぞれ検知された障害物は同一物であると判定して、3回目に検知された障害物を信頼度RL2よりも高い信頼度RL3とする。
 このように、障害物検知装置100は、1回目~3回目の送波音波および反射音波によってそれぞれ検知された障害物が、2回連続で同一物であるとの判定がなされ、3回目に検知された障害物が信頼度RL3となったことで、その障害物について所定の信頼度が得られたものとする。そして、障害物検知装置100は、3回目に検知された障害物に基づいて、車両1への制御を行うよう運転支援装置200へと指示を出す。
 一方、2回目に検知された障害物の位置座標が1回目に設定された同一物判定領域外にあった場合、または、3回目に検知された障害物の位置座標が2回目に設定された同一物判定領域外にあった場合には、信頼度の積み上げがキャンセルされる。障害物検知装置100は、その時点から再度、信頼度の積み上げを行って、信頼度RL3が得られるまで同一物判定を行う。
 すなわち、2回目に検知された障害物の位置座標が1回目に設定された同一物判定領域外にあった場合、障害物検知装置100は、2回目に検知された障害物を、信頼度RL2,RL3よりも低い信頼度RL1とする。そして、3回目に検知された障害物が、2回目に検知された障害物と同一物であると判定されれば、障害物検知装置100は、3回目に検知された障害物を信頼度RL2とする。以降、信頼度RL3が得られるまで同一物判定が行われる。
 また、3回目に検知された障害物の位置座標が2回目に設定された同一物判定領域外にあった場合、障害物検知装置100は、3回目に検知された障害物を信頼度RL1とする。そして、4回目に検知された障害物が、3回目に検知された障害物と同一物であると判定されれば、障害物検知装置100は、4回目に検知された障害物を信頼度RL2とする。以降、信頼度RL3が得られるまで同一物判定が行われる。
 このように、障害物検知装置100は、所定回数で検知された障害物が、その前の障害物と同一物ではないとの判定がなされるたびに信頼度RL1へ戻る。
 即ち、信頼度が信頼度RL1である場合に、今回(所定回数で)検知された障害物が、その前の障害物と同一であると判定された場合、信頼度は信頼度RL2に上がり、同じく信頼度RL1である場合に、今回(所定回数で)検知された障害物が、その前の障害物と同一でないと判定された場合、信頼度は信頼度RL1のままである。次に、信頼度が信頼度RL2である場合に、今回(所定回数で)検知された障害物が、その前の障害物と同一であると判定された場合、信頼度は信頼度RL3に上がり、同じく信頼度RL2である場合に、今回(所定回数で)検知された障害物が、その前の障害物と同一でないと判定された場合、信頼度は信頼度RL1に戻る。次に、信頼度が信頼度RL3である場合に、今回(所定回数で)検知された障害物が、その前の障害物と同一であると判定された場合、信頼度は信頼度RL3のままであり、同じく信頼度RL3である場合に、今回(所定回数で)検知された障害物が、その前の障害物と同一でないと判定された場合、信頼度は信頼度RL1に戻る。
 ここで障害物検知装置100は、信頼度RL1、信頼度RL2及び信頼度RL3の3段の信頼度を有するようにしたが、これに限らず、信頼度RL1と信頼度RL2との2段の信頼度を有するようにしてもよい。この場合、信頼度が信頼度RL1である場合に、今回(所定回数で)検知された障害物が、その前の障害物と同一であると判定された場合、信頼度は信頼度RL2に上がり、同じく信頼度RL1である場合に、今回(所定回数で)検知された障害物が、その前の障害物と同一でないと判定された場合、信頼度は信頼度RL1のままである。次に、信頼度が信頼度RL2である場合に、今回(所定回数で)検知された障害物が、その前の障害物と同一であると判定された場合、信頼度は信頼度RL2のままであり、同じく信頼度RL2である場合に、今回(所定回数で)検知された障害物が、その前の障害物と同一でないと判定された場合、信頼度は信頼度RL1に戻るようにしてもよい。
 図6は、第1の実施形態にかかる障害物検知装置100が車両1に対して斜めに配置される障害物OBdについて同一物判定をする場合を示す模式図である。図6に示すように、障害物OBdの同一物判定も、上述の障害物OBcの同一物判定と同様に行われる。
 すなわち、障害物検知装置100は、同一物判定を行うにあたり、前回データに基づいて推定点ESdを算出し、推定点ESdから同一物判定領域SAdを設定する。
 ここでも、同一物判定領域SAdは、前回検知され特定された障害物OBdの角度に対応するように設定される。つまり、同一物判定領域SAdの1対の長辺が、障害物OBdの車両1側に向いた面SRdに対して平行となり、障害物OBdの面SRdの法線方向NRdに対して直交するように、同一物判定領域SAdが設定される。
 また、障害物検知装置100は、今回の測定を行うため送波音波を送波する。この送波音波に対応する反射音波が受波されれば、車両1の近傍に障害物が検知されたこととなる。障害物検知装置100は、今回の送波音波および反射音波に基づいて、障害物における測距点MSdの位置座標を算出し、測距点MSdが同一物判定領域SAd内にあるか否かを判定する。
 ここで、障害物OBdが車両1に対して斜めに配置されていると、障害物OBdの車両1側に向いた面SRdにおける今回の送波音波が反射する位置、つまり、測距点MSdが、車両1の移動に伴って移動する。車両1が障害物OBdに近付いていくと、測距点MSdは、障害物OBdの面SRdの奥側、つまり、車両1から遠ざかる側へとシフトする。
 上記のように、同一物判定領域SAdは、障害物OBdの角度に対応するように設定されるので、今回の送波音波および反射音波により検知された障害物が、前回検知された障害物OBdと同一物であれば、測距点MSdが奥側にシフトしても、同一物判定領域SAd内に留まる可能性が高い。
 このことから、同一物判定領域SAc,SAdの奥行き、即ち、1対の短辺の距離は、同一物判定の閾値として機能する。
 障害物検知装置100は、測距点MSdが同一物判定領域SAd外にあった場合には今回検知された障害物を信頼度RL1とし、測距点MSdが同一物判定領域SAd内にあった場合には今回検知された障害物を信頼度RL2とする。
 障害物検知装置100は、複数回検知された障害物について、このような同一物判定を所定の信頼度が得られるまで行って、所定の信頼度が得られた場合、運転支援装置200の車両制御装置20に車両1への制御を行わせる。
 すなわち、送受波部5fは第1送波音波を送波し、第1送波音波に対応する第1反射音波を受波音波として受波する。
 障害物検知装置100は、第1送波音波および第1反射音波に基づき、第1障害物の車両1側に向いた面の法線方向の、車両1のX方向を基準にした第1角度と、第1障害物の位置とを求める。また、障害物検知装置100は、第1障害物の第1角度と位置とに基づき、第1障害物の第1角度に対応する第1同一物判定領域を設定する。
 次に、送受波部5fは第2送波音波を送波し、第2送波音波に対応する第2反射音波を受波音波として受波する。
 障害物検知装置100は、第2送波音波および第2反射音波に基づき第2障害物の車両1側に向いた面の法線方向の、車両1のX方向を基準にした第2角度と、第2障害物の位置とを求める。
 また、障害物検知装置100は、第2障害物の位置が、第1同一物判定領域内である場合、第2障害物の信頼度を、信頼度RL1より高い信頼度RL2とする。
 また、障害物検知装置100は、第2障害物の第2角度と位置とに基づき、第2障害物の第2角度に対応する第2同一物判定領域を設定する。
 次に、送受波部5fは第3送波音波を送波し、第3送波音波に対応する第3反射音波を受波音波として受波する。
 障害物検知装置100は、第3送波音波および第3反射音波に基づき第3障害物の位置を求める。
 障害物検知装置100は、第3障害物の位置が、第2同一物判定領域内である場合、第3障害物の信頼度を、信頼度RL2より高い信頼度RL3とする。また、障害物検知装置100は、第3障害物の信頼度が信頼度RL3である場合、第3障害物の位置に基づいて車体2に制動をかけ、及び/又は車体2の加速を抑制するように信号を出力する。
 障害物検知装置100は、第3障害物の位置が、第2同一物判定領域外である場合、第3障害物の信頼度を信頼度RL1とする。また、障害物検知装置100は、第3障害物の信頼度が信頼度RL1である場合、第3障害物の位置に基づいて車体2に制動をかけず、及び/又は車体2の加速を抑制しないように信号を出力する。つまり、障害物検知装置100は、車両1を通常走行させるように車両制御装置20に信号を出力する。
 図9は、障害物検知装置100の検出した障害物の信頼度に係る状態遷移を示す状態遷移図である。障害物検知装置100は、最初に障害物の検知座標がない場合、信頼度は最低の信頼度RL0(ST1)である。ST1において、引き続き検知座標がない場合(TR12)、ST1の状態であり続ける。ST1において、検知座標がある場合(TR11)、信頼度は信頼度RL0より高い信頼度RL1(ST2)になる。ST2において、図5や図6を用いて説明した通り、同一物判定が成立する場合(TR21)、信頼度は信頼度RL1より高い信頼度RL2(ST3)になる。ST2において、検知座標が無くなった場合(TR23)、ST1に戻る。ST3において、図5や図6を用いて説明した通り同一物判定が成立する場合(TR31)信頼度は信頼度RL2より高い信頼度RL3(ST4)になる。ST3において、検知座標が無くなった場合(TR34)、ST1に戻る。ST3において、検知座標は有るが、同一物判定が成立しない場合(TR33)、ST2に戻る。ST4において、図5や図6を用いて説明した通り同一物判定が成立する場合(TR41)、信頼度は信頼度RL3(ST4)であり続ける。ST4において、検知座標が無くなった場合(TR44)、ST1に戻る。ST4において、検知座標は有るが、同一物判定が成立しない場合(TR43)、ST2に戻る。
(障害物検知装置の処理)
 次に、図7を用いて、第1の実施形態の障害物検知装置100における処理について説明する。図7は、第1の実施形態にかかる障害物検知装置100における処理の手順を示すフロー図である。
 図7に示すように、障害物検知装置100は、送受波部5のいずれかの送受波装置51,52が、送波音波に対応する反射音波を受波したか否かを判定する(ステップS101)。
 いずれかの送受波装置51,52が反射音波を受波した場合には(ステップS101:Yes)、障害物検知装置100は、送波音波および反射音波に基づいて、送波音波を反射させた障害物の位置座標を算出する(ステップS102)。
 障害物検知装置100は、前回、送受波された送波音波および反射音波に基づき検知された障害物の位置座標から、今回、送受波された送波音波および反射音波によって、前回検知された障害物が再び検知された場合の位置座標を推定して推定点を算出する(ステップS103)。
 なお、障害物検知装置100は、前回、送波された送波音波に対応する反射音波が得られていない場合、つまり、前回、送波音波の送波により障害物が検知されなかった場合には、前々回、送受波された送波音波および反射音波に基づき検知された障害物の位置座標から、推定点を算出してもよい。
 障害物検知装置100は、ステップS102の処理で算出した位置座標が、ステップS103で算出した推定点に基づき設定した同一物判定領域内にあるか否かを判定して、前回または前々回検知された障害物と、今回検知された障害物とについて同一物判定を行う(ステップS104)。
 前回または前々回検知された障害物と、今回検知された障害物とが同一物であると判定した場合(ステップS104:Yes)、障害物検知装置100は、今回検知された障害物の信頼度が所定の信頼度に到達したか否かを判定する(ステップS105)。
 つまり、上述の例では、障害物検知装置100は、ステップS104の同一物判定処理において2回連続で同一物であるとの判定がなされ、今回検知された障害物の信頼度が信頼度RL3に到達したか否かを判定する。即ち上述の例では、ステップS105における所定の信頼度を信頼度RL3とする。
 今回検知された障害物の信頼度が所定の信頼度に到達していなかった場合(ステップS105:No)、障害物検知装置100は、今回検知された障害物について、ステップS102の処理で算出した位置座標に基づいて、今回検知された障害物の角度を判定する(ステップS107)。
 つまり、障害物検知装置100は、今回検知された障害物の位置座標が、正対物領域FA内であるか否か、また、正対物領域FAからどれくらい外れているか等に基づいて、今回検知された障害物の角度を判定する。
 そして、障害物検知装置100は、ステップS101の処理へと戻る。
 ステップS104の処理において、前回または前々回検知された障害物と、今回検知された障害物とが同一物ではないと判定した場合(ステップS104:No)、障害物検知装置100は、今回検知された障害物について、ステップS102の処理で算出した位置座標に基づいて、今回検知された障害物の角度を判定する(ステップS108)。
 そして、障害物検知装置100は、ステップS101の処理へと戻る。
 上述のステップS101の処理において、いずれの送受波装置51,52も反射音波を受波していなければ(ステップS101:No)、障害物検知装置100は、前回データが存在するか否かを判定する(ステップS109)。
 前回データが存在していれば(ステップS109:Yes)、障害物検知装置100は、現時点における障害物の位置座標を推定し(ステップS110)、推定した位置座標に基づいて、前回検知された障害物の角度を判定する(ステップS111)。
 そして、障害物検知装置100は、ステップS101の処理へと戻る。
 前回データが存在しなければ(ステップS109:No)、障害物検知装置100は、前々回までに取得した障害物の位置、角度、及び信頼度等の情報を無効とする(ステップS112)。
 そして、障害物検知装置100は、ステップS101の処理へと戻る。
 上述のステップS105の処理において、今回検知された障害物の信頼度が所定の信頼度に到達した場合(ステップS105:Yes)、障害物検知装置100は、今回検知された障害物に基づいて、車体2に制動をかけさせる信号および車体2の加速を抑制させる信号の少なくともいずかれかを、運転支援装置200の車両制御装置20へと出力する(ステップS106)。
 そして、障害物検知装置100は、ステップS101の処理へと戻る。
 なお、上述のステップS103,S110の座標推定処理は、必ずしも図7に示すタイミングで行われなくともよい。障害物検知装置100は、所定の周期で継続的に座標推定処理を実行し、ステップS104,S111の処理を行うタイミングで、直近で推定された座標を参照してもよい。
 また、障害物検知装置100は、以上のステップS101~S112までの処理を、時分割で行ってもよい。これにより、車両1が時々で位置を変えるのに合わせて、車両1に対する障害物の位置を特定し、運転支援装置200へと制御することができる。
 また、これに替えて、あるいは加えて、障害物の検知情報および障害物までの距離情報等を運転者に報知してもよい。運転者へのこれらの情報の報知は、ナビゲーション装置またはヘッドアップディスプレイ等へ警告を表示することにより行うことができる。またあるいは、警報音を鳴らしたり、LEDランプを点滅させたり点灯させたりすることで、運転者への情報の報知を行ってもよい。
 また、上述の例では、ステップS105における所定の信頼度を信頼度RL3としたが、これに限らず、ステップS105における所定の信頼度を信頼度RL2としても良い。
(概括)
 超音波等の音波を用いた障害物検知においては、複数回の測距を行って得られた座標が互いに所定範囲内の近しい位置にある場合に、障害物が存在すると判定する。図8(a)に示すように、比較例の車両101の進行方向に対して正対する障害物OBcについては、車両101の位置が変化しても得られる座標MSa,MSbは互いに近しい位置となる。
 一方、図8(b)に示すように、比較例の車両101の進行方向に対して斜めとなっている障害物OBdについては、例えばその障害物OBdに車両101が近づくにつれて、得られる座標MSa,MSbが車両101の遠方へと移動する。このため、車両101に正対していない障害物OBdも検知されるよう、例えば得られた座標MSa,MSbが互いに近い位置にあるか否かを判定するための範囲SAwを広く取る必要がある。
 しかしながら、上記のように範囲SAwを広く取ると、同一でないものも同一と判定してしまい、誤作動が生じる可能性がある。
 第1の実施形態の障害物検知装置100によれば、障害物OBdの角度と位置とに基づき、障害物OBdの角度に対応する同一物判定領域SAdを設定する。すなわち、同一物判定領域の長辺の直交方向が、障害物OBdの車両1側に向いた面SRdの法線方向NRdに沿うように同一物判定領域SAdを配置する。
 これにより、同一物判定領域SAdの奥行き、つまり、閾値を広げることなく、車両1に対して斜めに位置する障害物OBdの同一物判定精度を高めることができる。つまり、例えば送受波部5の分解能が許容する程度にまで、同一物判定の閾値を狭めることができる。したがって、同一でないものも同一と判定する誤判定を抑制することができ、車両1に対して誤った制御または不必要な制御を行ってしまうことが抑制される。
 第1の実施形態の障害物検知装置100によれば、車両1に対する障害物OBc,OBdの位置に基づいて障害物OBc,OBdの角度を決定する。
 すなわち、障害物OBcの位置が、障害物OBcが車両1に対して正対しているか否かの判定に用いる正対物領域FA内である場合には、障害物OBcの車両1側に向いた面SRcの法線方向NRcの角度が、車両1のX方向に対して0°であるものとする。
 また、障害物OBdの位置が、障害物OBdが車両1に対して正対しているか否かの判定に用いる正対物領域FA外である場合には、障害物OBdの車両1側に向いた面SRdの法線方向NRdの角度が、車両1のX方向に対して所定角度傾いているものとする。
 これにより、同一物判定領域SAc,SAdの奥行き、つまり、閾値を、車両1に対して正対している障害物OBcと、車両1に対して斜めになっている障害物OBdとで、揃えることができ、それぞれの障害物OBc,OBdについて同等の精度で同一物判定を行うことができる。
 第1の実施形態の障害物検知装置100によれば、障害物OBdの位置が、車両1の+Y方向へと向かって正対物領域FAの外側に外れていくほど、障害物OBdの角度+θが大きいものとする。また、障害物の位置が、車両1の-Y方向へと向かって正対物領域FAの外側に外れていくほど、障害物の角度-θが小さいものとする。
 これにより、より精密に障害物OBdの角度を判定することができ、より適正に同一物判定領域SAdを設定することができる。したがって、同一物判定の精度がよりいっそう高まる。
(変形例)
 上述の第1の実施形態では、障害物検知装置100は、それぞれ異なるタイミングで検知された複数の障害物について、2回連続で同一物であるとの判定がなされ、所定の障害物の信頼度が信頼度RL3に達した場合に、車両1への制御を行う例について説明した。
 しかし、障害物検知装置100は、障害物について、3回連続、または、それ以上連続で同一物であるとの判定がなされた場合に、所定の信頼度に達したものとして、車両1への制御を行ってもよい。
 また、図5,図6,図9では、障害物が静止している場合について説明したが、これに限らない。障害物が移動する場合であっても、以上の技術を適用することが可能である。
[第2の実施形態]
 次に、第2の実施形態の例について図面を用いて説明する。ただし、第2の実施形態に係る障害物検知装置110は、図1~図4及び図7の技術的特徴については、第1の実施形態に係る障害物検知装置100と基本的に共通であり、ここでは説明を省略する。
 図10は、障害物検知装置110が静止している静止障害物OBsについて同一物判定をする様子を示す模式図である。図10において、障害物OBsの面SRsが、車両1に対して正対しているものとする。ここで、静止しているとは、絶対的に静止していることを意味し、車両1が例えば前進している場合、車両1との相対的な位置関係としては、静止障害物OBsが車両1へ近づいてくることを意味する。
 障害物検知装置110は、所定の周期で障害物OBsの検知を行う。障害物検知装置110は、前回に検知した前回データに基づき静止障害物OBsの位置を静止推定点ESsとして算出し、静止推定点ESsから静止同一物判定領域SAsを設定する。ここで、静止同一物判定領域SAsは、1対の長辺と1対の短辺を有する長方形である。しかし、これに限らず、正方形、平行四辺形、単なる四角形であっても良い。或いは、単に所定の形状を有するものであっても良い。
 更に、障害物検知装置110は、前回に検知した前回データに基づき移動障害物OBmの位置を移動推定点ESmとして算出し、移動推定点ESmから移動同一物判定領域SAmを設定する。ここで、移動障害物OBmの移動とは、障害物が絶対的に移動していることを意味している。仮に、移動障害物OBmが、車両1と同一方向に同一速度で移動している場合、車両1と移動障害物OBmの相対的な位置関係としては静止していることになる。移動障害物OBmの例としては、渋滞中に車両1の前方を走行している別の車両が考えられる。また、移動同一物判定領域SAmは、1対の長辺と1対の短辺を有する長方形であるが、これに限らない。正方形、平行四辺形、単なる四角形であっても良い。或いは、単に所定の形状を有するものであっても良い。
 前回データとは、これから送波される送波音波の前に送波され、受波された送波音波および反射音波に基づいて算出された障害物OBs又は障害物OBmの位置座標である。障害物検知装置110は、これらの前回データから静止推定点ESsと移動推定点ESmを算出する。
 静止推定点ESsは、前回検知した静止障害物OBs及び移動障害物OBmの座標と、前回検知時から現在までの車両1の移動量と旋回角度とをもとに、現在の時点での車両1から、前回検知した静止障害物OBs及び移動障害物OBmの座標への相対位置を算出することで得られる。この静止推定点ESsは、次回送波する送波音波によって検知されるであろう静止した障害物の位置を推定したものである。
 静止同一物判定領域SAsは、算出した静止推定点ESsを中心点に置く、1対の長辺と1対の短辺とを有する矩形領域である。1対の長辺の長さは、車両1からの距離(X方向距離)に応じて決まる。
 移動推定点ESmは、前回検知した静止障害物OBs及び移動障害物OBmの座標と、前回検知時から現在までの車両1の移動量と旋回角度とをもとに、現在の時点での車両1から、前回検知した静止障害物OBs及び移動障害物OBmの座標への相対位置を算出することで得られる。この移動推定点ESmは、次回送波する送波音波によって検知されるであろう、移動している障害物の位置を推定したものである。移動同一物判定領域SAmは、移動障害物OBmが移動していることを前提にしているので、車両1を基準にして、静止同一物判定領域SAsより遠い位置に設定されることになる。
 移動同一物判定領域SAmは、算出した移動推定点ESmを中心点に置く、1対の長辺と1対の短辺とを有する矩形領域である。1対の長辺の長さは、車両1からの距離(X方向距離)に応じて決まる。
 障害物検知装置110は、次に測定を行うため送波音波を送波する。障害物検知装置110は、今回の送波音波および反射音波に基づいて、障害物の位置を表す測距点MSeの位置座標を算出する。次に、障害物検知装置110は、今回算出した測距点MSeが、前回データに基づき設定した静止同一物判定領域SAs内にあるか否かと、移動同一物判定領域SAm内にあるか否かと、を判定する。
 図10に示すように、測距点MSeが、前回データに基づき設定した静止同一物判定領域SAs内にある場合は、即ち静止同一物判定が成立する場合、後述するように検知された障害物の信頼度を向上させる。
 なお、図10及び図11において、静止同一物判定領域SAsと移動同一物判定領域SAmとは離れて、重ならいように設定されているが、これに限らない。静止同一物判定領域SAsと移動同一物判定領域SAmとは一部が重なるように設定されても良い(図示せず)。ただし、この場合であっても、移動同一物判定領域SAmの静止同一物判定領域SAsと重ならない部分は、車両1を基準に、静止同一物判定領域SAsより遠い位置に設定される。
 図11は、障害物検知装置110が移動している移動障害物OBmについて同一物判定をする様子を示す模式図である。移動障害物OBmが移動していること以外は、図10と共通である。図11において、障害物OBmの面SRmが、車両1に対して正対しているものとする。障害物検知装置110は、今回の送波音波および反射音波に基づいて、障害物の位置を表す測距点MSeの位置座標を算出する。次に、障害物検知装置110は、今回算出した測距点MSeが、前回データに基づき設定した静止同一物判定領域SAs内にあるか否かと、移動同一物判定領域SAm内にあるか否かと、を判定する。
 図11に示すように、測距点MSeが、前回データに基づき設定した移動同一物判定領域SAm内にある場合は、即ち移動同一物判定が成立する場合、後述するように検知された障害物の信頼度を向上させる。
 図12は、障害物検知装置110の検出した障害物の信頼度に係る状態遷移を示す状態遷移図である。図12の状態遷移図において、ST1,ST2,TR11,TR12,TR23,TR34,TR44については、基本的に図9に示した状態遷移図と共通であり、ここでは説明を省略する。
 ST2において、図10で説明したように静止同一物判定が成立する場合(TR21)、信頼度は信頼度RL1より高い信頼度RL2(ST3)になる。ST2において、図11で説明したように移動同一物判定が成立する場合(TR22)、信頼度は信頼度RL2(ST5)になる。
 ST3において、図10で説明したように静止同一物判定が成立する場合(TR31)、信頼度は信頼度RL2より高い信頼度RL3(ST4)になる。ST3において、図11で説明したように移動同一物判定が成立する場合(TR32)、信頼度は信頼度RL3(ST6)になる。ST3において、検知座標は有るが、静止同一物判定が成立せず、かつ移動同一物判定が成立しない場合(TR33)、ST2に戻る。
 ST5において、図10で説明したように静止同一物判定が成立する場合(TR52)、信頼度は信頼度RL3(ST4)になる。ST5において、図11で説明したように移動同一物判定が成立する場合(TR51)、信頼度は信頼度RL3(ST6)になる。ST5において、検知座標が無くなった場合(TR54)、ST1に戻る。ST5において、検知座標は有るが、静止同一物判定が成立せず、かつ移動同一物判定が成立しない場合(TR53)、ST2に戻る。
 ST4において、図10で説明したように静止同一物判定が成立する場合(TR41)、信頼度は信頼度RL3(ST4)のままになる。ST4において、図11で説明したように移動同一物判定が成立する場合(TR42)、信頼度は信頼度RL3(ST6)のままになる。ST4において、検知座標は有るが、静止同一物判定が成立せず、かつ移動同一物判定が成立しない場合(TR43)、ST2に戻る。
 ST6において、図10で説明したように静止同一物判定が成立する場合(TR62)、信頼度は信頼度RL3(ST4)のままになる。ST6において、図11で説明したように移動同一物判定が成立する場合(TR61)、信頼度は信頼度RL3(ST6)のままになる。ST6において、検知座標が無くなった場合(TR64)、ST1に戻る。ST6において、検知座標は有るが、静止同一物判定が成立せず、かつ移動同一物判定が成立しない場合(TR63)、ST2に戻る。
 このように、障害物検知装置110は、図12に示すように、ST1~ST6のぞれぞれの状態において、図10に示す静止同一物判定と、図11に示す移動同一物判定とを実行し、その結果に応じて、ST1~ST6の状態を遷移して行く。ST1には信頼度RL1が割り当てられ、ST3とST5とには信頼度RL2が割り当てられ、ST4とST6とには信頼度RL3が割り当てられているので、障害物検知装置110の状態が、ST2~ST6で遷移するのに伴い、信頼度が信頼度RL1~RL3で一意に定まることになる。
 これにより、障害物検知装置110は、静止している障害物の位置と想定される静止同一物判定領域SAsと、移動している障害物の位置と想定される移動同一物判定領域SAmとを備え、静止障害物には、静止同一物判定領域SAsを用いて障害物検出結果の信頼度を管理し、移動障害物には、移動同一物判定領域SAmを用いて障害物検出結果の信頼度を管理することで、静止障害物の検出結果の信頼度管理及び、移動障害物の検出結果の信頼度管理がより適切になり、結果として障害物の検出結果の精度を高めることができる。
 加えて、障害物の検知結果と信頼度との入力を受ける運転支援装置200は、信頼度も考慮して車両1への制御を行うことができる。例えば、障害物が検知され、信頼度RL3の場合だけ、車両1に制動をかけ、及び/又は前記車体の加速を抑制するようにしても良い。或いは、障害物が検知され、信頼度RL2又は信頼度RL3の場合に、ブレーキアクチュエータ24を利用して、車両1へ制動を掛けるようにしても良い。
 また、障害物検知装置110は、障害物検知装置100の機能を重畳して実装するようにしても良い。なお、障害物検知装置110は、図7に示すステップS104において、図11に例を示す静止同一物判定及び、図12に例を示す移動同一物判定の両方を行う。
 本開示のいくつかの実施形態を説明したが、これらの実施形態は、例として提示したものであり、発明の範囲を限定することは意図していない。これらの実施形態は、その他の様々な形態で実施されることが可能であり、発明の要旨を逸脱しない範囲で、種々の省略、置き換え、変更を行うことができる。これらの実施形態およびその変形例は、発明の範囲および要旨に含まれると同様に、請求の範囲に記載された発明とその均等の範囲に含まれる。
 また、第1の実施形態及び第2の実施形態で説明した技術を、以下のC1-C20に記載のように捉えることも可能である。
(C1)
 第1車輪と、
 前記第1車輪の回転方向に沿う所定の方向に配置される第2車輪と、
 前記第1車輪及び前記第2車輪に結合され、前記第1車輪及び前記第2車輪によって移動可能な車体と、
 前記車体の所定の端部に配置され、送波音波を送波する送波部と、
 前記車体の前記所定の端部に配置され、受波音波を受波する受波部と、を備える車両であって、
 前記送波部は第1送波音波を送波し、
 前記受波部は、前記第1送波音波に対応する第1反射音波を、前記受波音波として受波し、
 前記第1送波音波および前記第1反射音波に基づき、第1障害物の位置を求めるとともに前記第1障害物の第1の面の法線方向の、前記所定の方向を基準にした角度を求め、
 前記第1障害物の前記位置と前記角度とに基づき、前記第1障害物の前記角度に対応する同一物判定領域を設定し、
 次に、前記送波部は、第2送波音波を送波し、
 前記受波部は、前記第2送波音波に対応する第2反射音波を、前記受波音波として受波し、
 前記第2送波音波および前記第2反射音波に基づき第2障害物の位置を求め、
 前記第2障害物の前記位置が、前記同一物判定領域外である場合、前記第2障害物の信頼度を第1信頼度とし、
 前記第2障害物の前記位置が、前記同一物判定領域内である場合、前記第2障害物の信頼度を、前記第1信頼度より高い第2信頼度とし、
 前記第2障害物の前記信頼度と、前記第2障害物の前記位置とに基づいて、前記車体に制動をかけ、及び/又は前記車体の加速を抑制する、
 車両。
(C2)
 C1に記載の車両であって、
 更に、制御回路を備え、
 前記制御回路が、
 前記第1送波音波および前記第1反射音波に基づき、第1障害物の位置を求めるとともに前記第1障害物の第1の面の法線方向の、前記所定の方向を基準にした角度を求め、
 前記第1障害物の前記位置と前記角度とに基づき、前記第1障害物の前記角度に対応する同一物判定領域を設定し、
 前記第2送波音波および前記第2反射音波に基づき第2障害物の位置を求め、
 前記第2障害物の前記位置が、前記同一物判定領域外である場合、前記第2障害物の信頼度を第1信頼度とし、
 前記第2障害物の前記位置が、前記同一物判定領域内である場合、前記第2障害物の信頼度を、前記第1信頼度より高い第2信頼度とする、
 車両。
(C3)
 C1又はC2に記載の車両であって、
 前記同一物判定領域は、1対の長辺と、1対の短辺とを有し、
 前記同一物判定領域の前記長辺の直交方向が、前記第1障害物の法線方向に沿うように、前記同一物判定領域を配置する、
 車両。
(C4)
 C1からC3のいずれか1項に記載の車両であって、
 前記第1障害物の前記第1の面の法線方向の前記角度は、
 前記第1の面の法線方向が、前記車両の前記所定の方向と同一である場合は、0度であり、
 前記第1の面の法線方向が、前記車両の前記所定の方向より左向きである場合、正の値の角度であり、
 前記第1の面の法線方向が、前記車両の前記所定の方向より右向きである場合、負の値の角度であり、
 前記第1の面の法線方向が前記車両の前記所定の方向より左向きである場合、前記第1の面の法線方向が前記車両の前記所定の方向から外れるほど、前記角度は大きくなり、
 前記第1の面の法線方向が前記車両の前記所定の方向より右向きである場合、前記第1の面の法線方向が前記車両の前記所定の方向から外れるほど、前記角度は小さくなる、
 車両。
(C5)
 C1からC4のいずれか1項に記載の車両であって、
 前記送波部は前記第1送波音波を送波し、
 前記受波部は、前記第1送波音波に対応する前記第1反射音波を、前記受波音波として受波し、
 前記第1送波音波および前記第1反射音波に基づき、第1障害物の位置を求めるとともに前記第1障害物の第1の面の法線方向の、前記所定の方向を基準にした第1角度を求め、
 前記第1障害物の前記位置と前記第1角度とに基づき、前記第1障害物の前記第1角度に対応する第1同一物判定領域を設定し、
 次に、前記送波部は、第2送波音波を送波し、
 前記受波部は、前記第2送波音波に対応する前記第2反射音波を、前記受波音波として受波し、
 前記第2送波音波および前記第2反射音波に基づき第2障害物の位置を求めるとともに前記第2障害物の第1の面の法線方向の、前記所定の方向を基準にした第2角度を求め、
 前記第2障害物の前記位置が、前記第1同一物判定領域内である場合、前記第2障害物の信頼度を、前記第1信頼度より高い第2信頼度とし、
 前記第2障害物の前記位置と前記第2角度とに基づき、前記第2障害物の前記第2角度に対応する第2同一物判定領域を設定し、
 次に、前記送波部は、第3送波音波を送波し、
 前記受波部は、前記第3送波音波に対応する第3反射音波を、前記受波音波として受波し、
 前記第3送波音波および前記第3反射音波に基づき第3障害物の位置を求め、
 前記第3障害物の前記位置が、前記第2同一物判定領域内である場合、前記第3障害物の信頼度を、前記第2信頼度より高い第3信頼度とし、
 前記第3障害物の前記信頼度が前記第3信頼度である場合、前記第3障害物の前記位置に基づいて前記車体に制動をかけ、及び/又は前記車体の加速を抑制する、
 車両。
(C6)
 C5に記載の車両であって、
 前記第3障害物の前記位置が、前記第2同一物判定領域外である場合、前記第3障害物の信頼度を、前記第1信頼度とし、
 前記第3障害物の前記信頼度が前記第1信頼度である場合、前記第3障害物の前記位置に基づいて前記車体に制動をかけず、及び/又は前記車体の加速を抑制しない、
 車両。
(C7)
 C1からC6のいずれか1項に記載の車両であって、
 前記車両の前記所定の端部は、前記車両において前記所定の方向についての端部である、
 車両。
(C8)
 C1からC7のいずれか1項に記載の車両であって、
 バンパーを更に備え、
 前記送波部および前記受波部は、前記バンパーに配置された、
 車両。
(C9)
 C1からC8のいずれか1項に記載の車両であって、
 更に、第3車輪と、前記第3車輪の回転方向に沿う方向であって前記所定の方向に配置される第4車輪とを備え、
 前記第3車輪と前記第4車輪とは、前記車体に結合され、
 前記車体は、前記第1車輪、前記第2車輪、前記第3車輪、及び前記第4車輪によって移動可能である、
 車両。
(C10)
 C1からC9のいずれか1項に記載の車両であって、更に
 前記第1車輪及び前記第2車輪の少なくとも1つに制動を掛ける制動部と、
 前記第1車輪及び前記第2車輪の少なくとも1つに駆動を掛ける駆動部と、
 を備える、
 車両。
(C11)
 第1車輪と、
 前記第1車輪の回転方向に沿う所定の方向に配置される第2車輪と、
 前記第1車輪及び前記第2車輪に結合され、前記第1車輪及び前記第2車輪によって移動可能な車体と、を備える車両に搭載可能な障害物検知装置であって、
 前記車体の所定の端部に配置され、送波音波を送波する送波部と、
 前記車体の前記所定の端部に配置され、受波音波を受波する受波部と、を備え、
 前記送波部は第1送波音波を送波し、
 前記受波部は、前記第1送波音波に対応する第1反射音波を、前記受波音波として受波し、
 前記第1送波音波および前記第1反射音波に基づき、第1障害物の位置を求めるとともに前記第1障害物の第1の面の法線方向の、前記所定の方向を基準にした角度を求め、
 前記第1障害物の前記位置と前記角度とに基づき、前記第1障害物の前記角度に対応する同一物判定領域を設定し、
 次に、前記送波部は、第2送波音波を送波し、
 前記受波部は、前記第2送波音波に対応する第2反射音波を、前記受波音波として受波し、
 前記第2送波音波および前記第2反射音波に基づき第2障害物の位置を求め、
 前記第2障害物の前記位置が、前記同一物判定領域外である場合、前記第2障害物の信頼度を第1信頼度とし、
 前記第2障害物の前記位置が、前記同一物判定領域内である場合、前記第2障害物の信頼度を、前記第1信頼度より高い第2信頼度とし、
 前記第2障害物の前記信頼度と、前記第2障害物の前記位置とに基づいて、前記車体に制動をかけ、及び/又は前記車体の加速を抑制するように信号を出力する、
 障害物検知装置。
(C12)
 C11に記載の障害物検知装置であって、
 更に、制御回路を備え、
 前記制御回路が、
 前記第1送波音波および前記第1反射音波に基づき、第1障害物の位置を求めるとともに前記第1障害物の第1の面の法線方向の、前記所定の方向を基準にした角度を求め、
 前記第1障害物の前記位置と前記角度とに基づき、前記第1障害物の前記角度に対応する同一物判定領域を設定し、
 前記第2送波音波および前記第2反射音波に基づき第2障害物の位置を求め、
 前記第2障害物の前記位置が、前記同一物判定領域外である場合、前記第2障害物の信頼度を第1信頼度とし、
 前記第2障害物の前記位置が、前記同一物判定領域内である場合、前記第2障害物の信頼度を、前記第1信頼度より高い第2信頼度とする、
 障害物検知装置。
(C13)
 C11又はC12に記載の障害物検知装置であって、
 前記同一物判定領域は、1対の長辺と、1対の短辺とを有し、
 前記同一物判定領域の前記長辺の直交方向が、前記第1障害物の法線方向に沿うように、前記同一物判定領域を配置する、
 障害物検知装置。
(C14)
 C11からC13のいずれか1項に記載の障害物検知装置であって、
 前記第1障害物の前記第1の面の法線方向の前記角度は、
 前記第1の面の法線方向が、前記車両の前記所定の方向と同一である場合は、0度であり、
 前記第1の面の法線方向が、前記車両の前記所定の方向より左向きである場合、正の値の角度であり、
 前記第1の面の法線方向が、前記車両の前記所定の方向より右向きである場合、負の値の角度であり、
 前記第1の面の法線方向が前記車両の前記所定の方向より左向きである場合、前記第1の面の法線方向が前記車両の前記所定の方向から外れるほど、前記角度は大きくなり、
 前記第1の面の法線方向が前記車両の前記所定の方向より右向きである場合、前記第1の面の法線方向が前記車両の前記所定の方向から外れるほど、前記角度は小さくなる、
 障害物検知装置。
(C15)
 C11からC14のいずれか1項に記載の障害物検知装置であって、
 前記送波部は前記第1送波音波を送波し、
 前記受波部は、前記第1送波音波に対応する前記第1反射音波を、前記受波音波として受波し、
 前記第1送波音波および前記第1反射音波に基づき、第1障害物の位置を求めるとともに前記第1障害物の第1の面の法線方向の、前記所定の方向を基準にした第1角度を求め、
 前記第1障害物の前記位置と前記第1角度とに基づき、前記第1障害物の前記第1角度に対応する第1同一物判定領域を設定し、
 次に、前記送波部は、第2送波音波を送波し、
 前記受波部は、前記第2送波音波に対応する前記第2反射音波を、前記受波音波として受波し、
 前記第2送波音波および前記第2反射音波に基づき第2障害物の位置を求めるとともに前記第2障害物の第1の面の法線方向の、前記所定の方向を基準にした第2角度を求め、
 前記第2障害物の前記位置が、前記第1同一物判定領域内である場合、前記第2障害物の信頼度を、前記第1信頼度より高い第2信頼度とし、
 前記第2障害物の前記位置と前記第2角度とに基づき、前記第2障害物の前記第2角度に対応する第2同一物判定領域を設定し、
 次に、前記送波部は、第3送波音波を送波し、
 前記受波部は、前記第3送波音波に対応する第3反射音波を、前記受波音波として受波し、
 前記第3送波音波および前記第3反射音波に基づき第3障害物の位置を求め、
 前記第3障害物の前記位置が、前記第2同一物判定領域内である場合、前記第3障害物の信頼度を、前記第2信頼度より高い第3信頼度とし、
前記第3障害物の前記信頼度が前記第3信頼度である場合、前記第3障害物の前記位置に基づいて前記車体に制動をかけ、及び/又は前記車体の加速を抑制するように信号を出力する、
 障害物検知装置。
(C16)
 C15に記載の障害物検知装置であって、
 前記第3障害物の前記位置が、前記第2同一物判定領域外である場合、前記第3障害物の信頼度を、前記第1信頼度とし、
 前記第3障害物の前記信頼度が前記第1信頼度である場合、前記第3障害物の前記位置に基づいて前記車体に制動をかけず、及び/又は前記車体の加速を抑制しないように信号を出力する、
 障害物検知装置。
(C17)
 C11からC16のいずれか1項に記載の障害物検知装置であって、
 前記車両の前記所定の端部は、前記車両において前記所定の方向についての端部である、
 障害物検知装置。
(C18)
 C11からC17のいずれか1項に記載の障害物検知装置であって、
 バンパーを更に備え、
 前記送波部および前記受波部は、前記バンパーに配置された、
 障害物検知装置。
(C19)
 C11からC18のいずれか1項に記載の障害物検知装置であって、
 前記車両は更に、第3車輪と、前記第3車輪の回転方向に沿う方向であって前記所定の方向に配置される第4車輪とを備え、
 前記第3車輪と前記第4車輪とは、前記車体に結合され、
 前記車体は、前記第1車輪、前記第2車輪、前記第3車輪、及び前記第4車輪によって移動可能である、
 障害物検知装置。
(C20)
 C11からC19のいずれか1項に記載の障害物検知装置であって、前記車両は更に
 前記第1車輪及び前記第2車輪の少なくとも1つに制動を掛ける制動部と、
 前記第1車輪及び前記第2車輪の少なくとも1つに駆動を掛ける駆動部と、
 を備える、
 障害物検知装置。
1 車両
2 車体
3 車輪
4 バンパー
5 送受波部
10 ECU
20 車両制御装置
24 ブレーキアクチュエータ
25 エンジンコントローラ
51,52 送受波装置
100、110 障害物検知装置
200 運転支援装置
ESc,ESd、ESs、ESm 推定点
FA,FAab,FAcd 正対物領域
MS,MSc、MSd、MSe 測距点
NRc,NRd 法線方向
OB,OBc,OBd、OBs、OBm 障害物
SAc,SAd、SAs、SAm 同一物判定領域
SR,SRc,SRd、SRs,SRm 面

Claims (20)

  1.  所定の方向に沿って配置された第1車輪及び第2車輪と、
     前記第1車輪及び前記第2車輪に結合され、前記第1車輪及び前記第2車輪によって移動可能な車体と、
     前記車体の所定の端部に配置され、送波音波を送波する送波部と、
     前記車体の前記所定の端部に配置され、受波音波を受波する受波部と、を備える車両であって、
     前記送波部は、第1送波音波を送波し、
     前記受波部は、前記第1送波音波に対応する第1反射音波を、前記受波音波として受波し、
     前記第1送波音波および前記第1反射音波に基づき、少なくとも第1障害物の位置を求め、
     前記第1障害物の前記位置に基づき、静止同一物判定領域と、前記車体を基準に前記静止同一物判定領域よりも遠い位置の移動同一物判定領域とを設定し、
     次に、前記送波部は、第2送波音波を送波し、
     前記受波部は、前記第2送波音波に対応する第2反射音波を、前記受波音波として受波し、
     前記第2送波音波および前記第2反射音波に基づき第2障害物の位置を求め、
     前記第2障害物の前記位置が、前記静止同一物判定領域外であり、かつ前記移動同一物判定領域外である場合、前記第2障害物の信頼度を第1信頼度とし、
     前記第2障害物の前記位置が、前記静止同一物判定領域内である、又は前記移動同一物判定領域内である場合、前記第2障害物の信頼度を、前記第1信頼度より高い第2信頼度とし、
     前記第2障害物の前記信頼度と、前記第2障害物の前記位置とに基づいて、前記車体に制動をかけ、及び/又は前記車体の加速を抑制する、
     車両。
  2.  請求項1に記載の車両であって、
     更に、制御回路を備え、
     前記制御回路が、
     前記第1送波音波および前記第1反射音波に基づき、前記第1障害物の前記位置を求め、
     前記第1障害物の前記位置に基づき、前記静止同一物判定領域と、前記移動同一物判定領域とを設定し、
     前記第2送波音波および前記第2反射音波に基づき前記第2障害物の位置を求め、
     前記第2障害物の前記位置が、前記静止同一物判定領域外であり、かつ前記移動同一物判定領域外である場合、前記第2障害物の信頼度を第1信頼度とし、
     前記第2障害物の前記位置が、前記静止同一物判定領域内である、又は前記移動同一物判定領域内である場合、前記第2障害物の信頼度を、前記第2信頼度とする、
     車両。
  3.  請求項1又は請求項2に記載の車両であって、
     前記静止同一物判定領域と前記移動同一物判定領域とが離れて設定される、
     車両。
  4.  請求項1又は請求項2に記載の車両であって、
     前記静止同一物判定領域と前記移動同一物判定領域とは一部が重なって設定される、
     車両。
  5.  請求項1から請求項4のいずれか1項に記載の車両であって、
     前記静止同一物判定領域を、第1静止同一物判定領域とし、
     前記移動同一物判定領域を、第1移動同一物判定領域とし、
     前記送波部は、前記第2送波音波を送波し、
     前記受波部は、前記第2送波音波に対応する第2反射音波を、前記受波音波として受波し、
     前記第2送波音波および前記第2反射音波に基づき第2障害物の位置を求め、
     前記第2障害物の前記位置が、前記第1静止同一物判定領域外であり、かつ前記第1移動同一物判定領域外である場合、前記第2障害物の信頼度を第1信頼度とし、
     前記第2障害物の前記位置が、前記第1静止同一物判定領域内である、又は前記第1移動同一物判定領域内である場合、前記第2障害物の信頼度を、前記第1信頼度より高い第2信頼度とし、
     前記第2障害物の前記位置に基づき、第2静止同一物判定領域と、前記車体を基準に前記第2静止同一物判定領域よりも遠い位置の第2移動同一物判定領域とを設定し、
     次に、前記送波部は、第3送波音波を送波し、
     前記受波部は、前記第3送波音波に対応する第3反射音波を、前記受波音波として受波し、
     前記第3送波音波および前記第3反射音波に基づき第3障害物の位置を求め、
     前記第3障害物の前記位置が、前記第2静止同一物判定領域内である、又は前記第2移動同一物判定領域内である場合、前記第2障害物の信頼度を、前記第2信頼度より高い第3信頼度とし、
     前記第3障害物の前記信頼度が前記第3信頼度である場合、前記第3障害物の前記位置に基づいて前記車体に制動をかけ、及び/又は前記車体の加速を抑制する、
     車両。
  6.  請求項5に記載の車両であって、
     前記第3障害物の前記位置が、前記第2静止同一物判定領域外であり、かつ前記第2移動同一物判定領域外である場合、前記第3障害物の信頼度を第1信頼度とし、
     前記第3障害物の前記信頼度が前記第1信頼度である場合、前記第3障害物の前記位置に基づいて前記車体に制動をかけず、及び/又は前記車体の加速を抑制しない、
     車両。
  7.  請求項1から請求項6のいずれか1項に記載の車両であって、
     前記車両の前記所定の端部は、前記車両において前記所定の方向についての端部である、
     車両。
  8.  請求項1から請求項7のいずれか1項に記載の車両であって、
     バンパーを更に備え、
     前記送波部および前記受波部は、前記バンパーに配置された、
     車両。
  9.  請求項1から請求項8のいずれか1項に記載の車両であって、
     更に、第3車輪と、前記第3車輪の回転方向に沿う方向であって前記所定の方向に配置される第4車輪とを備え、
     前記第3車輪と前記第4車輪とは、前記車体に結合され、
     前記車体は、前記第1車輪、前記第2車輪、前記第3車輪、及び前記第4車輪によって移動可能である、
     車両。
  10.  請求項1から請求項9のいずれか1項に記載の車両であって、更に
     前記第1車輪及び前記第2車輪の少なくとも1つに制動を掛ける制動部と、
     前記第1車輪及び前記第2車輪の少なくとも1つに駆動を掛ける駆動部と、
     を備える、
     車両。
  11.  所定の方向に沿って配置された第1車輪及び第2車輪と、前記第1車輪及び前記第2車輪に結合され、前記第1車輪及び前記第2車輪によって移動可能な車体と、前記車体の所定の端部に配置され、送波音波を送波する送波部と、前記車体の前記所定の端部に配置され、受波音波を受波する受波部と、を備える車両に搭載可能な障害物検知装置であって、
     前記送波部は、第1送波音波を送波し、
     前記受波部は、前記第1送波音波に対応する第1反射音波を、前記受波音波として受波し、
     前記第1送波音波および前記第1反射音波に基づき、少なくとも第1障害物の位置を求め、
     前記第1障害物の前記位置に基づき、静止同一物判定領域と、前記車体を基準に前記静止同一物判定領域よりも遠い位置の移動同一物判定領域とを設定し、
     次に、前記送波部は、第2送波音波を送波し、
     前記受波部は、前記第2送波音波に対応する第2反射音波を、前記受波音波として受波し、
     前記第2送波音波および前記第2反射音波に基づき第2障害物の位置を求め、
     前記第2障害物の前記位置が、前記静止同一物判定領域外であり、かつ前記移動同一物判定領域外である場合、前記第2障害物の信頼度を第1信頼度とし、
     前記第2障害物の前記位置が、前記静止同一物判定領域内である、又は前記移動同一物判定領域内である場合、前記第2障害物の信頼度を、前記第1信頼度より高い第2信頼度とし、
     前記第2障害物の前記信頼度と、前記第2障害物の前記位置とに基づいて、前記車体に制動をかけさせ、及び/又は前記車体の加速を抑制させる、
     障害物検知装置。
  12.  請求項11に記載の障害物検知装置であって、
     更に、制御回路を備え、
     前記制御回路が、
     前記第1送波音波および前記第1反射音波に基づき、前記第1障害物の前記位置を求め、
     前記第1障害物の前記位置に基づき、前記静止同一物判定領域と、前記移動同一物判定領域とを設定し、
     前記第2送波音波および前記第2反射音波に基づき前記第2障害物の位置を求め、
     前記第2障害物の前記位置が、前記静止同一物判定領域外であり、かつ前記移動同一物判定領域外である場合、前記第2障害物の信頼度を第1信頼度とし、
     前記第2障害物の前記位置が、前記静止同一物判定領域内である、又は前記移動同一物判定領域内である場合、前記第2障害物の信頼度を、前記第2信頼度とする、
     障害物検知装置。
  13.  請求項11又は請求項12に記載の障害物検知装置であって、
     前記静止同一物判定領域と前記移動同一物判定領域とが離れて設定される、
     障害物検知装置。
  14.  請求項11又は請求項12に記載の障害物検知装置であって、
     前記静止同一物判定領域と前記移動同一物判定領域とは一部が重なって設定される、
     障害物検知装置。
  15.  請求項11から請求項14のいずれか1項に記載の障害物検知装置であって、
     前記静止同一物判定領域を、第1静止同一物判定領域とし、
     前記移動同一物判定領域を、第1移動同一物判定領域とし、
     前記送波部は、前記第2送波音波を送波し、
     前記受波部は、前記第2送波音波に対応する第2反射音波を、前記受波音波として受波し、
     前記第2送波音波および前記第2反射音波に基づき第2障害物の位置を求め、
     前記第2障害物の前記位置が、前記第1静止同一物判定領域外であり、かつ前記第1移動同一物判定領域外である場合、前記第2障害物の信頼度を第1信頼度とし、
     前記第2障害物の前記位置が、前記第1静止同一物判定領域内である、又は前記第1移動同一物判定領域内である場合、前記第2障害物の信頼度を、前記第1信頼度より高い第2信頼度とし、
     前記第2障害物の前記位置に基づき、第2静止同一物判定領域と、前記車体を基準に前記第2静止同一物判定領域よりも遠い位置の第2移動同一物判定領域とを設定し、
     次に、前記送波部は、第3送波音波を送波し、
     前記受波部は、前記第3送波音波に対応する第3反射音波を、前記受波音波として受波し、
     前記第3送波音波および前記第3反射音波に基づき第3障害物の位置を求め、
     前記第3障害物の前記位置が、前記第2静止同一物判定領域内である、又は前記第2移動同一物判定領域内である場合、前記第2障害物の信頼度を、前記第2信頼度より高い第3信頼度とし、
     前記第3障害物の前記信頼度が前記第3信頼度である場合、前記第3障害物の前記位置に基づいて前記車体に制動をかけさせ、及び/又は前記車体の加速を抑制させる、
     障害物検知装置。
  16.  請求項15に記載の障害物検知装置であって、
     前記第3障害物の前記位置が、前記第2静止同一物判定領域外であり、かつ前記第2移動同一物判定領域外である場合、前記第3障害物の信頼度を第1信頼度とし、
     前記第3障害物の前記信頼度が前記第1信頼度である場合、前記第3障害物の前記位置に基づいて前記車体に制動をかけさせず、及び/又は前記車体の加速を抑制させない、
     障害物検知装置。
  17.  請求項11から請求項16のいずれか1項に記載の障害物検知装置であって、
     前記車両の前記所定の端部は、前記車両において前記所定の方向についての端部である、
     障害物検知装置。
  18.  請求項11から請求項17のいずれか1項に記載の障害物検知装置であって、
     前記車両はバンパーを更に備え、
     前記送波部および前記受波部は、前記バンパーに配置された、
     障害物検知装置。
  19.  請求項11から請求項18のいずれか1項に記載の障害物検知装置であって、
     前記車両は、更に、第3車輪と、前記第3車輪の回転方向に沿う方向であって前記所定の方向に配置される第4車輪とを備え、
     前記第3車輪と前記第4車輪とは、前記車体に結合され、
     前記車体は、前記第1車輪、前記第2車輪、前記第3車輪、及び前記第4車輪によって移動可能である、
     障害物検知装置。
  20.  請求項11から請求項19のいずれか1項に記載の障害物検知装置であって、前記車両は更に
     前記第1車輪及び前記第2車輪の少なくとも1つに制動を掛ける制動部と、
     前記第1車輪及び前記第2車輪の少なくとも1つに駆動を掛ける駆動部と、
     を備える、
     障害物検知装置。
PCT/JP2021/026027 2020-08-03 2021-07-09 車両および障害物検知装置 WO2022030186A1 (ja)

Priority Applications (3)

Application Number Priority Date Filing Date Title
DE112021004117.7T DE112021004117T5 (de) 2020-08-03 2021-07-09 Fahrzeug und Hinderniserfassungsvorrichtung
CN202180060130.2A CN116134500A (zh) 2020-08-03 2021-07-09 车辆和障碍物探测装置
US17/978,724 US20230052064A1 (en) 2020-08-03 2022-11-01 Vehicle and obstacle detection device

Applications Claiming Priority (4)

Application Number Priority Date Filing Date Title
JP2020132025A JP6994676B1 (ja) 2020-08-03 2020-08-03 車両および障害物検知装置
JP2020-132025 2020-08-03
JP2021-056608 2021-03-30
JP2021056608A JP7108946B1 (ja) 2021-03-30 2021-03-30 車両および障害物検知装置

Related Child Applications (1)

Application Number Title Priority Date Filing Date
US17/978,724 Continuation US20230052064A1 (en) 2020-08-03 2022-11-01 Vehicle and obstacle detection device

Publications (1)

Publication Number Publication Date
WO2022030186A1 true WO2022030186A1 (ja) 2022-02-10

Family

ID=80117947

Family Applications (1)

Application Number Title Priority Date Filing Date
PCT/JP2021/026027 WO2022030186A1 (ja) 2020-08-03 2021-07-09 車両および障害物検知装置

Country Status (4)

Country Link
US (1) US20230052064A1 (ja)
CN (1) CN116134500A (ja)
DE (1) DE112021004117T5 (ja)
WO (1) WO2022030186A1 (ja)

Citations (5)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JPH05113479A (ja) * 1991-08-27 1993-05-07 Matsushita Electric Works Ltd 車載用超音波検知器
JP2000214259A (ja) * 1999-01-26 2000-08-04 Matsushita Electric Works Ltd 車両用障害物検知装置
JP2001273595A (ja) * 2000-03-28 2001-10-05 Matsushita Electric Works Ltd 自動車用障害物検知装置
JP2008039497A (ja) * 2006-08-03 2008-02-21 Matsushita Electric Works Ltd 障害物検出装置
JP2019070986A (ja) * 2017-10-11 2019-05-09 三菱電機株式会社 車両用走行支援装置

Family Cites Families (1)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP6336886B2 (ja) 2014-10-22 2018-06-06 株式会社デンソー 物体検知装置

Patent Citations (5)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JPH05113479A (ja) * 1991-08-27 1993-05-07 Matsushita Electric Works Ltd 車載用超音波検知器
JP2000214259A (ja) * 1999-01-26 2000-08-04 Matsushita Electric Works Ltd 車両用障害物検知装置
JP2001273595A (ja) * 2000-03-28 2001-10-05 Matsushita Electric Works Ltd 自動車用障害物検知装置
JP2008039497A (ja) * 2006-08-03 2008-02-21 Matsushita Electric Works Ltd 障害物検出装置
JP2019070986A (ja) * 2017-10-11 2019-05-09 三菱電機株式会社 車両用走行支援装置

Also Published As

Publication number Publication date
DE112021004117T5 (de) 2023-07-20
CN116134500A (zh) 2023-05-16
US20230052064A1 (en) 2023-02-16

Similar Documents

Publication Publication Date Title
WO2017014080A1 (ja) 運転支援システム
US9902399B2 (en) Vehicle travelling control device for controlling a vehicle in traffic
JP6409699B2 (ja) 自動運転システム
EP3039450B1 (en) In-vehicle control device
US9953532B2 (en) Obstacle warning apparatus
JP4442520B2 (ja) 車両用進路推定装置
JP2008195293A (ja) 衝突予測装置
JP5417832B2 (ja) 車両用運転支援装置
JP6432538B2 (ja) 衝突予測装置
JP7147648B2 (ja) 運転支援装置
JP6442225B2 (ja) 物体検知装置
JP2017151726A (ja) 衝突予測装置
JP5075656B2 (ja) 物体検知装置
JP4864450B2 (ja) 車両の運転支援装置
JP4850963B1 (ja) 車両の運転支援装置
WO2022030186A1 (ja) 車両および障害物検知装置
JP2007069728A (ja) 走行制御装置
JP7108946B1 (ja) 車両および障害物検知装置
JP6994676B1 (ja) 車両および障害物検知装置
WO2021172532A1 (ja) 駐車支援装置および駐車支援方法
JP5658125B2 (ja) 車両の運転支援装置
WO2016063533A1 (ja) 車載用物体判別装置
JP6315070B1 (ja) 車両用障害物検知装置
JP2013016052A (ja) 車両用物体認識装置
JP5658130B2 (ja) 車両の運転支援装置

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: 21853823

Country of ref document: EP

Kind code of ref document: A1

122 Ep: pct application non-entry in european phase

Ref document number: 21853823

Country of ref document: EP

Kind code of ref document: A1