Reference will hereinafter be made to the drawings in order to facilitate a better understanding of the present invention. Embodiments according to the present invention will be explained in detail referring to the drawings.
(Structures)
In a first embodiment of the present invention, a rear-wheel drive vehicle equipped with the lane departure (deviation) prevention apparatus according to the present invention is exemplified. The rear-wheel drive vehicle is equipped with an automatic transmission, a conventional differential gear, and a braking system capable of independently controlling braking forces of left and right wheels of the front end and also capable of independently controlling braking forces of left and right wheels of the rear end.
For example, a braking-fluid-pressure control section used for antiskid control (ABS), traction control (TCS), or vehicle dynamics control system (VDC) may be used for braking-fluid-pressure control section 7. Braking-fluid-pressure control section 7 can control (boost up and reduce) the braking fluid pressures of the respective wheel cylinders 6FL to 6RR, all by itself. However, braking-fluid-pressure control section 7 is also configured to control the braking fluid pressures of the respective wheel cylinders 6FL to 6RR in accordance with the value of a braking-fluid-pressure command sent from a braking/driving force control unit 8 as described below, when braking-fluid-pressure control section 7 receives the braking-fluid-pressure command value from braking/driving force control unit 8. For example, braking-fluid-pressure control section 7 includes an actuator in its fluid pressure supply system. An example of this actuator may be a proportional solenoid valve which can control the fluid pressure of each wheel cylinder to any (desired) braking fluid pressure.
The vehicle is provided with a drive torque control unit 12. Drive torque control unit 12 controls drive torques for rear wheels 5RL and 5RR serving as drive wheels, by controlling the operational status of an engine 9, a selected speed-change ratio (transmission ratio) of automatic transmission 10, and the throttle opening of a throttle valve 11. Drive torque control unit 12 can control the operational status of engine 9, for example, by controlling a volume of fuel injection or an ignition timing, or by adjusting the throttle opening at the same time. Drive torque control unit 12 outputs the value of drive torque(s) TW which was used for the control, to braking/driving (braking-and-driving) force control unit 8.
This drive torque control unit 12 alone (by itself) can control the drive torques of rear driving wheels 5RL and 5RR, however also can control the drive torques of driving wheels 5RL and 5RR in accordance with a drive-torque command value(s) when drive torque control unit 12 receives the drive-torque command value from braking/driving force control unit 8. Moreover, the vehicle is provided with an image pickup section 13 having an image processing function. Image pickup section 13 is used for detecting that the vehicle is tending to depart from a lane of travel, and serves to detect a position of the vehicle in its traveling lane (running lane). Image pickup section 13 includes a monocular camera having a CCD (Charge Coupled Device) camera adapted to take the image of an area ahead of the vehicle. Image pickup section (front camera) 13 is installed at a front part of the vehicle.
Image pickup section 13 detects (printed) lane markers such as white lines from the image of the front side (area) of vehicle and detects the traveling lane on the basis of the detected white lines. Moreover, image pickup section 13 calculates an angle (yaw angle) φfront formed by the traveling lane of the vehicle and a front-rear axis of the vehicle, a lateral displacement Xfront of the vehicle from a center of the lane, a lane curvature β, and the like, on the basis of the detected lane.
Thus, image pickup section 13 detects the white lines defining the traveling lane (cruising lane) and calculates yaw angle φfront on the basis of the detected white lines. Image pickup section 13 outputs the calculated yaw angle βfront, lateral displacement Xfront, lane curvature β (or road radius), and the like to braking/driving force control unit 8. In this embodiment, it is noted that the lane markers (white lines) may be detected by a detecting means other than the image processing. For example, the lane markers may be sensed by a plurality of infrared sensors attached to the front of the vehicle, and then the traveling lane may be detected based on this sensing result of lane markers.
Moreover, this embodiment is not limited to the configuration determining the lane from the white lines. Namely, in the case where the white lines (lane markers) serving to give the recognition of traveling lane do not exist on a traveling road; a configuration may be employed which estimates a range of traveling road suitable for the running (traveling) of vehicle or a range of traveling road within which the driver should drive the vehicle, on the basis of the information of a road shape, a surrounding environment, or the like obtained by the image processing or various sensors. Then, the estimated range of traveling road may be determined as the traveling lane. For example, in the case where the white lines are not printed on the road, and both ends of the road form cliffs (i.e., have steep drops); a portion of the traveling road which is surfaced with asphalt is defined as the traveling lane. Moreover, in the case where a guardrail, a curbstone, or the like exists; the traveling lane can be determined or defined in consideration of the information of this existence.
Note that lane curvature β may be calculated based on an after-mentioned steering angle δ of a steering wheel 21. The vehicle is also equipped with a navigation (system) device 14. Navigation device 14 detects a longitudinal acceleration Yg and/or a lateral acceleration Xg generated in the vehicle, or a yaw rate φ′ generated in the vehicle. Navigation device 14 outputs the detected longitudinal acceleration Yg, lateral acceleration Xg, and yaw rate φ′(=dφ/dt) along with road information to braking/driving force control unit 8. Here, the road information includes a lane number and the road type information indicating a road category such as ordinary road or express way. Moreover, these longitudinal acceleration Yg, lateral acceleration Xg, and yaw rate φ′ may be sensed by sensors for exclusive use. Namely, longitudinal acceleration Yg and lateral acceleration Xg may be sensed by an acceleration sensor, and yaw rate φ′ may be sensed by a yaw rate sensor.
Further, the vehicle is provided with a radar 16 for measuring, e.g., a distance between the vehicle and an obstacle ahead. Radar 16 measures the distance and the like by applying and sweeping a laser light to the obstacle ahead and then by receiving its reflected light from the obstacle. Then, radar 16 outputs the information about a position of obstacle ahead, to braking/driving force control unit 8. The detected result by radar 16 is used for the processing in a following cruise control (adaptive cruise control), a collision speed-reducing brake unit, or the like.
Further, the vehicle is provided with a master cylinder pressure sensor 17 for sensing an output pressure of master cylinder 3, that is, a master cylinder fluid pressure Pm; an accelerator opening sensor 18 for sensing the degree of depression of an accelerator pedal, that is, an accelerator opening θ; a steering angle sensor 19 for sensing steering angle (rudder angle for steering) δ of steering wheel 21; a direction indicator switch 20 for sensing a direction indicating operation of a direction indicator; and wheel speed sensors 22FL to 22RR for sensing rotational speeds of the respective vehicle wheels 5FL to 5RR, that is, so-called wheel speeds Vwi (i=fl, fr, rl, rr). The signals sensed by these sensors and the like are outputted to braking/driving force control unit 8.
Next, a computing process (processing routine) executed by braking/driving force control unit 8 will be now described.
As shown in
Subsequently at step S2, a vehicle speed V is calculated. Specifically, vehicle speed V is calculated from the following Equations (1) on the basis of wheel speeds Vwi read out at step S1.
In the case of front-wheel drive, V=(Vwrl+Vwrr)/2
In the case of rear-wheel drive, V=(Vwfl+Vwfr)/2 (1)
Here, Vwfl and Vwfr are the wheel speeds of respective left and right front wheels, and Vwrl and Vwrr are the wheel speeds of respective left and right rear wheels. Namely, vehicle speed V is calculated as an average value of the wheel speeds of driven wheels in these Equations (1). Since the rear-wheel drive vehicle is exemplified in this embodiment, vehicle speed V is calculated from the latter Equation, namely from the wheel speeds of front wheels.
Vehicle speed V calculated as described above is preferably used at the time of normal running. For example, when an ABS (Anti-lock Brake System) control is in operation, a vehicle-body speed estimated under the ABS control is used as the above-mentioned vehicle speed V.
Subsequently at step S3, yaw angle φfront is calculated. Specifically, yaw angle φfront of the vehicle is calculated relative to the white lines continuing (extending) far way which are detected by image pickup section 13.
Although thus-calculated yaw angle φfront is an actual measurement value of image pickup section 13, yaw angle φfront also can be calculated on the basis of the nearby white lines (i.e., white lines near the vehicle) imaged by image pickup section 13 instead of the usage of actual measurement value. Namely for example, yaw angle φfront is calculated from the following Equation (2) by using lateral displacement Xfront read out at step S1.
φfront=tan−1(V/dX′(=dY/dX)) (2)
Where dX denotes a variation (change amount) of lateral displacement X per unit time, dY denotes a variation in a traveling direction per unit time, dX′ denotes a derivative value of variation dX, and V denotes the vehicle speed calculated at step S2.
In the case where yaw angle φfront is calculated based on the nearby white lines, its calculation method is not limited to the above-mentioned method in which yaw angle φfront is calculated by using lateral displacement X as shown in Equation (2). For example, also by elongating or extending far away the nearby white lines detected in proximity to the vehicle, yaw angle φfront can be calculated based on these elongated white lines.
Subsequently at step S4, an estimated (future) lateral displacement is calculated. Specifically, estimated lateral displacement XS is calculated from the following Equation (3), by using traveling lane curvature β and current lateral displacement Xfront of vehicle which are obtained at step S1, vehicle speed V obtained at step S2, and yaw angle φfront obtained at step S3.
X
S
=Tt·V·(φfront+Tt·V·β)+Xfront (3)
Where Tt denotes a headway time for calculating a front focal point distance. The front focal point distance is obtained by multiplying headway time Tt by vehicle speed V. Namely, an estimated value of the lateral displacement from the center of traveling lane after the lapse of headway time Tt is estimated lateral displacement XS in the future. As recognized in Equation (3), estimated lateral displacement XS becomes larger as yaw angle φfront becomes larger.
Subsequently at step S5, braking/driving force control unit 8 calculates a yaw moment (hereinafter, referred to as basic yaw moment) which is applied to the vehicle as the lane departure prevention (avoidance) control. In the lane departure prevention control, when the vehicle tends to depart or deviate relative to the traveling lane (i.e., when there is a prediction that the vehicle departs from the traveling lane in near future), the vehicle is prevented from departing from the traveling lane by applying a predetermined yaw moment (predetermined control quantity (manipulated variable) for the lane departure avoidance) to the vehicle. At step S5, this yaw moment (basic yaw moment MS0) is calculated based on the actual running state.
Specifically, basic yaw moment MS0 is calculated from the following Equation (4) on the basis of estimated lateral displacement XS obtained at step S4 and a lateral displacement limit distance (length) XL.
M
S0=K1·K2·(|XS|−XL) (4)
Where K1 denotes a proportional gain determined from vehicle specifications, and K2 denotes a gain which varies according to vehicle speed V.
As recognized in Equation (4), basic yaw moment MS0 becomes larger as the difference between estimated lateral displacement XS and lateral displacement limit distance XL becomes larger. Moreover, basic yaw moment MS0 becomes larger as yaw angle φfront becomes larger, from the relation between estimated lateral displacement XS and yaw angle φfront (see Equation (3)). Basic yaw moment MS0 is calculated from Equation (4) when an after-mentioned departure judgment flag Fout set at step S6 is in “ON” status. On the other hand, basic yaw moment MS 0 is set to 0 when departure judgment flag Fout is in “OFF” status.
Subsequently at step S6, control unit 8 judges whether or not the vehicle is tending to depart from the traveling lane (i.e., whether or not there is a prediction that the vehicle would depart from the traveling lane anytime soon). Specifically, the departure tendency is judged by comparing estimated lateral displacement XS obtained at step S4, with a departure-tendency determining threshold value XL which is lateral displacement limit distance XL used for the calculation of basic yaw moment MS0 at step S5.
Departure-tendency determining threshold value (lateral displacement limit distance) XL is the value from which it can be generally determined that the vehicle tends to depart from the traveling lane. This departure-tendency determining threshold value XL is a value obtained through experimental trials and experiences. For example, departure-tendency determining threshold value XL is a value indicating the position of a boundary in the traveling lane and is calculated from the following Equation (5).
X
L=(L−H)/2 (5)
Where L denotes a lane width (i.e., width between white lines defining the traveling lane) of traveling lane, and H denotes a width of the vehicle. Image pickup section 13 obtains lane width L by processing the pickup image.
When estimated lateral displacement XS is greater than or equal to departure-tendency determining threshold value XL (|XS|≧XL); it is determined that the vehicle has the tendency to depart from the lane, and departure judgment flag Fout is set to ON. When estimated lateral displacement XS is smaller than departure-tendency determining threshold value XL (|XS|<XL); it is determined that the vehicle does not have the tendency to depart from the lane, and departure judgment flag. Fout is set to OFF. Note that this judgment on the lane departure tendency can be also conducted by using actual lateral displacement Xfront (i.e., estimated lateral displacement XS in the case of Tt=0) instead of estimated lateral displacement (position) XS. In this case, when actual lateral displacement Xfront is greater than or equal to departure-tendency determining threshold value XL(|Xfront|≧XL); it is determined that the vehicle has the tendency to depart from the lane, and departure judgment flag Fout is set to ON.
Further, when the vehicle becomes in the state where the vehicle does not have the tendency to depart from the lane (|XS|<XL or |Xfront|<XL) after setting departure judgment flag Fout to ON; departure judgment flag Fout can be set to OFF. Moreover, a time criterion (parameter) may be added to this judgment. For example, when a predetermined time period has elapsed after setting departure judgment flag Fout to ON; departure judgment flag Fout may be set to OFF.
After setting departure judgment flag Fout as mentioned above, a departure direction Dout is determined based on lateral displacement X. Specifically, when the vehicle is laterally displaced to the left from the center of traveling lane, the left direction is set as departure direction Dout (Dout=LEFT). On the other hand, when the vehicle is laterally displaced to the right from the center of traveling lane, the right direction is set as departure direction Dout (Dout=RIGHT). Note that departure judgment flag Fout may be set at OFF in order not to activate the lane departure prevention control, while antiskid control (ABS), traction control (TCS), or vehicle dynamics control system (VDC) is in operation.
Further, departure judgment flag Fout may be set finally in consideration of the driver's intention of lane change. For example, when the direction (lighting side of a winker) indicated by the signal of direction indicator switch 20 is the same as the departure direction Dout; it is determined that the driver is intentionally changing the lanes, and departure judgment flag Fout is changed to OFF. Namely, the information on the lane departure tendency is changed to the judgment result that the vehicle does not have the tendency to depart from the lane. On the other hand, when the direction (lighting side of winker) indicated by the signal of direction indicator switch 20 is different from departure direction Dout; departure judgment flag Fout is maintained at ON. Namely, the judgment result that the vehicle has the tendency to depart from the lane is maintained.
Moreover, in the case where direction indicator switch 20 is not actuated, departure judgment flag Fout is set finally based on steering angle δ. Namely in the case where the driver is steering the vehicle in the departure direction, when both of its steering angle δ and a variation (variation per unit time) Δδ of this steering angle δ are greater than or equal to predetermined values; it is determined that the driver is intentionally changing the lanes, and departure judgment flag Fout is changed to OFF.
Subsequently at step S7, control unit 8 determines a finish timing at which the lane departure prevention control finishes outputting (producing) or applying the yaw moment to the vehicle. By the above-mentioned judgment on the departure tendency at step S6, the determination that the vehicle has the lane departure tendency is removed or changed (Fout=OFF), for example when the vehicle returns to (a proper range of) the traveling lane or when the vehicle changes the lanes with the driver's intention. Thereby, the lane departure prevention (avoidance) control is finished, namely it is finished or stopped to output (apply) the yaw moment to the vehicle. At this step S7, separately in addition to such judgment on the departure tendency, control unit 8 determines the finish timing of lane departure prevention control. Namely, when the magnitude of lateral displacement of the vehicle relative to the traveling lane becomes greater than or equal to a predetermined magnitude, the lane departure prevention control is finished. Specifically, an output-finish determining threshold value Xend for determining the finish (finish position) of output (applying) of the yaw moment is provided. Then, when actual lateral displacement Xfront is greater than or equal to output-finish determining threshold value Xend (|Xfront|≧Xend); it is determined that the lane departure prevention control has reached its finish timing, and departure judgment flag Fout is set to OFF.
Subsequently at step S8, control unit 8 sets a target yaw moment which is finally used as a control command value. The lane departure prevention control according to this embodiment is based on the premise that the processing routine (processing routine of
Here, each value of increase-side variation limiter Lup or decrease-side variation limiter Ldown corresponds to a variation amount during the time period of one processing routine of lane departure prevention control. Moreover, increase-side variation limiter Lup, maximum-value limiter Lmax, and decrease-side variation limiter Ldown are respectively determined so as to smooth out the minimum yaw moment necessary to prevent the vehicle from departing from the traveling lane, on the basis of experimental trials and experiences.
Increase-side variation limiter Lup, maximum-value limiter Lmax, and decrease-side variation limiter Ldown are respectively set as prescribed values as mentioned above. Target yaw moment MS is calculated by limiting or suppressing basic yaw moment MS0 by using increase-side variation limiter Lup, maximum-value limiter Lmax, and decrease-side variation limiter Ldown.
Subsequently at step S9, control unit 8 corrects the finish timing (predetermined parameter for control termination) of output (applying) of yaw moment to the vehicle which is conducted by the lane departure prevention control. Specifically, when the vehicle becomes in the departure state, namely when the departure tendency is determined; a departure expanding degree after this departure-tendency determination (i.e., future expanding degree of departure amount) is estimated. Then, on the basis of the estimated departure expanding degree, the output finish timing of yaw moment is corrected.
As shown in
At step S22, the departure expanding degree of vehicle relative to the traveling lane is calculated or estimated, from an attitude of vehicle relative to the traveling lane (white lines) at the time of the determination that the vehicle has become in the lane-departure state at step S21. At first, yaw angle φdepart formed by the traveling lane (white lines) and the front-rear axis of vehicle is detected. This yaw angle φdepart (φdepart=φfront) is detected by image pickup section 13. Then, an estimated departure expanding degree EXdepart is set based on the detected yaw angle φdepart. Here, estimated departure expanding degree EXdepart is the future departure-expanding degree which is estimated when the vehicle becomes in the lane-departure (tendency) state.
Subsequently at step S23, the control range (output-finish determining threshold value Xend) for lane departure prevention control which is set at step S7 is corrected based on estimated departure expanding degree EXdepart set at step S22. Specifically, a gain Kwlimt for correcting the control range for lane departure prevention control is calculated based on estimated departure expanding degree EXdepart.
Thereby, output-finish determining threshold value Xend is corrected based on thus-set gain Kwlimt. Specifically, the control range (Xend−XL=IS
Control Range=Kwlimt·(Xend−XL) (6)
Accordingly, the control range (control area) is corrected and increased from 1·(Xend−XL) or 1·IS
Subsequently at step S10, a sound output or a display output is carried out as a warning for avoiding the lane departure when departure judgment flag Fout is ON. When departure judgment flag Fout becomes ON, namely when an absolute value |MS| of target yaw moment MS is greater than 0; the moment (target yaw moment MS) starts to be applied to the vehicle as the lane departure prevention control, and hence this warning output is carried out at the same time as the applying of moment to the vehicle. However, the output timing of warning is not limited to this. For example, the output timing of warning may be set to a timing before the start timing for applying the yaw moment.
Subsequently at step S11, control unit 8 calculates a target braking fluid pressure for each wheel. Specifically, respective target braking fluid pressures are calculated from the following Equations. In the case where departure judgment flag Fout is OFF, namely in the case where target yaw moment MS is equal to 0 (in the case where the lane departure prevention control is not carried out); target braking fluid pressures Psi (i=fl, fr, rl, rr) for respective wheels are set to a braking fluid pressure Pmf or a braking fluid pressure Pmr as shown in the following Equations (7) and (8).
Psfl=Psfr=Pmf (7)
Psrl=Psrr=Pmr (8)
Where Pmf is a braking fluid pressure for the front wheels. Moreover, Pmr is a braking fluid pressure for the rear wheels and is calculated based on braking fluid pressure Pmf for the front wheels in consideration of a distribution between the front and rear. For example, when the driver is operating the brake (pedal), braking fluid pressures Pmf and Pmr take values according to the operation degree (master cylinder fluid pressure Pm) of this brake operation.
On the other hand, in the case where departure judgment flag Fout is ON, namely in the case where absolute value |MS| of target yaw moment MS is greater than 0 (in the case where the determination result that there is the lane departure tendency is produced); a front-wheel target braking-fluid-pressure differential ΔPsf and a rear-wheel target braking-fluid-pressure differential ΔPsr are calculated on the basis of target yaw moment MS set at step S8. Specifically, target braking-fluid-pressure differentials ΔPsf and ΔPsr are calculated from the following Equations (9) and (10).
ΔPsf=2·Kbf·(MS·FRratio)/T (9)
ΔPsr=2·Kbr·(MS·(1−FRratio))/T (10)
Where FRratio denotes a threshold value for setting, and T denotes a tread. Note that this tread T is prescribed to take an equal value in the front and rear ends for convenience sake. Moreover, Kbf and Kbr are conversion factors respectively related to front wheels and the rear wheels which are used for converting the braking force (power) to the braking fluid pressure. Kbf and Kbr are determined from a brake specification. These target braking-fluid-pressure differentials ΔPsf and ΔPsr are values for determining the distribution (ratio) of braking force for being applied to respective wheels in accordance with the magnitude of target yaw moment MS. In other words, each of these target braking-fluid-pressure differentials ΔPsf and ΔPsr is a value for generating the difference of braking force between left wheel and right wheel in the corresponding front or rear end.
Then, target braking fluid pressures Psi (i=fl, fr, ri, rr) for respective wheels are calculated finally by using the calculated target braking-fluid-pressure differentials ΔPsf and ΔPsr. Specifically, in the case where departure judgment flag Fout is ON and departure direction Dout is LEFT, namely in the case where there is the lane departure tendency relative to the white line located on the left side of lane; target braking fluid pressure Psi (i=fl, fr, rl, rr) for each wheel is calculated from the following Equations (11).
Psfl=Pmf
Psfr=Pmf+ΔPsf
Psrl=Pmr
Psrr=Pmr+ΔPsr (11)
In the case where departure judgment flag Fout is ON and departure direction Dout is RIGHT, namely in the case where there is the lane departure tendency relative to the white line located on the right side of lane; target braking fluid pressure Psi (i=fl, fr, ri, rr) for each wheel is calculated from the following Equations (12).
Psfl =Pmf+ΔPsf
Psfr=Pmf
Psrl=Pmr+ΔPsr
Psrr=Pmr (12)
According to Equations (11) and (12), the difference of braking force between the left and right wheels is generated so as to allow the braking force of the wheel located in a direction to avoid the lane departure, to become greater. Moreover as shown in Equations (11) and (12), target braking fluid pressure Psi (i=fl, fr, rl, rr) for each wheel is calculated in consideration of the driver's brake operation namely in consideration of braking fluid pressures Pmf and Pmr. Then, braking/driving force control unit 8 outputs thus-calculated target braking fluid pressure Psi (i=fl, fr, rl, rr) for each wheel to braking-fluid-pressure control section 7, as the braking-fluid-pressure command value.
(Operations)
The operations according to the first embodiment will now be explained below. While the vehicle is running (traveling), the controller (control unit 8) reads various data (step S1) and calculates vehicle speed V and the yaw angle (steps S2 and S3). Subsequently, the controller calculates estimated lateral displacement (estimated value of departure) XS (step S4), carries out the judgment of lane departure tendency (setting of departure judgment flag Fout) on the basis of estimated lateral displacement XS, and corrects the judgment result (departure judgment flag Fout) of lane departure tendency on the basis of driver's intention of changing lanes (step S6).
On the other hand, the controller calculates basic yaw moment MS0 (step S5), and calculates target yaw moment MS by processing the calculated basic yaw moment MS0 with the limiters (step S8). Moreover, the controller corrects output-finish determining threshold value Xend (step S7) for judging the finish timing of output of yaw moment, on the basis of estimated departure expanding degree EXdepart according to yaw angle φdepart (step S9). Namely, the output finish timing of yaw moment is corrected.
Then, the controller carries out the warning output (e.g., alarm) in dependence upon the judgment result of lane departure tendency (step S10), calculates target braking fluid pressure Psi (i=fl, fr, rl, rr) for each wheel on the basis of target yaw moment MS, and outputs the calculated target braking fluid pressure Psi (i=fl, fr, rl, rr) for each wheel to braking-fluid-pressure control section 7 (step S11). Thereby, the yaw moment according to (the condition of) the lane departure tendency of vehicle is applied to the vehicle. Then, at the output finish timing of yaw moment (|Xfront|≧Xend), the controller stops applying (outputting) yaw moment to the vehicle so that the lane departure prevention control is terminated.
(Functions and Effects)
Next, functions and effects according to the first embodiment will now be explained below.
{circle around (1)} The lane departure prevention control in the case where the control range is not corrected (in the case where gain Kwlimt is equal to 1, namely in the case where estimated departure expanding degree EXdepart or yaw angle φdepart is small).
As shown in
{circle around (2)} The lane departure prevention control in the case where the control range is corrected (in the case where gain Kwlimt greater than 1, namely, in the case where estimated departure expanding degree EXdepart or yaw angle φdepart is large).
As shown in
Note that the time point (“B” point of
As mentioned above, the control range (lateral range relative to the lane) of lane departure prevention control is enlarged, by more enlarging output-finish determining threshold value Xend corresponding to the lateral position relative to traveling lane as yaw angle φdepart obtained at the time of start of lane departure (tendency) or at the time of start of lane departure prevention control becomes greater. Accordingly, the control time period (control duration time) of lane departure prevention control is elongated, namely the finish timing for outputting the yaw moment is delayed so that the total amount of yaw moment for lane departure prevention control (control quantity or controlled variable) is increased. Even in the case where the lane departure prevention control is carried out under the situation where the yaw angle of vehicle becomes large relative to the traveling lane, for example, when the vehicle is running at an entrance (beginning) of curve; it can be suppressed that the time period during which a vehicle passenger perceives a control feeling over this lane departure prevention control comes to be short. Namely, the above-mentioned configuration in this embodiment can fit the lane departure prevention control to the control feeling of passenger.
It is noted that the lane departure prevention control apparatus according to the first embodiment can be modified to have the following configurations. In the first embodiment, estimated departure expanding degree EXdepart is set based on yaw angle φdepart (step S9). Contrary to this, estimated departure expanding degree EXdepart can be set also based on a lateral speed XV or a lateral acceleration Xg of the vehicle relative to the lane (especially, lateral speed or lateral acceleration at the time of start of lane departure (tendency) or at the time of start of lane departure prevention control). Here, lateral speed XV is obtained, for example, by differentiating estimated lateral displacement XS or actual lateral displacement Xfront.
Moreover in the above-mentioned configuration, estimated departure expanding degree EXdepart is calculated on the basis of yaw angle φdepart, lateral speed XV, or the like obtained at the time of start of lane departure (tendency) or lane departure prevention control. However, estimated departure expanding degree EXdepart can also be updated on the basis of yaw angle φdepart, lateral speed XV, or the like obtainable after the start time of lane departure (tendency) or during the lane departure prevention control. For example, after the start time of lane departure (tendency) or during the lane departure prevention control; estimated departure expanding degree EXdepart may be continuously updated by way of feedback processing on the basis of the value of yaw angle φdepart, lateral speed XV, or the like, by detecting the momentarily varying yaw angle φdepart, lateral speed XV, or the like. Thereby, the output finish timing of moment may be corrected based on estimated departure expanding degree EXdepart which is newly updated during the lane departure prevention control or after the start of lane departure (tendency). Moreover, by detecting a maximum value of estimated departure expanding degree EXdepart during the lane departure prevention control or after the start of lane departure (tendency), the output finish timing for yaw moment can also be corrected by means of the detected maximum value of estimated departure expanding degree EXdepart.
Moreover, as another way for correcting the predetermined finish parameter (or condition) of lane departure prevention control, a target yaw angle (finish yaw angle) which is set when the lane departure prevention control finishes can be corrected. For example, in the case where the target yaw angle at the normal finish timing of lane departure prevention control has been already set at 0°, the target yaw angle is corrected to an angle more inclined toward the inner side of traveling lane as estimated departure expanding degree EXdepart becomes greater.
According to the above-described explanations about the first embodiment, the computing process shown by
According to the above-described explanations about the first embodiment, the structure making output-finish determining threshold value Xend greater as estimated departure expanding degree Exdepart becomes greater achieves a structure that the control finish-parameter correcting section brings the predetermined finish parameter more difficult to be satisfied as the expanding degree of departure tendency estimated by the departure-tendency-expanding-degree estimating section becomes greater, a structure that the control finish-parameter correcting section corrects the finish timing of lane departure prevention control (which is the predetermined finish parameter), and a structure that the control finish-parameter correcting section corrects the lateral control-finish position for lane departure prevention control (which is the predetermined finish parameter) relative to the lane.
In the lane departure prevention apparatus according to the first embodiment, it is achieved that the lane departure prevention control is terminated in accordance with the expanding degree of departure tendency of vehicle against the (center of) traveling lane after the start of lane departure prevention control.
Next, a second embodiment according to the present invention will be explained below.
(Structures)
In the second embodiment, a rear-wheel drive vehicle equipped with the lane departure prevention apparatus according to the present invention is exemplified in the similar manner as the first embodiment. In the second embodiment, a procedure of computing process that is executed in braking/driving force control unit 8 is same as the procedure shown in
Next, the controller corrects decrease-side variation limiter Ldown on the basis of the set gain Kldown, with reference to the following Equation (13).
L
down
=K
ldown
·L
down (13)
Thus, decrease-side variation limiter Ldown is corrected and decreased when gain Kldown is small. Accordingly, decrease-side variation limiter Ldown becomes smaller (i.e., more gentle) as estimated departure expanding degree EXdepart becomes greater, in other words, as yaw angle φdepart at the start time of lane departure (tendency) becomes greater. Thus in the second embodiment, the output finish timing for yaw moment is corrected by correcting decrease-side variation limiter Ldown so as to reduce decrease-side variation limiter Ldown.
Namely, the gradient (i.e., decrease rate) of target yaw moment MS in its decreasing side in the second embodiment becomes gentle (i.e., low) as compared with the gradient of target yaw moment MS in its decreasing side shown in
As mentioned above, decrease-side variation limiter Ldown is made smaller (gentle), as yaw angle φdepart at the time of start of lane departure (tendency) or at the time of start of lane departure prevention control becomes greater. Hence, an actual control time period of lane departure prevention control is elongated, and the total amount of yaw moment (control quantity) for lane departure prevention control is increased. Accordingly, even in the case where the lane departure prevention control is carried out under the situation where the yaw angle of vehicle becomes large relative to the (center line of) lane, for example, when the vehicle is running at an entrance (beginning) of curve; it can be suppressed that the time period during which a vehicle passenger perceives a control feeling over this lane departure prevention control comes to be short. Namely, the above-mentioned configuration in this embodiment can fit the lane departure prevention control to the control feeling of passenger.
It is noted that the lane departure prevention control apparatus according to the second embodiment can be modified to have the following configurations. Namely, since the lane departure prevention control apparatus according to the second embodiment is based on the premise that decrease-side variation limiter Ldown is corrected, target yaw moment MS may be calculated by using only the decrease-side variation limiter Ldown in the limit processing conducted at step S8. Namely, only (or, at least) the decrease-side variation limiter Ldown may be set as prescribed values.
According to the above-described explanations about the second embodiment, the structure making decrease-side variation limiter Ldown smaller as estimated departure expanding degree Exdepart becomes greater achieves a structure that the control finish-parameter correcting section (or means) corrects the decrease rate of control quantity (which is the predetermined finish parameter), in the case where the control section (or means) continuously varies the control quantity of lane departure prevention control during the lane departure prevention control and decreases the control quantity when finishing the lane departure prevention control.
Next, a third embodiment according to the present invention will be explained below.
(Structures)
In the third embodiment, a rear-wheel drive vehicle equipped with the lane departure prevention apparatus according to the present invention is exemplified in the similar manner as the first embodiment. In the third embodiment, a procedure of computing process that is executed in braking/driving force control unit 8 is same as the procedure shown in
Subsequently at step S42, the controller judges whether or not departure judgment flag Fout has changed from ON to OFF. If it is determined that departure judgment flag Fout has changed from ON to OFF, namely if the finish timing of lane departure prevention control has come; the program proceeds to step S43. If not, namely if it is determined that departure judgment flag Fout is being maintained at ON; the program returns to step S21.
At step S43, the controller determines that basic yaw moment MS 0 calculated at step S5 is held (i.e., previous value of basic yaw moment MS 0 is retained) for holding time Thold set at step S41. Thereby, basic yaw moment MS 0 at the time point when departure judgment flag Fout changes from ON to OFF is held for the whole length of holding time Thold. Then, the yaw moment based on basic yaw moment MS 0 which is being held is applied to the vehicle as the lane departure prevention control.
Thus in the third embodiment, basic yaw moment MS0 at the time point of the change of departure judgment flag Fout from ON to OFF is held for holding time Thold as it is, without reducing the basic yaw moment MS0. Then, the yaw moment based on basic yaw moment MS0 which is being held is applied to the vehicle.
Namely, by holding basic yaw moment MS 0 for holding time Thold from the time point when departure judgment flag Fout changes from ON to OFF; the output time period (output duration) of target yaw moment MS is elongated according to holding time Thold as compared with the target yaw moment MS shown by
As mentioned above, holding time Thold is made longer as yaw angle φdepart obtained at the time of start of lane departure (tendency) or at the time of start of lane departure prevention control becomes greater. Accordingly, the actual control time period (control duration time) of lane departure prevention control is elongated so that the total amount of yaw moment for lane departure prevention control (control quantity) is increased. Therefore, even in the case where the lane departure prevention control is carried out under the situation where the yaw angle of vehicle becomes large relative to the traveling lane, for example, when the vehicle is running at an entrance (beginning) of curve; it can be suppressed that the time period during which a vehicle passenger perceives a control feeling over this lane departure prevention control comes to be short. Namely, the above-mentioned configuration in this embodiment can fit the lane departure prevention control to the control feeling of passenger.
It is noted that the lane departure prevention control apparatus according to the third embodiment can be modified to have the following configurations. Namely in the third embodiment, the total amount of yaw moment is corrected by elongating the holding time Thold. Contrary to this, a total amount of braking force or brake fluid pressure for applying the yaw moment can also be corrected. Namely, the holding time may be determined by focusing on the braking force or brake fluid pressure instead of the yaw moment.
According to the above-described explanations about the third embodiment, the structure making holding time Thold longer as estimated departure expanding degree Exdepart becomes greater achieves a structure that the control finish-parameter correcting section (or means) corrects the control holding time (which is the predetermined finish parameter) for keeping the control quantity of the finish time of lane departure prevention control, in the case where the control section (or means) continuously varies the control quantity of lane departure prevention control during the lane departure prevention control.
Next, a fourth embodiment according to the present invention will be explained below.
(Structures)
In the fourth embodiment, a rear-wheel drive vehicle equipped with the lane departure prevention apparatus according to the present invention is exemplified in the similar manner as the first embodiment. In the fourth embodiment, the output finish timing for yaw moment (predetermined finish parameter) corrected based on yaw angle φdepart or estimated departure expanding degree EXdepart is further corrected based on a condition of driving operation by the driver.
As shown in
Δstr=|(δnow−δtstr)/Tstr1| (14)
Subsequently at step S52, the controller further corrects the output finish timing of yaw moment corrected at step S9, on the basis of the condition of driving operation.
As shown in
At step S63, the controller sets a correction gain Koverride at equal to 1. At step S64, the controller sets correction gain Koverride at a predetermined value lower than 1 (e.g., 0.5). Then, the program proceeds to step S65. Here, when steering speed Δstr is higher than steering-operation determining threshold value Δstr
At step S65, the controller further collects the output finish timing of yaw moment corrected at step S9, on the basis of correction gain Koverride. In the case where gain Kwlimt for correcting the control range is calculated based on estimated departure expanding degree EXdepart, and the output finish timing of yaw moment is corrected by using the calculated gain Kwlimt as the first embodiment; gain Kwlimt is corrected by using correction gain Koverride as shown in the following Equation (15).
K
wlimt
=K
override
·K
wlimt (15)
Moreover, in the case where gain Kldown for correcting decrease-side variation limiter Ldown is calculated based on estimated departure expanding degree EXdepart, and the output finish timing of yaw moment is corrected by using the calculated gain Kldown as the second embodiment; gain Kldown is corrected by using correction gain Koverride as shown in the following Equation (16).
K
ldown
=K
override
·K
ldown (16)
In practice, gain Kldown is calculated by using an inverse of correction gain Koverride as shown in the following Equation (17), in consideration of the feature that the output finish timing of yaw moment becomes later (more delayed) as gain Kldown becomes smaller.
K
ldown=(1/Koverride)·Kldown (17)
Moreover, in the case where holding time Thold is calculated based on estimated departure expanding degree EXdepart, and the output finish timing of yaw moment is corrected by using the calculated holding time Thold as the third embodiment; holding time Thold is corrected by using correction gain Koverride as shown in the following Equation (18).
T
hold
=K
override
·T
hold (18)
Thus in the fourth embodiment, the output finish timing of yaw moment corrected based on estimated departure expanding degree EXdepart is further corrected based on steering angle δ indicating the driving operation condition of the driver. Specifically, when the steering speed is relatively high; gain Kwlimt or holding time Thold is corrected to become smaller, or gain Kldown is corrected to become greater, by setting correction gain Koverride to become smaller. Thereby, the output finish timing of yaw moment corrected based on estimated departure expanding degree EXdepart is re-corrected to become earlier. Accordingly, even in the case where the output finish timing of yaw moment has been corrected to become more delayed on the basis of estimated departure expanding degree EXdepart at step S9; this corrected output finish timing of yaw moment is re-corrected to take an earlier value when the variation of steering angle δ is great (as compared to the threshold value), at steps S51 and S52. Namely, when the steering speed or variation of steering angle δ is relatively great, it is determined that the driver has the intention of driving operation (there is a high degree of driver's intention to manipulate the steering wheel). In other words, the correction of output finish timing of yaw moment which is conducted based on estimated departure expanding degree EXdepart is suppressed. Thereby, it can be prevented that the lane departure prevention control becomes burdensome for the driver due to the elongation of lane departure prevention control in the case where the driver has the intention of driving operation.
It is noted that the lane departure prevention control apparatus according to the fourth embodiment can be modified to have the following configurations. At step S51, the steering speed (Δstr2) can be calculated also based on a steering variation within a longer time period Tstr2 (>Tstr1, for example 2 seconds) which can correspond to a slower steering operation (manipulation), as shown by the following Equation (19).
Δstr2=|(δnow−δtstr2)/Tstr2| (19)
Where, δtstr2 denotes a value of steering angle δ obtained time period Tstr2 before.
Moreover in the fourth embodiment, the driver's intention of driving operation is judged by calculating steering speed Δstr on the basis of steering angle δ and then comparing the calculated steering speed Δstr with steering-operation determining threshold value Δstr
Accordingly, the output finish timing of yaw moment corrected based on estimated departure expanding degree EXdepart is re-corrected to its earlier side, by determining that the driver has very high degree of intention of driving operation in the case where the steering speed or variation of steering angle δ is considerably great. Namely, the correction of output finish timing of yaw moment which is conducted based on estimated departure expanding degree EXdepart is suppressed more strongly. In certain instances, the correction of output finish timing of yaw moment based on estimated departure expanding degree EXdepart may be canceled.
Moreover in the fourth embodiment, the driver's intention of driving operation can be judged based on a variation Δθ (e.g., operation speed of accelerator) of accelerator opening or a variation ΔBrk (e.g., operation speed of brake) of brake operation. Namely, the condition of accelerator operation or brake (pedal) operation can be defined as a marker (parameter) for judging the driver's intention of driving operation. In this case, the condition of accelerator operation is detected by accelerator opening sensor 18, and the condition of brake operation is detected by a brake operation sensor.
In this case, for example, variation Δθ of accelerator opening is calculated from the following Equation (20), and variation ΔBrk of brake operation is calculated from the following Equation (21).
Δθ=|(θnow−θtθ)/Tθ| (20)
ΔBrk=|(Brknow−Brktbrk)/TBrk| (21)
Where, θnow denotes a current value (this-time-around value) of accelerator opening θ, θtθ denotes a value of accelerator opening θ obtained a predetermined time period Tθ before, Brknow denotes a current value (this-time-around value) of a brake operative position Brk, and Brktbrk denotes a value of brake operative position Brk obtained a predetermined time period TBrk before.
Moreover in the fourth embodiment, a plurality of markers for judging the driver's intention of driving operation may be used. For example, by obtaining the above-mentioned Δstr, Δstr2, Δθ, and ΔBrk, a plurality of correction gains Koverride are obtained based on these respective judgment markers. Then, by selecting one among these plurality of correction gains Koverride (for example, by selecting the lowest one), the output finish timing of yaw moment can be further corrected by using the selected correction gain Koverride. Thus by referring to the plurality of markers for judging the driver's intention of driving operation, an optimum output finish timing of yaw moment can be achieved.
According to the above-described explanations about the fourth embodiment; steering angle sensor 19, the brake operation sensor, and steps S1 and S51 roughly achieve a driver-intention detecting section (or means) configured to detect the driver's intention of driving operation on the basis of the condition of driving operation by the driver. Accordingly, the control finish-parameter correcting section (or means) suppresses the correction of the predetermined finish parameter in the case where the driver-intention detecting section detects the driver's intention of driving operation.
Next, a fifth embodiment according to the present invention will be explained below.
(Structures)
In the fifth embodiment, a rear-wheel drive vehicle equipped with the lane departure prevention apparatus according to the present invention is exemplified in the similar manner as the first embodiment. It is noted that, in the case where each detected data of running state of vehicle has a directional property of left or right, the right direction is defined as a positive direction in the fifth embodiment. Namely, yaw rate φ′, lateral acceleration Xg, and yaw angle φ take positive values when the vehicle is turning (or departing) in the right direction. Lateral displacement X takes a positive value when the (center of) vehicle is displaced in the right direction from the center of traveling lane. Moreover, longitudinal acceleration Yg takes a positive value when the vehicle accelerates, and takes a negative value when the vehicle decelerates.
As shown in
Subsequently at step S72, vehicle speed V is calculated. Specifically, vehicle speed V is calculated from the following Equations (22) on the basis of wheel speeds Vwi read out at step S71.
In the case of front-wheel drive, V=(Vwrl+Vwrr)/2
In the case of rear-wheel drive, V=(Vwfl+Vwfr)/2 (22)
Here, Vwfl and Vwfr are the wheel speeds of respective left and right front wheels, and Vwrl and Vwrr are the wheel speeds of respective left and right rear wheels. Namely, vehicle speed V is calculated as an average value of the wheel speeds of driven wheels in these Equations (22). Since the rear-wheel drive vehicle is exemplified in this embodiment, vehicle speed V is calculated from the latter Equation, namely from the wheel speeds of front wheels.
Vehicle speed V calculated as described above is preferably used at the time of normal running. For example, when the ABS (Anti-lock Brake System) control is in operation, the vehicle-body speed estimated under the ABS control is used as the above-mentioned vehicle speed V. Moreover, a value related to vehicle speed which is used for navigation information in navigation device 14 may be used as the above-mentioned vehicle speed V. Then, the controller sets a previous vehicle speed VPAST at a value of vehicle speed V obtained in a previous computing process (last-time-around value of routine), as shown by the following Equation (23).
VPAST=V (vehicle speed value at the time of previous routine) (23)
Subsequently at step S73, the controller calculates a shortage yaw moment (shortage control quantity or controlled variable). In the lane departure prevention control in this embodiment, when the vehicle tends to depart or deviate relative to the traveling lane (i.e., when there is a prediction that the vehicle departs from the traveling lane in near future), the vehicle is prevented from departing from the traveling lane by applying a predetermined yaw moment (predetermined control quantity for the lane departure avoidance) to the vehicle. Moreover, the lane departure prevention control according to this embodiment is based on the premise that the processing routine (processing routine of
At this step S73, the shortage (shortage amount) of the yaw moment serving as the controlled variable for the above-mentioned lane departure prevention control is calculated or estimated. Specifically, a previously-calculated target yaw moment MSb is set at a value of target yaw moment MS (obtained at after-mentioned step S79) calculated in the previous computing process (e.g., last-time-around of routine), from the following Equation (24).
MSb=MS (24)
Subsequently, the controller calculates a previous-process-generating actual yaw moment MSr on the basis of vehicle speed V. Namely,-this actual yaw moment MSr is a value of yaw moment which is actually generated in the vehicle when target yaw moment MS calculated in the previous computing process (at last-time-around of routine) is applied to the vehicle as the lane departure prevention control.
For this calculation, at first, a decelerating degree (deceleration) ΔV is calculated by using previous vehicle speed VPAST calculated at step S72 and current vehicle speed V, from the following Equation (25).
ΔV=(V−VPAST)/ΔT (25)
Where, ΔT denotes the process time period during which one routine of computing process of
Subsequently, a decelerating degree (deceleration) ΔVc caused by the lane departure prevention control is calculated by using decelerating degree ΔV calculated by Equation (25), from the following Equation (26).
ΔVc=ΔV−ΔVd (26)
Where, ΔVd is a decelerating degree (deceleration) based on the accelerator operation or brake operation of the driver, vehicle specification, and a running resistance (travel resistance). ΔVd can be obtained, for example, from a map related to a deceleration obtainable by the accelerator operation and brake operation. Moreover, ΔVd can be calculated, for example, based on an engine rotational speed or the accelerator opening.
Then, the controller calculates actual yaw moment MSr by using lane-departure-prevention-control-part decelerating degree ΔVc calculated by Equation (26), from the following Equation (27).
M
S
r=A·ΔVc·T/2 (27)
Where, A denotes a vehicle weight, and T denotes the tread length. Thus, actual yaw moment MSr generated by the previous computing process is calculated based on vehicle speed V.
Then, the shortage yaw moment (shortage of yaw moment) ΔMS is calculated as the difference value between actual yaw moment MSr calculated by Equation (27) and previously-calculated target yaw moment MSb set by Equation (24), from the following Equation (28).
ΔM
S
=M
S
b−M
S
r (28)
Subsequently at step S74, the controller judges the tendency of lane departure. Specifically, future estimated lateral displacement XS is calculated from the following Equation (29), by using yaw angle φ (φfront), traveling lane curvature β and current lateral displacement Xfront of vehicle which are obtained at step S71, and vehicle speed (current vehicle speed) V obtained at step S72. (see
X
S
=Tt·V·(φ+Tt·V·β)+Xfront (29)
Where Tt denotes the headway time for calculating the front focal point distance. The front focal point distance is obtained by multiplying headway time Tt by vehicle speed V. Namely, an estimated value of the lateral displacement from the center of traveling lane after the lapse of headway time Tt is the estimated lateral displacement XS in the future. As recognized in Equation (29), for example if focusing on yaw angle φfront, estimated lateral displacement XS becomes larger as yaw angle φfront becomes larger.
Then, the lane departure tendency is judged by comparing estimated lateral displacement XS with predetermined departure-tendency determining threshold value (lateral displacement limit distance) XL. Departure-tendency determining threshold value XL is a value from which it can be generally determined that the vehicle tends to depart from the traveling lane. This departure-tendency determining threshold value XL is a value obtained through experimental trials and experiences. For example, departure-tendency determining threshold value XL is a value indicating the position of a boundary on the traveling road and is calculated from the following Equation (30). (see
X
L=(L−H)/2 (30)
Where L denotes the lane width, and H denotes the width of vehicle. Image pickup section 13 obtains lane width L by processing the pickup image. Moreover, the position of vehicle may be obtained from navigation device 14, and lane width L may be obtained from a map data of navigation device 14.
In the example shown in
Then, when the following Relation (31) is satisfied; the controller determines that the vehicle has the lane departure tendency, and sets departure judgment flag Fout to ON (Fout=ON).
|X
S
|≧X
L (31)
On the other hand, when the following Relation (32) is satisfied; the controller determines that the vehicle does not have the lane departure tendency, and sets departure judgment flag Fout to OFF (Fout=OFF).
|X
S
|<X
L (32)
Further, the controller judges departure direction Dout on the basis of lateral displacement X. Specifically, when the vehicle is laterally displaced to the left from the center of traveling lane, the left direction is set as departure direction Dout (Dout=LEFT). On the other hand, when the vehicle is laterally displaced to the right from the center of traveling lane, the right direction is set as departure direction Dout (Dout=RIGHT).
Subsequently at step S75, the controller sets or changes the control finish timing of lane departure prevention control. Specifically, the control finish timing is set or changed according to shortage yaw moment ΔMS calculated at step S73. This processing of step S75 is executed (becomes effective) when departure judgment flag Fout which is set at step S74 (more specifically is finally set at after-mentioned step S76) is ON. In this embodiment, a time (control finish time-point, or elapsed time period from start time point) and a position (control finish position (lateral position)) are defined as the markers (parameters) for the control finish timing. The control finish time-period (or finish time-point) is denoted by Tend, and the control finish position is denoted by Xend.
For example, the case where shortage yaw moment ΔMS is equal to or near 0 means the case where actual yaw moment MSr is equal to or substantially equal to target yaw moment MSb. Namely, in this case, a desired (ideal) yaw moment has been generated in (applied to) the vehicle by the lane departure prevention control. Control finish time-period Tend or control finish position Xend at this time is set at a value which does not make an impression on the driver that the lane departure prevention control is being carried out too long, or which prevents the lane departure prevention control from giving a botheration to the driver who is trying to change lanes. In summary, control finish time-period Tend and control finish position Xend are changed or updated based on thus-set values in accordance with shortage yaw moment ΔMS.
As mentioned above, referring to
Subsequently at step S76, the controller judges the driver's intention of lane change. Specifically, the driver's intention of lane change is judged based on the signal of direction indicator switch 20 and steering angle δ obtained at step S71, as follows. When the direction (lighting side of a winker) indicated by the signal of direction indicator switch 20 is the same as the departure direction Dout obtained as step S74; it is determined that the driver is intentionally changing the lanes, and departure judgment flag Fout is changed to OFF (Fout=OFF). Namely, the information on the lane departure tendency is changed to the judgment result that the vehicle does not have the tendency to depart from the lane. On the other hand, when the direction (lighting side of winker) indicated by the signal of direction indicator switch 20 is different from departure direction Dout obtained as step S74; departure judgment flag Fout is maintained at ON (Fout=ON). Namely, the judgment result that the vehicle has the tendency to depart from the lane is maintained. Thus, in the case where departure judgment flag Fout is ON, departure judgment flag Fout is kept at ON when the driver is not intentionally changing the lanes.
Subsequently at step S77, the controller carries out a sound output or a display output as the warning for avoiding the lane departure when departure judgment flag Fout is ON. As mentioned below, when departure judgment flag Fout becomes ON, the yaw moment starts to be applied to the vehicle as the lane departure prevention control. Hence this warning output is carried out at the same time as the applying of moment to the vehicle. However, the output timing of warning is not limited to this. For example, the output timing of warning may be set at a timing before the start timing for applying the yaw moment.
Subsequently at step S78, the controller judges whether or not a decelerating control (hereinafter called, decelerating control for lane departure prevention) that decelerates the vehicle as the lane departure prevention control should be carried out. Specifically, the controller judges whether or not a subtraction value (|XS|−XL) obtained by subtracting lateral displacement limit distance XL from estimated lateral displacement XS calculated at step S74 is greater than or equal to a decelerating-control determining threshold value Xβ. Here, determining threshold value Xβ is set according to lane curvature β, and its relation is shown in
When the subtraction value (|XS|−XL) is greater than or equal to decelerating-control determining threshold value Xβ (|XS|−XL≧Xβ); it is determined that the decelerating control should be carried out, and a decelerating-control-operation judgment flag Fgs is set to ON. When the subtraction value (|XS|−XL) is smaller than decelerating-control determining threshold value Xβ (|XS|−XL<Xβ); it is determined that the decelerating control is not carried out, and decelerating-control-operation judgment flag Fgs is set to OFF.
Here, the relation between decelerating-control-operation judgment flag Fgs and departure judgment flag Fout set at step S74 is now explained. At step S74, departure judgment flag Fout is set at ON when estimated lateral displacement XS is larger than or equal to departure-tendency determining threshold value XL (|XS|≧XL). On the other hand, decelerating-control-operation judgment flag Fgs is set at ON when the subtraction value (|XS|−XL) is greater than or equal to decelerating-control determining threshold value Xβ. Because of the relation between these two settings, even if decelerating-control-operation judgment flag Fgs is set to ON, decelerating-control-operation judgment flag Fgs is set to ON after departure judgment flag Fout has been set to ON. Namely, since the after-mentioned applying of yaw moment to the vehicle is started when departure judgment flag Fout becomes ON, the decelerating control for vehicle is carried out after the applying of yaw moment has started.
Subsequently at step S79, the controller calculates target yaw moment MS. Specifically, the controller calculates basic target yaw moment MS0 (yaw moment out of consideration of the above-mentioned shortage amount) from the following Equation (33) on the basis of estimated lateral displacement XS and lateral displacement limit distance XL obtained at step S74.
M
S0=K1·K3·(|XS|−XL) (33)
Where K1 denotes the proportional gain determined from vehicle specifications, and K3 denotes a gain which varies according to vehicle speed V.
As recognized in Equation (33), basic yaw moment MS0 becomes larger as the difference between estimated lateral displacement XS and lateral displacement limit distance XL becomes larger.
Then, the controller calculates target yaw moment (target yaw moment to be finally applied to the vehicle) MS from the following Equation (34), as a value obtainable by adding basic yaw moment MS0 calculated by Equation (33) to shortage yaw moment ΔMS calculated by Equation (28) at step S73.
M
S
=M
S0+ΔMS (34)
Where, target yaw moment MS is calculated when departure judgment flag Fout is ON. On the other hand, target yaw moment MS is set to 0 when departure judgment flag Fout is OFF.
Subsequently at step S80, the controller calculates a deceleration degree (deceleration) which is necessary for the decelerating control for lane departure prevention. Namely, the controller calculates a braking force for being applied to both of the left and right wheels for the purpose of decelerating the vehicle. More specifically, the controller calculates target braking fluid pressures Pgf and Pgr each of which applies such braking force to both of left and right wheels. (Deceleration-purpose) Target braking fluid pressure Pgf for front wheels is calculated from the following Equation (35) by using estimated lateral displacement XS and lateral displacement limit distance XL calculated at step S74, and decelerating-control determining threshold value Xβ obtained at step S78.
Pgf=Kgv·Kgx·(|XS|−XL−Xβ) (35)
Where, Kgv is a conversion factor which is set according to vehicle speed V, and Kgx is a conversion factor which is determined from vehicle specifications.
Moreover, target braking fluid pressure Pgr for rear wheels is calculated based on target braking fluid pressure Pgf for front wheels calculated as above, in consideration of a distribution between the front and rear. Thus at step S80, the deceleration degree (deceleration) to be used for the decelerating control for lane departure prevention (concretely, target braking fluid pressures Pgf and Pgr) is obtained.
Subsequently at step S81, the controller calculates the (final) target braking fluid pressure for each wheel. Namely, the final braking fluid pressure is calculated based on presence or absence of the braking or decelerating control for lane departure prevention, and is calculated specifically as follows.
In the case where departure judgment flag Fout is OFF, namely in the case where the judgment result that there is not the lane departure tendency is obtained; target braking fluid pressures Psi (i=fl, fr, rl, rr) for respective wheels are set at braking fluid pressure Pmf or Pmr as shown in the following Equations (36) and (37).
Psfl=Psfr=Pmf (36)
Psrl=Psrr=Pmr (37)
Where Pmf is a braking fluid pressure for the front wheels. Moreover, Pmr is a braking fluid pressure for the rear wheels and is calculated based on braking fluid pressure Pmf for front wheels in consideration of the distribution between the front and rear. For example, when the driver is operating the brake (pedal), braking fluid pressures Pmf and Pmr take values according to the operation degree of this brake operation.
On the other hand, in the case where departure judgment flag Fout is ON, namely in the case where the judgment result that there is the lane departure tendency is obtained; front-wheel target braking-fluid-pressure differential ΔPsf and rear-wheel target braking-fluid-pressure differential ΔPsr are calculated on the basis of target yaw moment MS. Specifically, target braking-fluid-pressure differentials ΔPsf and ΔPsr are calculated from the following Equations (38) to (41).
In the case of |MS|<MS1;
ΔPsf=0 (38)
ΔPsr=Kbr·M
S
/T (39)
In the case of |MS|≧MS1;
ΔPsf=Kbf·(MS/|MS|)·(|MS|−MS1)/T (40)
ΔPsr=Kbr·(MS/|MS|)·MS1/T (41)
Where MS1 denotes a threshold value for setting. Note that this tread T is prescribed to take an equal value in the front and rear ends for convenience sake. Moreover, Kbf and Kbr are conversion factors respectively related to front wheels and rear wheels which are used for converting the braking force (power) to the braking fluid pressure. Kbf and Kbr are determined from the brake specification.
Thus, the braking force to be generated at wheels is distributed to front and rear ends in accordance with the magnitude of target yaw moment MS. When target yaw moment MS is smaller than threshold value MS1; front-wheel target braking-fluid-pressure differential ΔPsf is made equal to 0, and rear-wheel target braking-fluid-pressure differential ΔPsr is made to take the predetermined value so as to generate a braking force differential between the rear left and right wheels. Moreover, when target yaw moment MS is greater than or equal to threshold value MS1; each of target braking-fluid-pressure differentials ΔPsf and ΔPsr is made to take its predetermined value so as to generate the braking force differential between the front left and right wheels, and also the braking force differential between the rear left and right wheels.
Then, the controller calculates final target braking fluid pressures Psi (i=fl, fr, rl, rr) for respective wheels, by using the calculated target braking-fluid-pressure differentials ΔPsf and ΔPsr and target braking fluid pressures Pgf and Pgr for the decelerating control. Specifically, final target braking fluid pressures Psi (i=fl, fr, rl, rr) for respective wheels are calculated also referring to decelerating-control-operation judgment flag Fgs set at step S78.
Namely, in the case where departure judgment flag Fout is ON and decelerating-control-operation judgment flag Fgs is OFF, namely when there is the judgment result that the vehicle has the lane departure tendency and the decelerating control is not carried out (i.e., in the case where only the applying of yaw moment to the vehicle is carried out); target braking fluid pressure Psi (i=fl, fr, rl, rr) for each wheel is calculated from the following Equations (42).
Psfl=Pmf
Psfr=Pmf+ΔPsf
Psrl=Pmr
Psrr=Pmr+ΔPsr (42)
Moreover, in the case where departure judgment flag Fout is ON and decelerating-control-operation judgment flag Fgs is ON, namely in the case where the vehicle is decelerated while applying the yaw moment to the vehicle; target braking fluid pressure Psi (i=fl, fr, rl, rr) for each wheel is calculated from the following Equations (43).
Psfl=Pmf+Pgf/2
Psfr=Pmf+ΔPsf+Pgf/2
Psrl=Pmr+Pgr/2
Psrr=Pmr+ΔPsr+Pgr/2 (43)
As shown in Equations (42) and (43), target braking fluid pressure Psi (i=fl, fr, rl, rr) for each wheel is calculated in consideration of the driver's brake operation namely in consideration of the braking fluid pressures Pmf and Pmr. Then, braking/driving force control unit 8 outputs thus-calculated target braking fluid pressure Psi (i=fl, fr, rl, rr) for each wheel to braking-fluid-pressure control section 7, as the braking-fluid-pressure command value.
Equations (38) to (43) shows the target braking fluid pressure for each wheel and the like, in the case where departure direction Dout is LEFT (Dout=LEFT), namely in the case where the vehicle has the lane departure tendency against the left-side lane marker. However, in the case where departure direction Dout is RIGHT (Dout=RIGHT), namely in the case where the vehicle has the lane departure tendency against the right-side lane marker; the explanations about Equations corresponding to Equations (38) to (43) will be omitted. In the case where departure direction Dout is RIGHT, target braking fluid pressure Psi (i=fl, fr, rl, rr) for each wheel is calculated from the following Equations (44) corresponding to Equations (42).
Psfl=Pmf+ΔPsf
Psfr=Pmf
Psrl=Pmr+ΔPsr
Psrr=Pmr (44)
The control finish timing of lane departure prevention control is set (changed) at step S75. Hence, departure judgment flag Fout is set (changed) to OFF when the elapsed time from the start of lane departure prevention control reaches control finish time-period Tend, or when the lateral position of vehicle (actual lateral position X or estimated lateral displacement XS) reaches control finish position Xend during operation of lane departure prevention control. Thereby, the lane departure prevention control is terminated.
(Operations)
The operations according to the fifth embodiment will now be explained below. While the vehicle is running (traveling), the controller reads various data (step S71), calculates vehicle speed V, and sets previous vehicle speed VPAST (step S72). Subsequently, the controller calculates shortage yaw moment ΔMS by using vehicle speed V, previous vehicle speed VPAST, and the like (step S73). Then, the controller sets (changes) the control finish timing for lane departure prevention control, specifically control finish time-period Tend and control finish position Xend on the basis of the calculated shortage yaw moment ΔMS (step S75).
Moreover, the controller calculates future estimated lateral displacement (estimated value of departure) XS, carries out the judgment of lane departure tendency (setting of departure judgment flag Fout) on the basis of estimated lateral displacement XS (step S74), and corrects the judgment result (departure judgment flag Fout) of lane departure tendency on the basis of driver's intention of changing lanes (step S76). Then, the controller carries out the warning output in dependence upon the judgment result of lane departure tendency (step S77).
Moreover, the controller sets decelerating-control-operation judgment flag Fgs on the basis of estimated lateral displacement XS (step S78). Then, the controller calculates target yaw moment MS to be applied to (produced in) the vehicle as the lane departure prevention control, and the decelerating degree (target braking fluid pressures Pgf and Pgr) for the decelerating control for lane departure prevention (steps S79 and S80). Here, target yaw moment MS is a value which is obtained by adding shortage yaw moment ΔMS to basic target yaw moment MS0 and therefore which compensates for shortage yaw moment ΔMS.
Then, the controller calculates target braking fluid pressure Psi (i=fl, fr, rl, rr) for each wheel on the basis of target yaw moment MS and the decelerating degree (target braking fluid pressures Pgf and Pgr), with reference to the statuses of departure judgment flag Fout and decelerating-control-operation judgment flag Fgs; and outputs the calculated target braking fluid pressure Psi (i=fl, fr, rl, rr) for each wheel to braking-fluid-pressure control section 7 (step S81). Thereby, the yaw moment according to (the state of) the lane departure tendency of vehicle is applied to the vehicle, and possibly the vehicle is decelerated. Then, the controller finishes the lane departure prevention control, when the elapsed time from the start of lane departure prevention control reaches control finish time-period Tend or when the lateral position of vehicle (actual lateral position X or estimated lateral displacement XS) reaches control finish position Xend during operation of lane departure prevention control. Namely when satisfying the above-mentioned condition of control finish timing, the lane departure prevention control is forced to finish irrespective of the lane departure tendency.
(Functions and Effects)
Next, functions and effects according to the fifth embodiment will now be explained below. Control finish time-period Tend and control finish position Xend for defining or determining the control finish timing of lane departure prevention control are set based on shortage (shortage amount) ΔMS of the yaw moment serving as a controlled variable for lane departure prevention control, as described above. At this time, control finish time-period Tend and control finish position Xend are set to become greater as shortage-amount yaw moment ΔMS becomes greater.
For example,
Since control finish time-period Tend and control finish position Xend are set based on shortage (shortage amount) ΔMS of the yaw moment serving as the controlled variable for lane departure prevention control as described above; it can be prevented that the control finish timing comes and thereby the lane departure prevention control is released, when trying to compensate for (or covering) the shortage amount of yaw moment as the lane departure prevention control, namely when applying target yaw moment MS compensating for shortage yaw moment ΔMS to the vehicle. Therefore, the yaw moment (control quantity) necessary for the lane departure prevention for vehicle can be secured.
Further, since control finish time-period Tend and control finish position Xend are made greater as shortage yaw moment ΔMS becomes greater, the control finish timing can be delayed according to shortage yaw moment ΔMS even if shortage yaw moment ΔMS is great.
It is noted that the lane departure prevention control apparatus according to the fifth embodiment can be modified to have the following configurations. In the fifth embodiment, the time (control finish time-period) and the position (control finish position (lateral position)) are used as markers (parameters) for determining the control finish timing. However, one of these may be used as the marker for the control finish timing. Moreover, a total amount of control quantity (integration value of controlled variable) from the start time of lane departure prevention control, the yaw angle of vehicle relative to (tangent of center line of) traveling lane during the lane departure prevention control, or the like may be used as the marker for determining the control finish timing. For example, if using the yaw angle as the marker for the control finish timing, an arbitrary value of yaw angle having a gradient toward the inner side of the traveling lane on which the vehicle is running is defined as the yaw angle's value for determining the control finish timing.
Further in this embodiment, shortage yaw moment ΔMS is (directly) calculated as the difference value between actual yaw moment MSr and target yaw moment MSb (see Equation (28)). Contrary to this, shortage yaw moment ΔMS can be calculated or estimated also on the basis of a temperature (or its temperature history) or a usage frequency of a brake equipment such as brake pad (or brake shoe), or a vehicle state such as vehicle weight. The temperature and the like of the brake equipment such as brake pad (or brake shoe) influences the braking force, and thereby influences actual yaw moment MSr. Hence, shortage yaw moment ΔMS can be calculated or estimated also from the temperature and the like of brake equipment such as brake pad (or brake shoe). In this case, for example, a device for detecting or estimating the temperature of brake equipment is further provided, and a relation between the temperature of brake equipment and a marker (variable) indicating a reduction of braking force is stored as a map in advance. Thereby, shortage yaw moment ΔMS is calculated or estimated based on the marker corresponding to the temperature of brake equipment. Moreover, without calculating the shortage yaw moment based on the above-mentioned marker, the difference value between actual yaw moment MSr and target yaw moment MSb may be calculated when the marker becomes greater than or equal to a predetermined threshold value. Moreover, shortage yaw moment ΔMS can be calculated or estimated also based on an external traveling environment of vehicle (external environment in which the vehicle is traveling) such as weather or ambient air temperature, instead of the state of vehicle.
Further in this embodiment, actual yaw moment MSr is calculated based on vehicle speed V (Equations (25) to (27)). Contrary to this, actual yaw moment MSr can be calculated also based on the other value such as yaw rate φ′.
According to the above-described explanations about the fifth embodiment, the computing process shown by
This application is based on prior Japanese Patent Applications No. 2006-125414 filed on Apr. 28, 2006 and No. 2006-190599 filed on Jul. 11, 2006. The entire contents of these Japanese Patent Applications are hereby incorporated by reference.
Although the invention has been described above with reference to certain embodiments of the invention, the invention is not limited to the embodiments described above. Modifications and variations of the embodiments described above will occur to those skilled in the art in light of the above teachings. The scope of the invention is defined with reference to the following claims.
Number | Date | Country | Kind |
---|---|---|---|
2006-125414 | Apr 2006 | JP | national |
2006-190599 | Jul 2006 | JP | national |