Collision determination device and vehicle behavior control device

• US 20070080968A1
• Filed: 10/05/2006
• Published: 04/12/2007
• Est. Priority Date: 10/06/2005
• Status: Active Grant

• Current Assignee: Fuji Heavy Industries Limited (Subaru Corp.)
• Original Assignee: Fuji Heavy Industries Limited (Subaru Corp.)
• Inventors: Tsukasaki, Yuichiro, Kogure, Masaru
• Granted Patent: US 7,864,032 B2
• Time in Patent Office: Days
• US Class Current: 345/474
• CPC Class Codes: B60W 10/18 including control of braking systems
• CPC Class Codes: B60W 2420/403 Image sensing, e.g. optical camera
• CPC Class Codes: B60W 2420/408 Radar; Laser, e.g. lidar
• CPC Class Codes: B60W 30/08 Active safety systems predicting or avoiding probable or impending collision or attempting to minimise its consequences
• CPC Class Codes: B60W 30/09 Taking automatic action to avoid collision, e.g. braking and steering
• CPC Class Codes: B60W 30/095 Predicting travel path or likelihood of collision
• CPC Class Codes: B60W 30/18172 Preventing, or responsive to skidding of wheels
• CPC Class Codes: B60W 50/14 Means for informing the driver, warning the driver or prompting a driver intervention
• CPC Class Codes: G08G 1/165 for passive traffic, e.g. including static obstacles, trees
• CPC Class Codes: G08G 1/166 for active traffic, e.g. moving vehicles, pedestrians, bikes
• CPC Class Codes: G08G 1/167 Driving aids for lane monitoring, lane changing, e.g. blind spot detection

Abstract

A control unit 5 calculates, by a statistical processing, the current front/rear-directional acceleration, the current front/rear-directional velocity, and the current front/rear-directional position of the three-dimensional object to be determined while considering an error caused by a camera. These values are used in the statistical processing so as to calculate the front/rear-directional acceleration after Δt seconds, the front/rear-directional velocity after Δt seconds, and the front/rear-directional position after Δt seconds, and so as to obtain a probability of contact after Δt seconds based on the front/rear-directional position after Δt seconds.

Claims

1. A collision determination device comprising:

three-dimensional object detection means for detecting a three-dimensional object existing around;

current state processing means for calculating current motion and positional states of the three-dimensional object by a statistical processing;

state estimation means for estimating motion and positional states of the three-dimensional object after a preset time period, by a statistical processing, based on the calculated current motion and positional states; and

contact probability calculation means for calculating a probability of contact with the three-dimensional object based on the estimated positional state of the three-dimensional object after the preset time period.

2. The collision determination device according to claim 1, wherein the collision determination device is mounted on a movable body, and

the collision determination device further comprises control means for performing at least one of the deceleration control, alarm control and provision of alert information based on the contact probability.

3. The collision determination device according to claim 1, wherein the three-dimensional object is a three-dimensional object existing ahead,

the current motion and positional states of the three-dimensional object calculated by the current state processing means by the statistical processing are obtained using a front/rear-directional distribution of an own vehicle,

the motion and positional states of the three-dimensional object after the preset time period estimated by the state estimation means are obtained using a front/rear-directional distribution of the own vehicle after the preset time period, and

the contact probability calculation means calculates the probability of contact based on the front/rear-directional distribution of the positional states of the three-dimensional object after the preset time period and the position of the own vehicle.

4. The collision determination device according to claim 1, wherein the three-dimensional object is a three-dimensional object existing on a plane ahead,

the current motion and positional states of the three-dimensional object calculated by the current state processing means by the statistical processing are obtained using a front/rear-directional distribution and a lateral distribution of an own vehicle,

the motion and positional states of the three-dimensional object after the preset time period estimated by the determination object state estimation means are obtained using the front/rear-directional distribution and the lateral distribution of the own vehicle after the preset time period, and

the contact probability calculation means calculates the probability of contact based on the front/rear-directional distribution and the lateral distribution of the positional state of the three-dimensional object after the preset time period and the position of the own vehicle.

5. The collision determination device according to claim 4, further comprising:

target three-dimensional object selection means for extracting three-dimensional objects for determining possibilities of contact from among the detected three-dimensional objects,

wherein more than one three-dimensional objects are selected by the target three-dimensional object selection means.

6. The collision determination device according to claim 5, wherein the control means performs at least one of the deceleration control, alarm control and provision of alert information based on the sum value of the contact probability calculated for each of the target three-dimensional objects.

7. A vehicle behavior control device comprising:

target behavior calculation means for calculating a target behavior of an own vehicle based on a driving state of the own vehicle;

three-dimensional object information detection means for detecting three-dimensional object information ahead of the own vehicle;

determination object selection means for extracting a determination object whose possibility of contact with the own vehicle is determined out of the detected three-dimensional objects;

determination object current state processing means for calculating a current motion and positional states of the determination object;

determination object state estimation means for estimating the motion and positional states of the determination object after a preset time period based on the calculated current motion and positional states of the determination object;

contact probability calculation means for calculating a probability of contact of the own vehicle with the determination object based on the motion and positional states of the determination object after the preset time period estimated by the determination object state estimation means;

target behavior correction amount calculation means for setting an objective function relating at least the probability of contact and a target behavior correction amount and providing a minimum value, and calculating the target behavior correction amount where the objective function takes the minimum value; and

control means for setting a control amount based on the target behavior and the target behavior correction amount.

8. The vehicle behavior control device according to claim 7, wherein the target behavior of the own vehicle calculated by the target behavior calculation means includes a target front/rear-directional force and a target yaw moment.

9. The vehicle behavior control device according to claim 7, wherein the determination object current state processing means calculates the current motion and positional states of the determination object by a statistical processing, and

the determination object state estimation means estimates the motion and positional states of the determination object after the preset time period based on the current motion and positional states of the determination object calculated by the statistical processing.

10. The vehicle behavior control device according to claim 7, wherein the determination object extracted by the determination object selection means is a three-dimensional object existing on a plane ahead of the own vehicle,

the current motion and positional states of the determination object calculated by the determination object current state processing means by the statistical processing are obtained using the front/rear-directional distribution and lateral distribution of the own vehicle,

the motion and positional states of the determination object after the preset time period estimated by the determination object state estimation means are obtained using the front/rear-directional distribution and lateral distribution of the own vehicle after the preset time period, and

the contact probability calculation means calculates the probability of contact based on the front/rear-directional distribution and lateral distribution of the positional state of the determination object after the preset time period and the position of the own vehicle.

11. The vehicle behavior control device according to claim 10, wherein more than one determination objects are set by the determination object selection means.

12. The vehicle behavior control device according to claim 7, further comprising:

frictional circle utilization factor calculation means for calculating a frictional circle utilization factor of the own vehicle after the preset time period,

wherein the target behavior correction amount calculation means presets the objective function including at least the frictional circle utilization factor, the probability of contact and the target behavior correction amount and providing the minimum value, and calculates the target behavior correction amount where the objective function takes the minimum value.