WO2021015065A1 - 衝突被害軽減装置 - Google Patents

衝突被害軽減装置 Download PDF

Info

Publication number
WO2021015065A1
WO2021015065A1 PCT/JP2020/027445 JP2020027445W WO2021015065A1 WO 2021015065 A1 WO2021015065 A1 WO 2021015065A1 JP 2020027445 W JP2020027445 W JP 2020027445W WO 2021015065 A1 WO2021015065 A1 WO 2021015065A1
Authority
WO
WIPO (PCT)
Prior art keywords
vehicle
obstacle
collision
unit
turning
Prior art date
Application number
PCT/JP2020/027445
Other languages
English (en)
French (fr)
Inventor
辰弥 堀米
Original Assignee
いすゞ自動車株式会社
Priority date (The priority date is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the date listed.)
Filing date
Publication date
Application filed by いすゞ自動車株式会社 filed Critical いすゞ自動車株式会社
Publication of WO2021015065A1 publication Critical patent/WO2021015065A1/ja

Links

Images

Classifications

    • BPERFORMING OPERATIONS; TRANSPORTING
    • B60VEHICLES IN GENERAL
    • B60RVEHICLES, VEHICLE FITTINGS, OR VEHICLE PARTS, NOT OTHERWISE PROVIDED FOR
    • B60R21/00Arrangements or fittings on vehicles for protecting or preventing injuries to occupants or pedestrians in case of accidents or other traffic risks
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B60VEHICLES IN GENERAL
    • B60RVEHICLES, VEHICLE FITTINGS, OR VEHICLE PARTS, NOT OTHERWISE PROVIDED FOR
    • B60R21/00Arrangements or fittings on vehicles for protecting or preventing injuries to occupants or pedestrians in case of accidents or other traffic risks
    • B60R21/01Electrical circuits for triggering passive safety arrangements, e.g. airbags, safety belt tighteners, in case of vehicle accidents or impending vehicle accidents
    • B60R21/013Electrical circuits for triggering passive safety arrangements, e.g. airbags, safety belt tighteners, in case of vehicle accidents or impending vehicle accidents including means for detecting collisions, impending collisions or roll-over
    • B60R21/0134Electrical circuits for triggering passive safety arrangements, e.g. airbags, safety belt tighteners, in case of vehicle accidents or impending vehicle accidents including means for detecting collisions, impending collisions or roll-over responsive to imminent contact with an obstacle, e.g. using radar systems
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B60VEHICLES IN GENERAL
    • B60WCONJOINT CONTROL OF VEHICLE SUB-UNITS OF DIFFERENT TYPE OR DIFFERENT FUNCTION; CONTROL SYSTEMS SPECIALLY ADAPTED FOR HYBRID VEHICLES; ROAD VEHICLE DRIVE CONTROL SYSTEMS FOR PURPOSES NOT RELATED TO THE CONTROL OF A PARTICULAR SUB-UNIT
    • B60W30/00Purposes of road vehicle drive control systems not related to the control of a particular sub-unit, e.g. of systems using conjoint control of vehicle sub-units
    • B60W30/08Active safety systems predicting or avoiding probable or impending collision or attempting to minimise its consequences
    • B60W30/09Taking automatic action to avoid collision, e.g. braking and steering
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B60VEHICLES IN GENERAL
    • B60WCONJOINT CONTROL OF VEHICLE SUB-UNITS OF DIFFERENT TYPE OR DIFFERENT FUNCTION; CONTROL SYSTEMS SPECIALLY ADAPTED FOR HYBRID VEHICLES; ROAD VEHICLE DRIVE CONTROL SYSTEMS FOR PURPOSES NOT RELATED TO THE CONTROL OF A PARTICULAR SUB-UNIT
    • B60W30/00Purposes of road vehicle drive control systems not related to the control of a particular sub-unit, e.g. of systems using conjoint control of vehicle sub-units
    • B60W30/08Active safety systems predicting or avoiding probable or impending collision or attempting to minimise its consequences
    • B60W30/095Predicting travel path or likelihood of collision
    • GPHYSICS
    • G08SIGNALLING
    • G08GTRAFFIC CONTROL SYSTEMS
    • G08G1/00Traffic control systems for road vehicles
    • G08G1/16Anti-collision systems

Definitions

  • This disclosure relates to a collision damage mitigation device that prevents or reduces collision damage when turning left or right.
  • Patent Document 1 calculates a collision determination index based on the speed of the own vehicle, the turning trajectory of the own vehicle, and the current position of an obstacle, and the own vehicle collides with an obstacle based on the collision determination index. It is judged whether there is a possibility.
  • an object of the present disclosure is to determine at an early stage the possibility that the own vehicle and the obstacle collide with each other in a situation where the obstacle is moving.
  • the collision damage mitigation device of the first aspect of the present disclosure is a collision damage mitigation device that reduces collision damage at the time of turning left or right, and determines whether or not the own vehicle turns left or right based on the state of the own vehicle.
  • a right / left turn determination unit an obstacle estimation unit that estimates the movement path of an obstacle in the vicinity of the own vehicle, a speed identification unit that specifies the speed of the own vehicle, and a yaw rate measurement unit that measures the yaw rate of the own vehicle.
  • the turning trajectory estimation unit that estimates the turning trajectory of the own vehicle based on the yaw rate measured by the yaw rate measuring unit and the speed of the own vehicle specified by the speed specifying unit, and the obstacle estimation unit that estimates the turning trajectory.
  • a collision determination unit that determines whether or not the own vehicle and the obstacle collide based on the movement path of the obstacle and the turning trajectory of the own vehicle estimated by the turning trajectory estimation unit, and the own vehicle.
  • the collision damage reduction unit executes a process of reducing the collision damage between the own vehicle and the obstacle. And have.
  • the intersection of the obstacle moving path and the own vehicle's turning trajectory based on the obstacle moving path estimated by the obstacle estimation unit and the turning trajectory of the own vehicle estimated by the turning trajectory estimation unit Collision between the own vehicle and the obstacle based on the positional relationship between the own vehicle and the obstacle when the own vehicle reaches the intersection estimated by the intersection estimation unit and the intersection estimation unit. It further has a collision determination index calculation unit that calculates a dynamic collision determination index for determination, and the collision determination unit is based on the dynamic collision determination index calculated by the collision determination index calculation unit. It may be determined whether or not the vehicle collides with the obstacle.
  • the turning track estimation unit may assume that the turning track of the own vehicle is an arc trajectory having the turning center of the own vehicle as the center of the arc and the front center of the own vehicle as a point on the arc. ..
  • the dynamic collision determination index includes a dynamic offset indicating the amount of entry of the obstacle into the circle formed by extending the turning trajectory estimated by the turning trajectory estimation unit, and the obstacle. Including a dynamic grace time indicating the time until the vehicle collides with the own vehicle.
  • the collision determination unit determines that the own vehicle and the obstacle collide with each other. You may.
  • FIG. 1 is a diagram showing a configuration of a collision damage mitigation device 1 according to the present embodiment.
  • the collision damage mitigation device 1 aims to prevent or reduce collision damage when the vehicle makes a right or left turn.
  • the collision damage mitigation device 1 determines whether or not the own vehicle and the obstacle collide with each other by estimating the movement path of the obstacle and the turning trajectory of the own vehicle. Therefore, the collision damage mitigation device 1 can determine at an early stage the possibility that the own vehicle and the obstacle collide with each other even when the obstacle is moving.
  • the collision damage mitigation device 1 includes a position measuring unit 11, a steering angle measuring unit 12, a yaw rate measuring unit 13, a speed specifying unit 14, a storage unit 15, and a control unit 16.
  • the position measuring unit 11 detects the position of the obstacle.
  • the position measuring unit 11 is, for example, a lidar (Light Detection And Ringing) that measures the position of an obstacle (for example, a pedestrian, a bicycle, a structure, etc.) by scanning with a laser beam.
  • the position measurement unit 11 may be a millimeter-wave radar that detects the position of an obstacle by scanning with radio waves in the millimeter-wave band, or a stereo camera that detects the front distance by matching captured images. There may be.
  • the steering angle measuring unit 12 measures the steering angle of the own vehicle, for example, by measuring the rotation angle of the steering wheel shaft.
  • the steering angle is defined as the direction in which the steering wheel of the own vehicle is operated clockwise.
  • the yaw rate measuring unit 13 measures the yaw rate of the own vehicle by, for example, measuring the Coriolis force applied to the tuning fork during vibration.
  • the direction in which the own vehicle is turned clockwise is defined as the positive direction.
  • the speed specifying unit 14 specifies the speed of the own vehicle by using, for example, a vehicle speed sensor.
  • the storage unit 15 is composed of, for example, a ROM (Read Only Memory) and a RAM (Random Access Memory).
  • the storage unit 15 stores various programs and various data for operating the control unit 16.
  • the control unit 16 is, for example, an ECU (Electronic Control Unit). By executing the program stored in the storage unit 15, the control unit 16 executes the right / left turn determination unit 161, the obstacle estimation unit 162, the turning trajectory estimation unit 163, the intersection estimation unit 164, the collision determination index calculation unit 165, and the collision. It functions as a determination unit 166 and a collision damage reduction unit 167.
  • ECU Electronic Control Unit
  • the right / left turn determination unit 161 determines whether or not the own vehicle makes a right / left turn based on the state of the own vehicle. For example, the right / left turn determination unit 161 determines that the vehicle is turning right when all of the following conditions (1-1) to (1-4) are satisfied.
  • Condition (1-1) The speed is equal to or higher than the speed threshold.
  • Condition (1-2) The yaw rate is equal to or higher than the yaw rate threshold for turning right.
  • Condition (1-4) The angular velocity of the steering angle must be equal to or greater than the angular velocity threshold for turning right.
  • the speed threshold value is, for example, a value for determining whether or not the own vehicle is moving.
  • the yaw rate threshold for turning right is, for example, several degrees per second with clockwise rotation as positive.
  • the angular velocity threshold value for turning right is a value for confirming that the driver has not turned the steering wheel counterclockwise, and as an example, it is minus several tens of degrees per second with clockwise rotation as positive.
  • the right / left turn determination unit 161 determines that the own vehicle is turning left when all of the following conditions (2-1) to (2-4) are satisfied.
  • Condition (2-1) The speed is equal to or higher than the speed threshold.
  • Condition (2-2) The yaw rate must be equal to or higher than the yaw rate threshold for turning left.
  • Condition (2-3) The blinker is turned on.
  • Condition (2-4) The angular velocity of the steering angle is equal to or less than the angular velocity threshold for turning left.
  • the yaw rate threshold for turning left is, for example, several degrees per second with counterclockwise as positive.
  • the angular velocity threshold value for turning left is a value for confirming that the driver has not turned the steering wheel clockwise, and as an example, it is minus several tens of degrees per second with counterclockwise rotation as positive.
  • the obstacle estimation unit 162 estimates the movement route of an obstacle in the vicinity of the own vehicle.
  • the vicinity of the own vehicle is, for example, a range within a few meters from the own vehicle.
  • the obstacle estimation unit 162 estimates the movement routes of all the obstacles in the vicinity of the own vehicle.
  • the obstacle estimation unit 162 obtains the position of the obstacle at the time of the previous measurement by the position measurement unit 11 and the position of the obstacle at the time of the current measurement, respectively.
  • FIG. 2 is a diagram showing a relative coordinate system and an absolute coordinate system for showing the positions of the own vehicle and obstacles.
  • the relative coordinate system of the obstacle seen from the own vehicle is shown by the lowercase x-axis and the y-axis
  • the absolute coordinate system is shown by the uppercase X-axis and the Y-axis.
  • the origin is the center of the front surface of the own vehicle.
  • the origin of the relative coordinate system shall move with the own vehicle.
  • the positive direction of the x-axis of the relative coordinate system indicates the front direction of the own vehicle
  • the positive direction of the y-axis indicates the left direction of the own vehicle.
  • the origin is the center of the rear axis of the own vehicle at the time of this measurement by the position measuring unit 11. It is assumed that the origin of the absolute coordinate system does not move when the own vehicle moves.
  • the traveling direction when the own vehicle is regarded as a mass point is the positive direction of the X-axis
  • the left direction of the vehicle orthogonal to the X-axis is the positive direction of the Y-axis.
  • the vehicle body slips at an angle formed by the traveling direction of the own vehicle, which is the positive direction of the X-axis of the absolute coordinate system, and the front direction of the own vehicle, which is the positive direction of the x-axis of the relative coordinate system. Let the angle ⁇ SAN be.
  • the obstacle estimation unit 162 calculates the vehicle body slip angle ⁇ SAN . More specifically, the obstacle estimation unit 162 uses a device (not shown) such as a GPS (Global Positioning System) or an inertial measurement unit (IMU) to determine the direction of speed when the vehicle body is regarded as a pledge point. And the azimuth of the vehicle body are measured respectively. The obstacle estimation unit 162 calculates the vehicle body slip angle ⁇ SAN from the difference between the two measured azimuth angles.
  • a device such as a GPS (Global Positioning System) or an inertial measurement unit (IMU) to determine the direction of speed when the vehicle body is regarded as a pledge point. And the azimuth of the vehicle body are measured respectively.
  • the obstacle estimation unit 162 calculates the vehicle body slip angle ⁇ SAN from the difference between the two measured azimuth angles.
  • the obstacle estimation unit 162 may estimate the vehicle body slip angle ⁇ SAN by the following equations (1) to (4).
  • Table 1 shows a list of variables used in equations (1) to (4).
  • the obstacle estimation unit 162 When the vehicle speed is equal to or less than the vehicle speed threshold value, the obstacle estimation unit 162 approximately estimates the vehicle body slip angle ⁇ SAN by the following equation (1).
  • the vehicle speed threshold value is, for example, the maximum value assumed as the speed at which the own vehicle turns at an intersection.
  • the obstacle estimating unit 162 assumes that the actual steering angle [delta] n is proportional to the steering angle theta strn, estimates the vehicle body slip angle theta SAn by equation (2).
  • the turning trajectory estimation unit 163 may estimate the vehicle body slip angle ⁇ SAN by the equation (4).
  • FIG. 3 is a diagram showing a method of estimating the movement route of an obstacle by the obstacle estimation unit 162.
  • Figure 3 shows a vehicle body slip angle theta SAn the current measurement time by the position measuring unit 11, and a vehicle body slip angle theta SAn-1 of the previous measurement.
  • the origin of the relative coordinates shown in FIG. 3 is the center of the front surface of the own vehicle and moves together with the own vehicle.
  • the position measurement unit 11 generates a measurement result in which the position of the obstacle is expressed in relative coordinates.
  • the obstacle estimation unit 162 since the origin of the relative coordinates moves, the obstacle estimation unit 162 generates the position of the obstacle expressed in relative coordinates. It is not possible to directly estimate the movement path of obstacles using. Therefore, the obstacle estimation unit 162 converts the relative coordinates of the obstacle into absolute coordinates.
  • the obstacle estimation unit 162 calculates the gain K SA of the vehicle body slip angle ⁇ SAN obtained by the equation (4). Obstacle estimation unit 162 uses the gain K SA of the vehicle body slip angle, the following equation (5), converts the relative coordinate of the obstacle to the absolute coordinates. Table 2 shows a list of variables used in equation (5).
  • the obstacle estimation unit 162 estimates the moving direction and the moving speed of the obstacle by using the converted absolute coordinates.
  • FIG. 3 shows the position of the obstacle at the time of the previous measurement by the position measuring unit 11 and the position of the obstacle at the time of the current measurement, respectively.
  • the obstacle estimation unit 162 uses the positions of the previous and current obstacles measured by the position measurement unit 11 to display the X-direction component of the moving speed of the obstacle. And the Y direction component is estimated.
  • Table 3 shows a list of variables used in equations (6) to (8).
  • the time interval ⁇ t of the measurement by the position measuring unit 11 is expressed by the following equation (6).
  • the obstacle estimation unit 162 obtains the absolute coordinates (X tun-1 , Y tun-1 ) of the obstacle at the time of the previous measurement by the following equation (7).
  • the obstacle estimation unit 162 estimates the X-direction component V tX and the Y-direction component V tY of the moving speed of the obstacle by the following equation (8).
  • the turning track estimation unit 163 estimates the turning track of the own vehicle. Orbiting estimator 163 estimates the turning trajectory of the vehicle based on the yaw rate w h yaw rate measuring unit 13 has measured, with the rate V h of the vehicle speed identification unit 14 has identified.
  • the turning track estimation unit 163 assumes that the turning track of the own vehicle is an arc trajectory having the turning center of the own vehicle as the center of the arc. As shown by the broken line in FIG. 2, the turning track estimation unit 163 may use the center of the rear axis of the own vehicle as a point on the arc, or the center of the front surface of the own vehicle as a point on the arc.
  • the arc having a radius R 0 (hereinafter, referred to as the turning radius), using the yaw rate w h and velocity V h of the vehicle is expressed by the following equation (9).
  • the center of this arc is expressed as (R 0 , 0).
  • the turning track estimation unit 163 may take time to estimate a turning track with high accuracy. Therefore, as shown in the equation (10), the turning trajectory estimation unit 163 may pre- read the subsequent yaw rate wFlt at the rising edge of the yaw rate.
  • hn is the yaw rate at the time of the current measurement
  • w hn-1 is the yaw rate at the time of the previous measurement
  • K w is a predetermined constant for look-ahead.
  • Orbiting estimating unit 163 we estimate the turning radius R 0Flt of the vehicle with a yaw rate w Flt that prefetching.
  • the turning track estimation unit 163 can accurately estimate the turning radius before the steering wheel turning is completed.
  • the intersection estimation unit 164 estimates the intersection of the movement path and the turning trajectory based on the obstacle moving path estimated by the obstacle estimating unit 162 and the turning trajectory of the own vehicle estimated by the turning track estimation unit 163.
  • FIG. 4 is a diagram showing a method of calculating the intersection of the turning track of the own vehicle and the track of an obstacle.
  • the circle of the turning track of the own vehicle estimated by the turning track estimation unit 163 is shown by a broken line.
  • the turning track of the own vehicle and the track of the obstacle have an intersection 1 and an intersection 2.
  • the intersection estimation unit 164 selects an intersection 1 that intersects earlier as an intersection between the moving path of the obstacle and the turning trajectory of the own vehicle.
  • the collision determination index calculation unit 165 calculates a static collision determination index and a dynamic collision determination index for determining a collision between the own vehicle and an obstacle. First, the calculation of the static collision determination index by the collision determination index calculation unit 165 will be described.
  • FIG. 5 is a diagram for explaining a static collision determination index calculated by the collision determination index calculation unit 165.
  • the collision determination index calculation unit 165 considers the own vehicle as a rectangle and calculates a static collision determination index for each vertex of the rectangle.
  • the position a1 in FIG. 5 indicates one of the vertices of the own vehicle.
  • Position C indicates the center of the turning track of the own vehicle, and position b1 indicates the position of an obstacle.
  • the turning track A at the apex a1 of the own vehicle is shown by a broken line.
  • the static offset DoffsetS is a value indicating the amount of entry in which an obstacle has entered the circle formed by extending the turning track A.
  • the static offset DoffsetS takes a negative value when the obstacle is outside the circle and a positive value when the obstacle is inside the circle.
  • the absolute value of the static offset DoffsetS is the shortest distance from the obstacle position b1 to the turning trajectory A.
  • ⁇ apex is an angle formed by a straight line extending from the apex a1 of the own vehicle to the turning center C and the Y axis.
  • ⁇ ts is the angle formed by the straight line extending from the obstacle position b1 to the turning center C and the Y axis.
  • the static mileage D mileageS is the length of the arc on the turning trajectory A corresponding to the angle obtained by subtracting ⁇ apex from ⁇ ts .
  • the collision determination index calculation unit 165 calculates the static collision determination index by the following equations (12) to (18). Table 4 shows a list of variables used in equations (12) to (18).
  • the collision determination index calculation unit 165 calculates the absolute coordinates of the vertices of the own vehicle by the equation (12).
  • the collision determination index calculation unit 165 calculates the turning radius R apex of each apex of the own vehicle by the following equation (13).
  • the collision determination index calculation unit 165 calculates the angle ⁇ apex formed by the straight line extending from the apex a1 of the own vehicle to the turning center C and the Y axis shown in FIG. 5 by the following equation (14).
  • the collision determination index calculation unit 165 calculates the angle ⁇ ts formed by the straight line extending from the obstacle position b1 shown in FIG. 5 to the turning center C and the Y axis by the following equation (15).
  • the collision determination index calculation unit 165 calculates the static offset DoffsetS by the following equation (16).
  • the collision determination index calculation unit 165 calculates the static grace time T 1S by the following equation (17).
  • Collision determination index calculation unit 165 calculates the following formula static mileage D mileageS (18).
  • the collision determination index calculation unit 165 estimates the absolute coordinates of the obstacle when the own vehicle reaches the intersection of the turning trajectory of the own vehicle and the movement path of the obstacle by the following equations (19) to (29). .. Table 5 shows a list of variables used in equations (19) to (29).
  • Absolute coordinates of the origin of the relative coordinate (X S, Y S) is expressed by the following equation (20).
  • the collision determination index calculation unit 165 obtains the length k (see FIG. 4) of the perpendicular line drawn from the turning center to the straight line L by the following equation (23).
  • the collision determination index calculation unit 165 obtains the distance S (see FIG. 4) from the foot of the perpendicular line drawn from the turning center to the straight line L to the intersection 1 of the arc and the straight line L by the following equation (25).
  • the collision determination index calculation unit 165 uses (X is , Y is ) shown in the equation (26) to set the central angle ⁇ Reach (see FIG. 4) at the turning center from the apex a1 to the intersection 1 of the own vehicle as follows. It is calculated by the formula (27).
  • the collision determination index calculation unit 165 calculates the time T Reach until the obstacle comes into contact with the apex of the own vehicle at the intersection 1 by the following equation (28).
  • the collision determination index calculation unit 165 estimates the absolute coordinates (X tF , Y tF ) of the obstacle when the own vehicle reaches the intersection 1 by the following equation (29).
  • the collision determination index calculation unit 165 is a motion for determining a collision between the own vehicle and the obstacle based on the positional relationship between the own vehicle and the obstacle when the own vehicle reaches the intersection estimated by the intersection estimation unit 164. Calculate the target collision judgment index.
  • the dynamic collision detection index includes, for example, a dynamic offset indicating the amount of approach that an obstacle has entered into a circle formed by extending the turning trajectory estimated by the turning track estimation unit 163, and the obstacle colliding with the own vehicle. Includes a dynamic grace time that indicates the time to do.
  • FIG. 6A indicates the position of the apex of the own vehicle at the time of this measurement by the position measuring unit 11.
  • the position b1 indicates the position of the obstacle at the time of the current measurement, and the position b0 indicates the position of the obstacle at the time of the previous measurement by the position measuring unit 11.
  • FIG. 6 (b) shows a forecast diagram in which Treach seconds have elapsed from the state of FIG. 6 (a).
  • the apex a2 of the own vehicle when the Treach second has elapsed has reached the intersection of the turning trajectory of the own vehicle and the movement path of the obstacle. At this time, the obstacle has reached the position b2 on the movement path B.
  • FIG. 7 shows an example of a dynamic collision determination index at the same time point as in FIG. 6 (b).
  • ⁇ apex is the same as in FIG.
  • ⁇ tD is the angle formed by the straight line extending from the obstacle position b2 to the turning center C after the lapse of Treach seconds and the Y axis.
  • the dynamic offset D offsetD is a value indicating the amount of approach in which an obstacle has entered the circle formed by extending the turning trajectory A.
  • the dynamic offset DoffsetD takes a negative value when the obstacle is outside the circle and a positive value when the obstacle is inside the circle.
  • the absolute value of the dynamic offset DoffsetD is the shortest distance from the obstacle to the turning trajectory A.
  • the dynamic mileage D mileageD is the length of the arc on the turning trajectory A corresponding to the angle obtained by subtracting ⁇ apex from ⁇ tD .
  • the collision determination index calculation unit 165 calculates the dynamic collision determination index by the following equations (30) to (33).
  • the variables used in equations (30) to (33) are shown in Table 6.
  • the collision determination index calculation unit 165 calculates ⁇ tD in FIG. 7 by the following equation (30).
  • the collision determination index calculation unit 165 calculates the dynamic offset DoffsetD by the following equation (31).
  • the collision determination index calculation unit 165 calculates the dynamic grace time T 1D by the following equation (32).
  • Collision determination index calculation unit 165 calculates the dynamic Mileage D MileageD by the following equation (33).
  • the collision determination unit 166 determines whether or not the own vehicle collides with an obstacle. More specifically, the collision determination unit 166 collides with the own vehicle and the obstacle based on the movement path of the obstacle estimated by the obstacle estimation unit 162 and the turning trajectory of the own vehicle estimated by the turning trajectory estimation unit 163. Determine whether or not to do so.
  • the collision determination unit 166 determines whether or not the own vehicle collides with an obstacle based on the static collision determination index calculated by the collision determination index calculation unit 165.
  • the collision detection unit 166 indicates the own vehicle and the obstacle. Judge that an object collides.
  • the collision detection unit 166 determines that the static offset is less than the minimum threshold value, the static offset is larger than the maximum threshold value, or the static grace time is equal to or longer than the time threshold value at all the vertices of the own vehicle. , Judge that the own vehicle and obstacles do not collide.
  • the offset minimum threshold value and the offset maximum threshold value are values for determining the presence or absence of a risk of collision.
  • the minimum offset threshold is, for example, minus several meters, and a different value may be assigned to each vertex of the own vehicle.
  • the maximum offset threshold is, for example, several meters, and different values may be assigned to each vertex of the own vehicle.
  • the time threshold value is a value that is assumed to be required to avoid a collision by, for example, an avoidance operation of the driver of the own vehicle or an automatic braking of the own vehicle.
  • the collision determination unit 166 determines the collision by the static collision determination index based on the vehicle speed of the own vehicle, the turning trajectory of the own vehicle, and the position of the obstacle at the time of the current measurement by the position measurement unit 11. However, when the obstacle is approaching from the lateral direction when viewed from the own vehicle, the collision determination unit 166 cannot determine whether or not there is a risk of collision until immediately before the collision in the collision determination using the static collision determination index. There is.
  • the collision determination unit 166 determines whether or not the own vehicle and the obstacle collide with each other based on the dynamic collision determination index calculated by the collision determination index calculation unit 165. judge. First, the collision determination unit 166 determines whether or not the movement speed of the obstacle estimated by the obstacle estimation unit 162 is equal to or higher than a predetermined value.
  • the predetermined value is, for example, a value for determining whether or not an obstacle is moving.
  • the collision determination unit 166 makes a determination based on the dynamic collision determination index when the movement speed of the obstacle estimated by the obstacle estimation unit 162 is equal to or higher than a predetermined value.
  • the collision determination unit 166 calculates that the dynamic offset calculated by the above equation (31) at any apex of the own vehicle is equal to or more than the offset minimum threshold value and equal to or less than the offset maximum threshold value, and is calculated by the above equation (32). If the dynamic grace time is smaller than the time threshold, it is determined that the own vehicle and an obstacle collide.
  • the dynamic offset is less than the offset minimum threshold value, the dynamic offset is larger than the offset maximum threshold value, or the dynamic grace time is greater than or equal to the time threshold value. In some cases, it is determined that the own vehicle and obstacles do not collide.
  • the collision determination unit 166 identifies the position of the obstacle when the own vehicle reaches the intersection, it is possible to improve the accuracy of determining whether or not the own vehicle and the obstacle collide. Further, since the collision determination unit 166 determines whether or not the dynamic offset and the value of the dynamic grace time are appropriate, the lateral position of the obstacle as seen from the own vehicle and the time until the collision occur. The presence or absence of a collision risk can be determined in consideration of the margin.
  • the collision damage mitigation unit 167 determines that the vehicle makes a right / left turn, the right / left turn determination unit 161 determines, and then the collision determination unit 166 determines that the vehicle collides with an obstacle. Take action to prevent or mitigate. For example, the collision damage mitigation unit 167 causes a speaker (not shown) to output an alarm for notifying the driver of the approach of an obstacle when the collision determination unit 166 determines that the own vehicle collides with an obstacle. .. When the collision determination unit 166 determines that the vehicle and an obstacle collide with each other, the collision damage mitigation unit 167 automatically causes a collision between the vehicle and the obstacle by an automatic braking device or an automatic steering device (not shown). You may avoid it.
  • FIG. 8 is a flowchart showing a collision damage mitigation processing procedure by the collision damage mitigation device 1. This processing procedure starts, for example, while the own vehicle is running.
  • the right / left turn determination unit 161 creates own vehicle data indicating a state such as the speed and steering angle of the own vehicle (S1).
  • the right / left turn determination unit 161 determines whether or not the own vehicle makes a right / left turn based on the generated own vehicle data (S2).
  • the collision determination index calculation unit 165 determines that the vehicle turns left or right when the vehicle turns left or right (YES in S2)
  • the collision determination index calculation unit 165 determines that the obstacle 1 is among a plurality of obstacles 1 to N in the vicinity of the vehicle. Create data (S3-1).
  • the collision determination unit 166 determines whether or not the own vehicle collides with the obstacle 1 (S4-1).
  • the collision damage mitigation unit 167 executes a process of reducing the collision damage between the own vehicle and the obstacle (YES in S4-1). S5), the process is terminated.
  • the collision determination index calculation unit 165 and the collision determination unit 166 determine that the own vehicle does not collide with the obstacle 1 (NO in S4-1)
  • the collision determination index calculation unit 165 and the collision determination unit 166 are among the obstacles 2 to N.
  • the same processing as in S3-1 and S4-1 is repeated for the obstacle 2 (S3-2, S4-2).
  • the collision determination index calculation unit 165 and the collision determination unit 166 repeat the same processing as in S3-1 and S4-1 for the following obstacles 3 to N (S3-3, S4-3, ... , S3-N, S4-N).
  • the collision damage mitigation unit 167 executes a process of reducing the collision damage between the own vehicle and the obstacle. (S5), the process is terminated.
  • the collision damage mitigation unit 167 determines in the determination of S4-N that the own vehicle does not collide with any of the obstacles 2 to N (NO of S4-N)
  • the collision damage mitigation unit 167 and the own vehicle The process is terminated without executing the process to reduce the damage caused by the collision with the obstacle.
  • FIG. 9 is a flowchart for explaining a detailed procedure of the data creation process (S3-1) of the obstacle 1 of FIG.
  • the data creation process for obstacles 2 to N (S3-2, S3-3, ..., S3-N) is the same as the data creation process for obstacle 1.
  • the obstacle estimation unit 162 estimates the movement route of the obstacle 1 (S11).
  • the turning track estimation unit 163 estimates the turning track of the own vehicle (S12).
  • the intersection estimation unit 164 estimates the intersection of the obstacle movement path estimated by the obstacle estimation unit 162 and the turning trajectory of the own vehicle estimated by the turning trajectory estimation unit 163 (S13).
  • the collision determination index calculation unit 165 obtains the position of an obstacle when the own vehicle reaches the intersection estimated by the intersection estimation unit 164.
  • the collision determination index calculation unit 165 calculates a dynamic collision determination index based on the positional relationship between the own vehicle and obstacles when the own vehicle reaches the intersection (S14).
  • the collision determination unit 166 collides with its own vehicle and obstacles based on the movement path of the obstacle estimated by the obstacle estimation unit 162 and the turning trajectory estimated by the turning trajectory estimation unit 163. Determine whether or not to do so.
  • the collision damage mitigation device 1 determines whether or not the own vehicle collides with the obstacle using the estimated movement route of the obstacle, so that the obstacle is moving. Even in this case, the possibility of collision between the own vehicle and an obstacle can be determined at an early stage.
  • the collision damage mitigation device of the present disclosure is useful in that it is possible to determine at an early stage the possibility of a collision between the own vehicle and an obstacle in a situation where an obstacle is moving.
  • Collision damage mitigation device 11 Position measurement unit 12 Steering angle measurement unit 13 Yaw rate measurement unit 14 Speed identification unit 15 Storage unit 16 Control unit 161 Right / left turn determination unit 162 Obstacle estimation unit 163 Turning trajectory estimation unit 164 Intersection estimation unit 165 Collision detection Index calculation unit 166 Collision detection unit 167 Collision damage reduction unit

Landscapes

  • Engineering & Computer Science (AREA)
  • Mechanical Engineering (AREA)
  • Automation & Control Theory (AREA)
  • Transportation (AREA)
  • Physics & Mathematics (AREA)
  • General Physics & Mathematics (AREA)
  • Radar, Positioning & Navigation (AREA)
  • Remote Sensing (AREA)
  • Traffic Control Systems (AREA)
  • Control Of Driving Devices And Active Controlling Of Vehicle (AREA)

Abstract

右左折時の衝突被害を軽減する衝突被害軽減装置(1)であって、自車両の状態に基づいて自車両が右左折するか否かを判定する右左折判定部(161)と、自車両近傍の障害物の移動経路を推定する障害物推定部(162)と、自車両の速度を特定する速度特定部(14)と、自車両のヨーレートを測定するヨーレート測定部(13)と、自車両の旋回軌道を推定する旋回軌道推定部(163)と、障害物推定部(162)が推定した障害物の移動経路と、旋回軌道推定部(163)が推定した自車両の旋回軌道とに基づいて、自車両及び障害物が衝突するか否かを判定する衝突判定部(166)と、自車両が右左折すると右左折判定部(161)が判定した後に自車両と障害物とが衝突すると判定した場合、自車両と障害物との衝突被害を軽減する処理を実行する衝突被害軽減部(167)と、を有する。

Description

衝突被害軽減装置
 本開示は、右左折時の衝突被害を予防又は軽減する衝突被害軽減装置に関する。
 従来、右左折時に自車両と障害物とが衝突する可能性の有無を判定し、自車両と障害物とが衝突する可能性がある場合、ドライバに警告したり、運転操作に介入したりすることで、右左折時の衝突被害を予防又は軽減する技術が知られている(例えば、特許文献1を参照)。
日本国特開2019-12345号公報
 特許文献1に記載の技術は、自車両の速度、自車両の旋回軌道及び障害物の現在位置に基づいて衝突判定指標を算出し、衝突判定指標に基づいて自車両と障害物とが衝突する可能性の有無を判定している。
 しかし、自車両の速度、自車両の旋回軌道及び障害物の現在位置だけでは、障害物が自車両に向かって接近している状況においては衝突の間際にならないと自車両と障害物とが衝突する可能性を判定することができないという問題が生じていた。
 そこで、本開示はこれらの点に鑑みてなされたものであり、障害物が移動している状況において、自車両と障害物とが衝突する可能性を早期に判定することを目的とする。
 本開示の第1の態様の衝突被害軽減装置は、右左折時の衝突被害を軽減する衝突被害軽減装置であって、自車両の状態に基づいて前記自車両が右左折するか否かを判定する右左折判定部と、前記自車両近傍の障害物の移動経路を推定する障害物推定部と、前記自車両の速度を特定する速度特定部と、前記自車両のヨーレートを測定するヨーレート測定部と、前記ヨーレート測定部が測定したヨーレート及び前記速度特定部が特定した前記自車両の速度に基づいて前記自車両の旋回軌道を推定する旋回軌道推定部と、前記障害物推定部が推定した前記障害物の移動経路と、前記旋回軌道推定部が推定した前記自車両の旋回軌道とに基づいて、前記自車両及び前記障害物が衝突するか否かを判定する衝突判定部と、前記自車両が右左折すると前記右左折判定部が判定した後に前記自車両と前記障害物とが衝突すると判定した場合、前記自車両と前記障害物との衝突被害を軽減する処理を実行する衝突被害軽減部と、を有する。
 また、前記障害物推定部が推定した前記障害物の移動経路及び前記旋回軌道推定部が推定した前記自車両の旋回軌道に基づいて前記障害物の移動経路と前記自車両の旋回軌道との交点を推定する交点推定部と、前記交点推定部が推定した前記交点に前記自車両が到達したときの前記自車両及び前記障害物の位置関係に基づいて前記自車両と前記障害物との衝突を判定するための動的衝突判定指標を算出する衝突判定指標算出部と、をさらに有し、前記衝突判定部は、前記衝突判定指標算出部が算出した前記動的衝突判定指標に基づいて前記自車両と前記障害物とが衝突するか否かを判定してもよい。
 また、前記旋回軌道推定部は、前記自車両の旋回軌道を、前記自車両の旋回中心を円弧の中心とし、前記自車両の前面中心を円弧上の点とした円弧軌道と仮定してもよい。
 また、前記動的衝突判定指標は、前記旋回軌道推定部が推定した前記旋回軌道を延長することにより形成される円に前記障害物が進入した進入量を示す動的オフセット、及び前記障害物が前記自車両と衝突するまでの時間を示す動的猶予時間を含み、
 前記衝突判定部は、前記動的オフセットが最小閾値以上であって最大閾値以下であり、かつ、前記動的猶予時間が時間閾値よりも小さい場合、前記自車両と前記障害物とが衝突すると判定してもよい。
 本開示によれば、障害物が移動している状況において、自車両と障害物とが衝突する可能性を早期に判定することができるという効果を奏する。
本実施形態に係る衝突被害軽減装置1の構成を示す図である。 自車両及び障害物の位置を示すための相対座標系及び絶対座標系を示す図である。 障害物推定部による障害物の移動経路の推定方法を示す図である。 自車両の旋回軌道と障害物の軌道との交点の算出方法を示す図である。 衝突判定指標算出部が算出する静的衝突判定指標を説明するための図である。 動的衝突判定指標を説明するための図である。 動的衝突判定指標を説明するための図である。 衝突被害軽減装置により衝突被害軽減の処理手順を示すフローチャートである。 図8の障害物のデータ作成の詳細な処理を説明するためのフローチャートである。
[衝突被害軽減装置の構成]
 図1は、本実施形態に係る衝突被害軽減装置1の構成を示す図である。衝突被害軽減装置1は、自車両の右左折時の衝突被害を予防又は軽減することを目的とする。詳細については後述するが、衝突被害軽減装置1は、障害物の移動経路と、自車両の旋回軌道とをそれぞれ推定することにより、自車両と障害物とが衝突するか否かを判定する。このため、衝突被害軽減装置1は、障害物が移動している場合においても、自車両と障害物とが衝突する可能性を早期に判定することができる。
 衝突被害軽減装置1は、位置測定部11と、操舵角測定部12と、ヨーレート測定部13と、速度特定部14と、記憶部15と、制御部16とを有する。位置測定部11は、障害物の位置を検出する。位置測定部11は、例えば、レーザ光でスキャンすることにより障害物(例えば歩行者、自転車及び構造物等)の位置を測定するLIDAR(Light Detection And Ranging)である。位置測定部11は、ミリ波帯の電波でスキャンすることにより障害物の位置を検出するミリ波レーダや、撮像画像のマッチングにより前方距離を検出するステレオカメラであってもよく、これらの組み合わせであってもよい。
 操舵角測定部12は、例えば、ハンドルシャフトの回転角度を測定することにより、自車両の操舵角を測定する。本明細書の例では、操舵角は、自車両のステアリングホイールを右回りに操作した向きを正の向きとする。
 ヨーレート測定部13は、例えば、振動中の音叉に加わるコリオリ力を測定することにより、自車両のヨーレートを測定する。本明細書の例では、自車両を右回りに旋回させた向きを正の向きとする。速度特定部14は、例えば車速センサを用いて、自車両の速度を特定する。
 記憶部15は、例えば、ROM(Read Only Memory)及びRAM(Random Access Memory)等により構成される。記憶部15は、制御部16を機能させるための各種プログラムや各種データを記憶する。
 制御部16は、例えば、ECU(Electronic Control Unit)である。制御部16は、記憶部15に記憶されたプログラムを実行することにより、右左折判定部161、障害物推定部162、旋回軌道推定部163、交点推定部164、衝突判定指標算出部165及び衝突判定部166及び衝突被害軽減部167として機能する。
[右左折の判定]
 右左折判定部161は、自車両の状態に基づいて自車両が右左折するか否かを判定する。例えば、右左折判定部161は、以下の条件(1-1)から(1-4)をいずれも満たす場合に、車両が右折していると判定する。条件(1-1)速度が速度閾値以上であること。条件(1-2)ヨーレートが右折用のヨーレート閾値以上であること。条件(1-3)ウィンカーがONに操作されていること。条件(1-4)操舵角の角速度が右折用の角速度閾値以上であること。
 速度閾値は、例えば、自車両が移動しているか否かを判定するための値である。右折用のヨーレート閾値は、例えば、右回りを正として毎秒数度である。右折用の角速度閾値は、運転者がステアリングホイールを左回りに切り戻していないことを確認するための値であり、一例としては、右回りを正として毎秒マイナス数十度である。
 右左折判定部161は、以下の条件(2-1)から(2-4)をいずれも満たす場合に、自車両が左折していると判定する。条件(2-1)速度が速度閾値以上であること。条件(2-2)ヨーレートが左折用のヨーレート閾値以上であること。条件(2-3)ウィンカーがONに操作されていること。条件(2-4)操舵角の角速度が左折用の角速度閾値以下であること。
 左折用のヨーレート閾値は、例えば、左回りを正として毎秒数度である。左折用の角速度閾値は、運転者がステアリングホイールを右回りに切り戻していないことを確認するための値であり、一例としては、左回りを正として毎秒マイナス数十度である。
[障害物の移動経路の推定]
 障害物推定部162は、自車両近傍の障害物の移動経路を推定する。自車両近傍とは、例えば、自車両から数メートル以内の範囲である。障害物推定部162は、自車両近傍に複数の障害物が存在する場合には、自車両近傍の全ての障害物の移動経路を推定する。障害物推定部162は、位置測定部11による前回測定時の障害物の位置と、今回測定時の障害物の位置とをそれぞれ求める。
 図2は、自車両及び障害物の位置を示すための相対座標系及び絶対座標系を示す図である。図2の例では、自車両からみた障害物の相対座標系を小文字のx軸及びy軸で示し、絶対座標系を大文字のX軸及びY軸で示す。相対座標系では、自車両の前面中心を原点とする。相対座標系の原点は、自車両とともに移動するものとする。相対座標系のx軸の正の向きは、自車両の前方方向を示し、y軸の正の向きは、自車両の左方向を示す。
 絶対座標系では、位置測定部11による今回測定時の自車両の後軸中心を原点とする。自車両が移動した際に、絶対座標系の原点は移動しないものとする。絶対座標系では、自車両を質点とみなしたときの進行方向をX軸の正の向きとし、X軸と直交する車両左方向をY軸の正の向きとする。図2に示すように、絶対座標系のX軸の正の向きである自車両の進行方向と、相対座標系のx軸の正の向きである自車両の前方方向とのなす角を車体スリップ角θSAnとする。
 この車体スリップ角θSAnは、障害物の移動経路を推定するために必要であるため、障害物推定部162は、車体スリップ角θSAnを算出する。より詳しくは、障害物推定部162は、GPS(Global Positioning System)や慣性計測装置(IMU:inertial measurement unit)などの装置(不図示)を用いて、車体を質点とみなしたときの速度の向きの方位角と、車体の方位角とをそれぞれ測定する。障害物推定部162は、測定した2つの方位角の差から車体スリップ角θSAnを算出する。
 また、障害物推定部162は、以下の式(1)~(4)により車体スリップ角θSAnを推定してもよい。式(1)~(4)に用いられる変数のリストを表1に示す。
Figure JPOXMLDOC01-appb-T000001
 障害物推定部162は、車速が車速閾値以下である場合、以下の式(1)により近似的に車体スリップ角θSAnを推定する。車速閾値は、例えば、交差点における自車両の旋回時の速度として想定される最大値である。
Figure JPOXMLDOC01-appb-M000002
 しかしながら、今のところ量産可能な車載用のセンサでは、実舵角δを得ることはできない。このため、障害物推定部162は、実舵角δが操舵角θstrnに比例すると仮定し、式(2)により車体スリップ角θSAnを推定する。
Figure JPOXMLDOC01-appb-M000003
 車速が車速閾値以下である場合、式(3)が成立すると仮定することができる。
Figure JPOXMLDOC01-appb-M000004
 式(3)を変形して式(1)に代入すると、以下の式(4)が得られる。旋回軌道推定部163は、式(4)により車体スリップ角θSAnを推定してもよい。
Figure JPOXMLDOC01-appb-M000005
 図3は、障害物推定部162による障害物の移動経路の推定方法を示す図である。図3は、位置測定部11による今回測定時の車体スリップ角θSAnと、前回測定時の車体スリップ角θSAn-1とを示す。図3に示す相対座標の原点は、自車両の前面中心であり、自車両とともに移動する。位置測定部11は、障害物の位置を相対座標で表現した測定結果を生成するが、相対座標の原点が移動することから、障害物推定部162は、相対座標で表現された障害物の位置を用いて障害物の移動経路を直接推定することはできない。このため、障害物推定部162は、障害物の相対座標を絶対座標に変換する。
 具体的には、障害物推定部162は、式(4)により求めた車体スリップ角θSAnのゲインKSAを算出する。障害物推定部162は、車体スリップ角のゲインKSAを用いて、以下の式(5)により、障害物の相対座標を絶対座標に変換する。式(5)に用いられる変数のリストを表2に示す。
Figure JPOXMLDOC01-appb-T000006
Figure JPOXMLDOC01-appb-M000007
 図3の例では、障害物が直線B上を一定速度で移動中であると仮定している。障害物推定部162は、変換した絶対座標を用いて、障害物の移動方向及び移動速度を推定する。
 位置測定部11による前回測定時の障害物の位置と、今回測定時の障害物の位置とをそれぞれ図3に示す。障害物推定部162は、式(6)~式(8)に示すように、位置測定部11が測定した前回及び今回の障害物の位置を用いることにより、障害物の移動速度のX方向成分及びY方向成分を推定する。式(6)~(8)に用いられる変数のリストを表3に示す。
Figure JPOXMLDOC01-appb-T000008
 位置測定部11による測定の時間間隔Δtは、以下の式(6)により表される。
Figure JPOXMLDOC01-appb-M000009
 障害物推定部162は、以下の式(7)により前回測定時の障害物の絶対座標(Xtn-1,Ytn-1)を求める。
Figure JPOXMLDOC01-appb-M000010
 障害物推定部162は、以下の式(8)により障害物の移動速度のX方向成分VtX及びY方向成分VtYを推定する。
Figure JPOXMLDOC01-appb-M000011
[自車両の旋回軌道の推定]
 旋回軌道推定部163は、自車両の旋回軌道を推定する。旋回軌道推定部163は、ヨーレート測定部13が測定したヨーレートwと、速度特定部14が特定した自車両の速度Vとに基づいて自車両の旋回軌道を推定する。旋回軌道推定部163は、自車両の旋回軌道を、自車両の旋回中心を円弧の中心とする円弧軌道と仮定する。旋回軌道推定部163は、図2の破線に示すように自車両の後軸中心を円弧上の点としてもよく、自車両の前面中心を円弧上の点としてもよい。この円弧の半径R(以下、旋回半径という)は、ヨーレートw及び自車両の速度Vを用いて、以下の式(9)で表される。絶対座標系では、この円弧の中心は、(R,0)と表現される。
Figure JPOXMLDOC01-appb-M000012
[ヨーレートの先読み]
 なお、旋回軌道推定部163は、交差点の右左折等において運転者が徐々にステアリングを切り増ししていく場合、精度の良い旋回軌道を推定するのに時間がかかることがある。そこで、旋回軌道推定部163は、式(10)に示すように、ヨーレートの立ち上がりにおいてその後のヨーレートwFltを先読みしてもよい。式(10)中、whnは、今回測定時のヨーレートであり、whn-1は、前回測定時のヨ-レートである。Kは、先読みのための所定の定数である。
Figure JPOXMLDOC01-appb-M000013
 旋回軌道推定部163は、式(11)に示すように、先読みしたヨーレートwFltを用いて自車両の旋回半径R0Fltを推定する。
Figure JPOXMLDOC01-appb-M000014
 このような構成により、旋回軌道推定部163は、運転者が徐々にステアリングを切り増ししていく場合に、ステアリングの切り増しが完了する前の段階で旋回半径を精度よく推定することができる。
[移動経路と旋回軌道の交点の推定]
 交点推定部164は、障害物推定部162が推定した障害物の移動経路と、旋回軌道推定部163が推定した自車両の旋回軌道とに基づいて、移動経路及び旋回軌道の交点を推定する。図4は、自車両の旋回軌道と障害物の軌道との交点の算出方法を示す図である。障害物推定部162が推定した障害物の移動経路は、直線L:aX+bY+c=0で表される。旋回軌道推定部163が推定した自車両の旋回軌道の円を破線で示す。
 図4に示すように、自車両の旋回軌道と、障害物の軌道とは交点1及び交点2を有する。交点推定部164は、障害物の移動経路と自車両の旋回軌道との交点として、より早く交わる交点1を選択する。
 衝突判定指標算出部165は、自車両と障害物との衝突を判定するための静的衝突判定指標及び動的衝突判定指標を算出する。まず、衝突判定指標算出部165による静的衝突判定指標の算出について説明する。
[静的衝突判定指標の算出]
 静的衝突判定指標は、例えば、静的オフセット、静的猶予時間及び静的マイレージである。図5は、衝突判定指標算出部165が算出する静的衝突判定指標を説明するための図である。衝突判定指標算出部165は、自車両を長方形とみなして、この長方形の各頂点について静的衝突判定指標を算出する。図5の位置a1は、自車両の頂点の一つを示す。位置Cは、自車両の旋回軌道の中心を示し、位置b1は、障害物の位置を示す。自車両の頂点a1の旋回軌道Aを破線で示す。
 静的オフセットDoffsetSは、旋回軌道Aを延長することにより形成される円内に障害物が進入した進入量を示す値である。静的オフセットDoffsetSは、障害物が円の外側にある場合には負の値をとり、障害物が円の内側にある場合には、正の値をとる。図5に示すように、静的オフセットDoffsetSの絶対値は、障害物の位置b1から旋回軌道Aまでの最短距離である。
 θapexは、自車両の頂点a1から旋回中心Cまで延びる直線と、Y軸とのなす角である。θtsは、障害物の位置b1から旋回中心Cまで延びる直線と、Y軸とのなす角である。静的マイレージDmileageSは、θtsからθapexを差し引いた角度に対応する旋回軌道A上の円弧の長さである。衝突判定指標算出部165は、以下の式(12)~式(18)により、静的衝突判定指標を算出する。式(12)~式(18)に用いられる変数のリストを表4に示す。
Figure JPOXMLDOC01-appb-T000015
 衝突判定指標算出部165は、自車両の頂点の絶対座標を式(12)により算出する。
Figure JPOXMLDOC01-appb-M000016
 衝突判定指標算出部165は、自車両の各頂点の旋回半径Rapexを以下の式(13)により算出する。
Figure JPOXMLDOC01-appb-M000017
 衝突判定指標算出部165は、図5に示す自車両の頂点a1から旋回中心Cまで延びる直線と、Y軸とのなす角θapexを以下の式(14)により算出する。
Figure JPOXMLDOC01-appb-M000018
 衝突判定指標算出部165は、図5に示す障害物の位置b1から旋回中心Cまで延びる直線と、Y軸とのなす角θtsを以下の式(15)により算出する。
Figure JPOXMLDOC01-appb-M000019
 衝突判定指標算出部165は、静的オフセットDoffsetSを以下の式(16)により算出する。
Figure JPOXMLDOC01-appb-M000020
 衝突判定指標算出部165は、静的猶予時間T1Sを以下の式(17)により算出する。
Figure JPOXMLDOC01-appb-M000021
 衝突判定指標算出部165は、静的マイレージDmileageSを以下の式(18)により算出する。
Figure JPOXMLDOC01-appb-M000022
[自車両が交点に到達したときの障害物の位置の推定]
 衝突判定指標算出部165は、以下の式(19)~(29)により、自車両の旋回軌道と障害物の移動経路との交点に自車両が到達したときの障害物の絶対座標を推定する。式(19)~(29)に用いられる変数のリストを表5に示す。
Figure JPOXMLDOC01-appb-T000023
 旋回軌道の中心の絶対座標(XRc,YRc)は、以下の式(19)により表される。
Figure JPOXMLDOC01-appb-M000024
 相対座標の原点の絶対座標(X,Y)は以下の式(20)により表される。
Figure JPOXMLDOC01-appb-M000025
 障害物の絶対速度の単位ベクトルのX,Y成分(VeX,VeY)は、以下の式(21)により表される。
Figure JPOXMLDOC01-appb-M000026
 衝突判定指標算出部165は、障害物の移動経路を示す直線L:aX+bY+c=0の各係数a,b,cを以下の式(22)により求める。
Figure JPOXMLDOC01-appb-M000027
 衝突判定指標算出部165は、旋回中心から直線Lへ引いた垂線の長さk(図4参照)を以下の式(23)により求める。
Figure JPOXMLDOC01-appb-M000028
 旋回中心から直線Lへ引いた垂線の足の絶対座標(X,Y)は、垂線の長さkを用いて、以下の式(24)により表される。
Figure JPOXMLDOC01-appb-M000029
 衝突判定指標算出部165は、旋回中心から直線Lへ引いた垂線の足から円弧と直線Lの交点1までの距離S(図4参照)を以下の式(25)により求める。
Figure JPOXMLDOC01-appb-M000030
 衝突判定指標算出部165は、式(26)に示す(Xis,Yis)を用いて、自車両の頂点a1から交点1までの旋回中心における中心角θReach(図4参照)を以下の式(27)により求める。
Figure JPOXMLDOC01-appb-M000031
Figure JPOXMLDOC01-appb-M000032
 衝突判定指標算出部165は、障害物が交点1において自車両の頂点と接触するまでの時間TReachを以下の式(28)により求める。
Figure JPOXMLDOC01-appb-M000033
 衝突判定指標算出部165は、自車両が交点1に到達したときの障害物の絶対座標(XtF,YtF)を以下の式(29)により推定する。
Figure JPOXMLDOC01-appb-M000034
[動的衝突判定指標の算出]
 衝突判定指標算出部165は、交点推定部164が推定した交点に自車両が到達したときの自車両及び障害物の位置関係に基づいて、自車両と障害物との衝突を判定するための動的衝突判定指標を算出する。動的衝突判定指標は、例えば、旋回軌道推定部163が推定した旋回軌道を延長することにより形成される円に障害物が進入した進入量を示す動的オフセット、及び障害物が自車両と衝突するまでの時間を示す動的猶予時間を含む。
 図6(a)、(b)及び図7は、動的衝突判定指標を説明するための図である。図6(a)に示す位置a1は、位置測定部11による今回測定時の自車両の頂点の位置を示す。位置b1は、今回測定時の障害物の位置を示し、位置b0は、位置測定部11による前回測定時の障害物の位置を示す。
 図6(b)は、図6(a)の状態からTreach秒が経過した状態を予想した予想図を示す。Treach秒が経過した時の自車両の頂点a2は、自車両の旋回軌道と、障害物の移動経路との交点に到達している。このとき、障害物は、移動経路B上の位置b2に到達している。
 図7は、図6(b)と同じ時点における動的衝突判定指標の例を示す。θapexは、図5と同様である。θtDは、Treach秒経過後の障害物の位置b2から旋回中心Cまで延びる直線と、Y軸とのなす角である。
 動的オフセットDoffsetDは、旋回軌道Aを延長することにより形成される円内に障害物が進入した進入量を示す値である。動的オフセットDoffsetDは、障害物が円の外側にある場合には負の値をとり、障害物が円の内側にある場合には、正の値をとる。図7に示すように、動的オフセットDoffsetDの絶対値は、障害物から旋回軌道Aまでの最短距離である。動的マイレージDmileageDは、θtDからθapexを差し引いた角度に対応する旋回軌道A上の円弧の長さである。
 衝突判定指標算出部165は、以下の式(30)~(33)により、動的衝突判定指標を算出する。式(30)~式(33)に用いられる変数を表6に示す。
Figure JPOXMLDOC01-appb-T000035
 衝突判定指標算出部165は、以下の式(30)により図7のθtDを算出する。
Figure JPOXMLDOC01-appb-M000036
 衝突判定指標算出部165は、以下の式(31)により動的オフセットDoffsetDを算出する。
Figure JPOXMLDOC01-appb-M000037
 衝突判定指標算出部165は、以下の式(32)により動的猶予時間T1Dを算出する。
Figure JPOXMLDOC01-appb-M000038
 衝突判定指標算出部165は、以下の式(33)により動的マイレージDmileageDを算出する。
Figure JPOXMLDOC01-appb-M000039
 衝突判定部166は、自車両が障害物に衝突するか否かを判定する。より詳しくは、衝突判定部166は、障害物推定部162が推定した障害物の移動経路と、旋回軌道推定部163が推定した自車両の旋回軌道とに基づいて、自車両及び障害物が衝突するか否かを判定する。
[静的衝突判定指標を用いた判定]
 衝突判定部166は、衝突判定指標算出部165が算出した静的衝突判定指標に基づいて、自車両と障害物とが衝突するか否かを判定する。衝突判定部166は、自車両のいずれかの頂点において静的オフセットがオフセット最小閾値以上であってオフセット最大閾値以下であり、かつ、静的猶予時間が時間閾値よりも小さい場合、自車両及び障害物が衝突すると判定する。
 一方、衝突判定部166は、自車両の全ての頂点において、静的オフセットが最小閾値未満であるか、静的オフセットが最大閾値より大きいか、あるいは、静的猶予時間が時間閾値以上である場合、自車両及び障害物が衝突しないと判定する。オフセット最小閾値及びオフセット最大閾値は、衝突の危険性の有無を判定するための値である。オフセット最小閾値は、例えば、マイナス数メートルであり、自車両の頂点ごとに異なる値が割り当てられてもよい。
 オフセット最大閾値は、例えば、数メートルであり、自車両の頂点ごとに異なる値が割り当てられてもよい。時間閾値は、例えば、自車両の運転者の回避操作又は自車両の自動ブレーキ等により、衝突を回避するために要すると想定される値である。
[動的衝突判定指標を用いた判定]
 衝突判定部166は、自車両の車速、自車両の旋回軌道、及び位置測定部11による今回測定時の障害物の位置に基づいて、静的衝突判定指標による衝突の判定を行う。しかしながら、衝突判定部166は、障害物が自車両からみて横方向から接近している場合には、静的衝突判定指標による衝突の判定において衝突直前まで衝突の危険性の有無の判定ができないことがある。
 そこで、衝突判定部166は、障害物が移動している場合には、衝突判定指標算出部165が算出した動的衝突判定指標に基づいて、自車両と障害物とが衝突するか否かを判定する。まず、衝突判定部166は、障害物推定部162が推定した障害物の移動速度が所定値以上であるか否かを判定する。所定値は、例えば、障害物が移動しているか否かを判定するための値である。
 衝突判定部166は、障害物推定部162が推定した障害物の移動速度が所定値以上である場合に、動的衝突判定指標に基づく判定を行う。衝突判定部166は、自車両のいずれかの頂点において上記式(31)により算出された動的オフセットがオフセット最小閾値以上であってオフセット最大閾値以下であり、かつ、上記式(32)により算出された動的猶予時間が時間閾値よりも小さい場合、自車両及び障害物が衝突すると判定する。一方、衝突判定部166は、自車両の全ての頂点において、動的オフセットがオフセット最小閾値未満であるか、動的オフセットがオフセット最大閾値より大きいか、あるいは、動的猶予時間が時間閾値以上である場合に、自車両及び障害物が衝突しないと判定する。
 自車両の旋回軌道と障害物の移動経路とが交点を有する場合であっても、自車両が交点に到達したときに障害物が交点から離れていれば、自車両及び障害物の衝突は発生しない。衝突判定部166は、自車両が交点に到達したときの障害物の位置を特定するので、自車両及び障害物が衝突するか否かの判定の精度を向上させることができる。また、衝突判定部166は、動的オフセットと、動的猶予時間の値とが適切であるか否かを判定するので、自車両からみた障害物の横方向の位置や衝突までの時間的な余裕を考慮して、衝突の危険性の有無を判定することができる。
[2つの衝突判定指標に基づく判定]
 衝突判定部166は、静的衝突判定指標に基づく判定と、動的衝突判定指標に基づく判定との少なくともいずれか一方において自車両及び障害物が衝突すると判定した場合に、自車両及び障害物が衝突するという判定結果を衝突被害軽減部167に出力する。
[衝突被害の予防又は軽減]
 衝突被害軽減部167は、自車両が右左折すると右左折判定部161が判定した後に自車両と障害物とが衝突すると衝突判定部166が判定した場合に、自車両と障害物との衝突被害を予防又は軽減する処理を実行する。例えば、衝突被害軽減部167は、自車両と障害物とが衝突すると衝突判定部166が判定した場合に、障害物の接近を運転者に通知するための警報をスピーカ(不図示)に出力させる。衝突被害軽減部167は、自車両と障害物とが衝突すると衝突判定部166が判定した場合に、自動ブレーキ装置又は自動操舵装置(不図示)により自車両と障害物との衝突を自動的に回避してもよい。
[衝突被害軽減の処理手順]
 図8は、衝突被害軽減装置1により衝突被害軽減の処理手順を示すフローチャートである。この処理手順は、例えば、自車両の走行中に開始する。
 まず、右左折判定部161は、自車両の速度や操舵角等の状態を示す自車両データを作成する(S1)。右左折判定部161は、生成した自車両データに基づいて自車両が右左折するか否かを判定する(S2)。衝突判定指標算出部165は、自車両が右左折すると右左折判定部161が判定した場合に(S2のYES)、自車両近傍の複数の障害物1~障害物Nのうち、障害物1のデータを作成する(S3-1)。衝突判定部166は、自車両が障害物1と衝突するか否かを判定する(S4-1)。
 衝突被害軽減部167は、自車両が障害物1と衝突すると衝突判定部166が判定した場合に(S4-1のYES)、自車両と障害物との衝突被害を軽減する処理を実行し(S5)、処理を終了する。
 衝突判定指標算出部165及び衝突判定部166は、自車両が障害物1と衝突しないと衝突判定部166が判定した場合に(S4-1のNO)、障害物2~障害物Nのうち、障害物2についてS3-1及びS4-1と同様の処理を繰り返す(S3-2、S4-2)。衝突判定指標算出部165及び衝突判定部166は、次以降の障害物3~障害物NについてもS3-1及びS4-1と同様の処理を繰り返す(S3-3、S4-3、・・・、S3-N、S4-N)。衝突被害軽減部167は、自車両が複数の障害物2~障害物Nのいずれかと衝突すると衝突判定部166が判定した場合に、自車両と障害物との衝突被害を軽減する処理を実行し(S5)、処理を終了する。
 衝突被害軽減部167は、S4-Nの判定において、自車両が障害物2~障害物Nのいずれとも衝突しないと衝突判定部166が判定した場合に(S4-NのNO)、自車両と障害物との衝突被害を軽減する処理を実行することなく、処理を終了する。
 図9は、図8の障害物1のデータ作成処理(S3-1)の詳細な手順を説明するためのフローチャートである。障害物2~障害物Nのデータ作成処理(S3-2、S3-3、・・・、S3-N)についても、障害物1のデータ作成処理と同様である。
 まず、障害物推定部162は、障害物1の移動経路を推定する(S11)。次に、旋回軌道推定部163は、自車両の旋回軌道を推定する(S12)。交点推定部164は、障害物推定部162が推定した障害物の移動経路と、旋回軌道推定部163が推定した自車両の旋回軌道との交点を推定する(S13)。衝突判定指標算出部165は、交点推定部164が推定した交点に自車両が到達したときの障害物の位置を求める。衝突判定指標算出部165は、自車両が交点に到達したときの自車両及び障害物の位置関係に基づいて、動的衝突判定指標を算出する(S14)。
[本実施形態の衝突被害軽減装置1による効果]
 本実施形態によれば、衝突判定部166は、障害物推定部162が推定した障害物の移動経路と、旋回軌道推定部163が推定した旋回軌道とに基づいて、自車両及び障害物が衝突するか否かを判定する。このようにすることで、衝突被害軽減装置1は、推定した障害物の移動経路を用いて自車両と障害物とが衝突するか否かを判定しているため、障害物が移動している場合であっても自車両と障害物とが衝突する可能性を早期に判定することができる。
 以上、本開示を実施の形態を用いて説明したが、本開示の技術的範囲は上記実施の形態に記載の範囲には限定されず、その要旨の範囲内で種々の変形及び変更が可能である。例えば、装置の全部又は一部は、任意の単位で機能的又は物理的に分散・統合して構成することができる。また、複数の実施の形態の任意の組み合わせによって生じる新たな実施の形態も、本開示の実施の形態に含まれる。組み合わせによって生じる新たな実施の形態の効果は、もとの実施の形態の効果を併せ持つ。
 本出願は、2019年7月22日付で出願された日本国特許出願(特願2019-134274)に基づくものであり、その内容はここに参照として取り込まれる。
 本開示の衝突被害軽減装置は、障害物が移動している状況において、自車両と障害物とが衝突する可能性を早期に判定することができる点において有用である。
1 衝突被害軽減装置
11 位置測定部
12 操舵角測定部
13 ヨーレート測定部
14 速度特定部
15 記憶部
16 制御部
161 右左折判定部
162 障害物推定部
163 旋回軌道推定部
164 交点推定部
165 衝突判定指標算出部
166 衝突判定部
167 衝突被害軽減部

Claims (4)

  1.  右左折時の衝突被害を軽減する衝突被害軽減装置であって、
     自車両の状態に基づいて前記自車両が右左折するか否かを判定する右左折判定部と、
     前記自車両近傍の障害物の移動経路を推定する障害物推定部と、
     前記自車両の速度を特定する速度特定部と、
     前記自車両のヨーレートを測定するヨーレート測定部と、
     前記ヨーレート測定部が測定したヨーレート及び前記速度特定部が特定した前記自車両の速度に基づいて前記自車両の旋回軌道を推定する旋回軌道推定部と、
     前記障害物推定部が推定した前記障害物の移動経路と、前記旋回軌道推定部が推定した前記自車両の旋回軌道とに基づいて、前記自車両及び前記障害物が衝突するか否かを判定する衝突判定部と、
     前記自車両が右左折すると前記右左折判定部が判定した後に前記自車両と前記障害物とが衝突すると判定した場合、前記自車両と前記障害物との衝突被害を軽減する処理を実行する衝突被害軽減部と、
     を有する、衝突被害軽減装置。
  2.  前記障害物推定部が推定した前記障害物の移動経路及び前記旋回軌道推定部が推定した前記自車両の旋回軌道に基づいて前記障害物の移動経路と前記自車両の旋回軌道との交点を推定する交点推定部と、
     前記交点推定部が推定した前記交点に前記自車両が到達したときの前記自車両及び前記障害物の位置関係に基づいて前記自車両と前記障害物との衝突を判定するための動的衝突判定指標を算出する衝突判定指標算出部と、
     をさらに有し、
     前記衝突判定部は、前記衝突判定指標算出部が算出した前記動的衝突判定指標に基づいて前記自車両と前記障害物とが衝突するか否かを判定する、
     請求項1に記載の衝突被害軽減装置。
  3.  前記旋回軌道推定部は、前記自車両の旋回軌道を、前記自車両の旋回中心を円弧の中心とし、前記自車両の前面中心を円弧上の点とした円弧軌道と仮定する、
     請求項2に記載の衝突被害軽減装置。
  4.  前記動的衝突判定指標は、前記旋回軌道推定部が推定した前記旋回軌道を延長することにより形成される円に前記障害物が進入した進入量を示す動的オフセット、及び前記障害物が前記自車両と衝突するまでの時間を示す動的猶予時間を含み、
     前記衝突判定部は、前記動的オフセットが最小閾値以上であって最大閾値以下であり、かつ、前記動的猶予時間が時間閾値よりも小さい場合、前記自車両と前記障害物とが衝突すると判定する、
     請求項3に記載の衝突被害軽減装置。
PCT/JP2020/027445 2019-07-22 2020-07-15 衝突被害軽減装置 WO2021015065A1 (ja)

Applications Claiming Priority (2)

Application Number Priority Date Filing Date Title
JP2019-134274 2019-07-22
JP2019134274A JP2021018622A (ja) 2019-07-22 2019-07-22 衝突被害軽減装置

Publications (1)

Publication Number Publication Date
WO2021015065A1 true WO2021015065A1 (ja) 2021-01-28

Family

ID=74193480

Family Applications (1)

Application Number Title Priority Date Filing Date
PCT/JP2020/027445 WO2021015065A1 (ja) 2019-07-22 2020-07-15 衝突被害軽減装置

Country Status (2)

Country Link
JP (1) JP2021018622A (ja)
WO (1) WO2021015065A1 (ja)

Citations (4)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP2015170233A (ja) * 2014-03-10 2015-09-28 日立オートモティブシステムズ株式会社 複数の移動体との衝突回避システム
JP2017120473A (ja) * 2015-12-28 2017-07-06 三菱電機株式会社 運転支援装置
JP2018156290A (ja) * 2017-03-16 2018-10-04 トヨタ自動車株式会社 衝突回避装置
JP2018156253A (ja) * 2017-03-16 2018-10-04 トヨタ自動車株式会社 衝突回避装置

Patent Citations (4)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP2015170233A (ja) * 2014-03-10 2015-09-28 日立オートモティブシステムズ株式会社 複数の移動体との衝突回避システム
JP2017120473A (ja) * 2015-12-28 2017-07-06 三菱電機株式会社 運転支援装置
JP2018156290A (ja) * 2017-03-16 2018-10-04 トヨタ自動車株式会社 衝突回避装置
JP2018156253A (ja) * 2017-03-16 2018-10-04 トヨタ自動車株式会社 衝突回避装置

Also Published As

Publication number Publication date
JP2021018622A (ja) 2021-02-15

Similar Documents

Publication Publication Date Title
US8483944B2 (en) Collision determination device
JP6403221B2 (ja) 制動作動基準の決定方法及び車両用非常制動システム
US10569769B2 (en) Vehicle control device
JP6451857B2 (ja) 走行制御装置の制御方法および走行制御装置
US11338801B2 (en) Collision avoidance device
US20110307175A1 (en) Method and system for collision assessment for vehicles
JP6809531B2 (ja) 車両判定方法、走行経路補正方法、車両判定装置、及び走行経路補正装置
US20190346273A1 (en) Host vehicle position estimation device
US8847792B2 (en) Object detection apparatus and object detection program
RU2626424C1 (ru) Устройство оценки позиции и угла пространственной ориентации транспортного средства и способ оценки позиции и угла пространственной ориентации транспортного средства
JP5120140B2 (ja) 衝突推定装置及び衝突推定プログラム
JP2007317018A (ja) 衝突判定装置
JP2004026143A (ja) 自動速度制御衝突回避システムにおける目標車両識別方法及び装置
JP2018101345A (ja) 運転支援装置
JP2008195293A (ja) 衝突予測装置
JP2009059082A (ja) 車両用物体検知装置
JP2007004711A (ja) 車両用進路推定装置
JP7474352B2 (ja) 車両制御装置、および、車両制御方法
JP2016200443A (ja) 障害物検出装置
JP2002175599A (ja) 先行車または物標の車線位置推定装置
JP2004066912A (ja) 車両用障害物検知装置
WO2021015065A1 (ja) 衝突被害軽減装置
JP4976998B2 (ja) 車両の走行安全装置
CN110979320B (zh) 具有不规则行径的行人紧急避让控制方法
JP6256795B2 (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: 20843229

Country of ref document: EP

Kind code of ref document: A1

NENP Non-entry into the national phase

Ref country code: DE

122 Ep: pct application non-entry in european phase

Ref document number: 20843229

Country of ref document: EP

Kind code of ref document: A1