Background of the Invention
1. Field of the invention
The present invention relates to a drive assist system for raising an alarm when a vehicle moves out from the lane and more particularly to a drive assist system capable of controlling the alarm according to situations.
2. Prior Arts
There is an idea of realizing a safety of a vehicle by positively assisting a driver's operation and a system introducing this idea is a so-called Active Drive Assist (ADA) System. A primary function of the ADA system is to estimate a hazard of a collision with a forward vehicle, a hazard of a contact with an object, a possibility of a moving-out from a lane of a road and the like, based on surrounding information or running conditions of a vehicle and to inform a driver of these hazardous possibilities or to activate various control devices.
There are known apparatuses employing a laser radar and the like to collect surrounding information. Further, the inventor of the present invention proposes, in Japanese Patent Application Laid-open No. Toku-Kai-Hei 5-265547, a technique in which picture images taken by cameras of the scenery in front of the vehicle are processed to recognize road and traffic conditions in the form of three-dimensional information.
A lane moving-out prevention technique which is one of the functions of the ADA system is for informing drivers of hazard by a warning device and the like, when vehicles come close to the lane marker or move out therefrom due to drivers' inadvertent behaviors such as sudden drowsiness falling on drivers or inattentive driving. Various technologies have been developed to prevent the moving-out from the lane.
However, in the real world, there are cases where drivers are required to negotiate roads crowded with pedestrians or parked vehicles and as a result, drivers often move out of lanes to avoid a contact with those pedestrians or parked vehicles.
In order to make this type of the ADA system more practicable, these drivers' intentional behaviors must be discriminated from inadvertent ones as described above to control or suppress the issuance of alarms.
With respect to the ADA system capable of reflecting drivers' intention, Japanese Patent Application Laid-open No. Toku-Kai-Hei discloses a technology wherein an alarm is raised only when the vehicle moves out from the lane without operating the turn signal lever.
However, drivers not always move out from the lane while the turn signal lever is operated. For example, when the vehicle travels on ordinary roads, in a case where some other vehicle or an obstacle jumps out in front of the vehicle, drivers may move out from the lane without having a leeway for operating the turn signal lever. According to the prior art, in such a case, an alarm is raised in the same manner regardless of drivers' intention.
Therefore, in order to make the ADA system more usable, it is required that the warning device of the ADA system is stopped or suppressed (for example, in case of a sound-based warning device, reduce the sound level, change the tone of the sound, stop the sound and the like) according the necessity of the warning.
Summary of the Invention
It is an object of the present invention to provide a drive assist system capable of stopping or suppressing an alarm in case of an intentional lane moving-out.
To achieve the above object, the drive assist system according to a first aspect of the present invention comprises:
a running environment detecting means for detecting running conditions of said self vehicle, a position of a self vehicle, a position of a self lane and a position of a neighboring lane and for recognizing objects existing on the self lane and the neighboring lane in the relationship with the position of the self vehicle;
a lane moving-out judging means based on information obtained from the running environment detecting means for comparing the position of the self vehicle with the position of the self lane and for judging a lane moving-out from the self lane of the self vehicle;
a warning signal generation judging means for outputting a signal to raise an alarm when the self vehicle moves out from the self lane when the self vehicle moves out from the self lane and at least when it is judged based on the information obtained from the running environment judging means that the neighboring lane does not exist in the direction of moving out; and
a warning control means for operating an warning device based on the signal from the warning signal generation judging means.
Further, according to a second aspect of the present invention, the drive assist system comprises:
a running environment detecting means for detecting running conditions of said self vehicle, a position of a self vehicle, a position of a self lane and a position of a neighboring lane and for recognizing objects existing on the self lane and the neighboring lane in the relationship with the position of the self vehicle;
a lane moving-out judging means based on information obtained from the running environment detecting means for comparing the position of the self vehicle with the position of the self lane and for judging a lane moving-out from the self lane of the self vehicle;
a warning signal generation judging means for outputting a signal to raise an alarm when the self vehicle moves out from the self lane in the direction of a neighboring lane of the self lane and at least when it is judged based on the information obtained from the running environment judging section that an object exists on the neighboring lane and that the object is an obstacle to the self vehicle; and
a warning control means for operating an warning device based on the signal from the warning signal generation judging means.
Further, according to a third aspect of the present invention, the drive assist system comprises:
a running environment detecting means for detecting running conditions of said self vehicle, a position of a self vehicle, a position of a self lane and a position of a neighboring lane and for recognizing objects existing on the self lane and the neighboring lane in the relationship with the position of the self vehicle;
a lane moving-out judging means based on information obtained from the running environment detecting means for comparing the position of the self vehicle with the position of the self lane and for judging a lane moving-out from the self lane of the self vehicle;
a warning signal generation judging means for outputting a signal to stop or suppress an alarm when the self vehicle moves out from the self lane and at least when it is judged based on the information obtained from the running environment judging means that a width of the self lane is narrower than a predetermined value; and
a warning control means for operating an warning device based on the signal from the warning signal generation judging means.
Furthermore, according to a fourth aspect of the present invention, the drive assist system comprises:
a running environment detecting means for detecting running conditions of said self vehicle, a position of a self vehicle, a position of a self lane and a position of a neighboring lane and for recognizing objects existing on the self lane and the neighboring lane in the relationship with the position of the self vehicle;
a lane moving-out judging means based on information obtained from the running environment detecting means for comparing the position of the self vehicle with the position of the self lane and for judging a lane moving-out from the self lane of the self vehicle;
a warning signal generation judging means for outputting a signal to stop or suppress an alarm when the self vehicle moves out from the self lane and at least when it is judged based on the information obtained from the running environment judging section that an object exists on the self lane within a preestablished range and that the object is an obstacle to the self vehicle; and
a warning control means for operating an warning device based on the signal from the warning signal generation judging means.
Description of the Drawings
FIG. 1 is a functional block diagram of a drive assist system according to the present invention;
FIG. 2 is a schematic diagram of a drive assist system according to the present invention;
FIG. 3 is an explanatory view of data detected by a road/object detecting section;
FIG. 4 is a view for explaining a judgment of a lane moving-out;
FIG. 5a is an explanatory view showing a relationship between a self vehicle and an oncoming vehicle;
FIG. 5b is an explanatory view showing a relationship between a self vehicle and a preceding vehicle;
FIGS. 6a through 6e are views showing examples of various cases where there is a possibility of avoiding obstacles;
FIG. 7 is an explanatory view showing a range of detection;
FIG. 8 is a flowchart of a drive assist control; and
FIG. 9 is a flowchart continued from FIG. 8.
Detailed Description of the Invention
Referring now to FIG. 2, numeral 1 denotes a vehicle (self vehicle) on which a drive assist system 2 according to the present invention is mounted. The drive assist system 2 has a function of a lane moving-out prevention in which a warning is raised when the vehicle comes close to the lane marker of a road.
The drive assist system 2 has a pair of CCD cameras 3 disposed in the frontal portion of the passenger compartment at a specified transversal interval on the left and right sides of the vehicle 1 in order to take stereoscopic pictures of the scenery at the front of the vehicle 1 from different view points.
The CCD cameras 3 are connected with an image processing section 4 in which three-dimensional distance distribution data are formed based on pictures of the scenery taken by the CCD cameras 3. Further, the image processing section 4 is connected with a control apparatus 6 for outputting a warning signal to a warning device 7 based on the distance distribution data and a vehicle speed v.sub.1 of the self vehicle when the vehicle 1 moves out of the lane marker. The vehicle speed v.sub.1 is detected by a vehicle speed sensor 5 and sent to the control apparatus 6.
The image processing section 4 calculates distance information over an entire image based on the deviation amount of a corresponding position with respect to a pair of the stereoscopic pictures taken by the CCD cameras 3 according to the principle of triangulation and forms distance images presenting three-dimensional distribution based on the distance information to output these distance images to the control apparatus 6.
The control apparatus 6 is formed by a multi-microprocessor system in which necessary information is extracted from the distance images processed in the image processing section 4 and a lane moving-out prevention control is performed based on the vehicle speed v.sub.1 detected by the vehicle speed sensor 5.
Further, as shown in FIG. 1, the control apparatus 6 comprises a road/object detecting section 11, a lane moving-out judging section 12, a warning signal generation judging section 13 and a warning control section 14.
The road/object detecting section 11 detects lane markers, other vehicles, objects other than vehicles and the like separately from the distance images inputted from the image processing section 4 and obtains the image data of the road and objects. In case of a road with two lanes as shown in FIG. 3, for example, the position and the configuration of lane markers H.sub.1, H.sub.3, H.sub.2 (left and right ones and a center one, respectively), a preceding vehicle M.sub.1 traveling on the self lane, a parked vehicle M.sub.2, an oncoming vehicle M.sub.3 traveling on the counter lane, a vehicle M.sub.4 crossing the self lane, a pedestrian S.sub.1 crossing the road, a pedestrian S.sub.2 walking along the lane and the other obstacle S.sub.3 are obtained based on the image data in terms of coordinates X, Y on a coordinate system composed of an X coordinate axis in the vehicle traveling direction and a Y coordinate axis which is perpendicular to the X coordinate axis X. Further, data of velocity vector for those objects M.sub.1, M.sub.2, M.sub.3, M.sub.4, S.sub.1, S.sub.2 and S.sub.3 are also calculated.
Thus, a running environment detecting means is formed by the vehicle speed sensor 5, a pair of the CCD cameras 3, the image processor 4 and the road/object detecting section 11.
The lane moving-out judging section 12 serving as a lane moving-out judging section 12 receives the data from the road/object detecting section 11 and judges whether or not the vehicle 1 is moving out from the lane marker by comparing the coordinates (0, 0) showing the reference position of the vehicle 1 with either of the coordinates (0, y.sub.1(n)) of the left-hand lane marker H.sub.1 or the coordinates (0, y.sub.r(n)) of the right-hand lane marker H.sub.2.
That is, for example, as shown in FIG. 4, letting the width of the vehicle 1 be T, if y.sub.1(n) .gtoreq.-T/2, it is judged that the vehicle is moving-out from the left-hand lane marker and if y.sub.r(n) .ltoreq.T/2, it is judged that the vehicle is moving out from the right-hand lane marker. The result of the judgment is outputted to the warning signal generation judging section 13.
The warning signal generation judging section 13 receives signals from the vehicle speed sensor 5, the road/object detecting section 11 and the lane moving-out judging section 12 and in case where the signal from the lane moving-out judging section 12 is "the vehicle is not moving out from the lane", a signal for stopping the warning is outputted to the warning control section 14. On the other hand, in case where the signal from the lane moving-out judging section 12 is "the vehicle is moving out from the lane", either a signal for raising the warning or a signal for controlling (stopping or suppressing) is outputted to the warning control section 14. Thus, the warning signal generation judging section 13 serves as a warning signal generation judging means.
Hence, the warning signal generation judging section 13 comprises a roadside judging section 13a, a moving-out direction obstacle judging section 13b, a lane width judging section 13c and a front direction obstacle judging section 13d.
The roadside judging section 13a is started to operate in response to the signal "the vehicle is moving out from the lane" of the lane moving-out judging section 12. When this roadside judging section 13a operates, based on data from the road/obstacle detecting section 11, it is judged whether or not a lane exists in the direction of "moving out". If a lane does not exist, a signal for raising an alarm is outputted to the warning control section 14. If a lane exists, the moving-out direction obstacle judging section 13b is operated. For example, in a case shown in FIG. 4, when the vehicle moves out from the lane to the right, it is judged that a lane exists and then the moving-out direction obstacle judging section 13b is started to operate. On the other hand, when the vehicle moves out from the lane to the left, it is judged that there is no lane and then a signal for raising an alarm is outputted to the warning control section 14.
The moving-out direction obstacle judging section 13b is started to operate based on the judgment "there is a lane" in the roadside judging section 13a. When the moving-out direction obstacle judging section 13b operates, based on data from the road/object detecting section 11 and data from the vehicle speed sensor 5, if an object exists on a "moving out direction" lane, it is judged whether or not the object is an obstacle to the self vehicle. If the object is an obstacle, a signal for raising an alarm is outputted to the warning control section 14 and if the object is not an obstacle, the lane width judging section 13c is started to operate.
The judgment whether the object is an obstacle or not is performed in the following manner for example:
Referring to FIG. 5a, in case where a distance 11 between the object and the self vehicle 1 is smaller than an obstacle judging distance L.sub.1 =f(v.sub.1, v.sub.2), the object is judged to be an obstacle and in case where the distance 11 is larger than L.sub.1, the object is judged not to be an obstacle. Herein, v.sub.1 is a velocity of the self vehicle 1 and v.sub.2 is a velocity of the object, that is, an oncoming vehicle or a vehicle traveling in the same direction. The obstacle judging distance L.sub.1 =f(v.sub.1, v.sub.2) is established based on a map or a formula which is prepared by experiments or other means. For example, the obstacle judging distance L.sub.1 =f(v.sub.1, v.sub.2) is calculated by multiplying a relative velocity (v.sub.1 -v.sub.2) by a specified constant t.sub.cl (L.sub.1 =t.sub.cl .multidot.(v.sub.1 -v.sub.2)). Further, the obstacle judging distance L.sub.1 may be established as a safe distance needed for avoiding a collision with the obstacle in consideration of the velocity v.sub.2 of the self vehicle and the velocity v.sub.2 of the obstacle.
The lane width judging section 13c is started to operate based on the judgment "there is no obstacle in the moving out direction lane" in the moving-out direction obstacle judging section 13b. When the lane width judging section 13c operates, based on data from the road/object detecting section 11, it is judged whether or not a width "B" of the self lane is broader than a predetermined width "B.sub.cl ". In case where the width "B" of the self lane is narrower than the predetermined width "B.sub.cl ", the lane moving-out is judged to be inevitable because of the narrow width of the lane and a signal for stopping or suppressing an alarm is outputted to the warning control section 14. On the other hand, in case where the width "B" of the self lane is broader than the predetermined width "B.sub.cl ", the front direction obstacle judging section 13d operates. This predetermined width "B.sub.cl " is a value for judging a narrow road and in this embodiment the value is established to be 3.5 meters for example.
When the front direction obstacle judging section 13d operates, based on data from the road/object detecting section 11 and data from the vehicle speed sensor 5, in case where there an object (or objects) is caught within a preestablished monitoring range, it is judged whether or not this object (or objects) is an obstacle to the self vehicle. If it is judged that the object is an obstacle, a signal for stopping or suppressing an alarm is outputted to the warning control section 14 and if it is judged that the object is not an obstacle, a signal for raising an alarm is outputted to the warning control section 14.
Situations in which a driver is likely to take an avoidance behavior are shown in FIGS. 6a through 6e. FIG. 6a illustrates a situation wherein the vehicle has a preceding vehicle ahead or is coming close to the preceding vehicle, FIG. 6b illustrates a situation wherein the vehicle is coming close to a parked vehicle, FIG. 6c illustrates a situation wherein the vehicle encounters a jumping-out vehicle or pedestrian, FIG. 6d illustrates wherein the vehicle is coming close to a pedestrian and FIG. 6e illustrates a situation wherein the vehicle is coming close to an oncoming vehicle or a vehicle traveling ahead in the same direction. Among these situations, situations shown in FIGS. 6a and 6b can be coped with provided that the frontal scenery of the self lane is monitored. To cope with situations shown in FIGS. 6c to 6e, it is necessary to monitor both the self lane and the neighboring lane. Therefore, the preestablished monitoring range must include, as shown in FIG. 7, not only the self lane (width B) but also the left and right ranges having a width "A" (for example 0.3 meters) respectively which cover the neighboring left and right lanes. The width "A" may be a fixed value or may be a value established by a map or formula parameterizing the vehicle speed v.sub.1.
The judgment whether the object situated in front of the self vehicle is an obstacle or not is performed in the following manner for example:
Referring to FIG. 5b and FIG. 7, in case where a distance l.sub.2 between the object and the self vehicle 1 is smaller than an obstacle judging distance L.sub.2 =f(v.sub.1, v.sub.3), the object is judged to be an obstacle and in case where the distance l.sub.2 is larger than L.sub.2, the object is judged not to be an obstacle. Herein, v.sub.1 is a velocity of the self vehicle 1 and v.sub.3 is a velocity of the object situated in front of the self vehicle. The obstacle judging distance L.sub.2 =f(v.sub.1, v.sub.3) is established based on a map or a formula which is prepared by experiments or other means. For example, the obstacle judging distance L.sub.2 =f(v.sub.1, v.sub.3) is determined in proportion to a relative velocity (v.sub.1 -v.sub.3). Further, the obstacle judging distance L.sub.2 may be established as a safe distance capable of avoiding a collision with that obstacle when the self vehicle applies an emergency brake. In this case, the obstacle judging distance L.sub.2 is expressed as L.sub.2 =(1/2).multidot.v.sub.3.sup.2 /g.sub.3 -(1/2).multidot.v.sub.1.sup.2 /g.sub.1, for example, where g.sub.1 is a deceleration of the self vehicle 1 and g.sub.3 is a deceleration of the object ahead of the vehicle.
Thus, the warning control section 14 which serves as a warning control means operates a buzzer responsive to signals from the warning signal generation judging section 13.
Next, the control of thus constituted drive assist system will be described using flowcharts shown in FIG. 8 and FIG. 9.
When the program starts, first at a step (hereinafter, referred to as "S") 101, the CCD camera optical system 3 images pictures in front of the self vehicle and produces distance images presenting three-dimensional distance distribution in the image processing section 4. Further, the vehicle speed sensor 5 detects a vehicle speed v.sub.1 of the self vehicle 1.
Next, the program goes to S102 where the road/object detecting section 11 of the control apparatus 6 detects lanes, vehicles, objects other than vehicles and the like separately and obtains image data of roads (lanes) and objects on X-Y coordinates fixed to the self vehicle 1.
Then, the program steps to S103 where the position and the coordinates of the left and right lane markers H.sub.1, H.sub.2 of the self vehicle are detected, based on the image data from the road/object detecting section 11, with respect to a reference coordinate (0, 0) placed on the self vehicle 1. Then, the program goes to S104 where it is judged whether or not the self vehicle is moving out from the lane. If the self vehicle is not in the moving-out condition, the program skips to S115 where an signal for stopping or suppressing an alarm is outputted to the warning control section 14. These processes S103, S104 are ones performed in the lane moving-out judging section 12. On the other hand, if the self vehicle is in the moving-out condition, the program goes to S105 where the roadside judging section 13a of the warning signal generation judging section 13 judges whether or not there is a lane in the moving-out direction. If there is no lane in the moving-out direction (in case of a lane on the roadside), the program skips to S116 where a signal for raising an alarm is outputted to the warning control section 14.
On the other hand, if there is a lane in the moving-out direction, the program goes to S106 where it is judged whether or not an object (or objects) exists on the moving-out direction lane based on the data from the road/object detecting section 11. If no object is found, that is, sine there is no obstacle, the program skips to S109 and if an object (or objects) is found, the program steps to S107.
When the program goes to S107, a velocity v.sub.2 of the object placed on the moving-out direction lane, an distance l.sub.1 between that object and the self vehicle and an object judging distance L.sub.1 are calculated and then the program goes to S108.
At S108, the object judging distance L.sub.1 is compared with the distance l.sub.1 and if the distance l.sub.1 is smaller than the object judging distance L.sub.1 (l.sub.1 .ltoreq.L.sub.1), in case where the self vehicle 1 enters into the moving-out direction lane, there is a possibility of colliding with the obstacle and consequently the program skips to S116 where an signal for raising an alarm is outputted to the warning control section 14.
On the other hand, if the distance l.sub.1 is larger than the object judging distance L.sub.1 (l.sub.1 >L.sub.1), the program goes to S109. Those steps S106, S107 are ones performed in the moving-out direction obstacle judging section 13b of the warning signal generation judging section 13.
When the program goes from S106 or S108 to S109, a width "B" of the self lane is calculated based on data from the road/object detecting section 11 and after that the program goes to S110 where the width "B" of the self lane is compared with a predetermined width "B.sub.cl ".
At S110, if the width "B" of the self lane is smaller than the predetermined width "B.sub.cl " (B<Bcl), the lane moving-out is judged to be unavoidable due to the narrow width of the lane and the program skips to S115 where a signal for stopping or suppressing an alarm is outputted to the warning control section 14. On the other hand, at S110, if the width "B" of the self lane is larger than the predetermined width "B.sub.cl " (B.gtoreq.B.sub.cl), the program goes to S111. The steps S109, S110 are ones performed in the lane width judging section 13c of the warning signal generation judging section 13.
When the program goes to S111, detecting ranges "A" (respective detecting ranges along the left and right neighboring lanes) are established based on data from the road/object detecting section 11 and data from the vehicle speed sensor 5 and an overall detecting range "C", including the lane width "B" and the left and right detecting ranges "A", is determined.
After that, the program goes to S112 where it is judged whether or not an object (or objects) exists within the overall detecting range "C" based on the data from the road/object detecting section 11. If there is no object within the range "C", that is, no obstacle exists in the frontal direction of the vehicle, since it is judged that the vehicle has tried a mere lane moving-out, the program skips to S116 where a signal for raising an alarm is outputted to the warning control section 14.
At S112, if there is an object (objects) within the range "C", the program steps to S113 where a velocity v.sub.3 of the detected object, a distance l.sub.2 between the detected object and the self vehicle 1 and an obstacle judging distance L2 are calculated, based on data from the road/object detecting section 11 and data from the vehicle speed sensor 5.
Then, the program goes to S114 where the obstacle judging distance L.sub.2 is compared with the distance l.sub.2 between the object and the vehicle. If the distance l.sub.2 is smaller than the obstacle judging distance L.sub.2 (l.sub.2 .ltoreq.L.sub.2), since it is judged that this lane moving-out is an intentional behavior to avoid the obstacle, the program goes to S115 in which a signal for stopping or suppressing an alarm is outputted to the warning control section 14.
On the other hand, at S114, if the distance l.sub.2 is larger than the obstacle judging distance L.sub.2 (l.sub.2 >L.sub.2), since it is judged that this is a mere lane moving-out, the program goes to S116 where a signal for raising an alarm is outputted to the warning control section 14. That is, steps S111, S112, S113, S114 are ones performed in the front direction obstacle judging section 13d of the warning signal generation judging section 13.
After a signal for stopping or suppressing an alarm is outputted to the warning control section 14 at S115 or a signal for raising an alarm is outputted to the warning control section 14 at S116, the program goes to S117 where the warning control section 14 operates the warning device 7.
Thus, the drive assist system according to the embodiment of the present invention can call a driver's attention by raising an alarm when the self vehicle moves out from the lane in the roadside direction. Further, in case where the vehicle tries to enter a neighboring lane, the drive assist system can call a driver's attention by raising an alarm when there is a possibility of colliding with an obstacle such as an oncoming vehicle. Further, in case where the vehicle moves out from the lane unavoidably due to the narrow width of the lane, the drive assist system can stop or suppress an alarm. Further, in case where the vehicle moves out from the lane to avoid an obstacle existing in front of the vehicle, the drive assist system can stop or suppress an alarm.
The warning device according to the embodiment of the present invention may include any kind of warning devices such as a buzzer, a warning light, a display, an announcing device and the like. Further, in addition to the warning device, an automatic brake system capable of braking automatically may be utilized.
As described hereinbefore, according to the present invention, in raising an lane moving-out alarm, since it is judged properly whether an alarm is really required or an alarm is to be stopped or suppressed, the drive assist system can have a lane moving-out warning function having a natural feeling and capable of reflecting a driver's intention.
While the presently preferred embodiment of the present invention has been shown and described, it is to be understood that this disclosure is for the purpose of illustration and that various changes and modifications may be made without departing from the scope of the invention as set forth in the appended claim.