The present invention relates to a collision position predicting device which serves to predict a collision position at which a moving object and an own or subject vehicle collide with each other.
In the past, in order to carry out driving support so as to avoid a collision between a moving object such as a pedestrian, bicycle, etc., crossing a road, and an own or subject vehicle, there has been developed a collision position predicting device which serves to predict the position of a collision between the moving object and the subject vehicle.
In Patent Document 1, there is disclosed a technique in which an intersection vector of an intersection at which a subject vehicle turns to the right or to the left is set from map data, and a moving direction vector of a pedestrian is set from pedestrian information, whereby the position of a collision between the subject vehicle and the pedestrian is predicted from both of the vectors. Moreover, in Patent Document 1, there are disclosed a technique in which the moving method vector of the pedestrian is set by the use of position information transmitted from the pedestrian, and a technique in which in cases where the moving direction of the pedestrian detected from the pedestrian's position information has been the same direction a plurality of times in a continuous manner, the moving direction vector is set to that moving direction.
In Patent Document 2, there is disclosed a technique in which in cases where the direction of the relative movement of a pedestrian has a component of movement to an orthogonal direction with respect to the direction of movement of a subject vehicle, a warning is generated by a warning unit. In Patent Document 3, there is disclosed a technique in which when the distance between a moving object and a pedestrian crossing is equal to or less than a predetermined value, a determination is made that the moving object crosses the pedestrian crossing.
Patent Document 1: Japanese patent application laid-open No. 2008-065482
Patent Document 2: Japanese patent application laid-open No. 2008-197720
Patent Document 3: Japanese patent application laid-open No. 2004-178610
In cases where the position of a collision between a moving object crossing a road and a subject vehicle is predicted, it is necessary to obtain a moving vector of the moving object. However, in cases where the moving vector of the moving object is calculated based on the position information on the moving object, there will be a fear that the following problems may occur.
In addition, for example, in cases where a vector with a different direction has been calculated at one time when a vector with a fixed direction has been calculated a plurality of times in a continuous manner as the moving vector of the moving object, it is possible to obtain the moving vector with the fixed direction by carrying out the processing of excluding the vector with the different direction. However, in cases where the direction of the moving vector changes in a frequent manner, as shown in
Moreover,
The present invention has been made in view of the above-mentioned problems, and has for its object to provide a technique which is capable of detecting the position of a collision between a moving object crossing a road and an own or subject vehicle with a higher degree of accuracy.
The present invention resides in that in cases where a moving object crossing a road into which a subject vehicle has entered is detected at the time when the subject vehicle has turned to the right or to the left, the direction of a moving vector of the moving object is fixed to a direction which is set based on a shape of the road into which the subject vehicle has turned to the right or to the left, and the position of a collision between the moving object and the subject vehicle is predicted based on the moving vector of which the direction is fixed.
More specifically, a collision position predicting device according to the present invention is characterized by comprising:
moving object detection unit to detect a moving object on a road; and
collision position predicting unit to predict, upon detection of the moving object crossing the road by the moving object detection unit, a collision position of the moving object and a subject vehicle based on a moving vector of the moving object;
wherein in cases where the moving object crossing the road into which the subject vehicle has entered is detected at the time when the subject vehicle has turned to the right or to the left, the direction of the moving vector of the moving object to be used for the prediction of the collision position by said collision position predicting unit is set based on a shape of the road into which the subject vehicle has turned to the right or to the left.
According to the present invention, even if the moving object is moving in a staggering or fluctuating manner at the time of predicting the collision position of the moving object and the subject vehicle, the direction of the moving vector thereof is fixed in a fixed direction. Accordingly, it is possible to detect the collision position of the moving object crossing the road and the subject vehicle with a higher degree of accuracy.
In the present invention, in cases where the moving object crossing the road into which the subject vehicle has entered is detected at the time when the subject vehicle has turned to the right or to the left, the direction of the moving vector of the moving object to be used for the prediction of the collision position by the collision position predicting unit may be set to a direction vertical to the road into which the subject vehicle has entered.
Even though the moving object crossing the road is moving in a staggering or fluctuating manner, there is a high possibility that the moving object is basically going or advancing in a direction vertical to the road. For that reason, by setting the direction vertical to the road as the direction of the moving vector of the moving object, it is possible to detect the collision position of the moving object crossing the road and the subject vehicle with a higher degree of accuracy.
In this case, the moving vector calculated from the position information on the moving object may be decomposed or divided into a road direction component in the direction of the road into which the subject vehicle has entered, and a vertical direction component which is vertical or orthogonal to that road, and the vertical direction component may be used as the moving vector of the moving object which is used for the prediction of the collision position by the collision position predicting unit.
In addition, in cases where a pedestrian crossing is formed or located on the road into which the subject vehicle has turned to the right or to the left to enter, and the moving object crossing the road detected by the moving object detection unit exists on the pedestrian crossing, there is a high possibility that the moving object is going or advancing in the direction of the pedestrian crossing. Accordingly, in this case, the direction of the moving vector of the moving object to be used for the prediction of the collision position of the moving object and the subject vehicle by the collision position predicting unit may be set to the direction of the pedestrian crossing in preference to the shape of the road. According to this, it is possible to detect the collision position of the moving object crossing the road and the subject vehicle with a higher degree of accuracy.
In above case, the moving vector calculated from the position information on the moving object may be decomposed or divided into a pedestrian crossing direction component and a vertical direction component which is vertical or orthogonal to the pedestrian crossing, and the pedestrian crossing direction component may be used as the moving vector of the moving object which is used for the prediction of the collision position by the collision position predicting unit.
According to the present invention, it is possible to predict the position of a collision between a moving object crossing a road and an own or subject vehicle with a higher degree of accuracy.
Hereinafter, specific embodiments of the present invention will be described based on the attached drawings. However, the dimensions, materials, shapes, relative arrangements and so on of component parts described in the embodiments are not intended to limit the technical scope of the present invention to these alone in particular as long as there are no specific statements.
<First Embodiment>
Reference will be made to a first embodiment of a collision position predicting device according to the present invention, based on
(Schematic Construction)
The millimeter wave radar 2 is arranged at the front side of the subject vehicle, and serves to detect the direction and distance from the subject vehicle of each target object existing ahead of the subject vehicle. The millimeter wave radar 2 scans millimeter waves within a predetermined range ahead of the subject vehicle, receives reflected waves from target objects, and detects the distance to each target object in each direction in which the reflected waves are detected. Such detection by the millimeter wave radar 2 is carried out at each predetermined period of time. The millimeter wave radar 2 outputs a signal corresponding to the direction and distance thus detected to the radar ECU 3 in a successive manner.
The radar ECU 3 calculates the position with respect to the subject vehicle of the target object existing ahead of the subject vehicle. The radar ECU 3 is composed, as a main component, of a computer including a CPU, a ROM, a RAM, and so on. The radar ECU 3 is provided with a target object relative position calculation part 31 and a target object relative speed calculation part 32.
The target object relative position calculation part 31 calculates, based on the signal inputted thereto from the millimeter wave radar 2, the position (relative position) with respect to the subject vehicle of each target object detected by the millimeter wave radar 2. This relative position is calculated as a distance and a lateral position thereof. Here, the distance and the lateral position are a component in a fore and aft or longitudinal direction of the subject vehicle and a component in a lateral or transverse direction of the subject vehicle, respectively, into which a rectilinear distance between a target object and the subject vehicle is divided, wherein the component in the longitudinal direction is assumed to be “the distance”, and the component in the lateral or transverse direction is assumed to be “the lateral position”. The target object relative position calculation part 31 outputs a signal corresponding to the result of the calculation to the system ECU 8.
The target object relative speed calculation part 32 calculates the speed (relative speed) with respect to the subject vehicle of the target object detected by the millimeter wave radar 2. The target object relative speed calculation part outputs a signal corresponding to the result of this calculation to the system ECU 8.
The steering angle sensor 4 is mounted on a steering shaft of the subject vehicle, and serves to detect the steering angle of the steering shaft of the subject vehicle. The steering angle sensor 4 is provided with a rotary encoder, etc., and serves to detect the direction and the magnitude of the steering angle which has been inputted by the driver of the subject vehicle. In addition, the steering angle sensor 4 outputs a steering angle signal corresponding to the direction and the magnitude of the steering angle thus detected to the system ECU 8.
The yaw rate sensor 5 is arranged in a central portion of the vehicle body of the subject vehicle, and serves to detect the yaw rate of the subject vehicle. In addition, the yaw rate sensor 5 outputs a signal corresponding to the yaw rate thus detected to the system ECU 8.
The wheel speed sensor 6 is provided for each of the wheels of the subject vehicle, and serves to detect wheel speed pulses. In addition, the wheel speed sensor 6 outputs a wheel speed pulse signal corresponding to the wheel speed pulses thus detected to the system ECU 8.
The navigation system 7 is a device which serves to calculate the current position of the subject vehicle by receiving signals from artificial satellites. Road (route) information (road map) is stored in advance in the navigation system 7. And, the navigation system 7 calculates the current position of the subject vehicle on the route information. In addition, the navigation system 7 outputs a signal corresponding to the result of this calculation to the system ECU 8.
The system ECU 8 serves to predict the collision position of the target object detected by the millimeter wave radar 2 and the subject vehicle, and to determine whether there is a possibility of a collision between the target object and the subject vehicle. The system ECU 8 is composed, as a main component, of a computer which includes a CPU, a ROM, a RAM, and so on. The system ECU 8 predicts the collision position by carrying out predetermined processing based on signals inputted from the radar ECU 3, the steering angle sensor 4, the yaw rate sensor 5, the wheel speed sensor 6, and the navigation system 7. The system ECU 8 is provided with a right and left turn determination calculation part 81, a crossing moving object determination calculation part 82, a road shape obtaining part 83, a road direction and road vertical direction calculation part 84, a the moving vector calculation part 85, a collision position calculation part 86, and a collision determination calculation part 87. The details of each part will be described later.
In cases where a determination is made by the system ECU 8 that the target object and the subject vehicle can collide with each other, an ON signal is transmitted from the system ECU 8 to an operation device 9. The operation device 9 includes a warning unit 91 and a brake control unit 92. Upon reception of the ON signal, the warning unit 91 carries out a warning to the driver by means of displaying it on a monitor, sounding, etc. Also, upon reception of the ON signal, the brake operating unit 92 operates a brake of the subject vehicle in an automatic manner. Here, note that other devices, such as an automatic steering apparatus, etc., to perform collision avoidance control may be included in the operation device 9. Moreover, a device to carry out collision damage reduction control, such as a seat belt control device, a seat position control device, an air bag control device, and so on, may be included in the operation device 9.
(Collision Position Predicting Method)
Next, in this embodiment, reference will be made to a method, based on
In this embodiment, the collision position of the crossing moving object and the subject vehicle is predicted based on the moving vector of the crossing moving object, the speed of the subject vehicle, etc. However, the crossing moving object does not always go in a fixed direction, but may move in a staggering or fluctuating manner, as shown in
Accordingly, in this embodiment, the direction of the moving vector of the crossing moving object A used for the prediction of the collision position of the crossing moving object A and the subject vehicle 100 is set based on the shape of a road to which the subject vehicle 100 has turned right (or the shape of a road to which the subject vehicle has turned left in cases where the subject vehicle has turned to the left). More specifically, as shown by solid line arrows in
Even if the crossing moving object is moving in a staggering manner, there is a very high possibility that the crossing moving object is basically going in the road vertical direction. In addition, by calculating the moving vector of the crossing moving object in the manner as mentioned above, the direction of the moving vector can be fixed to the road vertical direction. Accordingly, by predicting the collision position of the crossing moving object and the subject vehicle based on the moving vector calculated in this manner, it becomes possible to predict that collision position with a high degree of accuracy.
(Collision Position Predicting Flow)
A collision position predicting flow according to this embodiment will be described based on a flow chart shown in
In this flow, first in step S101, it is determined whether the subject vehicle is in a right turn state or in a left turn state. In this embodiment, such a determination is carried out based on at least one of the detected values of the steering angle sensor 4 and the yaw rate sensor 5. Here, note that in cases where the collision position predicting system 1 is provided with an image sensor which serves to pick up an image ahead of the subject vehicle, the above determination can also be carried out based on the image picked up by the image sensor. Moreover, the above determination can also be carried out based on the state of a vehicle mounted switch, such as a winker (directional indicator), etc., which is turned on at the time of right turn or left turn, or based on the travel lane of the subject vehicle, etc., detected by the image sensor or the navigation system 7.
In this embodiment, when the subject vehicle is in the right turn state, the value of a right/left turn state flag is set to “1”, and when the subject vehicle is in the left turn state, the value of the right/left turn state flag is set to “2”, and when the subject vehicle is in a straight travel state, the value of the right/left turn state flag is set to “0”. In step S101, when the value of the right/left turn state flag is “1” or “2”, an affirmative determination is made, and the processing of step S102 is then carried out. On the other hand, when the value of the right/left turn state flag is “0”, a negative determination is made, and the processing of step S106 is then carried out.
In step S102, it is determined whether a target object detected by the millimeter wave radar 2 is a crossing moving object. Such a determination is made based on the calculation results in the target object relative position calculation part 31 and the target object relative speed calculation part 32 of the radar ECU 3, for example. In addition, a determination as to whether the target object is a pedestrian or a bicycle may be made based on the strength of reception waves received by the millimeter wave radar 2. In this case, when a determination is made that the target object is a pedestrian or a bicycle, it is decided that the target object is a crossing moving object.
In this embodiment, when the target object is a crossing moving object, the value of a crossing moving object flag is set to “1”, whereas when the target object is not a crossing moving object, the value of the crossing moving object flag is set to “0”. In step S102, when the value of the crossing moving object flag is “1”, an affirmative determination is made, and the processing of step S103 is then carried out. On the other hand, when the value of the crossing moving object flag is “0”, a negative determination is made, and the processing of step S106 is then carried out.
In step S106 after a negative determination is made in the above-mentioned step S101 or S102, the collision position of the target object and the subject vehicle detected by the millimeter wave radar 2 is predicted according to a conventional method. In other words, the collision position is predicted based on a moving vector which is calculated based on the position information on the target object.
In step 103, the shape of a road to which the subject vehicle has turned right or left is obtained based on the current position of the subject vehicle calculated by the navigation system 7 and its road or route information. Here, note that in cases where the collision position predicting system 1 is provided with an image sensor which serves to pick up an image ahead of the subject vehicle, the shape of the road may also be obtained from the image picked up by the image sensor. In addition, the shape of the road may also be obtained based on a signal inputted from the millimeter wave radar 2. Moreover, a communication medium may be arranged on the road or in a structure in the surroundings of the road, so that the shape of the road may also be obtained based on information received from the communication medium.
Then, in step S104, the road direction and the road vertical direction with respect to the road into which the subject vehicle has turned to the right or of the left to enter are calculated based on the shape of the road obtained in step 103.
Subsequently, in step S105, the moving vector of the crossing moving object to be used for the prediction of the collision position is calculated. In other words, the temporary moving vector of the crossing moving object is calculated, and then it is further decomposed into individual components in the road direction and in the road vertical direction, respectively, which have been calculated in step S104. Then, the road vertical direction component of the temporary moving vector is calculated as the moving vector of the crossing moving object used for the prediction of the collision position.
Thereafter, in step S106, the collision position of the crossing moving object and the subject vehicle is predicted based on the moving vector of the crossing moving object calculated in step S105, the speed of the subject vehicle, etc.
Here, note that in the system ECU 8, the processing of the above-mentioned step 101 is carried out by the right and left turn determination calculation part 81, and the processing of the above-mentioned step S102 is carried out by the crossing moving object determination calculation part 82. In addition, the processing of the above-mentioned step S103 is carried out by the road shape obtaining part 83, and the processing of the above-mentioned step S104 is carried out by the road direction and road vertical direction calculation part 84. Moreover, the processing of step S105 is carried out by the moving vector calculation part 85, and the processing of step S106 is carried out by the collision position calculation part 86.
Then, based on whether the collision position of the crossing moving object and the subject vehicle predicted according to the above-mentioned flow satisfies a predetermined condition, it is determined whether the crossing moving object and the subject vehicle may collide with each other. Here, the predetermined condition is, for example, that the collision position thus predicted exists on the road on which the subject vehicle is travelling. This determination is carried out by the collision determination calculation part 87.
Here, note that in this embodiment, the millimeter wave radar 2 corresponds to moving object detection unit according to the present invention. In place of the millimeter wave radar 2, or in addition to the millimeter wave radar 2, it is also possible to use, as the moving object detection unit according to the present invention, another sensor, such as an image sensor, etc., which can detect the target object. In addition, in this embodiment, the collision position calculation part 86 of the system ECU 8 corresponds to collision position predicting unit according to the present invention.
<Second Embodiment>
Reference will be made to a second embodiment of a collision position predicting device according to the present invention, based on
(Schematic Construction)
Here, note that in this embodiment, a target object existing ahead of the subject vehicle may be detected based on the result of detection by the millimeter wave radar 2 and the image picked up by the image sensor 10.
In addition, the system ECU 8 according to this embodiment is provided with a pedestrian crossing detection part 88, and a pedestrian crossing direction and pedestrian crossing vertical direction calculation part 89. The details of each part will be described later.
(Collision Position Predicting Method)
A pedestrian crossing may be formed or arranged on a road into which the subject vehicle has turned to the right or to the left to enter. Here, in this embodiment, based on
In cases where the crossing moving object exists on the pedestrian crossing, even if the crossing moving object is going in a staggering manner, there is a very high possibility that the crossing moving object is going along the direction of the pedestrian crossing, irrespective of the shape of the road. Accordingly, in such a case, in this embodiment, the direction of the moving vector of the crossing moving object used for the prediction of the position of a collision between the crossing moving object and the subject vehicle is set to the direction of the pedestrian crossing in preference to the shape of the road.
By calculating the moving vector of the crossing moving object in this manner, the direction of the moving vector can be fixed to the pedestrian crossing direction which is a basic direction of movement of the crossing moving object. Accordingly, by predicting the collision position of the crossing moving object and the subject vehicle based on the moving vector calculated in this manner, it becomes possible to predict that collision position with a high degree of accuracy.
(Collision Position Predicting Flow)
A collision position predicting flow according to this embodiment will be described based on a flow chart shown in
In this embodiment, in cases where a determination is made in step S102 that a target object detected by the millimeter wave radar 2 is a crossing moving object, the processing of step S203 is then carried out. In step S203, it is determined, based on the image picked up by the image sensor 10, whether there is a pedestrian crossing formed on the road into which the subject vehicle has entered.
In this embodiment, in cases where a pedestrian crossing is detected by the pedestrian crossing detection part 88 from the image of the road into which the subject vehicle has entered and which has been picked up by the image sensor 10, the value of a pedestrian crossing flag is set to “1”, whereas in cases where a pedestrian crossing is not detected from the image, the value of the pedestrian crossing flag is set to “0”. In step S203, when the value of the pedestrian crossing flag is “1”, an affirmative determination is made, and the processing of step S204 is then carried out. On the other hand, when the value of the pedestrian crossing flag is “0”, a negative determination is made, and the processing of step S103 is then carried out.
In step S204, it is determined whether a crossing moving object exists on the pedestrian crossing. When a crossing moving object exists on the pedestrian crossing, the value of a moving object position flag is set to “1”, whereas when a crossing moving object does not exist on the pedestrian crossing, the value of the moving object position flag is set to “0”. In step S204, when the value of the moving object position flag is “1”, an affirmative determination is made, and the processing of step S205 is then carried out. On the other hand, when the value of the moving object position flag is “0”, a negative determination is made, and the processing of step S103 is then carried out.
In step S205, the pedestrian crossing direction and the pedestrian crossing vertical direction of the pedestrian crossing on which the crossing moving object exists are calculated based on the image picked up by the image sensor 10. Here, note that in the system ECU 8, the processing of the step S205 is carried out by the pedestrian crossing direction and pedestrian crossing vertical direction calculation part 89.
Subsequently, in step S105, the moving vector of the crossing moving object to be used for the prediction of the collision position is calculated. In this case, in step S105, the temporary moving vector of the crossing moving object is calculated, and then it is further decomposed into individual components in the pedestrian crossing direction and in the pedestrian crossing vertical direction, respectively, which have been calculated in step S205. Then, the pedestrian crossing direction component of the temporary moving vector is calculated as the moving vector of the crossing moving object to be used for the prediction of the collision position.
This application is a continuation of PCT international application No. PCT/JP2010/050229 filed on 12 Jan. 2010 and claims priority of it, the entire contents of which are expressly incorporated by reference herein.
Number | Name | Date | Kind |
---|---|---|---|
6035053 | Yoshioka et al. | Mar 2000 | A |
20010020217 | Matsuno | Sep 2001 | A1 |
20080243389 | Inoue et al. | Oct 2008 | A1 |
20100001880 | Kraft et al. | Jan 2010 | A1 |
20100030474 | Sawada | Feb 2010 | A1 |
20100073194 | Ghazarian | Mar 2010 | A1 |
20100094502 | Ito et al. | Apr 2010 | A1 |
20100199283 | Kido et al. | Aug 2010 | A1 |
20100201509 | Hara et al. | Aug 2010 | A1 |
20100305858 | Richardson | Dec 2010 | A1 |
20110071731 | Eidehall et al. | Mar 2011 | A1 |
20110163904 | Alland et al. | Jul 2011 | A1 |
20110169626 | Sun et al. | Jul 2011 | A1 |
Number | Date | Country |
---|---|---|
6-215300 | Aug 1994 | JP |
H10-105891 | Apr 1998 | JP |
H11-115660 | Apr 1999 | JP |
2000-247207 | Sep 2000 | JP |
2000-251200 | Sep 2000 | JP |
2002-075494 | Mar 2002 | JP |
2002-260192 | Sep 2002 | JP |
2004-178610 | Jun 2004 | JP |
2006-309445 | Nov 2006 | JP |
2007-001405 | Jan 2007 | JP |
2008-65482 | Mar 2008 | JP |
2008-197720 | Aug 2008 | JP |
2009-295184 | Dec 2009 | JP |
2008038369 | Apr 2008 | WO |
Entry |
---|
Office Action on Dec. 3, 2013 in Japanese Patent Application No. 2011-549800. |
Number | Date | Country | |
---|---|---|---|
20130013184 A1 | Jan 2013 | US |
Number | Date | Country | |
---|---|---|---|
Parent | PCT/JP2010/050229 | Jan 2010 | US |
Child | 13547117 | US |