WO2020170301A1 - 情報処理装置、プログラム及び情報処理方法 - Google Patents

情報処理装置、プログラム及び情報処理方法 Download PDF

Info

Publication number
WO2020170301A1
WO2020170301A1 PCT/JP2019/005828 JP2019005828W WO2020170301A1 WO 2020170301 A1 WO2020170301 A1 WO 2020170301A1 JP 2019005828 W JP2019005828 W JP 2019005828W WO 2020170301 A1 WO2020170301 A1 WO 2020170301A1
Authority
WO
WIPO (PCT)
Prior art keywords
time
vehicle
prediction
braking
speed
Prior art date
Application number
PCT/JP2019/005828
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 三菱電機株式会社
Priority to JP2019540123A priority Critical patent/JP6704531B1/ja
Priority to PCT/JP2019/005828 priority patent/WO2020170301A1/ja
Priority to DE112019006588.2T priority patent/DE112019006588T5/de
Priority to CN201980091744.XA priority patent/CN113424242B/zh
Publication of WO2020170301A1 publication Critical patent/WO2020170301A1/ja
Priority to US17/400,669 priority patent/US20210370891A1/en

Links

Images

Classifications

    • BPERFORMING OPERATIONS; TRANSPORTING
    • B60VEHICLES IN GENERAL
    • B60TVEHICLE BRAKE CONTROL SYSTEMS OR PARTS THEREOF; BRAKE CONTROL SYSTEMS OR PARTS THEREOF, IN GENERAL; ARRANGEMENT OF BRAKING ELEMENTS ON VEHICLES IN GENERAL; PORTABLE DEVICES FOR PREVENTING UNWANTED MOVEMENT OF VEHICLES; VEHICLE MODIFICATIONS TO FACILITATE COOLING OF BRAKES
    • B60T13/00Transmitting braking action from initiating means to ultimate brake actuator with power assistance or drive; Brake systems incorporating such transmitting means, e.g. air-pressure brake systems
    • B60T13/10Transmitting braking action from initiating means to ultimate brake actuator with power assistance or drive; Brake systems incorporating such transmitting means, e.g. air-pressure brake systems with fluid assistance, drive, or release
    • B60T13/66Electrical control in fluid-pressure brake systems
    • B60T13/662Electrical control in fluid-pressure brake systems characterised by specified functions of the control system components
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B60VEHICLES IN GENERAL
    • B60TVEHICLE BRAKE CONTROL SYSTEMS OR PARTS THEREOF; BRAKE CONTROL SYSTEMS OR PARTS THEREOF, IN GENERAL; ARRANGEMENT OF BRAKING ELEMENTS ON VEHICLES IN GENERAL; PORTABLE DEVICES FOR PREVENTING UNWANTED MOVEMENT OF VEHICLES; VEHICLE MODIFICATIONS TO FACILITATE COOLING OF BRAKES
    • B60T7/00Brake-action initiating means
    • B60T7/12Brake-action initiating means for automatic initiation; for initiation not subject to will of driver or passenger
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B60VEHICLES IN GENERAL
    • B60TVEHICLE BRAKE CONTROL SYSTEMS OR PARTS THEREOF; BRAKE CONTROL SYSTEMS OR PARTS THEREOF, IN GENERAL; ARRANGEMENT OF BRAKING ELEMENTS ON VEHICLES IN GENERAL; PORTABLE DEVICES FOR PREVENTING UNWANTED MOVEMENT OF VEHICLES; VEHICLE MODIFICATIONS TO FACILITATE COOLING OF BRAKES
    • B60T17/00Component parts, details, or accessories of power brake systems not covered by groups B60T8/00, B60T13/00 or B60T15/00, or presenting other characteristic features
    • B60T17/18Safety devices; Monitoring
    • B60T17/22Devices for monitoring or checking brake systems; Signal devices
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B60VEHICLES IN GENERAL
    • B60TVEHICLE BRAKE CONTROL SYSTEMS OR PARTS THEREOF; BRAKE CONTROL SYSTEMS OR PARTS THEREOF, IN GENERAL; ARRANGEMENT OF BRAKING ELEMENTS ON VEHICLES IN GENERAL; PORTABLE DEVICES FOR PREVENTING UNWANTED MOVEMENT OF VEHICLES; VEHICLE MODIFICATIONS TO FACILITATE COOLING OF BRAKES
    • B60T7/00Brake-action initiating means
    • B60T7/12Brake-action initiating means for automatic initiation; for initiation not subject to will of driver or passenger
    • B60T7/22Brake-action initiating means for automatic initiation; for initiation not subject to will of driver or passenger initiated by contact of vehicle, e.g. bumper, with an external object, e.g. another vehicle, or by means of contactless obstacle detectors mounted on the vehicle
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B60VEHICLES IN GENERAL
    • B60WCONJOINT CONTROL OF VEHICLE SUB-UNITS OF DIFFERENT TYPE OR DIFFERENT FUNCTION; CONTROL SYSTEMS SPECIALLY ADAPTED FOR HYBRID VEHICLES; ROAD VEHICLE DRIVE CONTROL SYSTEMS FOR PURPOSES NOT RELATED TO THE CONTROL OF A PARTICULAR SUB-UNIT
    • 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
    • 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
    • B60W30/0956Predicting travel path or likelihood of collision the prediction being responsive to traffic or environmental parameters
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B60VEHICLES IN GENERAL
    • B60WCONJOINT CONTROL OF VEHICLE SUB-UNITS OF DIFFERENT TYPE OR DIFFERENT FUNCTION; CONTROL SYSTEMS SPECIALLY ADAPTED FOR HYBRID VEHICLES; ROAD VEHICLE DRIVE CONTROL SYSTEMS FOR PURPOSES NOT RELATED TO THE CONTROL OF A PARTICULAR SUB-UNIT
    • B60W40/00Estimation or calculation of non-directly measurable driving parameters for road vehicle drive control systems not related to the control of a particular sub unit, e.g. by using mathematical models
    • B60W40/02Estimation or calculation of non-directly measurable driving parameters for road vehicle drive control systems not related to the control of a particular sub unit, e.g. by using mathematical models related to ambient conditions
    • B60W40/06Road conditions
    • B60W40/068Road friction coefficient
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B60VEHICLES IN GENERAL
    • B60WCONJOINT CONTROL OF VEHICLE SUB-UNITS OF DIFFERENT TYPE OR DIFFERENT FUNCTION; CONTROL SYSTEMS SPECIALLY ADAPTED FOR HYBRID VEHICLES; ROAD VEHICLE DRIVE CONTROL SYSTEMS FOR PURPOSES NOT RELATED TO THE CONTROL OF A PARTICULAR SUB-UNIT
    • B60W40/00Estimation or calculation of non-directly measurable driving parameters for road vehicle drive control systems not related to the control of a particular sub unit, e.g. by using mathematical models
    • B60W40/08Estimation or calculation of non-directly measurable driving parameters for road vehicle drive control systems not related to the control of a particular sub unit, e.g. by using mathematical models related to drivers or passengers
    • 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
    • B60W50/00Details 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/08Interaction between the driver and the control system
    • B60W50/14Means for informing the driver, warning the driver or prompting a driver intervention
    • GPHYSICS
    • G08SIGNALLING
    • G08GTRAFFIC CONTROL SYSTEMS
    • G08G1/00Traffic control systems for road vehicles
    • G08G1/16Anti-collision systems
    • G08G1/166Anti-collision systems for active traffic, e.g. moving vehicles, pedestrians, bikes
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B60VEHICLES IN GENERAL
    • B60TVEHICLE BRAKE CONTROL SYSTEMS OR PARTS THEREOF; BRAKE CONTROL SYSTEMS OR PARTS THEREOF, IN GENERAL; ARRANGEMENT OF BRAKING ELEMENTS ON VEHICLES IN GENERAL; PORTABLE DEVICES FOR PREVENTING UNWANTED MOVEMENT OF VEHICLES; VEHICLE MODIFICATIONS TO FACILITATE COOLING OF BRAKES
    • B60T2201/00Particular use of vehicle brake systems; Special systems using also the brakes; Special software modules within the brake system controller
    • B60T2201/02Active or adaptive cruise control system; Distance control
    • B60T2201/022Collision avoidance systems
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B60VEHICLES IN GENERAL
    • B60TVEHICLE BRAKE CONTROL SYSTEMS OR PARTS THEREOF; BRAKE CONTROL SYSTEMS OR PARTS THEREOF, IN GENERAL; ARRANGEMENT OF BRAKING ELEMENTS ON VEHICLES IN GENERAL; PORTABLE DEVICES FOR PREVENTING UNWANTED MOVEMENT OF VEHICLES; VEHICLE MODIFICATIONS TO FACILITATE COOLING OF BRAKES
    • B60T2210/00Detection or estimation of road or environment conditions; Detection or estimation of road shapes
    • B60T2210/10Detection or estimation of road conditions
    • B60T2210/12Friction
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B60VEHICLES IN GENERAL
    • B60TVEHICLE BRAKE CONTROL SYSTEMS OR PARTS THEREOF; BRAKE CONTROL SYSTEMS OR PARTS THEREOF, IN GENERAL; ARRANGEMENT OF BRAKING ELEMENTS ON VEHICLES IN GENERAL; PORTABLE DEVICES FOR PREVENTING UNWANTED MOVEMENT OF VEHICLES; VEHICLE MODIFICATIONS TO FACILITATE COOLING OF BRAKES
    • B60T2210/00Detection or estimation of road or environment conditions; Detection or estimation of road shapes
    • B60T2210/30Environment conditions or position therewithin
    • B60T2210/32Vehicle surroundings
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B60VEHICLES IN GENERAL
    • B60TVEHICLE BRAKE CONTROL SYSTEMS OR PARTS THEREOF; BRAKE CONTROL SYSTEMS OR PARTS THEREOF, IN GENERAL; ARRANGEMENT OF BRAKING ELEMENTS ON VEHICLES IN GENERAL; PORTABLE DEVICES FOR PREVENTING UNWANTED MOVEMENT OF VEHICLES; VEHICLE MODIFICATIONS TO FACILITATE COOLING OF BRAKES
    • B60T2220/00Monitoring, detecting driver behaviour; Signalling thereof; Counteracting thereof
    • B60T2220/02Driver type; Driving style; Driver adaptive features
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B60VEHICLES IN GENERAL
    • B60TVEHICLE BRAKE CONTROL SYSTEMS OR PARTS THEREOF; BRAKE CONTROL SYSTEMS OR PARTS THEREOF, IN GENERAL; ARRANGEMENT OF BRAKING ELEMENTS ON VEHICLES IN GENERAL; PORTABLE DEVICES FOR PREVENTING UNWANTED MOVEMENT OF VEHICLES; VEHICLE MODIFICATIONS TO FACILITATE COOLING OF BRAKES
    • B60T2250/00Monitoring, detecting, estimating vehicle conditions
    • B60T2250/04Vehicle reference speed; Vehicle body speed
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B60VEHICLES IN GENERAL
    • B60WCONJOINT CONTROL OF VEHICLE SUB-UNITS OF DIFFERENT TYPE OR DIFFERENT FUNCTION; CONTROL SYSTEMS SPECIALLY ADAPTED FOR HYBRID VEHICLES; ROAD VEHICLE DRIVE CONTROL SYSTEMS FOR PURPOSES NOT RELATED TO THE CONTROL OF A PARTICULAR SUB-UNIT
    • B60W50/00Details 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/0001Details of the control system
    • B60W2050/0019Control system elements or transfer functions
    • B60W2050/0028Mathematical models, e.g. for simulation
    • B60W2050/0031Mathematical model of the vehicle
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B60VEHICLES IN GENERAL
    • B60WCONJOINT CONTROL OF VEHICLE SUB-UNITS OF DIFFERENT TYPE OR DIFFERENT FUNCTION; CONTROL SYSTEMS SPECIALLY ADAPTED FOR HYBRID VEHICLES; ROAD VEHICLE DRIVE CONTROL SYSTEMS FOR PURPOSES NOT RELATED TO THE CONTROL OF A PARTICULAR SUB-UNIT
    • B60W2420/00Indexing codes relating to the type of sensors based on the principle of their operation
    • B60W2420/40Photo, light or radio wave sensitive means, e.g. infrared sensors
    • B60W2420/403Image sensing, e.g. optical camera
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B60VEHICLES IN GENERAL
    • B60WCONJOINT CONTROL OF VEHICLE SUB-UNITS OF DIFFERENT TYPE OR DIFFERENT FUNCTION; CONTROL SYSTEMS SPECIALLY ADAPTED FOR HYBRID VEHICLES; ROAD VEHICLE DRIVE CONTROL SYSTEMS FOR PURPOSES NOT RELATED TO THE CONTROL OF A PARTICULAR SUB-UNIT
    • B60W2520/00Input parameters relating to overall vehicle dynamics
    • B60W2520/10Longitudinal speed
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B60VEHICLES IN GENERAL
    • B60WCONJOINT CONTROL OF VEHICLE SUB-UNITS OF DIFFERENT TYPE OR DIFFERENT FUNCTION; CONTROL SYSTEMS SPECIALLY ADAPTED FOR HYBRID VEHICLES; ROAD VEHICLE DRIVE CONTROL SYSTEMS FOR PURPOSES NOT RELATED TO THE CONTROL OF A PARTICULAR SUB-UNIT
    • B60W2540/00Input parameters relating to occupants
    • B60W2540/10Accelerator pedal position
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B60VEHICLES IN GENERAL
    • B60WCONJOINT CONTROL OF VEHICLE SUB-UNITS OF DIFFERENT TYPE OR DIFFERENT FUNCTION; CONTROL SYSTEMS SPECIALLY ADAPTED FOR HYBRID VEHICLES; ROAD VEHICLE DRIVE CONTROL SYSTEMS FOR PURPOSES NOT RELATED TO THE CONTROL OF A PARTICULAR SUB-UNIT
    • B60W2540/00Input parameters relating to occupants
    • B60W2540/30Driving style
    • 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
    • B60W2555/00Input parameters relating to exterior conditions, not covered by groups B60W2552/00, B60W2554/00
    • B60W2555/20Ambient conditions, e.g. wind or rain
    • 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
    • B60W2555/00Input parameters relating to exterior conditions, not covered by groups B60W2552/00, B60W2554/00
    • B60W2555/60Traffic rules, e.g. speed limits or right of way

Definitions

  • the present invention relates to an information processing device, a program, and an information processing method.
  • the left/right turn assist device described in Patent Document 1 detects a target vehicle traveling in the rear side by a radar installed in the rear side of the vehicle being driven by the driver, and predicts the vehicle. The intersection of the track that is generated and the expected track of the detected target vehicle is identified. Then, the left-right turn assistance device, when the expected time when the vehicle arrives at the specified intersection point is later than the expected time when the target vehicle arrives, by outputting a danger signal, when the vehicle turns left or right or changes lanes, Informs the driver of the danger of a collision with a detected target vehicle traveling to the rear.
  • the conventional device specifies the assumed trajectory of the vehicle and the detected target vehicle, so it is possible to immediately find the intersection that means a collision.
  • An information processing apparatus is an information processing apparatus mounted on a vehicle, the braking time calculating unit calculating a braking time that is a time required for the vehicle to stop due to braking, and the vehicle.
  • the driver considers a response to changes in the environment around the vehicle and detects a reaction time which is a time required to execute the response, the braking time and the reaction time.
  • a prediction time specifying unit that specifies a prediction time that is a range of time for predicting a collision between the vehicle and a peripheral vehicle that is a vehicle around the vehicle in the future so that the longer the time obtained by adding
  • a position/speed prediction unit that performs prediction of the position and speed of the vehicle and the position and speed of the surrounding vehicles at a time included in the prediction time, and the vehicle and the surroundings based on the result of the prediction.
  • a collision prediction unit that predicts whether or not the vehicle will collide.
  • a program includes a computer mounted in a vehicle, a braking time calculation unit that calculates a braking time that is a time required for the vehicle to stop due to braking, and a driver of the vehicle, Considering the response to changes in the surrounding environment, a reaction time detection unit that detects a reaction time that is the time required to execute the response, the longer the time obtained by adding the braking time and the reaction time, the longer A predicted time specifying unit that specifies a predicted time that is a range of times for predicting a collision between the vehicle and a peripheral vehicle that is a vehicle in the vicinity of the vehicle in the future so as to be longer, and a time included in the predicted time.
  • a position/velocity prediction unit that performs prediction of the position and speed of the vehicle and the position and speed of the surrounding vehicle, and whether or not the vehicle and the surrounding vehicle collide from the result of the prediction. It is characterized by functioning as a collision prediction unit for predicting.
  • An information processing method calculates a braking time that is a time required for a vehicle to stop due to braking, and allows a driver of the vehicle to respond to changes in the environment around the vehicle.
  • the reaction time which is the time required to execute the countermeasure, is detected, and the longer the time obtained by adding the braking time and the reaction time is, the longer the time becomes.
  • a predicted time that is a range of time for predicting a collision with a peripheral vehicle that is a peripheral vehicle is specified, and at a time included in the predicted time, the position and speed of the vehicle, and the position and speed of the peripheral vehicle, Is executed and whether or not the vehicle and the surrounding vehicle collide with each other is predicted from the result of the prediction.
  • FIG. 1 is a block diagram schematically showing a configuration of a collision prediction device 100 which is an information processing device according to an embodiment.
  • the collision prediction device 100 includes a braking acceleration setting storage unit 101, a braking time calculation unit 102, a reaction time detection unit 103, a reaction time setting storage unit 104, a predicted time specifying unit 105, and a surrounding vehicle information storage unit 106.
  • a position/speed prediction unit 107 and a collision prediction unit 108 are provided.
  • the collision prediction device 100 is mounted on a vehicle 130, for example, as shown in FIG. FIG. 2 is a schematic diagram for explaining an apparatus mounted on vehicle 130.
  • the vehicle 130 is provided with a surroundings monitoring sensor 131, an image sensor 132 as an imaging device, and a warning device 133.
  • the perimeter monitoring sensor 131 is installed in front of, behind, on the side of, and on the roof of the vehicle 130. In addition, the perimeter monitoring sensor 131 does not need to be installed in all of these positions, and may be installed in another position.
  • the peripheral monitoring sensor 131 measures a relative position and a relative speed between the peripheral vehicle and the vehicle 130 in order to detect a peripheral vehicle (not shown) that is a vehicle around the vehicle 130. Then, the perimeter monitoring sensor 131 sends the measured value to the collision prediction device 100.
  • the image sensor 132 acquires an image in the traveling direction of the vehicle 130, and gives image information indicating the acquired image to the collision prediction device 100.
  • the warning device 133 warns the driver of the vehicle 130.
  • the warning device 133 receives the probability of a collision as an input, and when the probability exceeds a preset threshold value, the driver is displayed by a display (not shown) or reproduces sound by a speaker (not shown). Warn against.
  • the collision prediction device 100 is connected to a CAN (Controller Area Network) of the vehicle 130, and from an electronic control unit (ECU) connected to the CAN, information indicating an operation of an accelerator pedal, a detection result of a raindrop sensor, and , Vehicle speed information can be acquired.
  • ECU electronice control unit
  • the braking acceleration setting storage unit 101 stores information necessary for calculating the braking time of the vehicle 130.
  • the braking acceleration setting storage unit 101 stores the vehicle speed of the vehicle 130, the detection result of the raindrop sensor, the friction coefficient of the road, and the gravitational acceleration.
  • the friction coefficient of wet asphalt and the friction coefficient of dry asphalt are stored as the friction coefficient of the road.
  • the coefficient of friction of wet asphalt is usually a value of 0.4 to 0.6, and the smallest value of 0.4 is stored here.
  • the coefficient of friction of dry asphalt is 0.7 to 0.8, and the smallest value of 0.7 is stored here.
  • Gravity acceleration is approximately 9.8 meters per second per second.
  • the braking time calculation unit 102 calculates a braking time that is a time required for the vehicle 130 to stop due to braking.
  • the braking time is calculated from the assumed friction coefficient of the road surface and the current vehicle speed.
  • v is the speed of the vehicle 130
  • is the coefficient of friction
  • g is the acceleration of gravity.
  • the braking time calculation unit 102 determines the friction coefficient to be used based on the detection result of the raindrop sensor. Specifically, when the detection result of the raindrop sensor indicates that raindrops are detected, in other words, when it is raining, the friction coefficient of wet asphalt is used, and the detection result of the raindrop sensor is used. However, if it indicates that no raindrops have been detected, in other words no rain, the coefficient of friction of dry asphalt is used.
  • the reaction time detection unit 103 considers a response to a change in the environment around the vehicle 130 by the driver, detects a reaction time that is a time required to execute the response, and detects the detected reaction time. It is stored in the reaction time setting storage unit 104. For example, the reaction time detection unit 103 detects a signal from the image indicated by the image information from the image sensor 132, and specifies the time at which the detected signal changes from a red signal indicating stop to a blue signal indicating progress. Next, the reaction time detection unit 103 specifies the time when the driver operates the accelerator pedal after the signal changes to a green signal based on the information indicating the operation of the accelerator pedal obtained from the ECU via the CAN. Then, the reaction time detection unit 103 sets the time difference between the time when the signal changes and the time when the accelerator pedal is operated as the reaction time.
  • the predicted time specifying unit 105 specifies a predicted time that is a time range in which the subsequent position/velocity prediction unit 107 and the collision prediction unit 108 perform the prediction process. For example, the predicted time specifying unit 105 sets a predicted time that is a range of time for predicting a collision between the vehicle 130 and a surrounding vehicle in the future so that the longer the time obtained by adding the braking time and the reaction time is, the longer the predicted time is. Identify.
  • the predicted time is specified by adding the braking time, the reaction time, and a predetermined time.
  • the prediction time specifying unit 105 sets the range of the time step k+n (k and n are positive integers), which is the time at which the position/velocity prediction unit 107 and the collision prediction unit 108 perform the prediction process, to the following formula. It is limited to the range represented by (2) and equation (3).
  • M ⁇ n:0 ⁇ n ⁇ m ⁇ (2)
  • m ⁇ (r+s+ ⁇ )/ ⁇ t>> (3)
  • M is a set of predicted time steps, whereby the time at which the position/velocity prediction unit 107 and the collision prediction unit 108 perform the prediction process is determined in the range of time step k to time step k+m.
  • ⁇ t is a cycle in which the position/velocity prediction unit 107 and the collision prediction unit 108 operate
  • s is the above braking time
  • r is the above reaction time.
  • ⁇ a>> is an integer obtained by rounding up the first decimal place of the real number a.
  • is a set value of the grace period from the time when the collision is predicted to the time when the vehicle 130 has to start the braking to stop before the collision with the surrounding vehicles.
  • the peripheral vehicle information storage unit 106 stores the position and speed of the peripheral vehicle.
  • the position/velocity prediction unit 107 calculates the absolute position and the absolute speed of the surrounding vehicle from the relative position and the relative speed of the surrounding vehicle detected by the surrounding monitoring sensor 131, and calculates the calculated absolute position and absolute speed as the surrounding area.
  • the vehicle position and speed may be stored in the surrounding vehicle information storage unit 106.
  • the surrounding vehicle information storage unit 106 also stores the estimated value of the state value predicted by the position/speed prediction unit 107 and the error covariance.
  • the state value includes position and velocity.
  • the position/velocity prediction unit 107 predicts the position and speed of the vehicle 130 and the positions and speeds of surrounding vehicles at the time included in the prediction time. For example, the position/speed prediction unit 107 uses the Kalman filter to predict the position and speed of the peripheral vehicle in the future from the position and speed of the peripheral vehicle stored in the peripheral vehicle information storage unit 106 as follows.
  • the description will be limited to one peripheral vehicle.
  • the front direction of the vehicle 130 shown in FIG. 1 is the Y axis
  • the right direction of the vehicle 130 is the X axis
  • the X axis and the Y axis are orthogonal to each other.
  • x k F ⁇ x k ⁇ 1 (4)
  • F is a linear model of time transition due to constant velocity motion, and is represented by the following equation (5).
  • F [1 0 ⁇ t 0] (5) [0 1 0 ⁇ t]
  • F is a linear model that gives the state value a motion of time ⁇ t.
  • the term of control input to the system to be estimated and the term of process noise generated in the process of operation of the system are included in the equation of state. , which are unknown here, ignore the control input and process noise with those terms as zero vectors.
  • H is a mapping from the state space to the observation space, but here it is assumed that both the state space and the observation space are Euclidean spaces of position and velocity, and H is the unit matrix. It is assumed that v k is the observation noise of the peripheral monitoring sensor 131 and follows the Gaussian distribution of N(0,R). The variance R is a 4 ⁇ 4 covariance matrix.
  • x ⁇ a k is the estimated value of x k, when the P k and the error covariance of x ⁇ k, x ⁇ k and P k, the estimated value x ⁇ k-1 of the previous time step k-1 And its error covariance P k ⁇ 1 and the observed value z k at the current time step k, they are expressed as in the following equations (6) to (10).
  • x ⁇ k x ⁇ k
  • P k (I ⁇ K k ⁇ H) ⁇ P k
  • K k P k
  • k-1 F ⁇ x ⁇ k-1 (9)
  • k ⁇ 1 F ⁇ P k ⁇ 1 ⁇ F T (10)
  • k ⁇ 1 is the predicted value of the next time step k predicted based on the estimated value of the time step k ⁇ 1
  • k ⁇ 1 is the error Dispersion.
  • is a symbol indicating an estimated value.
  • the position/velocity prediction unit 107 reads the estimated value x ⁇ k ⁇ 1 of the previous time step k ⁇ 1 and the error covariance P k ⁇ 1 from the surrounding vehicle information storage unit 106, and based on them, estimate x ⁇ k in the current time step k estimated as described above, as well, the error covariance P k, for the next time step, shall be recorded in the peripheral vehicle information storage unit 106.
  • the position/speed prediction unit 107 records the state value including the position and speed and the error covariance in the peripheral vehicle information storage unit 106 for each of the plurality of peripheral vehicles. It shall be.
  • the prediction may be performed by the following equations (14) to (16).
  • k F*x ⁇ k+n-1
  • k F ⁇ P k+n ⁇ 1
  • F [1 0 ⁇ t 0] (16) [0 1 0 ⁇ t]
  • n is an integer whose maximum value is the maximum predicted time step k+m as described above.
  • the observation value of the surrounding vehicle that was already predicted in the previous time step and closest to the predicted position in the current time step is adopted as the observation value of the surrounding vehicle and linked to both.
  • the observation value is the closest to the predicted position, if the distance exceeds the threshold value, the observation value is not adopted as the observation value of the surrounding vehicles and is not linked.
  • the peripheral vehicles that are not associated with any of the observed values are regarded as lost and the estimated values and error covariances are deleted from the peripheral vehicle information storage unit 106. After that, the position/speed prediction unit 107 does not handle it thereafter.
  • the observation values that are not associated with any of the surrounding vehicles are regarded as those of the newly discovered surrounding vehicles, and the observed values are regarded as the estimated value of the time step, It is stored in the information storage unit 106.
  • the variance R of the observation noise is used or a zero matrix is used.
  • the distance for pegging is measured as follows. First, for each of the J peripheral vehicles o ⁇ j , the position Y ⁇ x ⁇ k
  • Y is a matrix as in the following Expression (17) for extracting only the position from the position velocity x ⁇ k
  • Y [1 0 0 0] (17) [0 1 0 0]
  • the collision prediction unit 108 predicts a collision between the vehicle 130 and a surrounding vehicle based on the result of the prediction performed by the position/speed prediction unit 107. For example, the collision prediction unit 108 predicts the presence/absence of a collision based on the probability of a collision at an arbitrary time step and position, as described below. Based on the prediction at the time step k, the position Y ⁇ x ⁇ k+n
  • the target vehicle position probability that is the probability that the vehicle 130 is at the position x is f k,n (x) at the time step k+n
  • the vehicle 130 and either That the surrounding vehicles are at the same coordinate x, that is, the collision probability h k,n (x) , which is the probability of collision is expressed by the following equation (18).
  • the presence or absence of a predicted collision can be determined as in the following Expression (19) depending on whether or not the collision probability h k,n (x) exceeds the threshold ⁇ . (19)
  • FIG. 3 is a block diagram schematically showing the hardware configuration of the collision prediction device 100 according to the embodiment.
  • the collision prediction device 100 includes a memory 120, a processor 121, a peripheral monitoring sensor interface (hereinafter referred to as I/F) 122, a warning I/F 123, and a vehicle information I/F 124.
  • I/F peripheral monitoring sensor interface
  • the function of the collision prediction device 100 is stored in the memory 120 as a program, and the processor 121 reads and executes it.
  • the collision prediction device 100 includes a surroundings monitoring sensor I/F 122, and a surroundings monitoring sensor 111 that measures the surroundings of the vehicle 130 is connected to the surroundings monitoring sensor I/F 122.
  • the program executed by the processor 121 can access the relative position and relative speed of another vehicle with respect to the own vehicle, which is the sensor data of the surrounding monitoring sensor 111. As will be described later, it is possible to obtain the absolute speed of the peripheral vehicle based on the speed of the vehicle 130 and the relative speed of the peripheral vehicle.
  • the collision prediction device 100 includes a warning I/F 123, and the warning device 133 is connected to the warning I/F 123.
  • the program executed by the processor 121 can present a warning to the driver of the vehicle 130 through the warning device 133.
  • the collision prediction device 100 includes a vehicle information I/F 124, and the CAN of the vehicle 130 is connected to the vehicle information I/F 124.
  • the program executed by the processor 121 can access the information on the accelerator pedal, the brake pedal, the raindrop sensor, and the vehicle speed information.
  • the above program may be provided via a network or may be provided by being recorded in a recording medium. That is, such a program may be provided as a program product, for example. Therefore, the collision prediction device 100 can be realized by the computer executing the above program.
  • FIG. 4 is a flowchart showing the operation of the collision prediction device 100 according to the embodiment.
  • the collision predicting apparatus 100 repeats the processing of S11 to S15 at the cycle ⁇ t, as shown in steps S10 and S16 of FIG. 4, after the operation starts when the power is turned on until the operation ends when the power is turned off. ..
  • step S11 the braking time calculation unit 102 calculates the braking time s based on the vehicle speed v of the vehicle 130, the friction coefficient ⁇ , and the gravitational acceleration g.
  • step S12 the reaction time detection unit 103 measures the reaction time of the driver of the vehicle 130 and records it in the reaction time setting storage unit 104.
  • step S13 the predicted time specifying unit 105 calculates the predicted time step set M corresponding to the predicted time for predicting a collision based on the braking time s and the reaction time r.
  • step S14 the position/velocity prediction unit 107 obtains the estimated value of the state value at the current time step using the position and velocity of the surrounding vehicle detected by the surrounding monitoring sensor 131 as the observed value, and further, based on the estimated value, the estimated time. The position and speed of the surrounding vehicle at each time step within the range of the step set M are predicted.
  • step S15 the collision prediction unit 108 calculates the probability of collision between the vehicle 130 and any of the surrounding vehicles based on the positions and speeds of the vehicle 130 and the surrounding vehicles at each time step within the range of the predicted time step set M. Then, the probability is output to the warning device 133.
  • the time range of the prediction process is limited based on the reaction time of the driver, there is no lack of prediction of a collision that requires a warning to the driver, The calculation cost can be reduced.
  • 100 collision prediction device 101 braking acceleration setting storage unit, 102 braking time calculation unit, 103 reaction time detection unit, 104 reaction time setting storage unit, 105 predicted time specifying unit, 106 peripheral vehicle information storage unit, 107 position/speed prediction unit, 108 collision prediction unit, 130 vehicle, 131 surrounding monitoring sensor, 132 image sensor, 133 warning device.

Landscapes

  • Engineering & Computer Science (AREA)
  • Transportation (AREA)
  • Mechanical Engineering (AREA)
  • Automation & Control Theory (AREA)
  • Physics & Mathematics (AREA)
  • Mathematical Physics (AREA)
  • Human Computer Interaction (AREA)
  • General Physics & Mathematics (AREA)
  • Traffic Control Systems (AREA)
  • Control Of Driving Devices And Active Controlling Of Vehicle (AREA)
  • Regulating Braking Force (AREA)

Abstract

車両の制動時間を算出する制動時間算出部(102)と、車両の運転手の反応時間を検知する反応時間検知部(103)と、制動時間と反応時間とを加算した時間が長いほど長くなるように、将来において、車両と、周辺車両との衝突を予測する時刻の範囲である予測時間を特定する予測時間特定部(105)と、予測時間に含まれる時刻において、車両の位置及び速度と、周辺車両の位置及び速度と、の予測を実行する位置速度予測部(107)と、その予測の結果から、車両と周辺車両とが衝突するか否かを予測する衝突予測部(108)とを備える。

Description

情報処理装置、プログラム及び情報処理方法
 本発明は、情報処理装置、プログラム及び情報処理方法に関する。
 従来から、自動車の運転を補助するために、後方の自動車を検知して、運転者に警告を行う装置が開発されている。
 例えば、特許文献1に記載された左右折支援装置は、運転手が運転を行っている車両の後側方に設置されたレーダにより、後側方を走行する対象車両を検知し、車両の予想される軌道と、検知された対象車両の予想される軌道との交点を特定する。そして、左右折支援装置は、車両が特定された交点に到達する予想時刻が、対象車両が到達する予想時間より遅ければ危険信号を出すことにより、車両が右左折又は車線を変更する際に、後側方を走行する検知された対象車両との衝突の危険を運転手に知らせる。
特許第2870096号公報
 従来の装置は、車両及び検知された対象車両の想定軌道を特定するため、衝突を意味する交点を即座に求めることができる。
 しかしながら、現実には車両及び検知された対象車両が取り得る軌道が一意に定まらず、また、それらの速度も一定ではないことから、軌道の交点の一点でのみ衝突が生じるとは限られない。このため、交点以外で生じる衝突については、警告を行うことができない。
 また、上記の交点以外で生じる衝突を検出するために、あらゆる方向へのあらゆる速度での車両の移動を考慮してしまうと、計算コストが問題となる。一方、不用意に車両の移動する予測範囲を絞れば、警告を必要とする衝突が予測されなくなる。
 そこで、本発明の一又は複数の態様は、現実的な計算コストに押さえながらも、運転手への警告を必要とする衝突の予測を行うことができるようにすることを目的とする。
 本発明の一態様に係る情報処理装置は、車両に搭載される情報処理装置であって、前記車両が制動により停止するのに要する時間である制動時間を算出する制動時間算出部と、前記車両の運転手が、前記車両の周囲の環境の変化に対して対応を考えて、前記対応を実行するまでに要する時間である反応時間を検知する反応時間検知部と、前記制動時間と前記反応時間とを加算した時間が長いほど長くなるように、将来において、前記車両と、前記車両の周辺の車両である周辺車両との衝突を予測する時刻の範囲である予測時間を特定する予測時間特定部と、前記予測時間に含まれる時刻において、前記車両の位置及び速度と、前記周辺車両の位置及び速度と、の予測を実行する位置速度予測部と、前記予測の結果から、前記車両と前記周辺車両とが衝突するか否かを予測する衝突予測部と、を備えることを特徴とする。
 本発明の一態様に係るプログラムは、車両に搭載されるコンピュータを、前記車両が制動により停止するのに要する時間である制動時間を算出する制動時間算出部、前記車両の運転手が、前記車両の周囲の環境の変化に対して対応を考えて、前記対応を実行するまでに要する時間である反応時間を検知する反応時間検知部、前記制動時間と前記反応時間とを加算した時間が長いほど長くなるように、将来において、前記車両と、前記車両の周辺の車両である周辺車両との衝突を予測する時刻の範囲である予測時間を特定する予測時間特定部、前記予測時間に含まれる時刻において、前記車両の位置及び速度と、前記周辺車両の位置及び速度と、の予測を実行する位置速度予測部、及び、前記予測の結果から、前記車両と前記周辺車両とが衝突するか否かを予測する衝突予測部、として機能させることを特徴とする。
 本発明の一態様に係る情報処理方法は、車両が制動により停止するのに要する時間である制動時間を算出し、前記車両の運転手が、前記車両の周囲の環境の変化に対して対応を考えて、前記対応を実行するまでに要する時間である反応時間を検知し、前記制動時間と前記反応時間とを加算した時間が長いほど長くなるように、将来において、前記車両と、前記車両の周辺の車両である周辺車両との衝突を予測する時刻の範囲である予測時間を特定し、前記予測時間に含まれる時刻において、前記車両の位置及び速度と、前記周辺車両の位置及び速度と、の予測を実行し、前記予測の結果から、前記車両と前記周辺車両とが衝突するか否かを予測することを特徴とする。
 本発明の一又は複数の態様によれば、現実的な計算コストに押さえながらも、運転手への警告を必要とする衝突の予測を行うことができる。
実施の形態に係る衝突予測装置の構成を概略的に示すブロック図である。 車両に搭載される装置を説明するための概略図である。 実施の形態に係る衝突予測装置のハードウェア構成を概略的に示すブロック図である。 実施の形態に係る衝突予測装置の動作を示すフローチャートである。
 図1は、実施の形態に係る情報処理装置である衝突予測装置100の構成を概略的に示すブロック図である。
 衝突予測装置100は、制動加速設定記憶部101と、制動時間算出部102と、反応時間検知部103と、反応時間設定記憶部104と、予測時間特定部105と、周辺車両情報記憶部106と、位置速度予測部107と、衝突予測部108とを備える。
 衝突予測装置100は、例えば、図2に示されているように、車両130に搭載される。
 図2は、車両130に搭載される装置を説明するための概略図である。
 車両130には、衝突予測装置100の他、周辺監視センサ131と、撮像装置としての画像センサ132と、警告装置133とが設置される。
 周辺監視センサ131は、車両130の前方、後方、側方及び屋根上に設置されている。なお、周辺監視センサ131は、これらの全ての位置に設置される必要はなく、また、別の位置に設置されてもよい。
 周辺監視センサ131は、車両130の周辺の車両である周辺車両(図示せず)を検出するために、周辺車両と車両130との相対位置及び相対速度を計測する。そして、周辺監視センサ131は、計測した値を、衝突予測装置100に送る。
 画像センサ132は、車両130の進行方向における画像を取得し、取得された画像を示す画像情報を衝突予測装置100に与える。
 警告装置133は、車両130の運転手に対して警告を行う。
 警告装置133は、衝突が生じる確率を入力として、その確率が予め設定された閾値を超える場合に、ディスプレイ(図示せず)による表示、又は、スピーカ(図示せず)による音再生により、運転手に対して警告を行う。
 また、衝突予測装置100は、車両130のCAN(Contoller Area Network)に接続され、CANに接続されている電子制御ユニット(ECU)から、アクセルペダルの操作を示す情報、雨滴センサの検出結果、及び、車速情報を取得することができる。
 図1に戻り、制動加速設定記憶部101は、車両130の制動時間を算出するために必要な情報を記憶する。例えば、制動加速設定記憶部101は、車両130の車速、雨滴センサの検出結果、道路の摩擦係数及び重力加速度を記憶する。
 ここで、道路の摩擦係数として、濡れたアスファルトの摩擦係数及び乾いたアスファルトの摩擦係数が記憶されている。濡れたアスファルトの摩擦係数は、通常、0.4~0.6の値であり、ここでは、最も小さい値である0.4が記憶されている。乾いたアスファルトの摩擦係数は、0.7~0.8であり、ここでは、最も小さい値である0.7が記憶されている。
 重力加速度は、約9.8メートル毎秒毎秒である。
 制動時間算出部102は、車両130が制動により停止するのに要する時間である制動時間を算出する。制動時間は、想定される路面の摩擦係数及び現在の車速から算出される。例えば、制動時間sは、下記の式(1)により求められる。
 s=v/(μ・g)                     (1)
 ここで、vは、車両130の速度、μは、摩擦係数、及び、gは、重力加速度である。これらは、制動加速設定記憶部101に記憶されている。
 制動時間算出部102は、雨滴センサの検出結果に基づいて、用いる摩擦係数を決定する。具体的には、雨滴センサの検出結果が、雨滴が検出されていること、言い換えると、雨が降っていることを示す場合には、濡れたアスファルトの摩擦係数が用いられ、雨滴センサの検出結果が、雨滴が検出されていないこと、言い換えると、雨が降っていないことを示す場合には、乾いたアスファルトの摩擦係数が用いられる。
 反応時間検知部103は、運転手が車両130の周囲の環境の変化に対して対応を考えて、その対応を実行するまでに要する時間である反応時間を検知して、検知された反応時間を反応時間設定記憶部104に記憶する。
 例えば、反応時間検知部103は、画像センサ132からの画像情報で示される画像から信号を検出し、検出された信号が、停止を示す赤信号から進行を示す青信号に変わった時刻を特定する。次に、反応時間検知部103は、CANを介してECUから得られるアクセルペダルの操作を示す情報により、信号が青信号に変わった後に、運転手がアクセルペダルを操作した時刻を特定する。そして、反応時間検知部103は、信号が変わった時刻と、アクセルペダルを操作した時刻との時間差を反応時間とする。
 予測時間特定部105は、後段の位置速度予測部107及び衝突予測部108が予測処理を行う時刻の範囲である予測時間を特定する。例えば、予測時間特定部105は、制動時間と反応時間とを加算した時間が長いほど長くなるように、将来において、車両130と、周辺車両との衝突を予測する時刻の範囲である予測時間を特定する。ここでは、予測時間は、制動時間と、反応時間と、予め定められた時間とを加算することで特定される。
 具体的には、予測時間特定部105は、位置速度予測部107及び衝突予測部108が予測処理を行う時刻である時刻ステップk+n(k及びnは、正の整数)の範囲を、下記の式(2)及び式(3)で示される範囲に制限する。
 M={n:0<n≦m}                   (2)
 m=《(r+s+α)/Δt》                (3)
 ここで、Mは、予測時刻ステップ集合であり、これにより、位置速度予測部107及び衝突予測部108が予測処理を行う時刻は、時刻ステップk~時刻ステップk+mの範囲に決定される。
 Δtは、位置速度予測部107及び衝突予測部108が動作する周期であり、sは、上記の制動時間であり、rは、上記の反応時間である。
 また、《a》は、実数aの少数第一位を切り上げた整数である。αは、衝突が予測されてから、車両130が周辺車両に衝突する前に停止するために制動を開始しなければならない時刻までの猶予時間の設定値である。
 周辺車両情報記憶部106は、周辺車両の位置及び速度を記憶する。例えば、位置速度予測部107は、周辺監視センサ131で検知された周辺車両の相対位置及び相対速度から、周辺車両の絶対位置及び絶対速度を算出し、算出された絶対位置及び絶対速度を、周辺車両の位置及び速度として、周辺車両情報記憶部106に記憶させればよい。
 また、周辺車両情報記憶部106は、位置速度予測部107で予測された状態値の推定値と、誤差共分散とを記憶する。状態値は、位置と速度とを含む。
 位置速度予測部107は、予測時間に含まれる時刻において、車両130の位置及び速度と、周辺車両の位置及び速度との予測を実行する。例えば、位置速度予測部107は、カルマンフィルタを用いて、周辺車両情報記憶部106に記憶されている周辺車両の位置及び速度から、未来における周辺車両の位置及び速度を以下のようにして予測する。
 <位置速度予測部107の推定処理>
 まず、1台の周辺車両に限定して説明する。
 ここでは、図1に示されている車両130の前方向をY軸、車両130の右方向をX軸とし、X軸とY軸とは互いに直交するものとする。
 時刻ステップkにおける、周辺車両の位置のX座標pxk、Y座標pyk、周辺車両の速度のX軸成分vxk、Y軸成分vykからなる、周辺車両の状態値をx=[pxk pyk vxk vykとすると、等速運動を表す状態方程式は次の式(4)のように表される。
 x=F・xk-1                       (4)
 Fは、等速運動による時間遷移の線形モデルであり、次の式(5)ように表される。
 F=[1 0 Δt 0]                  (5)
   [0 1 0 Δt]
 Fは、状態値に時間Δt分の運動を与える線形モデルである。一般的なカルマンフィルタでは、推定対象のシステムへの制御入力の項と、システムの動作の過程で生じる過程雑音の項とが状態方程式に含まれているが、周辺車両内で生じる制御入力及び過程雑音は、ここでは不明であるため、それらの項を零ベクトルとして制御入力と過程雑音とを無視する。
 次に、周辺車両が持つ状態値xと、周辺監視センサ131が周辺車両を観測して得ることができる観測値zとの関係を次のように仮定する。
 z=H・x+v
 Hは、状態空間から観測空間への写像であるが、ここでは状態空間も観測空間も位置と速度とのユークリッド空間であると仮定し、Hを単位行列とする。
 vは、周辺監視センサ131の観測雑音であり、N(0、R)のガウス分布に従うと仮定する。分散Rは、4×4の共分散行列である。
 次に、x^をxの推定値とし、Pをx^の誤差共分散とすると、x^及びPは、前の時刻ステップk-1の推定値x^k-1及びその誤差共分散Pk-1と、現時刻ステップkの観測値zを用いて、次の式(6)~式(10)のように表される。
 x^=x^k|k-1+K・(z-H・x^k|k-1)      (6)
 P=(I-K・H)・Pk|k-1               (7)
 K=Pk|k-1・H(R+H・Pk|k-1・H-1       (8)
 x^k|k-1=F・x^k-1                   (9)
 Pk|k-1=F・Pk-1・F                 (10)
 ここで、x^k|k-1は、時刻ステップk-1の推定値に基づいて予測された、その次の時刻ステップkの予測値であり、Pk|k-1は、その誤差共分散である。ここで、「^」は、推定値であることを示す記号である。
 位置速度予測部107は、前の時刻ステップk-1の推定値x^k-1、並びに、誤差共分散Pk-1を、周辺車両情報記憶部106から読み取るものとし、それらを基に、上述の通り推定した現時刻ステップkの推定値x^、並びに、誤差共分散Pを、次時刻ステップのために、周辺車両情報記憶部106に記録するものとする。
 なお、通常、複数の周辺車両が存在するため、位置速度予測部107は、複数の周辺車両のそれぞれについて、位置及び速度を含む状態値、並びに、誤差共分散を周辺車両情報記憶部106に記録するものとする。
 <位置速度予測部107の予測処理方法>
 ここで、次のような状態遷移モデルF(t)を用いることで、現時刻ステップkにおける推定値x^及び誤差共分散Pを元に、次の時刻ステップk+1のみならず、任意の時刻ステップk+nの推定値を、次の式(11)~式(13)のように予測することができる。
 x^k+n|k=F(n)・x^               (11)
 Pk+n|k=F(n)・P・F(n)            (12)
 F(n)=[1 0 nΔt 0]             (13)
      [0 1 0 nΔt]
 または次の式(14)~式(16)により予測が行われてもよい。
 x^k+n|k=F・x^k+n-1|k               (14)
 Pk+n|k=F・Pk+n-1|k・F              (15)
 F=[1 0 Δt 0]                 (16)
   [0 1 0 Δt]
 但し、nは、上述のように最大予測時刻ステップk+mを最大値とする整数である。
 <位置速度予測部107の紐付け処理>
 次に、複数の周辺車両が走行している場合の、周辺車両情報記憶部106に格納されている推定値と、新たに得られた観測値との紐付けについて説明する。
 時刻ステップkにおいて、車両130の周辺にI台の周辺車両が走行している場合に観測されるI個の観測値zi、k(i=1、2、・・・、I:Iは正の整数)を、既にカルマンフィルタにより位置及び速度が予測されているJ台の周辺車両(Jは正の整数)の推定値の何れかと紐付ける必要がある。
 大まかな方針として、既に前時刻ステップにおいて予測された周辺車両の現時刻ステップの予測位置との距離が最も近い観測値を、その周辺車両の観測値として採用して両者を紐付ける。但し、予測位置に最も近い観測値であっても、その距離が閾値を超える場合は、その観測値はその周辺車両の観測値としては採用せず紐付けしない。
 J台の周辺車両のうち、いずれの観測値も紐付けされなかった周辺車両については、その周辺車両については見失われたものとし、その推定値及び誤差共分散を周辺車両情報記憶部106から削除して、以後、位置速度予測部107により取り扱われない。
 他方、何れの周辺車両にも紐付けられなかった観測値については、それを新規に発見された周辺車両のものとみなし、その観測値は、その時刻ステップの推定値とみなされて、周辺車両情報記憶部106に記憶される。その新たに記憶される観測値の誤差共分散には観測雑音の分散Rを用いるか、又は、零行列が用いられる。
 紐付けのための距離は、次のように測定される。
 まず、J台の周辺車両o^のそれぞれについて、時刻ステップk-1において予測された時刻ステップkにおける位置Y・x^k|k-1をその平均値とし、誤差共分散Y・Pj、k|k-1・Yをその分散とした、多変量ガウス分布gj、k(X)を考えると、gj、k(X)は、周辺車両o^が位置Xにいる確率を表している。言い換えると、gj、k(Y・zi、k)は、周辺車両o^が観測された位置Y・zi、kにいる確率を表している。
 より尤もらしい観測値との距離を小さくするため、1/gj、k(Y・zi、k)、又は、1-gj、k(Y・zi、k)を、紐付けのために測る距離とする。但し、Yは、位置速度x^k|k-1から位置のみを取り出すための次の式(17)のような行列とする。
 Y=[1 0 0 0]                  (17)
   [0 1 0 0]
 衝突予測部108は、位置速度予測部107での予測の結果から、車両130と、周辺車両との衝突を予測する。例えば、衝突予測部108は、次に説明するとおり、任意の時刻ステップ及び位置において衝突が起こる確率に基づき、衝突の有無を予測する。
 時刻ステップkにおける予測に基づく、時刻ステップk+nにおける位置Y・x^k+n|k-1をその平均値とし、誤差共分散Y・Pj、k+n|k-1・Yをその分散とした、多変量ガウス分布gj、k、n(x)を考えると、これは時刻ステップk+nにおいて周辺車両o^が位置xにいる確率である周辺車両位置確率を表している。
 同様に車両130の位置及び速度の予測に基づいて、時刻ステップk+nにおいて、車両130が位置xにいる確率である対象車両位置確率をfk、n(x)とすると、車両130と、何れかの周辺車両とが同じ座標xにいること、つまり衝突する確率である衝突確率hk、n(x)は、次の式(18)で示される。
Figure JPOXMLDOC01-appb-M000001
                              (18)
 よって、予測される衝突の有無は、衝突確率hk、n(x)が閾値λを超えるか否かにより、次の式(19)のように判定できる。
Figure JPOXMLDOC01-appb-M000002
                             (19)
 但し、位置の範囲Xは、以下の式(20)に表されるとおり、対象車両位置確率fk、n(x)が閾値λを超える範囲とする。
 X={x:fk、n(x)>λ}                (20)
 図3は、実施の形態に係る衝突予測装置100のハードウェア構成を概略的に示すブロック図である。
 衝突予測装置100は、メモリ120と、プロセッサ121と、周辺監視センサインタフェース(以下、I/Fという)122と、警告I/F123と、車両情報I/F124とを備える。
 衝突予測装置100の機能は、プログラムとしてメモリ120に記憶されており、プロセッサ121がそれを読み出して実行する。
 衝突予測装置100は、周囲監視センサI/F122を備え、車両130の周囲を計測する周囲監視センサ111が周囲監視センサI/F122に接続されている。プロセッサ121が実行するプログラムは、周囲監視センサ111のセンサデータである他車両の自車両に対する相対位置および相対速度にアクセスすることができる。後述するように、車両130の速度と、周辺車両との相対速度を基に、周辺車両の絶対速度を得ることが可能である。
 また、衝突予測装置100は、警告I/F123を備え、警告装置133が警告I/F123に接続されている。プロセッサ121が実行するプログラムは、警告装置133を通して車両130の運転手に対して警告を提示することができる。
 また、衝突予測装置100は、車両情報I/F124を備え、車両130のCANが車両情報I/F124に接続されている。プロセッサ121が実行するプログラムは、アクセルペダル、ブレーキペダル、雨滴センサの情報及び車速情報にアクセスすることが出来る。
 以上のようなプログラムは、ネットワークを通じて提供されてもよく、また、記録媒体に記録されて提供されてもよい。即ち、このようなプログラムは、例えば、プログラムプロダクトとして提供されてもよい。このため、衝突予測装置100は、以上のようなプログラムをコンピュータが実行することで実現可能となる。
 次に、動作について説明する。
 図4は、実施の形態に係る衝突予測装置100の動作を示すフローチャートである。
 衝突予測装置100は、電源の投入による動作開始後、電源切断等による動作終了までの間、図4のステップS10及びS16に示されているように、S11~S15の処理を、周期Δtで繰り返す。
 ステップS11では、制動時間算出部102は、車両130の車速v、摩擦係数μ、重力加速度gを基に、制動時間sを算出する。
 ステップS12では、反応時間検知部103は、車両130の運転手の反応時間を計測し、それを反応時間設定記憶部104に記録する。
 ステップS13では、予測時間特定部105は、制動時間s及び反応時間rを基に、衝突の予測を行う予測時間に対応する予測時刻ステップ集合Mを算出する。
 ステップS14では、位置速度予測部107は、周辺監視センサ131が検知した周辺車両の位置及び速度を観測値として現時刻ステップにおける状態値の推定値を求め、さらに、その推定値を基に予測時刻ステップ集合Mの範囲の各時刻ステップにおける周辺車両の位置及び速度を予測する。
 ステップS15では、衝突予測部108は、予測時刻ステップ集合Mの範囲の各時刻ステップにおける車両130及び周辺車両の位置及び速度を基に、車両130と何れかの周辺車両とが衝突する確率を算出し、その確率を警告装置133へ出力する。
 以上のように、本実施の形態によれば、運転手の反応時間に基づき予測処理の時刻範囲を制限するようにしているので、運転手への警告が必要な衝突の予測が欠けることなく、計算コストを削減することができる。
 100 衝突予測装置、 101 制動加速設定記憶部、 102 制動時間算出部、 103 反応時間検知部、 104 反応時間設定記憶部、 105 予測時間特定部、 106 周辺車両情報記憶部、 107 位置速度予測部、 108 衝突予測部、 130 車両、 131 周辺監視センサ、 132 画像センサ、 133 警告装置。

Claims (9)

  1.  車両に搭載される情報処理装置であって、
     前記車両が制動により停止するのに要する時間である制動時間を算出する制動時間算出部と、
     前記車両の運転手が、前記車両の周囲の環境の変化に対して対応を考えて、前記対応を実行するまでに要する時間である反応時間を検知する反応時間検知部と、
     前記制動時間と前記反応時間とを加算した時間が長いほど長くなるように、将来において、前記車両と、前記車両の周辺の車両である周辺車両との衝突を予測する時刻の範囲である予測時間を特定する予測時間特定部と、
     前記予測時間に含まれる時刻において、前記車両の位置及び速度と、前記周辺車両の位置及び速度と、の予測を実行する位置速度予測部と、
     前記予測の結果から、前記車両と前記周辺車両とが衝突するか否かを予測する衝突予測部と、を備えること
     を特徴とする情報処理装置。
  2.  前記予測時間特定部は、前記制動時間と、前記反応時間と、予め定められた時間とを加算することにより前記予測時間を特定すること
     を特徴とする請求項1に記載の情報処理装置。
  3.  前記反応時間検知部は、信号が停止から進行に変わってから、前記運転手が前記車両のアクセルペダルを操作するまでの時間により、前記反応時間を検知すること
     を特徴とする請求項1又は2に記載の情報処理装置。
  4.  前記反応時間検知部は、前記車両に取り付けられた撮像装置から得られる画像により、前記信号が前記停止から前記進行に変わった時刻を特定すること
     を特徴とする請求項3に記載の情報処理装置。
  5.  前記反応時間検知部は、前記車両の電子制御ユニットから、前記アクセルペダルの操作を示す情報を取得することで、前記アクセルペダルが操作された時刻を特定すること
     を特徴とする請求項3又は4に記載の情報処理装置。
  6.  前記制動時間算出部は、前記車両の速度を、道路の摩擦係数に重力加速度を乗算した値で除算することにより、前記制動時間を算出すること
     を特徴とする請求項1から4の何れか一項に記載の情報処理装置。
  7.  前記制動時間算出部は、前記車両の電子制御ユニットから、前記車両に取り付けられている雨滴センサによる雨滴の検出の有無を示す情報を取得し、雨滴が検出されている場合には、雨滴が検出されている場合よりも、前記摩擦係数を小さな値にすること
     を特徴とする請求項6に記載の情報処理装置。
  8.  車両に搭載されるコンピュータを、
     前記車両が制動により停止するのに要する時間である制動時間を算出する制動時間算出部、
     前記車両の運転手が、前記車両の周囲の環境の変化に対して対応を考えて、前記対応を実行するまでに要する時間である反応時間を検知する反応時間検知部、
     前記制動時間と前記反応時間とを加算した時間が長いほど長くなるように、将来において、前記車両と、前記車両の周辺の車両である周辺車両との衝突を予測する時刻の範囲である予測時間を特定する予測時間特定部、
     前記予測時間に含まれる時刻において、前記車両の位置及び速度と、前記周辺車両の位置及び速度と、の予測を実行する位置速度予測部、及び、
     前記予測の結果から、前記車両と前記周辺車両とが衝突するか否かを予測する衝突予測部、として機能させること
     を特徴とするプログラム。
  9.  車両が制動により停止するのに要する時間である制動時間を算出し、
     前記車両の運転手が、前記車両の周囲の環境の変化に対して対応を考えて、前記対応を実行するまでに要する時間である反応時間を検知し、
     前記制動時間と前記反応時間とを加算した時間が長いほど長くなるように、将来において、前記車両と、前記車両の周辺の車両である周辺車両との衝突を予測する時刻の範囲である予測時間を特定し、
     前記予測時間に含まれる時刻において、前記車両の位置及び速度と、前記周辺車両の位置及び速度と、の予測を実行し、
     前記予測の結果から、前記車両と前記周辺車両とが衝突するか否かを予測すること
     を特徴とする情報処理方法。
PCT/JP2019/005828 2019-02-18 2019-02-18 情報処理装置、プログラム及び情報処理方法 WO2020170301A1 (ja)

Priority Applications (5)

Application Number Priority Date Filing Date Title
JP2019540123A JP6704531B1 (ja) 2019-02-18 2019-02-18 情報処理装置、プログラム及び情報処理方法
PCT/JP2019/005828 WO2020170301A1 (ja) 2019-02-18 2019-02-18 情報処理装置、プログラム及び情報処理方法
DE112019006588.2T DE112019006588T5 (de) 2019-02-18 2019-02-18 Informationsverarbeitungsvorrichtung, programm und informationsverarbeitungsverfahren
CN201980091744.XA CN113424242B (zh) 2019-02-18 2019-02-18 信息处理装置、计算机可读取的记录介质及信息处理方法
US17/400,669 US20210370891A1 (en) 2019-02-18 2021-08-12 Information processing device, non-transitory computer-readable storage medium, and information processing method

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
PCT/JP2019/005828 WO2020170301A1 (ja) 2019-02-18 2019-02-18 情報処理装置、プログラム及び情報処理方法

Related Child Applications (1)

Application Number Title Priority Date Filing Date
US17/400,669 Continuation US20210370891A1 (en) 2019-02-18 2021-08-12 Information processing device, non-transitory computer-readable storage medium, and information processing method

Publications (1)

Publication Number Publication Date
WO2020170301A1 true WO2020170301A1 (ja) 2020-08-27

Family

ID=70858211

Family Applications (1)

Application Number Title Priority Date Filing Date
PCT/JP2019/005828 WO2020170301A1 (ja) 2019-02-18 2019-02-18 情報処理装置、プログラム及び情報処理方法

Country Status (5)

Country Link
US (1) US20210370891A1 (ja)
JP (1) JP6704531B1 (ja)
CN (1) CN113424242B (ja)
DE (1) DE112019006588T5 (ja)
WO (1) WO2020170301A1 (ja)

Cited By (1)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN112466119A (zh) * 2020-11-26 2021-03-09 清华大学 一种利用车路协同数据的汽车跟车车速预测方法及系统

Families Citing this family (1)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP2022140032A (ja) * 2021-03-12 2022-09-26 本田技研工業株式会社 運転支援装置及び車両

Citations (10)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP2006259948A (ja) * 2005-03-16 2006-09-28 Clarion Co Ltd 安全車間距離表示装置
JP2007233744A (ja) * 2006-03-01 2007-09-13 Fujitsu Ten Ltd 運転支援装置
JP2009157685A (ja) * 2007-12-27 2009-07-16 Kyushu Univ 安全運転促進システム
JP2010205123A (ja) * 2009-03-05 2010-09-16 Nec System Technologies Ltd 運転支援方法、運転支援装置及び運転支援用プログラム
JP2015519622A (ja) * 2012-02-03 2015-07-09 ルノー エス.ア.エス. 道路の車線の車線交通路内の車両の位置を決定する方法、並びに2つの車両間の整列及び衝突リスクを検知する方法
WO2016059724A1 (ja) * 2014-10-17 2016-04-21 三菱電機株式会社 ドライバー支援装置および警報タイミング制御方法
JP2017504526A (ja) * 2014-02-03 2017-02-09 ローベルト ボツシユ ゲゼルシヤフト ミツト ベシユレンクテル ハフツングRobert Bosch Gmbh 車両の運転方法
JP2017105357A (ja) * 2015-12-10 2017-06-15 いすゞ自動車株式会社 安全装置
JP2017222322A (ja) * 2016-06-17 2017-12-21 株式会社デンソー 走行支援装置
JP2017222357A (ja) * 2013-05-16 2017-12-21 ジャガー ランド ローバー リミテッドJaguar Land Rover Limited 車両牽引制御

Family Cites Families (14)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP2870096B2 (ja) 1990-03-06 1999-03-10 いすゞ自動車株式会社 右左折支援装置
JP4544987B2 (ja) * 2004-09-06 2010-09-15 ダイハツ工業株式会社 衝突予測方法及び衝突予測装置
JP2007279892A (ja) * 2006-04-04 2007-10-25 Honda Motor Co Ltd 衝突予知システムの制御装置、衝突予知方法および乗員保護システム
CN101407199A (zh) * 2008-10-28 2009-04-15 湖北汽车工业学院 一种车辆碰撞预警方法及装置
JP5507433B2 (ja) * 2010-12-21 2014-05-28 ダイハツ工業株式会社 運転支援装置
JP5715454B2 (ja) * 2011-03-15 2015-05-07 富士重工業株式会社 車両の運転支援装置
CN102390320B (zh) * 2011-08-22 2013-06-12 武汉理工大学 基于车载传感网络的车辆防撞预警系统及用途
DE102012002695A1 (de) * 2012-02-14 2013-08-14 Wabco Gmbh Verfahren zur Ermittlung einer Notbremssituation eines Fahrzeuges
CN102800214B (zh) * 2012-08-27 2014-06-18 武汉大学 一种基于车车信息交互条件下的车辆换道冲突消解方法
CN103448720B (zh) * 2013-06-04 2015-11-04 浙江吉利汽车研究院有限公司杭州分公司 汽车爆胎防追尾控制方法及控制装置
CN104751677B (zh) * 2013-12-27 2017-07-18 上海博泰悦臻网络技术服务有限公司 车辆碰撞报警方法和系统
CN105216792A (zh) * 2014-06-12 2016-01-06 株式会社日立制作所 对周围环境中的障碍物目标进行识别跟踪的方法和设备
CN105015520A (zh) * 2015-07-27 2015-11-04 苏州宏展信息科技有限公司 一种汽车防碰撞系统
CN206781626U (zh) * 2017-03-09 2017-12-22 浙江吉利控股集团有限公司 一种车辆防撞预警系统及车辆

Patent Citations (10)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP2006259948A (ja) * 2005-03-16 2006-09-28 Clarion Co Ltd 安全車間距離表示装置
JP2007233744A (ja) * 2006-03-01 2007-09-13 Fujitsu Ten Ltd 運転支援装置
JP2009157685A (ja) * 2007-12-27 2009-07-16 Kyushu Univ 安全運転促進システム
JP2010205123A (ja) * 2009-03-05 2010-09-16 Nec System Technologies Ltd 運転支援方法、運転支援装置及び運転支援用プログラム
JP2015519622A (ja) * 2012-02-03 2015-07-09 ルノー エス.ア.エス. 道路の車線の車線交通路内の車両の位置を決定する方法、並びに2つの車両間の整列及び衝突リスクを検知する方法
JP2017222357A (ja) * 2013-05-16 2017-12-21 ジャガー ランド ローバー リミテッドJaguar Land Rover Limited 車両牽引制御
JP2017504526A (ja) * 2014-02-03 2017-02-09 ローベルト ボツシユ ゲゼルシヤフト ミツト ベシユレンクテル ハフツングRobert Bosch Gmbh 車両の運転方法
WO2016059724A1 (ja) * 2014-10-17 2016-04-21 三菱電機株式会社 ドライバー支援装置および警報タイミング制御方法
JP2017105357A (ja) * 2015-12-10 2017-06-15 いすゞ自動車株式会社 安全装置
JP2017222322A (ja) * 2016-06-17 2017-12-21 株式会社デンソー 走行支援装置

Cited By (1)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN112466119A (zh) * 2020-11-26 2021-03-09 清华大学 一种利用车路协同数据的汽车跟车车速预测方法及系统

Also Published As

Publication number Publication date
CN113424242B (zh) 2023-03-28
US20210370891A1 (en) 2021-12-02
JP6704531B1 (ja) 2020-06-03
JPWO2020170301A1 (ja) 2021-03-11
DE112019006588T5 (de) 2021-11-04
CN113424242A (zh) 2021-09-21

Similar Documents

Publication Publication Date Title
US9595197B2 (en) Lateral control apparatus of vehicle and control method of the same
US20170113685A1 (en) Method and system for assisting a driver of a vehicle in driving the vehicle, vehicle and computer program
WO2018209997A1 (zh) 用于目标跟踪的车载毫米波雷达滤波估计方法、装置及存储介质
US20150239472A1 (en) Vehicle-installed obstacle detection apparatus having function for judging motion condition of detected object
US20180173232A1 (en) System and method for sensing the driving environment of a motor vehicle
JP2013225295A5 (ja)
JP2018055539A (ja) 移動体の状態算出装置、状態算出方法、プログラムおよびそれを記録した記録媒体
JP6704531B1 (ja) 情報処理装置、プログラム及び情報処理方法
JP5904226B2 (ja) 車両挙動予測装置及びプログラム
JP6936098B2 (ja) 対象物推定装置
CN110632916B (zh) 行动预测装置以及自动驾驶装置
US20220113397A1 (en) Target tracking device
JP5482323B2 (ja) 運転支援装置及びプログラム
CN109684944B (zh) 障碍物检测方法、装置、计算机设备和存储介质
JP2009175929A (ja) ドライバ状態推定装置及びプログラム
KR102025491B1 (ko) 차량 제동거리 예측을 통한 보강된 전방 추돌 경고 시스템 및 방법
CN112166434A (zh) 运行辅助方法、控制单元、运行辅助系统和工作设备
JP2012059058A (ja) 危険推定装置及びプログラム
SE536649C2 (sv) System och metod för reglering av fordon i fordonståg
JP2009145951A (ja) ドライバ状態推定装置及びプログラム
CN113176562B (zh) 多目标跟踪方法、装置、电子设备及可读存储介质
WO2021172535A1 (ja) 物体検知装置
JP2003151095A (ja) 車両用障害物認識装置
JP6299289B2 (ja) パラメータ学習装置、運転支援装置、及びプログラム
JP4817854B2 (ja) 周辺物体追尾装置及び周辺物体位置予測方法

Legal Events

Date Code Title Description
ENP Entry into the national phase

Ref document number: 2019540123

Country of ref document: JP

Kind code of ref document: A

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

Ref document number: 19916118

Country of ref document: EP

Kind code of ref document: A1

122 Ep: pct application non-entry in european phase

Ref document number: 19916118

Country of ref document: EP

Kind code of ref document: A1