WO2018092566A1 - 衝突判定装置、及び衝突判定方法 - Google Patents
衝突判定装置、及び衝突判定方法 Download PDFInfo
- Publication number
- WO2018092566A1 WO2018092566A1 PCT/JP2017/039081 JP2017039081W WO2018092566A1 WO 2018092566 A1 WO2018092566 A1 WO 2018092566A1 JP 2017039081 W JP2017039081 W JP 2017039081W WO 2018092566 A1 WO2018092566 A1 WO 2018092566A1
- Authority
- WO
- WIPO (PCT)
- Prior art keywords
- target
- filter
- course
- collision determination
- host vehicle
- Prior art date
Links
- 238000000034 method Methods 0.000 title claims description 45
- 238000001514 detection method Methods 0.000 claims abstract description 125
- 238000009499 grossing Methods 0.000 claims abstract description 15
- 238000001914 filtration Methods 0.000 claims abstract description 14
- 230000008569 process Effects 0.000 claims description 37
- 230000008859 change Effects 0.000 claims description 22
- 238000000137 annealing Methods 0.000 claims description 5
- 239000000523 sample Substances 0.000 abstract 1
- 230000004043 responsiveness Effects 0.000 description 16
- 230000005540 biological transmission Effects 0.000 description 8
- 238000010586 diagram Methods 0.000 description 7
- 230000000694 effects Effects 0.000 description 4
- 230000007246 mechanism Effects 0.000 description 4
- 230000004044 response Effects 0.000 description 3
- 230000004048 modification Effects 0.000 description 2
- 238000012986 modification Methods 0.000 description 2
- 230000001788 irregular Effects 0.000 description 1
- 230000000116 mitigating effect Effects 0.000 description 1
- 230000007935 neutral effect Effects 0.000 description 1
- 230000002040 relaxant effect Effects 0.000 description 1
Images
Classifications
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B60—VEHICLES IN GENERAL
- B60W—CONJOINT 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/00—Conjoint control of vehicle sub-units of different type or different function
- B60W10/18—Conjoint control of vehicle sub-units of different type or different function including control of braking systems
- B60W10/184—Conjoint control of vehicle sub-units of different type or different function including control of braking systems with wheel brakes
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01S—RADIO DIRECTION-FINDING; RADIO NAVIGATION; DETERMINING DISTANCE OR VELOCITY BY USE OF RADIO WAVES; LOCATING OR PRESENCE-DETECTING BY USE OF THE REFLECTION OR RERADIATION OF RADIO WAVES; ANALOGOUS ARRANGEMENTS USING OTHER WAVES
- G01S13/00—Systems using the reflection or reradiation of radio waves, e.g. radar systems; Analogous systems using reflection or reradiation of waves whose nature or wavelength is irrelevant or unspecified
- G01S13/88—Radar or analogous systems specially adapted for specific applications
- G01S13/93—Radar or analogous systems specially adapted for specific applications for anti-collision purposes
- G01S13/931—Radar or analogous systems specially adapted for specific applications for anti-collision purposes of land vehicles
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B60—VEHICLES IN GENERAL
- B60R—VEHICLES, VEHICLE FITTINGS, OR VEHICLE PARTS, NOT OTHERWISE PROVIDED FOR
- B60R22/00—Safety belts or body harnesses in vehicles
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B60—VEHICLES IN GENERAL
- B60W—CONJOINT 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/00—Purposes of road vehicle drive control systems not related to the control of a particular sub-unit, e.g. of systems using conjoint control of vehicle sub-units
- B60W30/08—Active safety systems predicting or avoiding probable or impending collision or attempting to minimise its consequences
- B60W30/09—Taking automatic action to avoid collision, e.g. braking and steering
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B60—VEHICLES IN GENERAL
- B60W—CONJOINT 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/00—Purposes of road vehicle drive control systems not related to the control of a particular sub-unit, e.g. of systems using conjoint control of vehicle sub-units
- B60W30/08—Active safety systems predicting or avoiding probable or impending collision or attempting to minimise its consequences
- B60W30/095—Predicting travel path or likelihood of collision
- B60W30/0953—Predicting travel path or likelihood of collision the prediction being responsive to vehicle dynamic parameters
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B60—VEHICLES IN GENERAL
- B60W—CONJOINT 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/00—Purposes of road vehicle drive control systems not related to the control of a particular sub-unit, e.g. of systems using conjoint control of vehicle sub-units
- B60W30/08—Active safety systems predicting or avoiding probable or impending collision or attempting to minimise its consequences
- B60W30/095—Predicting travel path or likelihood of collision
- B60W30/0956—Predicting travel path or likelihood of collision the prediction being responsive to traffic or environmental parameters
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01S—RADIO DIRECTION-FINDING; RADIO NAVIGATION; DETERMINING DISTANCE OR VELOCITY BY USE OF RADIO WAVES; LOCATING OR PRESENCE-DETECTING BY USE OF THE REFLECTION OR RERADIATION OF RADIO WAVES; ANALOGOUS ARRANGEMENTS USING OTHER WAVES
- G01S13/00—Systems using the reflection or reradiation of radio waves, e.g. radar systems; Analogous systems using reflection or reradiation of waves whose nature or wavelength is irrelevant or unspecified
- G01S13/02—Systems using reflection of radio waves, e.g. primary radar systems; Analogous systems
- G01S13/50—Systems of measurement based on relative movement of target
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01S—RADIO DIRECTION-FINDING; RADIO NAVIGATION; DETERMINING DISTANCE OR VELOCITY BY USE OF RADIO WAVES; LOCATING OR PRESENCE-DETECTING BY USE OF THE REFLECTION OR RERADIATION OF RADIO WAVES; ANALOGOUS ARRANGEMENTS USING OTHER WAVES
- G01S7/00—Details of systems according to groups G01S13/00, G01S15/00, G01S17/00
- G01S7/02—Details of systems according to groups G01S13/00, G01S15/00, G01S17/00 of systems according to group G01S13/00
- G01S7/41—Details of systems according to groups G01S13/00, G01S15/00, G01S17/00 of systems according to group G01S13/00 using analysis of echo signal for target characterisation; Target signature; Target cross-section
- G01S7/415—Identification of targets based on measurements of movement associated with the target
-
- G—PHYSICS
- G08—SIGNALLING
- G08G—TRAFFIC CONTROL SYSTEMS
- G08G1/00—Traffic control systems for road vehicles
- G08G1/16—Anti-collision systems
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B60—VEHICLES IN GENERAL
- B60W—CONJOINT 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
- B60W50/00—Details of control systems for road vehicle drive control not related to the control of a particular sub-unit, e.g. process diagnostic or vehicle driver interfaces
- B60W2050/0001—Details of the control system
- B60W2050/0043—Signal treatments, identification of variables or parameters, parameter estimation or state estimation
- B60W2050/0052—Filtering, filters
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B60—VEHICLES IN GENERAL
- B60W—CONJOINT 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
- B60W50/00—Details of control systems for road vehicle drive control not related to the control of a particular sub-unit, e.g. process diagnostic or vehicle driver interfaces
- B60W50/08—Interaction between the driver and the control system
- B60W50/14—Means for informing the driver, warning the driver or prompting a driver intervention
- B60W2050/143—Alarm means
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B60—VEHICLES IN GENERAL
- B60W—CONJOINT 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/00—Indexing codes relating to the type of sensors based on the principle of their operation
- B60W2420/40—Photo, light or radio wave sensitive means, e.g. infrared sensors
- B60W2420/408—Radar; Laser, e.g. lidar
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B60—VEHICLES IN GENERAL
- B60W—CONJOINT 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
- B60W2510/00—Input parameters relating to a particular sub-units
- B60W2510/10—Change speed gearings
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B60—VEHICLES IN GENERAL
- B60W—CONJOINT 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/00—Input parameters relating to overall vehicle dynamics
- B60W2520/10—Longitudinal speed
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B60—VEHICLES IN GENERAL
- B60W—CONJOINT 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/00—Input parameters relating to occupants
- B60W2540/18—Steering angle
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B60—VEHICLES IN GENERAL
- B60W—CONJOINT 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/00—Input parameters relating to objects
- B60W2554/80—Spatial relation or speed relative to objects
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B60—VEHICLES IN GENERAL
- B60W—CONJOINT 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/00—Input parameters relating to objects
- B60W2554/80—Spatial relation or speed relative to objects
- B60W2554/801—Lateral distance
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01S—RADIO DIRECTION-FINDING; RADIO NAVIGATION; DETERMINING DISTANCE OR VELOCITY BY USE OF RADIO WAVES; LOCATING OR PRESENCE-DETECTING BY USE OF THE REFLECTION OR RERADIATION OF RADIO WAVES; ANALOGOUS ARRANGEMENTS USING OTHER WAVES
- G01S13/00—Systems using the reflection or reradiation of radio waves, e.g. radar systems; Analogous systems using reflection or reradiation of waves whose nature or wavelength is irrelevant or unspecified
- G01S13/02—Systems using reflection of radio waves, e.g. primary radar systems; Analogous systems
- G01S13/50—Systems of measurement based on relative movement of target
- G01S13/58—Velocity or trajectory determination systems; Sense-of-movement determination systems
- G01S13/583—Velocity or trajectory determination systems; Sense-of-movement determination systems using transmission of continuous unmodulated waves, amplitude-, frequency-, or phase-modulated waves and based upon the Doppler effect resulting from movement of targets
- G01S13/584—Velocity or trajectory determination systems; Sense-of-movement determination systems using transmission of continuous unmodulated waves, amplitude-, frequency-, or phase-modulated waves and based upon the Doppler effect resulting from movement of targets adapted for simultaneous range and velocity measurements
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01S—RADIO DIRECTION-FINDING; RADIO NAVIGATION; DETERMINING DISTANCE OR VELOCITY BY USE OF RADIO WAVES; LOCATING OR PRESENCE-DETECTING BY USE OF THE REFLECTION OR RERADIATION OF RADIO WAVES; ANALOGOUS ARRANGEMENTS USING OTHER WAVES
- G01S13/00—Systems using the reflection or reradiation of radio waves, e.g. radar systems; Analogous systems using reflection or reradiation of waves whose nature or wavelength is irrelevant or unspecified
- G01S13/88—Radar or analogous systems specially adapted for specific applications
- G01S13/93—Radar or analogous systems specially adapted for specific applications for anti-collision purposes
- G01S13/931—Radar or analogous systems specially adapted for specific applications for anti-collision purposes of land vehicles
- G01S2013/9314—Parking operations
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01S—RADIO DIRECTION-FINDING; RADIO NAVIGATION; DETERMINING DISTANCE OR VELOCITY BY USE OF RADIO WAVES; LOCATING OR PRESENCE-DETECTING BY USE OF THE REFLECTION OR RERADIATION OF RADIO WAVES; ANALOGOUS ARRANGEMENTS USING OTHER WAVES
- G01S13/00—Systems using the reflection or reradiation of radio waves, e.g. radar systems; Analogous systems using reflection or reradiation of waves whose nature or wavelength is irrelevant or unspecified
- G01S13/88—Radar or analogous systems specially adapted for specific applications
- G01S13/93—Radar or analogous systems specially adapted for specific applications for anti-collision purposes
- G01S13/931—Radar or analogous systems specially adapted for specific applications for anti-collision purposes of land vehicles
- G01S2013/9317—Driving backwards
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01S—RADIO DIRECTION-FINDING; RADIO NAVIGATION; DETERMINING DISTANCE OR VELOCITY BY USE OF RADIO WAVES; LOCATING OR PRESENCE-DETECTING BY USE OF THE REFLECTION OR RERADIATION OF RADIO WAVES; ANALOGOUS ARRANGEMENTS USING OTHER WAVES
- G01S13/00—Systems using the reflection or reradiation of radio waves, e.g. radar systems; Analogous systems using reflection or reradiation of waves whose nature or wavelength is irrelevant or unspecified
- G01S13/88—Radar or analogous systems specially adapted for specific applications
- G01S13/93—Radar or analogous systems specially adapted for specific applications for anti-collision purposes
- G01S13/931—Radar or analogous systems specially adapted for specific applications for anti-collision purposes of land vehicles
- G01S2013/93185—Controlling the brakes
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01S—RADIO DIRECTION-FINDING; RADIO NAVIGATION; DETERMINING DISTANCE OR VELOCITY BY USE OF RADIO WAVES; LOCATING OR PRESENCE-DETECTING BY USE OF THE REFLECTION OR RERADIATION OF RADIO WAVES; ANALOGOUS ARRANGEMENTS USING OTHER WAVES
- G01S13/00—Systems using the reflection or reradiation of radio waves, e.g. radar systems; Analogous systems using reflection or reradiation of waves whose nature or wavelength is irrelevant or unspecified
- G01S13/88—Radar or analogous systems specially adapted for specific applications
- G01S13/93—Radar or analogous systems specially adapted for specific applications for anti-collision purposes
- G01S13/931—Radar or analogous systems specially adapted for specific applications for anti-collision purposes of land vehicles
- G01S2013/932—Radar or analogous systems specially adapted for specific applications for anti-collision purposes of land vehicles using own vehicle data, e.g. ground speed, steering wheel direction
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01S—RADIO DIRECTION-FINDING; RADIO NAVIGATION; DETERMINING DISTANCE OR VELOCITY BY USE OF RADIO WAVES; LOCATING OR PRESENCE-DETECTING BY USE OF THE REFLECTION OR RERADIATION OF RADIO WAVES; ANALOGOUS ARRANGEMENTS USING OTHER WAVES
- G01S13/00—Systems using the reflection or reradiation of radio waves, e.g. radar systems; Analogous systems using reflection or reradiation of waves whose nature or wavelength is irrelevant or unspecified
- G01S13/88—Radar or analogous systems specially adapted for specific applications
- G01S13/93—Radar or analogous systems specially adapted for specific applications for anti-collision purposes
- G01S13/931—Radar or analogous systems specially adapted for specific applications for anti-collision purposes of land vehicles
- G01S2013/9327—Sensor installation details
- G01S2013/93271—Sensor installation details in the front of the vehicles
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01S—RADIO DIRECTION-FINDING; RADIO NAVIGATION; DETERMINING DISTANCE OR VELOCITY BY USE OF RADIO WAVES; LOCATING OR PRESENCE-DETECTING BY USE OF THE REFLECTION OR RERADIATION OF RADIO WAVES; ANALOGOUS ARRANGEMENTS USING OTHER WAVES
- G01S13/00—Systems using the reflection or reradiation of radio waves, e.g. radar systems; Analogous systems using reflection or reradiation of waves whose nature or wavelength is irrelevant or unspecified
- G01S13/88—Radar or analogous systems specially adapted for specific applications
- G01S13/93—Radar or analogous systems specially adapted for specific applications for anti-collision purposes
- G01S13/931—Radar or analogous systems specially adapted for specific applications for anti-collision purposes of land vehicles
- G01S2013/9327—Sensor installation details
- G01S2013/93272—Sensor installation details in the back of the vehicles
Definitions
- the present disclosure relates to a collision determination device that performs a collision determination between a host vehicle and a target, and a collision determination method.
- Patent Document 1 there is a collision determination device that performs a collision determination between a host vehicle and a target to make the vehicle travel safe (for example, Patent Document 1).
- the system ECU acquires the behavior (running state) of the host vehicle from a vehicle speed sensor or the like, and estimates the course of the host vehicle.
- the radar ECU detects the position of the other vehicle (target) using the millimeter wave radar device, and estimates the course of the other vehicle based on the change in the position. Then, the system ECU performs a collision determination based on the estimated course of the own vehicle and the estimated course of the other vehicle, and executes a vehicle control such as braking the vehicle when it is determined that the collision occurs. Thereby, traveling safety of the vehicle can be achieved.
- the millimeter wave radar device detects the position of a target based on a reflected wave from another vehicle as a target. For this reason, when estimating the path of a target based on detection information from the millimeter wave radar device, there is a risk that the path may be erroneously estimated due to the influence of unnecessary reflected waves reflected from vehicles other than the target. is there. Therefore, in order to suppress the influence of unnecessary reflected waves, the detection information is filtered (smoothed) using a low-pass filter or the like, and the course is appropriately estimated.
- the present disclosure has been made in view of the above circumstances, and has as its main purpose to provide a collision determination device and a collision determination method capable of appropriately setting filter characteristics.
- This disclosure is as follows in order to solve the above problems.
- the collision determination device includes an acquisition unit that transmits detection waves and receives detection information based on the reflected waves from a search device that receives the reflected waves reflected by the target, and a filter that filters the detection information Based on a change in the position of the target detected by the processing unit, the target information detecting unit that detects the position of the target using the filtered detection information, and the target information detecting unit
- the target course estimating unit that estimates the course of the target, the own vehicle course estimating unit that estimates the course of the host vehicle, and whether or not the course of the target and the course of the host vehicle intersect,
- a collision determination unit that performs a collision determination between the host vehicle and the target, and the host vehicle and the target collide, based on the path of the target and the path of the host vehicle, Estimate the timing when the target collides with the host vehicle,
- a vehicle control unit that executes control, and the course of the target used in the collision determination unit is estimated based on the detection information filtered by the collision determination filter, and the vehicle
- the influence can be suppressed by appropriately setting the filter characteristics. Therefore, it is possible to suppress unnecessary vehicle control from being performed and to prevent necessary vehicle control from being performed.
- FIG. 1 is a block diagram of PCSS.
- FIG. 2 is a diagram showing the course of the target
- FIG. 3 is a diagram showing the detection range of the radar sensor
- 4A and 4B are diagrams illustrating a situation in which a deviation in the course of a target occurs.
- FIG. 5 is a diagram showing the relationship between the filter characteristics and the course of the target.
- FIG. 6 is a flowchart showing the collision determination process.
- FIG. 7 is a configuration diagram of the PCSS of the second embodiment.
- FIGS. 8A to 8C are diagrams showing detectable distances.
- FIG. 9 is a flowchart illustrating a collision determination process according to the second embodiment.
- FIG. 1 shows a pre-crash safety system (hereinafter referred to as PCSS: Pre-crash safety system) 100.
- the PCSS 100 is an example of a vehicle system mounted on a vehicle, detects an object positioned around the vehicle, and when the detected object and the vehicle may collide, A collision mitigation operation (PCS) is performed.
- PCS collision mitigation operation
- a vehicle on which the PCSS 100 is mounted is referred to as a host vehicle CS
- an object to be detected is referred to as a target Ob.
- the driving assistance ECU 20 functions as a collision determination device and executes a collision determination method.
- the various sensors are connected to the driving support ECU 20, and output to the driving support ECU 20 the detection information of the target Ob and the vehicle information related to the host vehicle CS.
- the various sensors include a radar sensor 31 as a search device, a vehicle speed sensor 32, and a steering angle sensor 33.
- the radar sensor 31 is, for example, a known millimeter wave radar device that uses a millimeter wave band high frequency signal as a transmission wave.
- the radar sensor 31 is provided, for example, at the rear end of the host vehicle CS, and detects a position of the target Ob in the detection range 31a by setting a region entering the predetermined detection angle ⁇ as a detection range 31a.
- an exploration wave is transmitted at a predetermined period, and a reflected wave is received by a plurality of antennas.
- the distance from the target Ob is calculated from the transmission time of the exploration wave and the reception time of the reflected wave.
- the relative velocity is calculated from the frequency of the reflected wave reflected by the target Ob, which has changed due to the Doppler effect.
- the direction of the target Ob is calculated from the phase difference of the reflected waves received by the plurality of antennas.
- the relative position of the target Ob with respect to the host vehicle CS can be specified.
- the radar sensor 31 transmits an exploration wave, receives a reflected wave, calculates a distance, calculates an azimuth, and calculates a relative velocity at predetermined intervals. Then, the radar sensor 31 outputs the driving assistance ECU 20 with the calculated distance from the target Ob, the direction of the target Ob, and the relative speed as radar detection information. The radar sensor 31 may calculate the relative position of the target object Ob and output it as radar detection information.
- the vehicle speed sensor 32 detects the current vehicle speed of the host vehicle CS. The detected vehicle speed is input to the driving assistance ECU 20.
- the steering angle sensor 33 detects the steering angle of the steering wheel (or tire). The detected steering angle is input to the driving assistance ECU 20.
- the brake device 40 includes a brake mechanism that changes the braking force of the host vehicle CS and a brake ECU that controls the operation of the brake mechanism.
- the brake ECU is communicably connected to the driving support ECU 20, and controls the brake mechanism under the control of the driving support ECU 20.
- the brake mechanism includes, for example, a master cylinder, a wheel cylinder that applies braking force to wheels (tires), and an ABS actuator that adjusts the distribution of pressure (hydraulic pressure) from the master cylinder to the wheel cylinder.
- the ABS actuator is connected to the brake ECU, and the amount of operation with respect to the wheels (tires) is adjusted by adjusting the hydraulic pressure from the master cylinder to the wheel cylinder under the control of the brake ECU.
- the alarm device 50 warns the driver that there is a target Ob approaching the rear of the vehicle under the control of the driving support ECU 20.
- the alarm device 50 includes, for example, a speaker provided in the passenger compartment and a display unit that displays an image.
- the seat belt device 60 includes a seat belt provided in each seat of the own vehicle and a pretensioner that pulls in the seat belt.
- the seat belt device 60 performs a preliminary operation of retracting the seat belt when the possibility of the host vehicle CS colliding with the target Ob increases as the operation of the PCS. If the collision cannot be avoided, the seat belt is retracted to remove the slack, and the driver or other passenger is fixed to the seat to protect the passenger.
- the transmission 70 sets the shift position of the host vehicle CS when a shift lever (not shown) is operated by a driver.
- the shift position includes, for example, an R position (reverse) that is a position indicating that the host vehicle CS is moving backward, and a D position (drive) that is a position indicating that the host vehicle CS is moving forward. is there.
- the shift position includes an N position (neutral) and a P position (parking). Information indicating the shift position is input to the driving support ECU 20.
- the driving support ECU 20 is configured as a well-known microcomputer including a CPU, a ROM, and a RAM, and performs vehicle control on the host vehicle CS with reference to a calculation program and control data in the ROM.
- the driving assistance ECU 20 causes the PCS to be performed when the host vehicle CS is moving backward, that is, when the shift position is the R position.
- the driving support ECU 20 acquires radar detection information from the radar sensor 31 and detects the position of the target Ob based on the acquired radar detection information. Then, based on the detection result, the driving support ECU 20 causes the PCS to be executed with at least one of the devices 40, 50, 60 as a control target.
- the driving support ECU 20 executes the program stored in the ROM, thereby obtaining the acquisition unit 21, the filter processing unit 22, the target information detection unit 23, the target course estimation unit 24, and the own vehicle course estimation.
- the unit 25 the collision determination unit 26, and the vehicle control unit 27. Each function will be described below.
- the acquisition unit 21 acquires the radar detection information input from the radar sensor 31 every predetermined period (for example, 80 ms).
- the radar detection information includes position information indicating the position Pr of the target object Ob.
- the acquisition unit 21 acquires information indicating the vehicle speed of the host vehicle CS from the vehicle speed sensor 32, and acquires information indicating the steering angle from the steering angle sensor 33. Further, the acquisition unit 21 acquires information indicating the shift position from the transmission 70.
- the filter processing unit 22 performs a filtering process on the radar detection information acquired by the acquisition unit 21.
- the filter process is, for example, an annealing process that suppresses changes in radar detection information. More specifically, the filtering process indicates that information included in the radar detection information (such as the direction, distance, relative speed, or relative position of the target Ob) changes abruptly from the information included in the previous radar detection information. It is a process of relaxing by a filter, or a process of selecting information that has changed suddenly by a filter. By this filtering process, it is possible to suppress a sudden change in the position Pr of the target object Ob detected based on the radar detection information.
- the filter process suppresses (smooths) the position Pr of the target Ob from being rapidly changed from the position Pr of the target Ob detected up to the previous time. And by this filter process, the influence of the unnecessary reflected wave other than the target Ob is suppressed or excluded.
- the filter process includes a low-pass filter process that excludes radar detection information based on a reflected wave in a high-frequency band by a low-pass filter.
- the target information detection unit 23 detects the position Pr of the target Ob based on the radar detection information filtered by the filter processing unit 22. Specifically, the target information detection unit 23 detects a position Pr on the coordinates with the host vehicle CS as the origin based on the distance and direction from the target Ob included in the radar detection information. In this coordinate, the X axis is set along the vehicle width direction of the host vehicle CS, and the Y axis direction is set along the traveling direction of the host vehicle CS. More specifically, the origin is set as the origin at the midpoint of the rear wheel of the host vehicle CS. Thereby, the relative position of the target Ob with respect to the host vehicle CS is detected.
- the lateral direction orthogonal to the traveling direction is the vehicle width direction (X-axis direction). Further, when the radar detection information includes the relative position of the target Ob, it may be obtained as a detection result. The position Pr of the target Ob is recorded in the history information.
- the target course estimation unit 24 estimates the course of the target Ob based on the change in the position Pr stored as the history information. For example, the moving direction vector of the target Ob is calculated as the course of the target Ob.
- FIG. 2 shows the position Pr of the target Ob at each time from time t1 to time t4 of the vehicle detected as the target Ob, and the course of the target Ob calculated from the position Pr. The time t4 becomes the position Pr of the latest target Ob recorded in the history information.
- the target course estimation unit 24 estimates the course of the target Ob using a known linear interpolation operation such as a least square method for a straight line passing through a position closest to each position Pr.
- the own vehicle course estimation unit 25 estimates the course of the host vehicle CS based on the vehicle speed and the steering angle.
- the course of the host vehicle CS is estimated by calculating the turning direction, turning radius, turning center, and the like based on the vehicle speed and the steering angle.
- the steering angle is 0 degree
- the course of the host vehicle CS is estimated by a straight line
- the steering angle is other than 0 degree
- the course of the host vehicle CS is estimated by a curve.
- the turning direction may be specified based on the steering angle
- the course of the host vehicle CS may be estimated from a straight line along the turning direction.
- the vehicle speed is 0 km / h
- the host vehicle CS is stopped, and the course of the host vehicle CS is fixed at a local point.
- the collision determination unit 26 performs a collision determination between the host vehicle CS and the target Ob based on the estimated path of the target Ob and the path of the host vehicle CS. For example, when the course of the target Ob and the course of the host vehicle CS intersect, the collision determination unit 26 determines that the host vehicle CS and the target Ob may collide.
- the collision determination unit 26 may determine whether or not to collide in consideration of the vehicle width of the host vehicle CS. For example, the collision determination unit 26 determines, based on the estimated path of the host vehicle CS and the vehicle width of the host vehicle CS, the path through which the left rear end portion (for example, the left rear wheel or the left tail lamp) passes, The path through which the rear end portion (for example, the right rear wheel or the right tail lamp) passes is estimated. And the collision determination part 26 may determine based on whether one of the estimated courses and the course of the target Ob intersect. Similarly, the collision determination may be performed in consideration of the width of the target object Ob.
- the vehicle control unit 27 determines that there is a possibility of collision, the distance to the intersection (predicted collision point) between the course of the target Ob that is determined to have the possibility of collision and the course of the host vehicle CS. (Predicted distance) is calculated. Then, the vehicle control unit 27 controls the alarm device 50, the brake device 40, and the seat belt device 60 in accordance with the predicted distance, thereby implementing PCS as vehicle control.
- the vehicle control unit 27 determines whether or not the calculated predicted distance is equal to or less than a predetermined first distance.
- the first time is a threshold for indicating the PCS start timing, and a value such as 10 m is set, for example.
- the vehicle control unit 27 controls the alarm device 50 to output an alarm.
- the vehicle control unit 27 controls the brake device 40 to brake the host vehicle CS.
- the vehicle control unit 27 controls the seat belt device 60, and the seat belt To pull in.
- the detection angle ⁇ of the radar sensor 31 attached to the rear side of the vehicle is set wider than the radar sensor attached to the front side of the vehicle.
- the radar sensor 31 has a detection angle ⁇ of about 50 to 140 degrees, and a range up to a distance of about 50 m from the host vehicle CS is set as a detection range 31a.
- a radar sensor mounted in front of the vehicle has a detection angle ⁇ of about 20 to 30 degrees, and a range up to a distance of about 100 m from the host vehicle CS is often used as a detection range.
- the driving assistance ECU 20 acquires the radar detection information from the radar sensor 31 having such a detection range 31a and detects the position Pr of the target Ob, the driving support ECU 20 is effective in the rear of the host vehicle CS that has many blind spots for the driver. It is possible to detect the target Ob and make a collision determination.
- the position Pr of the target Ob may be erroneously detected due to the influence of the reflected wave (unnecessary reflected wave) from the adjacent stopped vehicle TS.
- the position of the surrounding stopped vehicle TS may be erroneously detected as the position Pr of the target Ob.
- Radar detection information based on such unnecessary reflected waves often changes abruptly compared to previous radar detection information. That is, the target Ob is often erroneously detected at an unnatural position, for example, a position that does not follow the traveling direction up to that point or a position away from the previous position. In this case, there is a possibility that necessary PCS is not performed or unnecessary PCS is performed. For this reason, in order to reduce the influence of unnecessary reflected waves, it is desirable to perform filter processing so as to suppress changes in radar detection information.
- the filtering process is performed so as to suppress the change of the radar detection information
- the response to the movement of the target Ob is deteriorated. That is, it is selected that the position Pr of the target Ob detected based on the radar detection information is a position that is suppressed more than a position that has actually changed (a position that is close to the previous position) or that has been erroneously detected. May be excluded (ignored).
- the course of the target Ob (shown by a broken line) does not follow the actual course (shown by a solid line), and is easily estimated to cross the rear of the host vehicle CS.
- PCS may be implemented.
- the course of the target Ob used in the collision judgment unit 26 (hereinafter, referred to as a collision judgment course B1) is estimated based on the radar detection information filtered by the collision judgment filter.
- the course of the target Ob used in the vehicle control unit 27 (hereinafter referred to as a vehicle control course B2) is estimated based on radar detection information filtered by the vehicle control filter.
- the filter characteristics of the vehicle control filter and the filter characteristics of the collision determination filter are made different.
- Filter characteristics are the degree of smoothing (filter strength) that suppresses changes in radar detection information.
- the greater the degree of smoothing of the filter the stronger the filter characteristics), the easier it is to suppress or eliminate the influence of unnecessary reflected waves from objects other than the target Ob, and the stability of the position Pr and the course of the target Ob is improved.
- the position Pr and the course of the target Ob are difficult to change, and the responsiveness to the movement of the target Ob is deteriorated.
- the filter characteristics are strengthened by narrowing the pass band, while the filter characteristics are weakened by widening the pass band.
- FIG. 5A specifically explains how the path of the target Ob is estimated based on the difference in filter characteristics when the traveling vehicle to be the target Ob turns.
- the course Y1 (shown by a broken line) of the target Ob when the filter characteristic is weak is compared with the course Y2 (shown by a one-dot chain line) of the target Ob when the filter characteristic is strong. It becomes easy to respond (shown by a solid line). That is, when the filter characteristic is weak, the estimated course Y1 of the target Ob is easily along the turning direction as the target Ob turns. On the other hand, when the filter characteristic is strong, even if the target Ob turns, the estimated course Y2 of the target Ob is likely to go straight.
- the filter processing unit 22 performs a filter process using a collision determination filter and a filter process using a vehicle control filter on the acquired radar detection information.
- the vehicle control filter has a filter characteristic set so that the degree of smoothing that suppresses the change in the radar detection information is larger than the collision determination filter (so that the filter characteristic becomes stronger). That is, the characteristic of the collision determination filter is weaker than that of the vehicle control filter.
- the target information detection unit 23 detects the position Pr of the target Ob (hereinafter referred to as a collision determination position P1) based on the radar detection information filtered using the collision determination filter.
- the collision determination position P1 is recorded in the collision determination history information.
- the target information detection unit 23 detects the position Pr of the target Ob (hereinafter, referred to as a vehicle control position P2) based on the radar detection information filtered using the vehicle control filter.
- the vehicle control position P2 is recorded in the vehicle control history information.
- the target course estimation unit 24 estimates the course of the target Ob based on the change in the collision determination position P1 stored as the collision determination history information (hereinafter referred to as a collision determination path B1). Similarly, the target course estimation unit 24 estimates the course of the target Ob (hereinafter, referred to as a vehicle control path B2) based on the change in the vehicle control position P2 stored as the vehicle control history information. .
- the collision determination unit 26 performs a collision determination between the host vehicle CS and the target Ob based on the estimated collision determination course B1 and the course of the host vehicle CS. For example, when the collision determination course B1 and the course of the host vehicle CS intersect, the collision determination unit 26 determines that the host vehicle CS and the target Ob may collide.
- the vehicle control unit 27 When it is determined that there is a possibility of collision, the vehicle control unit 27 intersects the intersection (predicted collision) between the vehicle control path B2 of the target Ob determined to have a possibility of collision and the path of the host vehicle CS. The distance (predicted distance) to the point) is calculated. Then, the vehicle control unit 27 controls the alarm device 50, the brake device 40, and the seat belt device 60 according to the predicted distance, thereby causing the PCS to be performed.
- the filter characteristic of the collision determination filter is weaker than that of the vehicle control filter.
- the collision determination course B1 has improved responsiveness to the actual movement of the target Ob, and the accuracy of the collision determination is improved even if the target Ob suddenly turns.
- the stability is deteriorated, and the influence of unnecessary reflected waves from other than the target Ob is increased in the collision determination.
- the vehicle control route B2 has good stability, and the influence of unnecessary reflected waves from other than the target Ob is suppressed. For this reason, when implementing PCS, the influence of the unnecessary reflected wave other than the target Ob is suppressed.
- And driving assistance ECU20 performs a collision determination process for every predetermined period (for example, 80 ms), in order to implement PCS.
- predetermined period for example, 80 ms
- the driving support ECU 20 acquires radar detection information input from the radar sensor 31 (step S101). Further, the driving support ECU 20 acquires information indicating the vehicle speed of the host vehicle CS from the vehicle speed sensor 32 and acquires information indicating the steering angle from the steering angle sensor 33. Further, the driving assistance ECU 20 acquires information indicating the shift position from the transmission 70.
- the driving support ECU 20 determines whether or not the R position is set (step S102). When it is not the R position (step S102: No), the driving assistance ECU 20 ends the collision determination process.
- the driving assistance ECU 20 filters the radar detection information (step S103). Specifically, the driving assistance ECU 20 performs filtering processing of radar detection information using a collision determination filter, and acquires the processing result. At the same time, the driving support ECU 20 performs a filter process of the radar detection information using the vehicle control filter and acquires the processing result.
- the driving assistance ECU 20 detects the position Pr of the target object Ob based on the filtered radar detection information (Step S104). Specifically, the driving assistance ECU 20 detects the collision determination position P1 based on the radar detection information filtered using the collision determination filter. The driving support ECU 20 records the collision determination position P1 in the collision determination history information. Further, the driving assistance ECU 20 detects the vehicle control position P2 based on the radar detection information filtered using the vehicle control filter. The driving assistance ECU 20 records the vehicle control position P2 in the vehicle control history information.
- the driving support ECU 20 estimates the course of the target Ob based on the change in the position Pr stored as history information (step S105). Specifically, the driving assistance ECU 20 estimates the collision determination course B1 based on the change in the collision determination position P1 stored as the history information for collision determination. Similarly, the driving assistance ECU 20 estimates the vehicle control route B2 based on the change in the vehicle control position P2 stored as the vehicle control history information.
- the driving support ECU 20 estimates the course of the host vehicle CS based on the steering angle or the like (step S106).
- the driving assistance ECU 20 executes a collision determination between the host vehicle CS and the target Ob based on the estimated collision determination course B1 and the course of the host vehicle CS (step S107).
- the driving assistance ECU 20 determines that the host vehicle CS and the target Ob may collide when the collision determination course B1 and the course A1 of the host vehicle CS intersect.
- step S107 when the driving assistance ECU 20 determines that there is a possibility of a collision (step S107: Yes), the vehicle control path B2 of the target Ob determined to have a possibility of a collision and the path of the host vehicle CS. And the distance (predicted distance) from the vehicle CS to the predicted collision point is calculated (step S108).
- the driving support ECU 20 determines whether or not the calculated predicted distance is equal to or less than a predetermined first distance (step S109). When it is determined that the distance is not less than the first distance (step S109: No), the driving assistance ECU 20 ends the collision determination process.
- step S109 When it determines with it being below 1st distance (step S109: Yes), driving assistance ECU20 performs PCS by controlling the alarm device 50, the brake device 40, and the seatbelt apparatus 60 according to prediction distance. (Step S110). Then, the collision determination process ends. As described above, the driving assistance ECU 20 executes the collision determination process, thereby executing the collision determination method.
- the first embodiment has the following effects.
- Radar detection that is filtered by separate filters for the case of estimating the collision determination route B1 used in the collision determination and the case of estimating the vehicle control route B2 used in executing the vehicle control. Estimated based on information.
- the filter characteristics of the collision determination filter are different from the filter characteristics of the collision control filter. Specifically, the filter characteristic of the collision determination filter is weaker than that of the collision control filter.
- the collision determination course B1 having good responsiveness when executing the collision determination
- the vehicle control course B2 having good stability when performing the PCS (vehicle control). For this reason, even when the target Ob suddenly changes its traveling direction, the collision determination can be performed accurately.
- PCS vehicle control
- the influence can be suppressed. As described above, it is possible to suppress unnecessary vehicle control from being performed and to prevent necessary vehicle control from being performed.
- PCS vehicle control
- the driving support ECU 20 includes a filter setting unit that sets the filter characteristics of the vehicle control filter in the filter processing, and is different from the first embodiment in that appropriate filter processing is performed according to the situation. ing.
- the filter setting unit will be described in detail.
- the driving support ECU 20 in the second embodiment functions as the filter setting unit 28 by executing a program stored in the ROM when performing PCS.
- the filter setting unit 28 sets the filter characteristics of the vehicle control filter used in the filter processing in the next cycle according to the detectable distance at which the position Pr of the target Ob can be detected on the path of the target Ob. Set.
- a method for estimating the detectable distance will be described.
- the filter setting unit 28 estimates the detectable distance based on the position Pr of the target Ob and the traveling state of the host vehicle CS. Specifically, as illustrated in FIG. 8A, the filter setting unit 28 includes a vehicle control route B ⁇ b> 2 estimated by the target route estimation unit 24 and a host vehicle estimated by the host vehicle route estimation unit 25. The intersection of CS with the course A1 is specified as the predicted collision point D1. When the predicted collision point D1 exists within the detection range 31a of the radar sensor 31, the filter setting unit 28 can detect the distance E1 from the vehicle control position P2 of the detected target Ob to the predicted collision point D1. Estimate as distance.
- the distance E1 is a distance that can specify a margin time or a margin distance until a timing at which the host vehicle CS may collide with the target Ob.
- the allowance time can be calculated by dividing the distance E1 by the speed of the target Ob.
- the distance E1 from the vehicle control position P2 of the target Ob to the predicted collision point D1 is set as the detectable distance at least until the subject vehicle CS and the target Ob collide with each other. This is because the use position P2 can be detected.
- the detection range 31a of the radar sensor 31 is calculated based on the detection angle and detection distance of the radar sensor 31.
- the filter setting unit 28 moves from the vehicle control position P2 of the target Ob to the outside of the detection range 31a of the radar sensor 31. Is estimated as a detectable distance.
- the filter The setting unit 28 detects a shorter distance between the distance E3 from the vehicle control position P2 of the target Ob to the orthogonal point D2 and the distance E1 from the vehicle control position P2 of the target Ob to the predicted collision point D1. Estimated as possible distance.
- the orthogonal point D2 is obtained by drawing a perpendicular (illustrated by a broken line) from the position of the radar sensor 31 (that is, the position of the host vehicle CS) with respect to the vehicle control route B2.
- the filter setting unit 28 estimates the distance E3 from the vehicle control position P2 to the orthogonal point D2 as a detectable distance.
- the radar sensor 31 detects the target Ob based on the reflected wave from the front of the vehicle. For example, as shown in FIG. 8C, when the target Ob travels after the orthogonal point D2, the reflected wave is not received from the front of the target Ob, and the vehicle control position P2 of the target Ob is lost. There is.
- the filter setting unit 28 sets the filter characteristic of the vehicle control filter to be weaker when the estimated detectable distance is longer than when it is shorter. For example, when the detectable distance is greater than or equal to a predetermined distance, the filter setting unit 28 sets a weak filter with a weak filter characteristic of the vehicle control filter, and when the detectable distance is less than the predetermined distance, A strong filter whose filter characteristics are stronger than a weak filter is set.
- the predetermined distance for example, a distance longer than the first distance (for example, 15 m) is set in consideration of the timing at which PCS is performed.
- two types of filters a strong filter and a weak filter
- the strong filter or the weak filter is set as the vehicle control filter, the characteristic is stronger than the collision determination filter (the degree of tanning is large).
- the weak filter is set as the vehicle control filter.
- the responsiveness to the actual movement of the target Ob is improved, and even if the target Ob turns sharply, the PCS is appropriately performed.
- the stability is deteriorated, and the influence of unnecessary reflected waves from other than the target Ob is increased.
- the detectable distance is long, more vehicle control positions P2 can be detected than when the detectable distance is short, and there is a grace (margin) until the influence based on erroneous detection is corrected. large.
- the distance E1 from the vehicle control position P2 to the predicted collision point D1 is set as a detectable distance, there is a margin in the distance or time until the PCS is performed. For this reason, even if the weak filter is set as the vehicle control filter, the influence based on the false detection is expected to be corrected thereafter even if it is affected by the false detection.
- a strong filter is set as the vehicle control filter.
- the stability is improved. Therefore, the influence of unnecessary reflected waves from other than the target Ob is suppressed, and PCS is appropriately performed.
- the strong filter when the strong filter is set as the vehicle control filter, the response to the movement of the target Ob is deteriorated.
- the distance E1 from the vehicle control position P2 to the predicted collision point D1 is a detectable distance
- the grace (margin) until the PCS is performed can be small. High nature. For this reason, even if the responsiveness is poor by setting the strong filter as the vehicle control filter, there is no delay until the PCS is performed, so that the deviation is not expected to increase.
- the vehicle control path B2 of the target Ob is estimated based on the vehicle control position P2 detected in a plurality of cycles based on the vehicle control history information.
- the vehicle Ob even if the filter characteristic of the vehicle control filter is strengthened and the responsiveness is deteriorated, the vehicle Ob also considers the vehicle control position P2 of the target Ob when the distance is longer than a predetermined distance (when the responsiveness is good) It is considered that the deviation is reduced by determining the control route B2. As described above, even if the target Ob turns sharply, PCS is appropriately performed.
- a weak filter is set as the vehicle control filter. Thereby, even if it turns suddenly, it responds to the movement of the target Ob, and it becomes possible to implement appropriate PCS. In the initial state, a weak filter is set as the vehicle control filter.
- And driving assistance ECU20 performs a collision determination process for every predetermined period (for example, 80 ms), in order to implement PCS.
- predetermined period for example, 80 ms
- the driving support ECU 20 acquires radar detection information and the like input from the radar sensor 31 (step S201).
- the driving assistance ECU 20 determines whether or not the R position is set (step S202). If it is not the R position (step S202: No), the driving assistance ECU 20 ends the collision determination process.
- the driving assistance ECU 20 filters the radar detection information (step S203). Specifically, the driving assistance ECU 20 performs filtering processing of radar detection information using a collision determination filter, and acquires the processing result. At the same time, the driving support ECU 20 performs a filter process of the radar detection information using the vehicle control filter and acquires the processing result. At this time, the filter characteristic of the vehicle control filter is set in the previous cycle. When the filter characteristic of the vehicle control filter is not set in the previous cycle, the filter characteristic is in the initial state (weak filter).
- the driving support ECU 20 executes the processing of step S204 to step S206 in the same manner as the processing of step S104 to step S106 of the first embodiment.
- the driving support ECU 20 estimates the detectable distance, and sets the filter characteristic of the vehicle control filter in the next cycle based on the detectable distance (step S207). Specifically, the driving support ECU 20 sets a weak filter having a weak filter characteristic as the vehicle control filter when the detectable distance is greater than or equal to a predetermined distance, and if the detectable distance is less than the predetermined distance, the filter characteristic Set a strong filter that is stronger than a weak filter.
- the driving assistance ECU 20 identifies the intersection (predicted collision point D1) between the vehicle control course B2 of the target Ob and the course A1 of the host vehicle CS.
- the driving support ECU 20 sets a weak filter when the vehicle control route B2 and the route A1 of the host vehicle CS do not intersect. Thereafter, the driving support ECU 20 executes the processing of step S208 to step S211 as in the processing of step S107 to step S110 of the first embodiment.
- the second embodiment has the following effects in addition to the effects of the first embodiment.
- the driving assistance ECU 20 sets the filter characteristics of the vehicle control filter according to the detectable distance.
- the filter characteristics of the vehicle control filter are varied depending on whether or not the detectable distance is greater than or equal to the predetermined distance.
- the filter characteristic of the vehicle control filter becomes weak when the detectable distance is greater than or equal to the predetermined distance, so the actual movement of the target Ob
- the vehicle control route B2 can be made to respond.
- the filter characteristic of the vehicle control filter becomes strong, so that the vehicle control path B2 of the target Ob can be stabilized. it can. Therefore, the filter characteristics of the vehicle control filter can be changed depending on the situation, and PCS can be appropriately performed.
- the driving assistance ECU 20 sets the filter characteristics of the vehicle control filter so that the degree of smoothing is smaller when the detectable distance is long than when it is short. Thereby, a filter characteristic can be set more appropriately. If the filter characteristic of the vehicle control filter is weakened, the stability is deteriorated and the vehicle is easily affected by unnecessary reflected waves. However, since the detectable distance is long, it is expected to be corrected. For this reason, even if the filter characteristic of the vehicle control filter is weakened when the detectable distance is long, the influence of unnecessary reflected waves can be suppressed.
- the driving assistance ECU 20 sets the filter characteristics of the vehicle control filter so that the degree of smoothing is increased, thereby suppressing the influence of unnecessary reflected waves and suppressing false detection. be able to. Thereby, a filter characteristic can be set more appropriately.
- the filter characteristic is strengthened and the responsiveness is deteriorated, the responsiveness is improved when the distance is longer than the predetermined distance, and the vehicle control position P2 of the target Ob when the distance is longer than the predetermined distance is also taken into consideration.
- the vehicle control route B2 is determined. For this reason, when the distance is less than the predetermined distance, PCS can be appropriately performed even if the filter characteristics of the vehicle control filter are strengthened.
- the millimeter wave radar device is employed as the exploration device, but a sonar that detects and measures an object (target) using sound waves may be employed.
- the filter characteristic of the collision determination filter may be set to be stronger than the filter characteristic of the vehicle control filter.
- -PCSS100 may be adopted in order to perform PCS on the target Ob in front of the host vehicle CS.
- the vehicle control route B2 may be estimated when it is determined that there is a possibility of collision in the collision determination.
- the course of the host vehicle CS is estimated using the steering angle detected by the steering angle sensor 33.
- the yaw rate sensor is used instead of the steering angle sensor 33, and the own vehicle CS is estimated based on the yaw rate and the vehicle speed. You may estimate the course of vehicle CS.
- the filter setting unit 28 may set the filter characteristics of the collision determination filter according to the detectable distance. Even in this case, it is desirable that the collision determination filter always has a weaker characteristic (less tanning degree) than the vehicle control filter.
- the filter setting unit 28 may specify a detectable distance according to the distance from the host vehicle CS to the predicted collision point D1.
- the filter setting unit 28 estimates the detectable distance, but may estimate the detectable time. Specifically, after calculating the detectable distance, the filter setting unit 28 may estimate the detectable time by dividing the detectable distance by the speed of the target Ob. In this case, the filter setting unit 28 may set the filter characteristics of the vehicle control filter according to the detectable time. For example, the filter setting unit 28 may set the filter characteristics of the vehicle control filter depending on whether or not the detectable time is a predetermined time or more. That is, the filter setting unit 28 sets a weak filter as a vehicle control filter when the detectable time is 10 seconds or more, and as a vehicle control filter when the detectable time is less than 10 seconds. A strong filter may be set.
- the filter setting unit 28 may estimate the distance (inter-vehicle distance) between the host vehicle CS and the target Ob as a detectable distance.
- the time obtained by dividing the inter-vehicle distance by the relative speed may be estimated as the detectable time.
- the filter setting unit 28 is configured to be able to set two types of filters as the vehicle control filter, but is configured to be able to set three or more types of filters according to the detectable distance. It may be.
- the driving assistance ECU 20 sets a weak filter as a vehicle control filter when the vehicle control course B2 of the target Ob and the course A1 of the host vehicle CS do not intersect.
- the driving support ECU 20 may set the filter characteristics of the vehicle control filter by using the distance from the vehicle control position P2 of the target Ob to the outside of the detection range as a detectable distance.
- the filter setting unit 28 determines the distance from the vehicle control position P2 to the orthogonal point D2. It may be estimated as a detectable distance.
- the filter setting unit 28 may estimate the detectable distance or the detectable time based on the vehicle control route B2 and the route A1 of the host vehicle CS estimated in the previous cycle. Then, the filter setting unit 28 may set the filter characteristics of the vehicle control filter in the current cycle according to the estimated detectable distance or the detectable time. In this case, it is desirable that the driving assistance ECU 20 sets the filter characteristics of the vehicle control filter before acquiring radar detection information (before step S201) in the collision determination process.
- the filter setting unit 28 may always estimate the distance E1 from the vehicle control position P2 to the predicted collision point D1 as a detectable distance. That is, the distance E1 from the vehicle control position P2 to the predicted collision point D1 is detected even when the predicted collision point D1 exists outside the detection range 31a or when the orthogonal point D2 exists within the detection range 31a. It may be estimated as a possible distance.
Landscapes
- Engineering & Computer Science (AREA)
- Remote Sensing (AREA)
- Radar, Positioning & Navigation (AREA)
- Physics & Mathematics (AREA)
- Mechanical Engineering (AREA)
- General Physics & Mathematics (AREA)
- Transportation (AREA)
- Computer Networks & Wireless Communication (AREA)
- Automation & Control Theory (AREA)
- Electromagnetism (AREA)
- Chemical & Material Sciences (AREA)
- Combustion & Propulsion (AREA)
- Traffic Control Systems (AREA)
- Radar Systems Or Details Thereof (AREA)
- Control Of Driving Devices And Active Controlling Of Vehicle (AREA)
Abstract
衝突判定装置は、探査装置(31)からその反射波に基づく検知情報を取得する取得部(21)と、検知情報をフィルタ処理するフィルタ処理部(22)と、フィルタ処理された検知情報を利用して、物標の位置を検出する物標情報検出部(23)と、検出された物標の位置の変化に基づき、物標の進路を推定する物標進路推定部(24)と、自車両の進路を推定する自車進路推定部(25)と、自車両と物標との衝突判定を実行する衝突判定部(26)と、車両制御を実行させる車両制御部(27)と、を備える。物標の進路は、衝突判定用フィルタによりフィルタ処理された検知情報に基づき推定される。物標の進路は、車両制御用フィルタによりフィルタ処理された検知情報に基づき推定される。フィルタ処理は、検知情報の変化を抑制するなまし処理である。車両制御用フィルタと、衝突判定用フィルタとは、検知情報の変化を抑制するなまし度合いが異なる。
Description
本出願は、2016年11月17日に出願された日本出願番号2016-224530号に基づくもので、ここにその記載内容を援用する。
本開示は、自車両と物標との衝突判定を行う衝突判定装置、及び衝突判定方法に関する。
従来、自車両と物標との衝突判定を行い、車両の走行安全を図る衝突判定装置が存在する(例えば、特許文献1)。特許文献1において、システムECUは、車速センサなどから自車両の挙動(走行状態)を取得し、自車両の進路を推定する。その一方、レーダECUは、ミリ波レーダ装置を利用して他車両(物標)の位置を検出し、位置の変化に基づき、他車両の進路を推定する。そして、システムECUは、推定した自車両の進路と、推定された他車両の進路に基づき、衝突判定を行い、衝突すると判定した場合、車両に制動を加えるなどの車両制御を実行させる。これにより、車両の走行安全を図ることができる。
ところで、ミリ波レーダ装置は、物標となる他車両からの反射波に基づき、物標の位置を検出するものである。このため、ミリ波レーダ装置からの検知情報に基づき物標の進路を推定する場合、物標以外の車両などから反射される不要な反射波の影響により、進路を誤って推定してしまう虞がある。そこで、不要な反射波の影響を抑制するため、ローパスフィルタなどを利用して、検知情報をフィルタ処理(なまし処理)し、進路を適切に推定するようにしている。
しかしながら、フィルタ特性によっては、不要な車両制御が行われたり、必要な車両制御が行われなかったりする可能性がある。具体的には、フィルタ特性を強くする場合(なまし度合いを大きくする場合)、不要な反射波の影響が少なくなる一方、物標の動きに応答しにくくなる。つまり、安定性が良くなる一方、応答性が悪くなる。このため、物標が急に進行方向を変化させると、推定する進路との間にずれが生じる場合があり、この場合、衝突判定が難しくなり、また、車両制御を適切なタイミングで実施させることが難しくなる。
一方、フィルタ特性を弱くする場合(なまし度合いを小さくする場合)、物標の動きに応答しやすくなるが、不要な反射波の影響も強くなる。つまり、応答性が良くなる一方、安定性が悪くなる。その結果、不要な反射波の影響を受けて、実際の進路とずれる場合があり、この場合も衝突判定が難しくなり、また、車両制御を適切なタイミングで実施させることが難しくなる。
このように、進路の応答性と安定性を両立させることが難しいため、衝突判定や、車両制御の実施タイミングの設定が難しくなっていた。これにより、不要な車両制御が行われたり、必要な車両制御が行われなかったりする可能性があった。
本開示は、上記事情に鑑みてなされたものであり、フィルタ特性を適切に設定することができる衝突判定装置及び衝突判定方法を提供することを主たる目的とするものである。
本開示は、上記課題を解決するために、以下のようにした。
本開示の衝突判定装置は、探査波を送信し、物標により反射された反射波を受信する探査装置からその反射波に基づく検知情報を取得する取得部と、前記検知情報をフィルタ処理するフィルタ処理部と、フィルタ処理された前記検知情報を利用して、前記物標の位置を検出する物標情報検出部と、前記物標情報検出部により検出された前記物標の位置の変化に基づき、前記物標の進路を推定する物標進路推定部と、自車両の進路を推定する自車進路推定部と、前記物標の進路と、自車両の進路とが交差するか否かにより、前記自車両と前記物標との衝突判定を実行する衝突判定部と、前記自車両と前記物標とが衝突すると判定された場合、前記物標の進路と自車両の進路とに基づき、前記物標が自車両と衝突するタイミングを推定し、車両制御を実行させる車両制御部と、を備え、前記衝突判定部にて用いられる前記物標の進路は、衝突判定用フィルタによりフィルタ処理された前記検知情報に基づき推定され、前記車両制御部にて用いられる前記物標の進路は、車両制御用フィルタによりフィルタ処理された前記検知情報に基づき推定され、前記フィルタ処理は、前記検知情報の変化を抑制するなまし処理であり、前記車両制御用フィルタと、前記衝突判定用フィルタとは、前記検知情報の変化を抑制するなまし度合いが異なる。
これにより、衝突判定及び車両制御のうち、いずれか一方の処理において、応答性の良い物標の進路を利用し、他方の処理において安定性の良い物標の進路を利用することができる。このため、物標が急に進行方向を変えた場合であっても、衝突判定及び車両制御のうち、いずれか一方の処理を行う際にその影響を抑えることができる。同様に、不要な反射波を受けた場合であっても、衝突判定及び車両制御のうち、いずれか一方の処理を行う際にその影響を抑えることができる。
以上により、物標が急に進行方向を変えた場合及び不要な反射波を受けた場合のいずれであっても、フィルタ特性を適切に設定することにより、その影響を抑えることができる。したがって、不要な車両制御が行われることを抑制するとともに、必要な車両制御が行われないことを抑制することができる。
本開示についての上記目的およびその他の目的、特徴や利点は、添付の図面を参照しながら下記の詳細な記述により、より明確になる。その図面は、
図1は、PCSSの構成図であり、
図2は、物標の進路を示す図であり、
図3は、レーダセンサの検知範囲を示す図であり、
図4は、(a)及び(b)は、物標の進路のずれが生じる状況を示す図であり、
図5は、フィルタ特性と物標の進路との関係性を示す図であり、
図6は、衝突判定処理を示すフローチャートであり、
図7は、第2実施形態のPCSSの構成図であり、
図8は、(a)~(c)は、検出可能距離を示す図であり、
図9は、第2実施形態の衝突判定処理を示すフローチャートである。
(第1実施形態)
以下、本開示の実施形態について図に基づいて説明する。なお、以下の各実施形態相互において、互いに同一もしくは均等である部分には、図中、同一符号を付してある。
以下、本開示の実施形態について図に基づいて説明する。なお、以下の各実施形態相互において、互いに同一もしくは均等である部分には、図中、同一符号を付してある。
図1は、プリクラッシュセーフティシステム(以下、PCSS:Pre-crash safety systemと記載する。)100を示している。PCSS100は、車両に搭載される車両システムの一例であり、車両周囲に位置する物体を検出し、検出した物体と車両とが衝突するおそれがある場合、物体に対する自車両の衝突の回避動作、又は衝突の緩和動作(PCS)を実施させる。以下では、このPCSS100が搭載された車両を自車両CSと記載し、検出対象となる物体を物標Obと記載する。
図1に示すPCSS100は、各種センサと、運転支援ECU20と、ブレーキ装置40と、警報装置50と、シートベルト装置60と、変速装置70と、を備えている。図1に示す実施形態において、運転支援ECU20が衝突判定装置として機能し、衝突判定方法を実行する。
各種センサは、運転支援ECU20に接続されており、物標Obの検知情報や自車両CSに関する車両情報を運転支援ECU20に出力する。図1では、各種センサには、探査装置としてのレーダセンサ31と、車速センサ32と、操舵角センサ33と、が含まれる。
レーダセンサ31は、例えば、ミリ波帯の高周波信号を送信波とする公知のミリ波レーダ装置である。レーダセンサ31は、例えば、自車両CSの後端部に設けられ、所定の検知角αに入る領域を検知範囲31aとし、検知範囲31a内の物標Obの位置を検出する。具体的には、所定周期で探査波を送信し、複数のアンテナにより反射波を受信する。この探査波の送信時刻と反射波の受信時刻とにより、物標Obとの距離を算出する。また、物標Obに反射された反射波の、ドップラー効果により変化した周波数により、相対速度を算出する。加えて、複数のアンテナが受信した反射波の位相差により、物標Obの方位を算出する。なお、物標Obとの距離及び方位が算出できれば、その物標Obの、自車両CSに対する相対位置を特定することができる。
レーダセンサ31は、所定周期毎に、探査波の送信、反射波の受信、距離の算出、方位の算出、及び相対速度の算出を行う。そして、レーダセンサ31は、算出した物標Obとの距離、物標Obの方位及び相対速度をレーダ検知情報として運転支援ECU20を出力する。なお、レーダセンサ31は、物標Obの相対位置を算出してレーダ検知情報として出力してもよい。
車速センサ32は、自車両CSの現在の車速を検知する。検知された車速は、運転支援ECU20に入力される。操舵角センサ33は、ステアリングホイール(又はタイヤ)の操舵角を検知する。検知された操舵角は、運転支援ECU20に入力される。
ブレーキ装置40は、自車両CSの制動力を変化させるブレーキ機構と、このブレーキ機構の動作を制御するブレーキECUとを備えている。ブレーキECUは、運転支援ECU20と通信可能に接続されており、運転支援ECU20の制御により、ブレーキ機構を制御する。ブレーキ機構は、例えば、マスターシリンダと、車輪(タイヤ)に制動力を与えるホイルシリンダと、マスターシリンダからホイルシリンダへの圧力(油圧)の分配を調整するABSアクチュエータとを備えている。ABSアクチュエータは、ブレーキECUに接続されており、このブレーキECUからの制御によりマスターシリンダからホイルシリンダへの油圧を調整することで、車輪(タイヤ)に対する作動量を調整する。
警報装置50は、運転支援ECU20の制御により、ドライバに対して自車後方に接近する物標Obが存在することを警報する。警報装置50は、例えば、車室内に設けられたスピーカや、画像を表示する表示部により構成されている。
シートベルト装置60は、自車の各座席に設けられたシートベルトや、このシートベルトを引き込むプリテンショナにより構成されている。シートベルト装置60は、PCSの動作として、自車両CSが物標Obに衝突する可能性が高まった場合に、シートベルトの引き込みの予備動作を行う。また衝突を回避できない場合には、シートベルトを引き込んで弛みを除くことにより、ドライバ等の乗員を座席に固定し、乗員の保護を行う。
変速装置70は、図示しないシフトレバー等がドライバにより操作されることにより、自車両CSのシフトポジションを設定する。シフトポジションには、例えば、自車両CSが後退する状態であることを示す位置であるRポジション(リバース)、自車両CSが前進する状態であることを示す位置であるDポジション(ドライブ)が少なくともある。また、シフトポジションには、他に、Nポジション(ニュートラル)、Pポジション(パーキング)などもある。シフトポジションを示す情報は、運転支援ECU20に入力される。
運転支援ECU20は、CPU、ROM、RAMを備える周知のマイクロコンピュータとして構成されており、ROM内の演算プログラムや制御データを参照して、自車両CSに対する車両制御を実施する。本実施形態において、運転支援ECU20は、自車両CSが後退している状態の場合、すなわち、シフトポジションがRポジションである場合に、PCSを実施させる。具体的には、運転支援ECU20は、シフトポジションがRポジションである場合、レーダセンサ31からのレーダ検知情報を取得し、取得したレーダ検知情報に基づいて物標Obの位置を検出する。そして、運転支援ECU20は、その検出結果に基づいて、各装置40,50,60の少なくともいずれかを制御対象としてPCSを実施させる。運転支援ECU20は、PCSを実施させるに際し、ROMに記憶されたプログラムを実行することで、取得部21、フィルタ処理部22、物標情報検出部23、物標進路推定部24、自車進路推定部25、衝突判定部26、及び車両制御部27として機能する。各機能について、以下に説明する。
取得部21は、レーダセンサ31から入力されたレーダ検知情報を所定周期(例えば、80ms)ごとに取得する。レーダ検知情報には、物標Obの位置Prを示す位置情報が含まれる。また、取得部21は、車速センサ32から自車両CSの車速を示す情報を取得し、操舵角センサ33から操舵角を示す情報を取得する。また、取得部21は、変速装置70からシフトポジションを示す情報を取得する。
フィルタ処理部22は、取得部21が取得したレーダ検知情報に対してフィルタ処理を実行する。フィルタ処理は、例えば、レーダ検知情報の変化を抑制するなまし処理である。より詳しく説明すると、フィルタ処理は、レーダ検知情報に含まれる情報(物標Obの方位、距離、相対速度又は相対位置など)が、前回のレーダ検知情報に含まれる情報から急激に変化することをフィルタにより緩和する処理、又は急激に変化した情報をフィルタにより選別する処理である。このフィルタ処理により、レーダ検知情報に基づき検出される物標Obの位置Prが急激に変化することが抑制される。つまり、フィルタ処理によって、物標Obの位置Prが、前回までに検出された物標Obの位置Prから急激に変化することが抑制される(なまされる)。そして、このフィルタ処理により、物標Ob以外からの不要な反射波の影響が抑制又は除外される。例えば、フィルタ処理には、ローパスフィルタにより、高周波帯域の反射波に基づくレーダ検知情報を除くローパスフィルタ処理などがある。
物標情報検出部23は、フィルタ処理部22によりフィルタ処理されたレーダ検知情報に基づき、物標Obの位置Prを検出する。具体的には、物標情報検出部23は、レーダ検知情報に含まれる物標Obとの距離及び方位に基づき、自車両CSを原点とする座標上の位置Prを検出する。この座標では、自車両CSの車幅方向に沿ってX軸が設定され、自車両CSの進行方向に沿ってY軸方向が設定される。原点は、より詳しくは、自車両CSの後輪における中点が原点として設定される。これにより、自車両CSに対する物標Obの相対位置が検出される。なお、進行方向(Y軸方向)と直交する横方向が、車幅方向(X軸方向)となる。また、レーダ検知情報に物標Obの相対位置が含まれている場合、それを取得して検出結果としてもよい。物標Obの位置Prは、履歴情報に記録される。
物標進路推定部24は、履歴情報として記憶されている位置Prの変化に基づいて、物標Obの進路を推定する。例えば、物標Obの進路として、物標Obの移動方向ベクトルを算出する。図2では、物標Obとして検出された車両の時刻t1からt4での各時刻での物標Obの位置Prと、この位置Prにより算出される物標Obの進路を示している。時刻t4が履歴情報に記録された最新の物標Obの位置Prとなる。例えば、物標進路推定部24は、各位置Prに最も近い位置を通る直線を最小二乗法といった、周知の線形補間演算を用いて物標Obの進路を推定する。
自車進路推定部25は、車速及び操舵角に基づき、自車両CSの進路を推定する。例えば、車速及び操舵角に基づき、旋回方向と、旋回半径と、旋回中心等を算出して、自車両CSの進路を推定する。操舵角が0度の場合には、自車両CSの進路は直線により推定され、操舵角が0度以外の場合には、自車両CSの進路は曲線により推定される。なお、操舵角に基づき、旋回方向を特定し、旋回方向に沿った直線により、自車両CSの進路を推定してもよい。また、車速が0km/hである場合には、自車両CSは停止していることとなり、自車両CSの進路は、現地点に固定される。
衝突判定部26は、推定された物標Obの進路と自車両CSの進路とに基づいて、自車両CSと物標Obとの衝突判定を実行する。例えば、衝突判定部26は、物標Obの進路と自車両CSの進路とが交わる場合、自車両CSと物標Obとが衝突する可能性があると判定する。
なお、衝突判定を行う際、衝突判定部26は、自車両CSの車幅を考慮して衝突するか否かを判定してもよい。例えば、衝突判定部26は、推定した自車両CSの進路と自車両CSの車幅に基づき、自車両CSにおける左側後端部(例えば、左側後輪や左側テールランプ)が通過する進路と、右側後端部(例えば、右側後輪や右側テールランプ)が通過する進路とを推定する。そして、衝突判定部26は、推定した進路のいずれか一方と、物標Obの進路が交差するか否かに基づき、判定してもよい。同様に、物標Obの幅を考慮して衝突判定を行ってもよい。
車両制御部27は、衝突する可能性があると判定した場合、衝突する可能性があると判定された物標Obの進路と、自車両CSの進路との交点(予測衝突点)までの距離(予測距離)を算出する。そして、車両制御部27は、予測距離に応じて、警報装置50、ブレーキ装置40、及びシートベルト装置60を制御することで、車両制御としてのPCSを実施させる。
具体的には、車両制御部27は、算出した予測距離が予め決められた第1距離以下であるか否かを判定する。第1時間は、PCSの開始タイミングを示すための閾値であり、例えば、10mなどの値が設定される。
第1距離以下であると判定した場合、車両制御部27は、警報装置50を制御して、警報を出力させる。予測距離が、第1距離よりも短い第2距離(例えば、5m)以下である場合、警報装置50に加えて、車両制御部27は、ブレーキ装置40を制御して、自車両CSを制動させる。予測距離が、第2距離よりも短い第3距離(例えば、1m)以下である場合、警報装置50及びブレーキ装置40に加えて、車両制御部27は、シートベルト装置60を制御し、シートベルトの引き込みなどを実施させる。
ところで、車両前方にもレーダセンサが取り付けられる場合、車両前方に取り付けられるレーダセンサと比較して、車両後方に取り付けられるレーダセンサ31の検知角αは、広く設定されている。具体的には、図3に示すように、レーダセンサ31は、50度~140度程度の検知角αを有し、また、自車両CSから50m程度離れた距離までの範囲を検知範囲31aとしている。一方、車両前方に取り付けられるレーダセンサの場合、20度~30度程度の検知角βを有する一方、自車両CSから100m程度離れた距離までの範囲を検知範囲としていることが多い。
運転支援ECU20は、このような検知範囲31aを有するレーダセンサ31からのレーダ検知情報を取得して、物標Obの位置Prを検出するため、ドライバにとって死角が多い自車両CSの後方において、効果的に物標Obを検知し、衝突判定を行うことができる。
特に、後退時において、自車両CSの斜め後方から、例えば、自車両CSの後ろを横切るように走行するような他車両の位置は、認識しにくい。また、駐車場などにおいて自車両CSを駐車する場合又は駐車場から出る場合に後退させることが多いが、駐車場においては車両の速度が低速であるために車両の操舵角が大きくなりやすく、車両の動きが不規則になりやすい。この結果、駐車場などでは、ドライバの死角から他車両が旋回してくることが道路などと比較して多く、他車両の動きを把握しにくい。このため、車両後方のレーダセンサ31の検知角αを広くして、自車両CSの後退時においてPCSを実施させることは、ドライバにとって特に有用となる。
しかしながら、検知角αを広くすることにより、不要な反射波の影響を受けて、物標Obの誤検出が生じる可能性が高くなる。誤検出が生じる状況としては、例えば、図4(a)に示すような状況が考えられる。図4(a)では、駐車場において、複数台の車両が整列して駐車されている中で、自車両CSが駐車位置から後退させる場合に、自車両CSの進行方向と直交するように通路を物標Obとしての他車両が走行する状況を示している。
この場合、レーダセンサ31の検知角αが広いと、隣接する停止車両TSからの反射波(不要な反射波)の影響により、物標Obの位置Prが誤検出される場合がある。すなわち、周りの停止車両TSの位置が物標Obの位置Prとして誤検出される場合がある。このような不要な反射波に基づくレーダ検知情報は、前回のレーダ検知情報と比較して急激に変化していることが多い。つまり、物標Obが不自然な位置、例えば、それまでの進行方向に沿っていない位置や前回の位置から離れた位置において誤検出されることが多い。この場合、必要なPCSが実施されない原因や、不要なPCSが実施される原因となる可能性がある。このため、不要な反射波の影響を少なくするため、レーダ検知情報の変化を抑制するようにフィルタ処理を行うことが望ましい。
しかしながら、常にレーダ検知情報の変化を抑制すると、駐車場など、物標Obとなる車両の操舵角(旋回角度)が大きくなりやすい状況では、問題が生じる可能性がある。このような状況としては、例えば、図4(b)に示すような状況がある。図4(b)では、駐車場において、自車両CSが駐車位置から後退させる場合に、通路を走行する物標Obとしての走行車両が、自車両CSの隣に駐車するように旋回する状況を示している。
この場合、レーダ検知情報の変化を抑制するようにフィルタ処理が行われた場合、物標Obの動きに対する応答性が悪くなる。すなわち、レーダ検知情報に基づき検出される物標Obの位置Prが、実際に変化した位置よりも抑制された位置(前回の位置に近い位置)となる、あるいは誤検出されたものであると選別されて除外(無視)される場合がある。これにより、物標Obの進路(破線で示す)は、実際の進路(実線で示す)に沿わず、自車両CSの後方を横切るように推定されやすくなり、衝突判定において衝突すると判定され、不要なPCSが実施されてしまう可能性がある。
そこで、衝突判定部26にて用いられる物標Obの進路(以下、衝突判定用進路B1と示す)は、衝突判定用フィルタによりフィルタ処理されたレーダ検知情報に基づき推定されるようにした。その一方、車両制御部27にて用いられる物標Obの進路(以下、車両制御用進路B2と示す)は、車両制御用フィルタによりフィルタ処理されたレーダ検知情報に基づき推定されるようにした。そして、車両制御用フィルタのフィルタ特性と、衝突判定用フィルタのフィルタ特性を異ならせるようにした。
フィルタ特性とは、レーダ検知情報の変化を抑制するなまし度合い(フィルタの強弱)のことである。フィルタのなまし度合いが大きい(フィルタ特性が強い)ほど、物標Ob以外のものからの不要な反射波の影響を抑制又は除外しやすくなり、物標Obの位置Prや進路の安定性が良くなる。つまり、フィルタ特性が強いほど、フィルタ処理において、変化が小さいレーダ検知情報であっても除きやすくなる、又は変化が小さくなるようにレーダ検知情報が緩和される。その反面、物標Obの位置Prや進路が変化しにくくなり、物標Obの動きに対する応答性が悪くなる。
一方、フィルタのなまし度合いが小さい(フィルタ特性が弱い)ほど、物標Obの位置Prや進路が変化しやすくなり、物標Obの動きに対する応答性が良くなる。その反面、フィルタ処理において、物標Ob以外からの不要な反射波の影響を受けやすくなり、物標Obの位置Prや進路の安定性が悪くなる。つまり、フィルタ特性が弱いほど、変化が大きいレーダ検知情報であっても除外されない、又はレーダ検知情報の変化が緩和されにくくなる。具体的には、ローパスフィルタ処理においては、通過帯域を狭くすることにより、フィルタ特性が強くなる一方、通過帯域を広くすることにより、フィルタ特性が弱くなる。
図5(a)では、物標Obとなる走行車両が旋回する場合において、フィルタ特性の違いにより物標Obの進路がどのように推定されるかについて具体的に説明する。フィルタ特性が弱い場合における物標Obの進路Y1(破線で示す)は、フィルタ特性が強い場合における物標Obの進路Y2(一点鎖線で示す)と比較して、物標Obの実際の進路Y0(実線で示す)に応答しやすくなる。すなわち、フィルタ特性が弱い場合、物標Obが旋回することに応じて、推定される物標Obの進路Y1も旋回方向に沿いやすくなる。その一方、フィルタ特性が強い場合、物標Obが旋回しても、推定される物標Obの進路Y2は、直進しやすくなる。
その反面、例えば、図5(b)に示すように、物標Obが直進する場合、フィルタ特性が弱いと、物標Obの位置Prが誤検出されやすくなり、進路Y1が実際の進路Y0からずれて推定されやすい。その一方、フィルタ特性が強いと、物標Obが直進する場合、物標Obの位置Prが誤検出されにくくなり、進路Y2が実際の進路Y0からずれないように推定されやすい。
本実施形態において、フィルタ処理部22は、取得したレーダ検知情報に対して、衝突判定用フィルタを利用したフィルタ処理と、車両制御用フィルタを利用したフィルタ処理をそれぞれ行う。車両制御用フィルタは、衝突判定用フィルタと比較して、レーダ検知情報の変化を抑制するなまし度合いが大きくなるように(フィルタ特性が強くなるように)、フィルタ特性が設定されている。つまり、衝突判定用フィルタの方が、車両制御用フィルタよりもその特性が弱くなっている。
そして、物標情報検出部23は、衝突判定用フィルタを利用してフィルタ処理されたレーダ検知情報に基づく物標Obの位置Pr(以下、衝突判定用位置P1と示す)を検出する。この衝突判定用位置P1は、衝突判定用の履歴情報に記録される。同様に、物標情報検出部23は、車両制御用フィルタを利用してフィルタ処理されたレーダ検知情報に基づく物標Obの位置Pr(以下、車両制御用位置P2と示す)を検出する。この車両制御用位置P2は、車両制御用の履歴情報に記録される。
物標進路推定部24は、衝突判定用の履歴情報として記憶されている衝突判定用位置P1の変化に基づく物標Obの進路(以下、衝突判定用進路B1と示す)を推定する。同様に、物標進路推定部24は、車両制御用の履歴情報として記憶されている車両制御用位置P2の変化に基づく物標Obの進路(以下、車両制御用進路B2と示す)を推定する。
衝突判定部26は、推定された衝突判定用進路B1と自車両CSの進路とに基づいて、自車両CSと物標Obとの衝突判定を実行する。例えば、衝突判定部26は、衝突判定用進路B1と自車両CSの進路とが交わる場合、自車両CSと物標Obとが衝突する可能性があると判定する。
車両制御部27は、衝突する可能性があると判定された場合、衝突する可能性があると判定された物標Obの車両制御用進路B2と、自車両CSの進路との交点(予測衝突点)までの距離(予測距離)を算出する。そして、車両制御部27は、予測距離に応じて、警報装置50、ブレーキ装置40、及びシートベルト装置60を制御することで、PCSを実施させる。
以上のように、衝突判定用フィルタのフィルタ特性は、車両制御用フィルタのフィルタ特性よりも弱い。このため、衝突判定用進路B1は、物標Obの実際の動きに対する応答性が良くなり、物標Obが急旋回したとしても、衝突判定の正確性が向上する。その一方、安定性が悪くなり、衝突判定において、物標Ob以外からの不要な反射波の影響が大きくなる。しかしながら、車両制御用進路B2は、安定性が良く、物標Ob以外からの不要な反射波の影響が抑制される。このため、PCSを実施させる場合、物標Ob以外からの不要な反射波の影響が抑えられる。
そして、運転支援ECU20は、PCSを実施させるため、衝突判定処理を所定周期(例えば、80ms)ごとに実行する。以下、図6に基づき、衝突判定処理について説明する。
運転支援ECU20は、レーダセンサ31から入力されたレーダ検知情報を取得する(ステップS101)。また、運転支援ECU20は、車速センサ32から自車両CSの車速を示す情報を取得し、操舵角センサ33から操舵角を示す情報を取得する。また、運転支援ECU20は、変速装置70からシフトポジションを示す情報を取得する。
運転支援ECU20は、Rポジションであるか否かを判定する(ステップS102)。Rポジションでない場合(ステップS102:No)、運転支援ECU20は、衝突判定処理を終了する。
一方、Rポジションである場合(ステップS102:Yes)、運転支援ECU20は、レーダ検知情報をフィルタ処理する(ステップS103)。具体的には、運転支援ECU20は、衝突判定用フィルタを利用してレーダ検知情報のフィルタ処理を行い、その処理結果を取得する。それとともに、運転支援ECU20は、車両制御用フィルタを利用してレーダ検知情報のフィルタ処理を行い、その処理結果を取得する。
そして、運転支援ECU20は、フィルタ処理によりレーダ検知情報を得られた場合、フィルタ処理されたレーダ検知情報に基づき、物標Obの位置Prを検出する(ステップS104)。具体的には、運転支援ECU20は、衝突判定用フィルタを利用してフィルタ処理されたレーダ検知情報に基づき、衝突判定用位置P1を検出する。運転支援ECU20は、この衝突判定用位置P1を衝突判定用の履歴情報に記録する。また、運転支援ECU20は、車両制御用フィルタを利用してフィルタ処理されたレーダ検知情報に基づき、車両制御用位置P2を検出する。運転支援ECU20は、この車両制御用位置P2を車両制御用の履歴情報に記録する。
運転支援ECU20は、履歴情報として記憶されている位置Prの変化に基づいて、物標Obの進路を推定する(ステップS105)。具体的には、運転支援ECU20は、衝突判定用の履歴情報として記憶されている衝突判定用位置P1の変化に基づき、衝突判定用進路B1を推定する。同様に、運転支援ECU20は、車両制御用の履歴情報として記憶されている車両制御用位置P2の変化に基づき、車両制御用進路B2を推定する。
また、運転支援ECU20は、操舵角等に基づき、自車両CSの進路を推定する(ステップS106)。次に、運転支援ECU20は、推定された衝突判定用進路B1と自車両CSの進路とに基づいて、自車両CSと物標Obとの衝突判定を実行する(ステップS107)。具体的には、運転支援ECU20は、衝突判定用進路B1と自車両CSの進路A1とが交差する場合、自車両CSと物標Obとが衝突する可能性があると判定する。衝突可能性がないと判定した場合(ステップS107:No)、運転支援ECU20は、衝突判定処理を終了する。
また、運転支援ECU20は、衝突する可能性があると判定した場合(ステップS107:Yes)、衝突する可能性があると判定された物標Obの車両制御用進路B2と、自車両CSの進路との交点(予測衝突点)を特定し、自車両CSから予測衝突点までの距離(予測距離)を算出する(ステップS108)。
また、運転支援ECU20は、算出した予測距離が予め決められた第1距離以下であるか否かを判定する(ステップS109)。第1距離以下でないと判定された場合(ステップS109:No)、運転支援ECU20は、衝突判定処理を終了する。
第1距離以下であると判定した場合(ステップS109:Yes)、運転支援ECU20は、予測距離に応じて警報装置50、ブレーキ装置40、及びシートベルト装置60を制御することで、PCSを実施させる(ステップS110)。そして、衝突判定処理を終了する。このように、運転支援ECU20が、衝突判定処理を実行することにより、衝突判定方法を実行することとなる。
上記構成により、第1実施形態では、以下の効果を奏する。
衝突判定にて用いられる衝突判定用進路B1を推定する場合と、車両制御を実行させる際に用いられる車両制御用進路B2を推定する場合とで、それぞれ別のフィルタにてフィルタ処理されたレーダ検知情報に基づき、推定するようにした。そして、衝突判定用フィルタのフィルタ特性は、衝突制御用フィルタのフィルタ特性と異ならせた。具体的には、衝突判定用フィルタのフィルタ特性は、衝突制御用フィルタのフィルタ特性と比較して、弱くした。
これにより、衝突判定を実行する場合に応答性の良い衝突判定用進路B1を利用し、PCS(車両制御)を実施させる場合に安定性の良い車両制御用進路B2を利用することができる。このため、物標Obが急に進行方向を変えた場合であっても、衝突判定を正確に行うことができる。一方、不要な反射波を受けた場合であっても、PCS(車両制御)を実施させる際に、その影響を抑えることができる。以上により、不要な車両制御が行われることを抑制するとともに、必要な車両制御が行われないことを抑制することができる。
物標Obと自車両CSとが衝突するまでの予測距離が第1距離(閾値)以下となった場合に、PCS(車両制御)が行わるようにした。これにより、第1距離未満となるまで、衝突判定用進路B1及び車両制御用進路B2のずれを修正することが可能となり、不要なPCSが行われることを抑制することができる。
(第2実施形態)
第2実施形態にかかる運転支援ECU20は、フィルタ処理における車両制御用フィルタのフィルタ特性を設定するフィルタ設定部を備え、状況に応じて適切なフィルタ処理が行われることが、第1実施形態と異なっている。以下、フィルタ設定部について詳しく説明する。
第2実施形態にかかる運転支援ECU20は、フィルタ処理における車両制御用フィルタのフィルタ特性を設定するフィルタ設定部を備え、状況に応じて適切なフィルタ処理が行われることが、第1実施形態と異なっている。以下、フィルタ設定部について詳しく説明する。
図7に示すように、第2実施形態における運転支援ECU20は、PCSを実施させるに際し、ROMに記憶されたプログラムを実行することで、フィルタ設定部28として機能する。
フィルタ設定部28は、次の周期におけるフィルタ処理にて利用される車両制御用フィルタのフィルタ特性を、物標Obの進路上において、物標Obの位置Prを検出可能な検出可能距離に応じて設定する。ここで、検出可能距離の推定方法について説明する。
フィルタ設定部28は、物標Obの位置Pr及び自車両CSの走行状態に基づき、検出可能距離を推定する。具体的には、図8(a)に示すように、フィルタ設定部28は、物標進路推定部24により推定された車両制御用進路B2と、自車進路推定部25により推定された自車両CSの進路A1との交点を予測衝突点D1として特定する。そして、レーダセンサ31の検知範囲31a内に予測衝突点D1が存在する場合、フィルタ設定部28は、検出された物標Obの車両制御用位置P2から予測衝突点D1までの距離E1を検出可能距離として推定する。
なお、距離E1は、自車両CSが物標Obと衝突する可能性があるタイミングまでの余裕時間又は余裕距離を特定可能な距離ともいえる。余裕時間は、物標Obの速度で距離E1を除算することにより算出可能である。また、物標Obの車両制御用位置P2から予測衝突点D1までの距離E1を検出可能距離としたのは、少なくとも自車両CSと物標Obとが衝突する前まで、物標Obの車両制御用位置P2を検出可能だからである。また、衝突後、物標Obの進路及び自車両CSの進路は、衝突の影響を受けるため、検出可能であるか否かは不明である。レーダセンサ31の検知範囲31aは、レーダセンサ31の検知角及び検知距離に基づき、算出される。
ただし、図8(b)に示すように、予測衝突点D1が検知範囲31a外に存在する場合、フィルタ設定部28は、物標Obの車両制御用位置P2からレーダセンサ31の検知範囲31a外となるまでの距離E2を、検出可能距離として推定する。
また、図8(c)に示すように、物標Obの車両制御用進路B2とレーダセンサ31からの探査波の送信方向とが直交する直交点D2が検知範囲31a内に存在する場合、フィルタ設定部28は、物標Obの車両制御用位置P2から直交点D2までの距離E3と、物標Obの車両制御用位置P2から予測衝突点D1までの距離E1とのうちより短い距離を検出可能距離として推定する。直交点D2は、レーダセンサ31の位置(すなわち、自車両CSの位置)から、車両制御用進路B2に対して垂線(破線で図示する)を引くことにより得られる。なお、直交点D2が検知範囲31a内に存在し、予測衝突点D1が存在しない場合、フィルタ設定部28は、車両制御用位置P2から直交点D2までの距離E3を検出可能距離として推定する。
このようにしたのは、レーダセンサ31の検知範囲31a内であっても、直交点D2に物標Obが到達した以降は、レーダセンサ31の性質上、物標Obの正面からの反射波を受信することができず、物標Obの車両制御用位置P2を検出できなくなる場合があるからである。つまり、レーダセンサ31は、車両の正面からの反射波に基づき、物標Obを検出しているからである。例えば、図8(c)に示すように、直交点D2以降に物標Obが進行すると、物標Obの正面から反射波を受けることがなくなり、物標Obの車両制御用位置P2を見失う場合がある。
そして、検出可能距離の推定後、フィルタ設定部28は、推定した検出可能距離が長い場合には、短い場合と比較して、車両制御用フィルタのフィルタ特性を弱くするように設定する。例えば、フィルタ設定部28は、検出可能距離が所定距離以上である場合には、車両制御用フィルタのフィルタ特性が弱い弱フィルタを設定し、所定距離未満である場合には、車両制御用フィルタのフィルタ特性が弱フィルタよりも強い強フィルタを設定する。所定距離としては、例えば、PCSが実施されるタイミングを考慮して、第1距離よりも長い距離(例えば、15m)が設定される。
なお、本実施形態では、強フィルタと、弱フィルタの2種類のフィルタが設定可能となっている。また、車両制御用フィルタとして、強フィルタと弱フィルタのいずれが設定されたとしても、衝突判定用フィルタよりもその特性が強くなっている(なめし度合いが大きい)。
これにより、検出可能距離が所定距離以上である場合には、車両制御用フィルタとして弱フィルタが設定される。車両制御用フィルタとして弱フィルタが設定された場合、物標Obの実際の動きに対する応答性が良くなり、物標Obが急旋回したとしても、PCSが適切に実施される。その一方、安定性が悪くなり、物標Ob以外からの不要な反射波の影響が大きくなる。しかしながら、検出可能距離が長い場合には、検出可能距離が短い場合と比較して、車両制御用位置P2を多く検出することができ、誤検出に基づく影響を修正するまでの猶予(余裕)が大きい。また、車両制御用位置P2から予測衝突点D1までの距離E1を検出可能距離とすることにより、PCSが実施されるまで距離又は時間に余裕がある。このため、車両制御用フィルタとして弱フィルタが設定されることにより誤検出による影響を受けても、その後に誤検出に基づく影響が修正されることが期待される。
さらに、検出可能距離が所定距離未満である場合には、車両制御用フィルタとして強フィルタが設定される。車両制御用フィルタとして強フィルタが設定された場合、安定性が良くなる。したがって、物標Ob以外からの不要な反射波の影響が抑制され、PCSが適切に実施される。
その一方、車両制御用フィルタとして強フィルタが設定された場合、物標Obの動きに対する応答性が悪くなる。しかしながら、車両制御用位置P2から予測衝突点D1までの距離E1を検出可能距離としている場合、検出可能距離が所定距離以下である際には、PCSを実施させるまでの猶予(余裕)が小さい可能性が高い。このため、車両制御用フィルタとして強フィルタが設定されることにより、応答性が悪かったとしても、PCSを実施させるまでの猶予がないため、ずれが大きくなることはないと予想される。また、物標Obの車両制御用進路B2は、車両制御用の履歴情報に基づき、複数周期において検出された車両制御用位置P2によって推定されるものである。このため、車両制御用フィルタのフィルタ特性を強くして応答性が悪くなったとしても、所定距離以上の場合(応答性の良い時)における物標Obの車両制御用位置P2も考慮して車両制御用進路B2を決定することにより、ずれが小さくなると考えられる。以上により、物標Obが急旋回したとしても、PCSが適切に実施される。
なお、物標Obの車両制御用進路B2と、自車両CSの進路A1が交わらない場合、車両制御用フィルタとして弱フィルタが設定される。これにより、急旋回したとしても物標Obの動きに応答し、適切なPCSを実施させることが可能となる。また、初期状態では、車両制御用フィルタとして弱フィルタが設定される。
そして、運転支援ECU20は、PCSを実施させるため、衝突判定処理を所定周期(例えば、80ms)ごとに実行する。以下、図9に基づき、第2実施形態における衝突判定処理について説明する。
運転支援ECU20は、レーダセンサ31から入力されたレーダ検知情報等を取得する(ステップS201)。運転支援ECU20は、Rポジションであるか否かを判定する(ステップS202)。Rポジションでない場合(ステップS202:No)、運転支援ECU20は、衝突判定処理を終了する。
一方、Rポジションである場合(ステップS202:Yes)、運転支援ECU20は、レーダ検知情報をフィルタ処理する(ステップS203)。具体的には、運転支援ECU20は、衝突判定用フィルタを利用してレーダ検知情報のフィルタ処理を行い、その処理結果を取得する。それとともに、運転支援ECU20は、車両制御用フィルタを利用してレーダ検知情報のフィルタ処理を行い、その処理結果を取得する。このとき、車両制御フィルタのフィルタ特性は、前回の周期において設定されたものである。なお、前回の周期において車両制御フィルタのフィルタ特性が設定されていない場合には、フィルタ特性は初期状態(弱フィルタ)である。
そして、運転支援ECU20は、第1実施形態のステップS104~ステップS106の処理と同様に、ステップS204~ステップS206の処理を実行する。
次に、運転支援ECU20は、検出可能距離を推定し、検出可能距離に基づき、次の周期における車両制御用フィルタのフィルタ特性を設定する(ステップS207)。具体的には、運転支援ECU20は、検出可能距離が所定距離以上である場合には、車両制御用フィルタとして、フィルタ特性が弱い弱フィルタを設定し、所定距離未満である場合には、フィルタ特性が弱フィルタよりも強い強フィルタを設定する。なお、検出可能距離を推定する際、前述したように、運転支援ECU20は、物標Obの車両制御用進路B2と、自車両CSの進路A1との交点(予測衝突点D1)を特定する。なお、運転支援ECU20は、車両制御用進路B2と、自車両CSの進路A1が交わらない場合、弱フィルタを設定する。その後、運転支援ECU20は、第1実施形態のステップS107~ステップS110の処理と同様に、ステップS208~ステップS211の処理を実行する。
上記構成により、第2実施形態では、第1実施形態の効果に加えて、以下の効果を奏する。
検出可能時間又は検出可能距離が長い場合には、短い場合と比較して、物標Obの車両制御用位置P2の検出回数を多くすることが可能となる。そして、車両制御用位置P2の検出回数が多くなれば、物標Obの車両制御用進路B2が修正されることが期待できる。車両制御用進路B2が修正されることが期待できるのであれば、車両制御用進路B2における望ましい応答性と安定性は異なる。したがって、車両制御用位置P2が検出可能な検出可能距離に応じて、車両制御用進路B2の望ましい応答性と安定性は異なる。そこで、運転支援ECU20は、検出可能距離に応じて、車両制御用フィルタのフィルタ特性を設定した。
すなわち、検出可能距離が所定距離以上であるか否かにより、車両制御用フィルタのフィルタ特性を異ならせた。これにより、実際の進路が急激に変化したとしても、検出可能距離が所定距離以上である場合に、車両制御用フィルタのフィルタ特性が弱くなるため、物標Obの実際の動きに物標Obの車両制御用進路B2を応答させることができる。また、不要な反射波を入力したとしても、検出可能距離が所定距離未満である場合に、車両制御用フィルタのフィルタ特性が強くなるため、物標Obの車両制御用進路B2を安定させることができる。したがって、状況によって車両制御用フィルタのフィルタ特性を変えることができ、PCSを適切に実施させることができる。
車両制御用フィルタのフィルタ特性を弱くする場合(なまし度合いが小さい場合)、応答性が良くなる。すなわち、物標Obが急に進行方向を変化させても、物標Obの車両制御用進路B2をそれに合わせて変化させることができる。このため、運転支援ECU20は、検出可能距離が長い場合には短い場合と比較して、なまし度合いが小さくなるように車両制御用フィルタのフィルタ特性を設定することとした。これにより、より適切にフィルタ特性を設定することができる。なお、車両制御用フィルタのフィルタ特性を弱くすると、安定性が悪くなり、不要な反射波の影響を受けやすくなるが、検出可能距離が長いため、修正されることが期待される。このため、検出可能距離が長い場合に車両制御用フィルタのフィルタ特性を弱くしても、不要な反射波の影響を抑制できる。
車両制御用フィルタのフィルタ特性を強くする場合(なまし度合いが大きい場合)、安定性が良くなる。このため、運転支援ECU20は、検出可能距離が短い場合、なまし度合いが大きくなるように車両制御用フィルタのフィルタ特性を設定することにより、不要な反射波の影響を抑え、誤検出を抑制することができる。これにより、より適切にフィルタ特性を設定することができる。
なお、フィルタ特性を強くして、応答性が悪くなったとしても、所定距離以上のときには、応答性をよくしており、所定距離以上のときの物標Obの車両制御用位置P2も考慮して車両制御用進路B2が決定される。このため、所定距離未満の場合に、車両制御用フィルタのフィルタ特性を強くしても、PCSを適切に実施させることができる。
(他の実施形態)
本開示は、上記実施形態に限定されず、例えば以下のように実施してもよい。なお、以下では、各実施形態で互いに同一又は均等である部分には同一符号を付しており、同一符号の部分についてはその説明を援用する。
本開示は、上記実施形態に限定されず、例えば以下のように実施してもよい。なお、以下では、各実施形態で互いに同一又は均等である部分には同一符号を付しており、同一符号の部分についてはその説明を援用する。
・上記実施形態において、探査装置として、ミリ波レーダ装置を採用したが、音波を用いて物体(物標)を探知及び測距するソナーを採用してもよい。
・上記実施形態において、衝突判定用フィルタのフィルタ特性が、車両制御用フィルタのフィルタ特性と比較して、強くなるように設定されていてもよい。
・自車両CSの前方における物標Obに対してPCSを実施するために、PCSS100を採用してもよい。
・車両制御用進路B2は、衝突判定において衝突する可能性があると判定された場合に、推定されるようにしてもよい。
・上記実施形態では、操舵角センサ33により検出された操舵角を用いて、自車両CSの進路を推定したが、操舵角センサ33の代わりにヨーレートセンサを用いて、ヨーレートと車速に基づき、自車両CSの進路を推定してもよい。
・第2実施形態において、フィルタ設定部28は、検出可能距離に応じて、衝突判定用フィルタのフィルタ特性を設定するようにしてもよい。なお、この場合でも、衝突判定用フィルタは、常に車両制御用フィルタと比較して、その特性が弱い(なめし度合いが小さい)ことが望ましい。
・第2実施形態において、フィルタ設定部28は、自車両CSから予測衝突点D1までの距離に応じて検出可能距離を特定してもよい。
・第2実施形態において、フィルタ設定部28は、検出可能距離を推定したが、検出可能時間を推定してもよい。具体的には、フィルタ設定部28は、検出可能距離を算出した後、検出可能距離を物標Obの速度で除算することにより、検出可能時間を推定してもよい。この場合、フィルタ設定部28は、検出可能時間に応じて車両制御用フィルタのフィルタ特性を設定すればよい。例えば、フィルタ設定部28は、検出可能時間が所定時間以上であるか否かにより、車両制御用フィルタのフィルタ特性を設定してもよい。つまり、フィルタ設定部28は、検出可能時間が10秒以上である場合には、車両制御用フィルタとして弱フィルタを設定し、検出可能時間が10秒未満である場合には、車両制御用フィルタとして強フィルタを設定するようにしてもよい。
・第2実施形態において、フィルタ設定部28は、自車両CSと物標Obとの距離(車間距離)を、検出可能距離として推定してもよい。また、車間距離を相対速度で除算した時間を、検出可能時間として推定してもよい。
・第2実施形態において、フィルタ設定部28は、車両制御用フィルタとして2種類のフィルタを設定可能に構成されていたが、検出可能距離に応じて、3種類以上のフィルタを設定可能に構成されていてもよい。
・第2実施形態において、運転支援ECU20は、物標Obの車両制御用進路B2と、自車両CSの進路A1が交わらない場合、車両制御用フィルタとして弱フィルタを設定した。この別例として、運転支援ECU20は、物標Obの車両制御用位置P2から検知範囲外となるまでの距離を検出可能距離として、車両制御用フィルタのフィルタ特性を設定してもよい。この場合、車両制御用進路B2と探査波の送信方向とが直交する直交点D2が検知範囲31a内に存在する場合、フィルタ設定部28は、車両制御用位置P2から直交点D2までの距離を検出可能距離として推定してもよい。
・第2実施形態において、フィルタ設定部28は、前回周期において推定された車両制御用進路B2及び自車両CSの進路A1に基づき、検出可能距離又は検出可能時間を推定してもよい。そして、フィルタ設定部28は、推定した検出可能距離又は検出可能時間に応じて、今回の周期における車両制御用フィルタのフィルタ特性を設定するようにしてもよい。この場合、運転支援ECU20は、衝突判定処理において、レーダ検知情報を取得する前(ステップS201の前)に、車両制御用フィルタのフィルタ特性を設定することが望ましい。
・第2実施形態において、フィルタ設定部28は、常に、車両制御用位置P2から予測衝突点D1までの距離E1を検出可能距離として推定してもよい。すなわち、予測衝突点D1が検知範囲31a外に存在する場合や、直交点D2が検知範囲31a内に存在する場合であっても、車両制御用位置P2から予測衝突点D1までの距離E1を検出可能距離として推定してもよい。
本開示は、実施例に準拠して記述されたが、本開示は当該実施例や構造に限定されるものではないと理解される。本開示は、様々な変形例や均等範囲内の変形をも包含する。加えて、様々な組み合わせや形態、さらには、それらに一要素のみ、それ以上、あるいはそれ以下、を含む他の組み合わせや形態をも、本開示の範疇や思想範囲に入るものである。
Claims (6)
- 探査波を送信し、物標により反射された反射波を受信する探査装置(31)からその反射波に基づく検知情報を取得する取得部(21)と、
前記検知情報をフィルタ処理するフィルタ処理部(22)と、
フィルタ処理された前記検知情報を利用して、前記物標の位置を検出する物標情報検出部(23)と、
前記物標情報検出部により検出された前記物標の位置の変化に基づき、前記物標の進路を推定する物標進路推定部(24)と、
自車両の進路を推定する自車進路推定部(25)と、
前記物標の進路と、自車両の進路とが交差するか否かにより、前記自車両と前記物標との衝突判定を実行する衝突判定部(26)と、
前記自車両と前記物標とが衝突すると判定された場合、前記物標の進路と自車両の進路とに基づき、前記物標が自車両と衝突するタイミングを推定し、車両制御を実行させる車両制御部(27)と、を備え、
前記衝突判定部にて用いられる前記物標の進路は、衝突判定用フィルタによりフィルタ処理された前記検知情報に基づき推定され、
前記車両制御部にて用いられる前記物標の進路は、車両制御用フィルタによりフィルタ処理された前記検知情報に基づき推定され、
前記フィルタ処理は、前記検知情報の変化を抑制するなまし処理であり、
前記車両制御用フィルタと、前記衝突判定用フィルタとは、前記検知情報の変化を抑制するなまし度合いが異なる衝突判定装置。 - 前記車両制御用フィルタは、前記衝突判定用フィルタと比較して、前記検知情報の変化を抑制するなまし度合いが大きくなるようにフィルタ特性が設定されている請求項1に記載の衝突判定装置。
- 前記車両制御部は、前記物標の進路と、自車両の進路との交点を予測衝突点として算出し、自車両から前記予測衝突点までの距離に応じて、車両制御を実行させる請求項1又は2に記載の衝突判定装置。
- 前記車両制御用フィルタのフィルタ特性を設定する設定部(23)を備え、
前記設定部は、前記物標の位置と自車両の走行状態とに基づいて、前記物標の進路上において前記物標の位置を検出可能な検出可能時間又は検出可能距離を推定し、推定した前記検出可能時間又は前記検出可能距離に応じて、前記車両制御用フィルタのフィルタ特性を設定する請求項1~3のうちいずれか1項に記載の衝突判定装置。 - 前記取得部は、前記探査装置から自車両の後方における前記物標の検知情報を取得するものであり、
前記自車進路推定部は、自車両が後退する場合に、自車両の進路を推定する請求項1~4のうちいずれか1項に記載の衝突判定装置。 - 探査波を送信し、物標により反射された反射波を受信する探査装置からその反射波に基づく検知情報を取得するステップ(S101)と、
前記検知情報をフィルタ処理するステップ(S103)と、
フィルタ処理された検知情報を利用して、前記物標の位置を検出するステップ(S104)と、
検出された前記物標の位置の変化に基づき、前記物標の進路を推定するステップ(S105)と、
自車両の進路を推定するステップ(S106)と、
前記物標の進路と、自車両の進路とが交差するか否かにより、自車両と前記物標との衝突判定を実行するステップ(S107)と、
自車両と前記物標とが衝突すると判定された場合、前記物標の進路と自車両の進路とに基づき、前記物標が自車両と衝突するタイミングを推定し、車両制御を実行させるステップ(S110)と、を備え、
前記衝突判定にて用いられる前記物標の進路は、衝突判定用フィルタによりフィルタ処理された検知情報に基づき推定され、
前記車両制御にて用いられる前記物標の進路は、車両制御用フィルタによりフィルタ処理された検知情報に基づき推定され、
前記フィルタ処理は、前記検知情報の変化を抑制するなまし処理であり、
前記車両制御用フィルタと、前記衝突判定用フィルタとは、前記検知情報の変化を抑制するなまし度合いが異なる衝突判定方法。
Priority Applications (3)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201780070620.4A CN109952241B (zh) | 2016-11-17 | 2017-10-30 | 碰撞判定装置以及碰撞判定方法 |
US16/461,154 US11460574B2 (en) | 2016-11-17 | 2017-10-30 | Collision determination apparatus and collision determination method |
DE112017005805.8T DE112017005805T5 (de) | 2016-11-17 | 2017-10-30 | Kollisionsbestimmungsvorrichtung und kollisionsbestimmungsverfahren |
Applications Claiming Priority (2)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP2016-224530 | 2016-11-17 | ||
JP2016224530A JP6564355B2 (ja) | 2016-11-17 | 2016-11-17 | 衝突判定装置、及び衝突判定方法 |
Publications (1)
Publication Number | Publication Date |
---|---|
WO2018092566A1 true WO2018092566A1 (ja) | 2018-05-24 |
Family
ID=62146241
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
PCT/JP2017/039081 WO2018092566A1 (ja) | 2016-11-17 | 2017-10-30 | 衝突判定装置、及び衝突判定方法 |
Country Status (5)
Country | Link |
---|---|
US (1) | US11460574B2 (ja) |
JP (1) | JP6564355B2 (ja) |
CN (1) | CN109952241B (ja) |
DE (1) | DE112017005805T5 (ja) |
WO (1) | WO2018092566A1 (ja) |
Cited By (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN110843776A (zh) * | 2019-11-29 | 2020-02-28 | 深圳市元征科技股份有限公司 | 车辆防撞方法和装置 |
Families Citing this family (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
KR102485394B1 (ko) * | 2017-12-11 | 2023-01-05 | 현대자동차주식회사 | 자동차 및 그 제어 방법 |
KR102106345B1 (ko) * | 2018-04-25 | 2020-05-04 | 주식회사 만도 | 후측방 경보 시스템 및 그 제어 방법 |
CN111833648A (zh) * | 2019-04-18 | 2020-10-27 | 上海汽车集团股份有限公司 | 一种车辆碰撞预警方法及装置 |
US20200346642A1 (en) * | 2019-05-01 | 2020-11-05 | Steering Solutions Ip Holding Corporation | Torque based vehicle path prediction |
Citations (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JPH07260929A (ja) * | 1994-03-28 | 1995-10-13 | Mazda Motor Corp | 車両の障害物検知装置および安全装置 |
JP2007317018A (ja) * | 2006-05-26 | 2007-12-06 | Toyota Motor Corp | 衝突判定装置 |
WO2010073292A1 (ja) * | 2008-12-22 | 2010-07-01 | トヨタ自動車株式会社 | レーダ装置、及び当該レーダ装置において用いられる測定方法 |
Family Cites Families (17)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
FR2662814B1 (fr) * | 1990-06-01 | 1994-03-25 | Thomson Trt Defense | Dispositif de mesure de la distance a une piste pour un engin volant. |
US5402129A (en) * | 1993-08-04 | 1995-03-28 | Vorad Safety Systems, Inc. | Monopulse azimuth radar system for automotive vehicle tracking |
US5659318A (en) * | 1996-05-31 | 1997-08-19 | California Institute Of Technology | Interferometric SAR processor for elevation |
JP2000222696A (ja) * | 1999-01-28 | 2000-08-11 | Mazda Motor Corp | 車両の制御装置 |
US7124027B1 (en) * | 2002-07-11 | 2006-10-17 | Yazaki North America, Inc. | Vehicular collision avoidance system |
FR2874278B1 (fr) * | 2004-07-20 | 2009-03-06 | Denso Corp | Dispositif de detection d'obstacle |
DE102005016009A1 (de) * | 2005-04-07 | 2006-10-12 | Robert Bosch Gmbh | Verfahren und Vorrichtung zur Stabilisierung eines Fahrzeugs nach einer Kollision |
JP4914787B2 (ja) * | 2007-08-30 | 2012-04-11 | 本田技研工業株式会社 | 車両用物体検知装置 |
US7903024B2 (en) * | 2007-10-25 | 2011-03-08 | Lockheed Martin Corporation | Adaptive moving target indicator (MTI) clutter rejection filter for radar systems |
US7911375B2 (en) * | 2009-06-02 | 2011-03-22 | Honeywell International Inc. | Doppler beam-sharpened radar altimeter |
US8824733B2 (en) * | 2012-03-26 | 2014-09-02 | Tk Holdings Inc. | Range-cued object segmentation system and method |
CN104002809B (zh) * | 2014-05-28 | 2016-08-24 | 长安大学 | 一种车辆岔口路段检测装置及检测方法 |
JP6260483B2 (ja) * | 2014-07-16 | 2018-01-17 | 株式会社デンソー | 物標検出装置 |
US9811732B2 (en) * | 2015-03-12 | 2017-11-07 | Qualcomm Incorporated | Systems and methods for object tracking |
JP6557830B2 (ja) | 2015-05-27 | 2019-08-14 | 多摩川精機株式会社 | ジンバル制御システム |
US10586102B2 (en) * | 2015-08-18 | 2020-03-10 | Qualcomm Incorporated | Systems and methods for object tracking |
CN105946853B (zh) * | 2016-04-28 | 2018-05-29 | 中山大学 | 基于多传感器融合的长距离自动泊车的***及方法 |
-
2016
- 2016-11-17 JP JP2016224530A patent/JP6564355B2/ja active Active
-
2017
- 2017-10-30 DE DE112017005805.8T patent/DE112017005805T5/de active Pending
- 2017-10-30 CN CN201780070620.4A patent/CN109952241B/zh active Active
- 2017-10-30 WO PCT/JP2017/039081 patent/WO2018092566A1/ja active Application Filing
- 2017-10-30 US US16/461,154 patent/US11460574B2/en active Active
Patent Citations (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JPH07260929A (ja) * | 1994-03-28 | 1995-10-13 | Mazda Motor Corp | 車両の障害物検知装置および安全装置 |
JP2007317018A (ja) * | 2006-05-26 | 2007-12-06 | Toyota Motor Corp | 衝突判定装置 |
WO2010073292A1 (ja) * | 2008-12-22 | 2010-07-01 | トヨタ自動車株式会社 | レーダ装置、及び当該レーダ装置において用いられる測定方法 |
Cited By (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN110843776A (zh) * | 2019-11-29 | 2020-02-28 | 深圳市元征科技股份有限公司 | 车辆防撞方法和装置 |
Also Published As
Publication number | Publication date |
---|---|
US20200064464A1 (en) | 2020-02-27 |
CN109952241B (zh) | 2022-08-02 |
CN109952241A (zh) | 2019-06-28 |
DE112017005805T5 (de) | 2019-09-26 |
US11460574B2 (en) | 2022-10-04 |
JP6564355B2 (ja) | 2019-08-21 |
JP2018079847A (ja) | 2018-05-24 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
WO2018092566A1 (ja) | 衝突判定装置、及び衝突判定方法 | |
JP6574407B2 (ja) | 車両制御装置、及び車両制御方法 | |
WO2018092565A1 (ja) | 衝突判定装置、及び衝突判定方法 | |
WO2018074287A1 (ja) | 車両制御装置 | |
JP6155963B2 (ja) | 衝突緩和装置 | |
US11414074B2 (en) | Driving support device | |
JP6609237B2 (ja) | 衝突判定装置、及び衝突判定方法 | |
WO2017002548A1 (ja) | 運転支援装置及び運転支援方法 | |
JP2016101893A5 (ja) | ||
WO2016158726A1 (ja) | 物体検知装置、及び物体検知方法 | |
EP2916306B1 (en) | Collision avoidance assist device and collision avoidance assist method | |
WO2014024294A1 (ja) | 車両の警報装置 | |
JP6336886B2 (ja) | 物体検知装置 | |
JP2011123535A (ja) | 障害物検出装置 | |
JP4873186B2 (ja) | 衝突軽減装置 | |
US20230166730A1 (en) | Vehicle control device | |
JP5071885B2 (ja) | 車両の障害物検知装置 | |
JP6462610B2 (ja) | 横断判定装置 | |
WO2021070882A1 (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: 17872477 Country of ref document: EP Kind code of ref document: A1 |
|
122 | Ep: pct application non-entry in european phase |
Ref document number: 17872477 Country of ref document: EP Kind code of ref document: A1 |