The present invention relates to a technique for preventing a movable body from colliding.
Various techniques for improving a safety of a movable body by preventing a collision thereof have been developed. For example, another movable body is detected by a radar or camera, a time period to the collision is calculated from a distance to the detected another movable body and a relative velocity with respect to the detected another movable body, and a deceleration is performed when the calculated time period is not more than a threshold value.
JP-A-2005-100336 discloses that a movable body has a safety keeping area to perform a collision avoidance operation or output an alarm when the another movable body proceeds into the safety keeping area, and JP-A-2005-254835 discloses that the another movable body has the safety keeping area.
Further, JP-A-2005-56372 discloses that a shape of the safety keeping area is modified in accordance with a traveling direction of the movable body.
In the above prior art, the deceleration may be carried out when the another movable body is getting away from the movable body in a transverse direction, and there is an unfavorable aspect in calculation amount caused by that it is difficult for the safety keeping area of the another movable body to be modified in accordance with a predetermined change in traveling direction of the movable body so that a logical determination for the modification based on the predetermined change in traveling direction of the movable body is required after setting the safety keeping area.
An object of the present invention is to provide a technique for easily and accurately escaping from the collision.
According to the invention, an imaginary safety keeping area around a movable body is determined in accordance with a relative physical value between the movable body and the other movable body so that an escaping control or an alarm us carried out when it is decided that the other movable body will proceed into the safety keeping area.
The technique for easily and accurately escaping from the collision is obtained by the invention.
Other objects, features and advantages of the invention will become apparent from the following description of the embodiments of the invention taken in conjunction with the accompanying drawings.
Hereafter, embodiments are described with an automobile as a movable body, but the movable body does not need to be limited to the automobile.
In this system, the other automobile or a pedestrian is detected by a radar 101 and a camera 102 mounted on the vehicle, a road shape ahead and aside of the vehicle measured by a vehicle ahead road shape detector 105 and a position and traffic-lane of the vehicle detected by a vehicle position velocity traveling direction detector 104 are input through an input device 111 so that a safety keeping area is calculated by a safety keeping area extension calculator 106. When it is detected or predicted by an other vehicle safety keeping area intrusion detector 107 that the other vehicle intrudes or will intrude into the safety keeping area, a vehicle deceleration velocity steering-wheel setting device 108 determines a plan to be output through an outputting device 110 to a velocity steering-wheel controller 109 so that the vehicle escapes. Incidentally, an apparatus and method for escaping from collision of the invention is realized by a program executed by a navigation device or a controller with CPU (central processing unit). Further, in this embodiment, a signal for executing the plan for escaping (which signal may be an ordering signal, or a signal only indicating the intrusion usable to determine the plan for escaping at a signal receiving side) is transmitted through the outputting device 110 to the velocity steering-wheel controller 109, but only the alarm may be output. In such case, the outputting device 110 may output a signal for generating the alarm so that the signal receiving side carries out a predetermined alarm output operation.
The radar 101 and camera 102 mounted on the automobile detect the other automobile, a pedestrian, an obstacle and a traffic lane under the automobile to output information thereof to an object recognizing device 103. The information includes a distance (from the vehicle) to the other vehicle, pedestrian and obstacle, the traffic lane under the vehicle and a distance from a left or right end of the traffic lane.
For detecting the other vehicle or obstacle with the radar, there is a method in which a distance to the object in front of the vehicle, a relative velocity of the object and an angle toward the object are measured by emitting extremely high frequency wave to receive the reflected extremely high frequency wave as disclosed by “Anzen-soukousienn-system wo sasaeru kankyou-ninnsiki-gijutsu” in Hitachi-hyouron Vol 85, No. 5, pp-43-46, published on May 2004. The radar may use a laser or microwave.
A method for recognizing the other vehicle with the camera is disclosed by JP-A-2005-156199. In such method, an edge point of the other vehicle in front of the vehicle is detected by the camera measuring a change in brightness of the other vehicle to be analyzed. For detecting the pedestrian with the camera, the distance is determined from an azimuth difference detected by a stereo-camera. A technique for recognizing the traffic lane with the camera is disclosed by “Anzen-soukousienn-system wo sasaeru kankyou-ninnsiki-gijutsu” in Hitachi-hyouron Vol 85, No. 5, pp-43-46, published on May 2004.
The object recognizing device 103 is described below. The object recognizing device 103 gathers information corresponding to distance and direction of the object (for example, the other vehicle or pedestrian as the other movable body, an object on the ground as the obstacle, a ground point including latitude and longitude, a topography such as a shape of road, or a local information such as a school-zone as described below), an absolute velocity of the object a relative velocity of the object with respect to the vehicle, or a shift vale of the vehicle with respect to the traffic lane, increases an accuracy of the relative position, relative velocity and direction of each of the objects with sensor fusion, and forms a relative position map and relative velocity directional vectors of the vehicle and the objects (the other vehicle, pedestrian and obstacle) to be transmitted to the safety keeping area extension calculator 106 through the inputting device 111.
The vehicle position velocity traveling direction detector 104 is described below. The vehicle position velocity traveling direction detector 104 determines a position of the vehicle in east-longitude, north-latitude, traveling direction, absolute velocity and altitude from GPS (Global Positioning System) of navigation. The direction may be compensated along gyroscope or earth magnetism. The velocity may be measured by a velocity sensor of the vehicle. The position of the vehicle may be compensated along a position correcting signal received from a beacon. The determined position, absolute-velocity and altitude are transmitted to the vehicle ahead road shape detector 105 and the safety keeping area extension calculator 106 through the inputting device 111.
The vehicle position velocity traveling direction detector 104 may provide in addition to the above information, local information such as date, time, school zone, characteristic of city, town or country, weather, dangerous point or area caused by construction or known from experience and so forth. The safety keeping area extension calculator 106 may determine the safety keeping area on the basis of the above information. For example, the safety keeping area is enlarged in response to the information of the school zone.
Incidentally, the information is input through the inputting device 111 from the object recognizing device 103, the vehicle position velocity traveling direction detector 104 and the vehicle ahead road shape detector 105 into the safety keeping area extension calculator 106 in this embodiment, and the inputting device 111 is an interface for receiving the information through LAN or connector in the vehicle from the object recognizing device 103, the vehicle position velocity traveling direction detector 104 and the vehicle ahead road shape detector 105 incorporated in the camera, radar or navigation device. Therefore, when at least one of the object recognizing device 103, the vehicle position velocity traveling direction detector 104 and the vehicle ahead road shape detector 105 is incorporated as another CPU in the vehicle collision avoidance equipment as the embodiment of the invention, the inputting device is a signal transmission line. Alternatively, when functions of those are incorporated as application or driver in the vehicle collision avoidance equipment, the inputting device is an interface software for the application or driver. When the vehicle ahead road shape detector 105 is incorporated in the vehicle collision avoidance equipment, the inputting device 111 is incorporated between the vehicle position velocity traveling direction detector 104 and the vehicle ahead road shape detector 105. Further, the vehicle collision avoidance equipment as the embodiment as well as the inputting device may be incorporated in an engine controller, a following distance controller or a combined controller.
A method for measuring the traveling direction is described below. The traveling direction is measured from a direction indicator or a steering wheel angular sensor. Alternatively, a timing of changing the traffic lane is estimated from a turning position along a traveling course predetermined by the navigation. The traveling course predetermined by the navigation includes the turning position on which the timing of changing the traffic lane is estimated. The changing the traffic lane (the traveling course) means proceeding straight, turning to left, turning to right, moving to left traffic lane or moving to right traffic lane.
The vehicle ahead road shape detector 105 makes reference to a part of the map selected in accordance with the position and traveling direction and altitude of the vehicle obtained by the vehicle position velocity traveling direction detector 104. The map includes information of, for example, the shape of road, usable traffic lane, and a variation in shape of the road along the traveling direction. The information on the map including an image information and information of a traffic lane adjacent to the traveling course are transmitted to the safety keeping area extension calculator 106.
The safety keeping area extension calculator 106 sets the safety keeping area for each of the detected objects (the other vehicle and the pedestrian), and calculates an extension of the safety keeping area. In other words, the imaginary safety keeping area around the vehicle is formed in accordance with relative physical values with respect to the object. An example of the safety keeping area is described with making reference to
In
The lower the absolute velocity of the vehicle is, the greater the degree of expanding the safety keeping area toward the other moving body or in a transverse directional component of the predetermined change in traveling direction is.
The safety keeping area may be formed by any closed curve expanding radially from the vehicle 1 other than the trapezoid. A method for determining an angle θ1 (46) of a left side of the safety keeping area 42 and an angle θ2 (47) of a right side of the safety keeping area 42 is described below. In this embodiment, the left and right sides of the safety keeping area are symmetrical to each other with θ1=θ2 so that θ1 is calculated along formula 1 from the lengths of the upper and lower bottoms.
θ1=atn[(length of upper bottom−length of lower bottom)/2×length of safety keeping area] Formula 1
atn: inverse function of function atn to calculate angle
The length of the safety keeping area is described below. The length of the safety keeping area may be calculated from the absolute velocity of the vehicle 1 or the relative velocity between the vehicle and the object. When the length of the safety keeping area is calculated from the relative velocity between the vehicle and the object, the length of the safety keeping area is a length to the collision against the other vehicle with the deceleration of the vehicle 1 and the relative velocity as calculated along formula 2.
Length of safety keeping area=freely running time period×relative velocity+(relative velocity)2×2/maximum deceleration formula 2
A component of the relative velocity in the traveling direction or an absolute value of the relative velocity vector may be used as the relative velocity. When the other vehicle is in front of the vehicle 1 and the length calculated along the formula 2 has negative value, that is, the other vehicle moves away from the vehicle, the safety keeping area is not formed, or alternatively a maximum one of the safety keeping area (rectangular area as parking space) may be formed. The freely running time period in the formula 2 is a predetermined time period from outputting a control signal to bringing the control into effect. The freely running time period may be zero. The maximum deceleration in the formula 2 is a predetermined deceleration of the system, for example, 0.2 G (G: acceleration of gravity).
When the absolute velocity of the vehicle 1 is used to form the safety keeping area, the length of the safety keeping area is calculated with using the absolute velocity of the vehicle 1 as substitute for the relative velocity in the formula 2.
The safety keeping area shown in
In
Extension of left side of upper bottom=freely running time period×relative velocity in transverse direction+(relative velocity in transverse direction)2×2/maximum deceleration formula 3
When the calculated result of the formula 3 has negative value, the extension of left side of upper bottom is made zero or a predetermined value.
Further, the angle θ1 (55) of the left side is calculated along formula 4.
θ1=atn[extended length of left side of upper bottom/length of safety keeping length] formula 4
A method for a plurality of the safety keeping areas for a plurality of the other vehicles respectively is described below. In
A method for determining the extension of the safety keeping area toward the adjacent traffic lane in accordance with the predetermined change in traveling direction of the vehicle 1 is described with making reference to
02
=atn[extended length of right side of upper bottom/length of safety keeping area] formula 5
When the vehicle will move toward the adjacent traffic lane, the safety keeping area of the vehicle 1 is extended to the adjacent traffic lane so that the vehicle is capable of escaping from the collision against the other vehicle on the adjacent traffic lane while prevented from being decelerated with respect to the other vehicle.
A method for extending the safety keeping area when turning to the right at a traffic intersection is described with making reference to
When moving along a left-hand or right-hand curve, the safety keeping area may be modified in accordance with a front road shape of the vehicle, that is, the shape of the curve.
A method for determining the safety keeping area when the steering wheel of the vehicle is rotated to turn is described with making reference to
Alternatively, when the steering wheel is rotated, as shown in
Length of extension of right side of upper bottom=sin φ×length of safety keeping area formula 6
The other vehicle safety keeping area intrusion detector 107 is described below. The other vehicle safety keeping area intrusion detector decides as to whether the object exists or will exist in the safety keeping area determined for each of the objects and calculated by the safety keeping area extension calculator 106. That is, the other vehicle safety keeping area intrusion detector decides whether or not the object exists or will exist in the safety keeping area. When the object exists or will exist in the safety keeping area, the deceleration or the angular velocity of the steering wheel is set by the vehicle deceleration velocity steering-wheel setting device 108.
A method for forecasting a proceeding of the other vehicle into the safety keeping area of the vehicle is described with making reference to
T=(absolute velocity of vehicle)2/(2×maximum value of radical deceleration) formula 7
For example, the maximum value of radical deceleration may be 0.2 G (G: acceleration of gravity) to calculate the T.
The above described decisions are carried out for each of the objects.
The vehicle deceleration velocity steering-wheel setting device 108 is described below. A method for determining the deceleration and the rotating angle of the steering wheel when each of the objects proceeds into the safety keeping area, is described with making reference to
Deceleration=(relative velocity in y direction)2/(2×distance in y direction)×offset rate formula 8
The offset rate may be calculated as a rate between an overlap length D1203 between the vehicle 1 and the other vehicle and a width W1204 of the vehicle, that is, D/W, as (D+δ)/W (δ: door width of the vehicle and door width of the other vehicle), or as a length of a part of the other vehicle in the safety keeping area and a length of the safety keeping area in the transverse direction. D may have negative value. When the offset rate is (D+δ)/W, there is an effect of that the door of the vehicle is prevented from colliding against the other vehicle even when the door is opened suddenly. Each of the deceleration and the offset rate may be calculated from the current position of the object other than the position of the object after the T seconds. When the calculated offset rate is not more than zero, the offset may be zero for further calculation.
The collision may be prevented by an operation of the steering wheel. A method thereof is described below. For preventing the safety keeping area from overlapping the other vehicle after the T seconds, the safety keeping area is rotated as shown in
These operation are carried out for each of the detected objects, and the highest one of the calculated deceleration is selected. For preventing the steering wheel from being rotated rapidly so that the vehicle is prevented from becoming unstable, relatively lower one of the calculated angular velocities of the rotated steering wheel is selected.
A case where the vehicle passes between the other vehicles is described with making reference to
Finally, the velocity steering-wheel controller 109 is described. The velocity steering-wheel controller outputs to the steering wheel and the brake controller ECU (Electric Control Unit) the deceleration calculated by the vehicle deceleration velocity steering-wheel setting device 108 or a change of velocity along time proceeding calculated from the deceleration, and the angular velocity of the steering wheel or a change in angle of the steering wheel calculated from the angular velocity so that the vehicle is controlled on the basis of such information.
A control flow of the system is described below with making reference to a sequence diagram of
Original values of the angular velocity of the steering wheel and the deceleration are set at zero. For each of the detected other objects whose total number is N, the safety keeping area is set at step 154, it is decided at step 155 as to whether or not the object is or will be in the safety keeping area, and the deceleration or the angular velocity of the steering wheel is determined at step 156 if the object is or will be in the safety keeping area. If the determined deceleration or angular velocity of the steering wheel is maximum in comparison with the previously determined deceleration or angular velocity of the steering wheel, the previously determined deceleration or angular velocity of the steering wheel as a desirable value for preventing the collision is replaced at step 157 by the newly determined deceleration or angular velocity of the steering wheel. The step 154 corresponds to the safety keeping area extension calculator 106 in
After the steps 154-158 are carried out for each of the objects, the deceleration and the angular velocity of the steering wheel are transmitted to the vehicle controller to control the vehicle at step 159. The step 159 corresponds to the velocity steering-wheel controller 109 in
A method for indicating the information for the vehicle driver in the system is described. For indicating the information for the vehicle driver, a display and the system output an alarm before performing the collision avoidance operation. The display as a head-up display or a navigator display shows the map of
The vertical extension of the safety keeping area in the embodiment is described with making reference to
The vertical extension of the safety keeping area in the embodiment for a slope is described below with making reference to
How the embodiment is applicable to a provability of that the other vehicle behind the vehicle 1 collides with the vehicle is described below. When the other vehicle behind the vehicle 1 has the relative velocity of positive value, the safety keeping area is formed to cover a back side of the vehicle 1 so that a provability of collision of the other vehicle with the vehicle is decided from whether or not the other vehicle behind the vehicle is or will be in the safety keeping area. When there is the provability of collision of the other vehicle with the vehicle, the deceleration obtained along the formula 8 is made negative, that is, the vehicle is accelerated.
A method for decreasing an influence of the inclination by measuring the inclination under the vehicle to expand forward in the traveling direction the safety keeping area when the inclination is negative, that is, the vehicle proceeds on the downward slope and to shorten backward the safety keeping area when the vehicle proceeds on the upward slope, is described below. For example, the length of the safety keeping area of the vehicle may be calculated along the formula 2 from a total amount of the maximum deceleration of the vehicle and the acceleration of gravity by the inclination. The inclination of the road under the vehicle may be obtained from an acceleration sensor or information of the inclination recorded on the map and read out in accordance with the position of the vehicle measured by GPS (Global Positioning System).
A method for decreasing a difference between the automatic collision avoiding operation and a collision avoiding operation by the driver by expanding the safety keeping area in accordance with an increase of the deceleration ordered by the driver, an increase of reaction delay of the driver or an increase of fatigue degree of the driver, is described below. When the driver shows the increase of the ordered deceleration, the increase of reaction delay or the increase of fatigue degree, a margin is added to the safety keeping area obtained along the formula 2. The margin is determined from a table including a relation ship between the margin and each of the ordered deceleration, the reaction delay or the fatigue degree. A degree of change in the ordered deceleration is calculated from a standard deviation of the deceleration and a degree of distortion thereof obtained from the vehicle as disclosed by “Sharyou-jouhou wo katsuyousita telematique anzen-unten-shien eno torikumi” by Tanikoshi et al. in Hitachi-hyouron Vol 88, No. 08, pp-22-25, published on August 2005. The reaction delay may be obtained statistically from the recorded information of the vehicle such as a time period from releasing an accelerator pedal to pressing a brake pedal. The fatigue degree may be obtained from a measured inconscient swing of the steering wheel or a biological information obtained from saliva.
A method for determining the deceleration in accordance with a degree of urgency as a distance between the other object and the vehicle is described below. In this method, a plurality of the safety keeping areas analogous to each other are formed, and the degree of urgency is determined in accordance with which is the closest one of the safety keeping areas penetrated by the other object so that the deceleration is determined as a product of the deceleration calculated along the formula 8 and a coefficient corresponding to the degree of urgency. A relationship between the coefficient and the degree of urgency is predetermined.
The other movable body which is not detected from the movable body can be detected by an infra-communication or a communication between the movable bodies, or the safety keeping area may be formed in a blind region of the movable body.
The embodiments are described above, but in the prior art, for example, in a case where single safety area is formed around the movable body, when the other movable body moving away from the movable body in the transverse direction is in the safety keeping area, the movable body is decelerated.
In a case where the other movable body have the safety keeping areas respectively, the deceleration of the movable body is not performed for the other movable body moving away from the movable body, but a difficulty of forecasting a future traveling direction of the other movable body causes a difficulty of extending or shortening the safety body in the future traveling direction of the other movable body.
Further, since it is difficult for the safety keeping area of the other movable body to be modified in accordance with a future change in traveling direction of the movable body, a logical decision for modifying the safety keeping area of the other movable body in accordance with the future change in traveling direction of the movable body is necessary after forming the safety keeping area of the other movable body, to cause an undesirable calculation amount.
In a method for modifying the safety keeping area along the road shape on the future traveling coarse of the movable body, since the future change in traveling coarse of the movable body is not taken into consideration, it is difficult for the collision avoidance operation is performed when the traveling coarse of the movable body is changed.
Each of the above embodiments solve solves at least one of these problems, and includes means for detecting the other movable bodies with camera or radar, means for determining a safety keeping area for each of the detected other movable bodies and expanding the safety keeping area in a traveling direction of the movable body in accordance with a relative velocity while expanding the safety keeping area toward the other movable body, means for determining a future change in traveling direction of the movable body, means for expanding the safety keeping area in a future traveling direction of the movable body, means for deciding as to whether or not one of the other movable bodies proceeds into corresponding one of the safety keeping areas, means for determining an operation degree for avoiding the collision when it is decided that the one of the other movable bodies proceeds into the corresponding one of the safety keeping areas, and means for at least one of controlling the movable body in accordance with the operation degree and outputting an alarm.
According to this, the safety keeping area for each of the other movable bodies is formed around the movable body, and the collision avoiding operation is prevented from being performed for the other movable body moving away from the movable body. Further, the safety keeping area is modified in accordance with the future change in traveling coarse of the movable body.
In these embodiments, the safety keeping area is expanded in a future traveling direction of the movable body on the basis of the future change in traveling coarse of the movable body, so that for example, a vehicle is prevented from colliding with the other vehicle on a traffic lane adjacent to a traffic lane under the vehicle to be applicable to a shift between the traffic lanes. Further, the safety keeping area is modified in accordance with the future change in traveling coarse of the movable body to make another logical treatment according to the driver's intention unnecessary so that a calculation amount is decreased.
Further, since the safety keeping area is expanded toward the detected movable body, the collision avoiding operation can be performed when the movable body passes between the other movable bodies adjacent to the movable body.
It should be further understood by those skilled in the art that although the foregoing description has been made on embodiments of the invention, the invention is not limited thereto and various changes and modifications may be made without departing from the spirit of the invention and the scope of the appended claims.
Number | Date | Country | Kind |
---|---|---|---|
2007-078122 | Mar 2007 | JP | national |