Brake system control

Information

  • Patent Grant
  • 6122584
  • Patent Number
    6,122,584
  • Date Filed
    Monday, February 22, 1999
    25 years ago
  • Date Issued
    Tuesday, September 19, 2000
    24 years ago
Abstract
A brake system control method, comprising the steps of: measuring a longitudinal speed and steering angle of the vehicle; specifying an un-damped natural frequency and a damping ratio for a linear reference model of said vehicle; determining a first gain parameter relating a desired value of steady state lateral velocity to the vehicle steering angle; computing a desired lateral velocity as a function of said first gain parameter, the measured longitudinal speed, the measured steering angle, and the specified un-damped natural frequency and damping ratio; determining a second gain parameter relating a desired value of steady state yaw rate to the vehicle steering angle; computing a desired yaw rate as a function of said second gain parameter, the measured longitudinal speed and steering angle, and the specified un-damped natural frequency and damping ratio; measuring a lateral acceleration and yaw rate of said vehicle, and forming a yaw rate command for said vehicle based at least part in a first deviation between said desired and measured yaw rates, and a second deviation between said measured lateral acceleration and a desired lateral acceleration based on said desired lateral velocity; and differentially braking wheels of said vehicle to impart a yaw moment corresponding to said yaw rate command.
Description

BACKGROUND OF THE INVENTION
Automotive vehicles have been produced or demonstrated with brake systems that modulate brake force during stops to provide anti-lock brake control (ABS) and/or that modulate brake force during vehicle acceleration to provide positive acceleration traction control (TCS). Some such brake systems additionally provide brake-by-wire control.
More recently, vehicles have been produced with brake systems that activate in certain situations where some or all vehicle tires are experiencing excessive lateral movement relative to the road surface. The brakes are selectively controlled to attempt to bring the vehicle to a desired course and/or to minimize the lateral movement of the tires relative to the road surface.
SUMMARY OF THE INVENTION
It is an object of this invention provide a brake system control method according to claim 1.
Advantageously this invention provides a brake system control method for actively controlling the road response of a motor vehicle.
Advantageously this invention provides a brake system control method and apparatus that provides an improved vehicle reference model for determining desired yaw rate and desired slip angle. Advantageously, the reference model implements the desired vehicle dynamics as represented by the damping ratio and natural frequency in a single filter whose output is used by relatively simple calculations to calculate both the desired slip angle and desired yaw rate.
Advantageously, this invention allows the system designer to (a) select the damping ratio and natural frequency desired of the vehicle reference model, (b) define a single filter representing the selected damping ratio and natural frequency, (c) apply steering angle to the filter, (d) use the filter output with a predetermined slip angle gain function to determine desired vehicle slip angle and (e) use the filter output with a predetermined yaw gain function to determine the desired vehicle yaw rate.
Advantageously, according to one example, this invention provides a brake system control method, comprising the steps of: measuring a longitudinal speed and steering angle of the vehicle; specifying an un-damped natural frequency and a damping ratio for a linear reference model of said vehicle; determining a first gain parameter relating a desired value of steady state lateral velocity to the vehicle steering angle; computing a desired lateral velocity as a function of said first gain parameter, the measured longitudinal speed, the measured steering angle, and the specified un-damped natural frequency and damping ratio; determining a second gain parameter relating a desired value of steady state yaw rate to the vehicle steering angle; computing a desired yaw rate as a function of said second gain parameter, the measured longitudinal speed and steering angle, and the specified un-damped natural frequency and damping ratio; measuring a lateral acceleration and yaw rate of said vehicle, and forming a yaw rate command for said vehicle based at least in part on a first deviation between said desired and measured yaw rates, and a second deviation between said measured lateral acceleration and a desired lateral acceleration based on said desired lateral velocity; and differentially braking wheels of said vehicle to impart a yaw moment corresponding to said yaw rate command.





BRIEF DESCRIPTION OF THE DRAWINGS
The present invention will now be described by way of example with reference to the following drawings, in which:
FIG. 1 is an example schematic of a vehicle brake control system according to this invention;
FIG. 2 illustrates an example diagram of vehicle dynamics according to this invention;
FIG. 3 illustrates an example control according to this invention;
FIGS. 4-8 illustrate command flow diagrams of example control functions according to this invention;
FIGS. 9-11 illustrate example gain functions for use with the example system described below;
FIG. 12 illustrates an example vehicle reference model; and
FIG. 13 illustrates another example vehicle reference model.





DESCRIPTION OF THE PREFERRED EMBODIMENT
Referring to FIG. 1, the vehicle 10 shown includes a controllable brake system with controller 68 for controlling the brakes 20, 22, 24 and 26 of the vehicle wheels 12, 14, 16 and 18, respectively. Various inputs to the controller 68 include the wheel speed signals on lines 36, 38, 40 and 42 from wheel speed sensors 28, 30, 32 and 34, the brake pedal switch signal on line 84 from brake pedal switch 82, the brake pedal extended travel signal on line 83 from pedal travel sensor 85 (optional), the steering wheel angle signal on line 62 from sensor 61 indicating the angle of steering wheel 60, the yaw rate signal on line 81 from yaw rate sensor 80, the master cylinder pressure signal on line 96 from master cylinder pressure sensor 94 (optional) and the lateral acceleration signal on line 99 from lateral accelerometer 98.
Each of the sensors 28, 30, 32, 34, 61, 80, 82, 85, 98 and 99 is implemented in a manner known to those skilled in the art. The brake pedal travel sensor 85 is a switch mounted to the pedal that provides an output signal when the pedal has been depressed an extended amount indicating "hard" braking by the driver.
In one example, the steering wheel position sensor 61 may be a digital sensor that provides output signals that increment a digital position signal within controller 68 with each degree or partial degree of movement of the steering wheel 60 in one direction and decrement the digital position signal with each degree or partial degree of movement in the opposite direction. The steering wheel sensor 61 may also include an analog sensor position output (i.e., from a rotary resistive device of a known type) that provides approximate steering wheel position information. The analog output can be used, for example, to determine whether the steering wheel is turned less than a preset limit, i.e., 90 degrees, at vehicle start-up. A method for determining the center position of the steering wheel position sensor is disclosed in pending U.S. patent application, Ser. No. 08/664,321, assigned to the assignee of this invention.
Responsive to the various inputs, the controller controls the braking of each wheel in anti-lock braking mode during certain braking maneuvers and in traction control mode during certain vehicle acceleration maneuvers to maintain tractive force of the drive wheels on the road surface. The anti-lock brake control and positive acceleration traction control are performed in a known manner except as modified herein.
The controller 68 also actively controls the wheel brakes 20, 22 (in a two channel system) or 20, 22, 24 and 26 (in a four channel system) responsive to the actual vehicle yaw rate and actual vehicle lateral acceleration as measured by sensors 80 and 98, respectively, to minimize the difference between the actual vehicle yaw rate and a desired vehicle yaw rate and to minimize the difference between the actual vehicle slip angle and the desired vehicle slip angle. Because the base braking, antilock braking and traction control functions are known to those skilled in the art, only a general description thereof will be set forth herein.
When the vehicle is in a braking maneuver, the controller monitors the wheel speed signals from sensors 28, 30, 32 and 34 and determines if one or more of the wheels is in or is about to be in an incipient lock-up condition, in which case anti-lock brake control mode for the one or more wheels is activated. In the anti-lock brake control mode, the controller 68 determines and outputs commands to the actuators 52, 54, 56 and 58 corresponding to the wheels in anti-lock brake mode to modulate brake force to the wheels. Through control of the actuators 52, 54, 56 and 58, the controller prevents the wheels from entering a lock-up condition while achieving effective brake control and steeribility in a manner known to those skilled in the art of anti-lock brake control.
When the vehicle is not in a braking maneuver, but is accelerating due to output motive force from the vehicle prime mover, i.e., the internal combustion engine or electric motor, the controller 68 monitors the wheel speeds sensed by sensors 28, 30, 32 and 34 to determine if the wheels transferring motive force to the road surface are slipping or are about to slip. In such wheel conditions, the controller 68 sends commands to the actuators 52-58 corresponding to the wheels that are slipping or are about to slip to provide brake force to the wheels to reduce the slip. Such control is typically performed in conjunction with a parallel control in the engine or motor (and/or the transmission) controller to temporarily reduce the motive force output until wheel-to-road traction is reestablished.
In one example, the brake actuators 52-58 are implemented as reciprocating piston actuators of a type known to those skilled in the art. Such actuators typically include a dc motor positionally controlling a reciprocating piston through a rotary-to-linear motion converter to increase and/or decrease hydraulic pressure in the wheel brakes. In another example, brake actuators 52-58 are implemented as solenoid valves for selectively coupling brakes 20-26 to a source of pressurized hydraulic fluid to increase brake pressure and for selectively coupling brakes 20-26 to a brake fluid reservoir to decrease brake pressure. Implementation of such solenoid valves is known to those skilled in the art. In yet another example, the rear brakes and/or the front brakes may be electric motor-driven brakes, in which case the actuator and brake functions are performed by the same unit. An example of a brake system including front hydraulic brakes and rear electric brakes in which all four brakes are controlled in a brake-by-wire method is set forth in U.S. Pat. No. 5,366,291, assigned to the assignee of this invention.
The example system describe herein performs an active brake control of the two wheel brakes 20 and 22 or of the four wheel brakes 20, 22, 24 and 26 responsive to the steering wheel angle signal on line 62, the yaw rate signal on line 81, the vehicle speed as calculated responsive to the signals from the four wheel speed sensors, the lateral acceleration signal on line 99 and either the brake pedal extended travel sensor 85 or the master cylinder pressure sensor 94. Using these signals, controller 68 determines a desired vehicle yaw rate and compares that desired yaw rate to the actual yaw rate sensed by sensor 80. The controller 68 also determines a desired vehicle slip angle (defined below) and compares that desired vehicle slip angle to the actual vehicle slip angle as determined by an estimator or observer in the controller. If the yaw rate of the vehicle differs from the desired yaw rate by more than a yaw rate threshold that is dynamically determined, or if a desired corrective yaw moment determined responsive to yaw rate error and slip angle error is greater than a yaw moment threshold, controller 68 determines and outputs commands to actuators 52, 54, 56 and 58 to control the vehicle wheel brakes 20, 22, 24 and/or 26 to bring the vehicle yaw rate and slip angle into conformance with the desired yaw rate and slip angle. In a two channel system, only brakes 20 and 22 are controlled via actuators 52 and 54, respectively.
In carrying out these tasks, controller 68 typically includes a microprocessor, ROM and RAM and appropriate input and output circuits of a known type for receiving the various input signals and for outputting the various control commands to the actuators 52, 54, 56 and 58.
Referring now to FIG. 2, the schematic diagram illustrates the concepts of slip angle and yaw rate control. The vehicle 10 has a longitudinal axis 201 oriented in what is referred to as the x direction or the forward direction of the vehicle. The vector denoted by reference 204 illustrates an example true velocity of the vehicle center of gravity, which has a direction oriented at an angle .beta., denoted by reference 202, from the x axis or longitudinal axis 201 of the vehicle. The vector 204 has longitudinal (x axis) velocity component 208 and lateral velocity component 206, which is parallel to what is referred to herein as the y axis. Reference 200 represents the vehicle center of gravity.
During vehicle maneuvering operations, there are generally two kinds of vehicle behavior. The first is linear behavior during which the vehicle's yaw rate and slip angle have fixed relationships to steering wheel angle and vehicle forward velocity. A nonlinear operation of the vehicle is characterized by significant lateral movement of at least some of the vehicle tires with respect to the road surface. During nonlinear operation, the vehicle's yaw rate 210 and slip angle 202 deviate from the fixed relationships to steering wheel angle and vehicle forward velocity that are characteristic of linear operation.
This invention advantageously reduces the deviation of the vehicle's yaw rate 210 and slip angle 202 from desired yaw rates and slip angles during many nonlinear operating conditions of the vehicle. The control of the vehicle yaw rate and slip angle is achieved by the selective application of brake forces at the vehicle wheels 12, 14 (in a two channel system) or 12, 14, 16 and 18 (in the four channel system) to induce yaw moments on the vehicle 10 countering the undesirable yaw movement detected of the vehicle 10. These brake forces are illustrated graphically by references 212. Additionally, during braking maneuvers a yaw moment may be introduced by decreasing brake forces at select wheels while maintaining or increasing the brake forces at other wheels. Decreases in brake forces are represented by references 214. Thus, it is through the selective increase and/or decrease of brake forces at the vehicle wheels 12, 14 (two channel system) or 12, 14, 16 and 18 (four channel system) that yaw moments are induced on the vehicle 10 to minimize the respective differences between desired and actual yaw rates and between desired and actual slip angles.
Referring now to FIG. 3, the example control shown includes the vehicle reference model 102, block 104 representing the vehicle, estimators 120 and 122 for estimating the actual surface coefficient of adhesion and vehicle slip angle, respectively, yaw command and slip command control blocks 138, 142, output command block 154 and the brake actuators and wheel brakes represented by blocks 132 and 128, respectively.
In the following sections, time values denoted with a (k) represent present control-loop values and time values denoted by (k-n) represent the nth most recent control-loop values in a conventional manner. Where time value denotations, i.e., (k), are omitted from equations, it is assumed that the time value denotation is (k) unless otherwise specified.
The vehicle reference model receives inputs from lines 112, 62 and 121 representing the vehicle forward velocity, steering wheel angle and estimated surface coefficient of adhesion. The vehicle reference model uses the inputs to calculate desired vehicle slip angle, desired vehicle lateral velocity and desired vehicle yaw rate according to the following equations:
v.sub.yd (k)=(1+a.sub.11 *.DELTA.t)*v.sub.yd (k-1)+a.sub.12 *.DELTA.t*.OMEGA..sub.du (k-1)+b.sub.1 *.DELTA.t*.delta.(k-1),
.OMEGA..sub.du (k)=a.sub.21 *.DELTA.t*v.sub.yd (k-1)+(1+a.sub.22 *.DELTA.t)*.OMEGA..sub.du (k-1)+b.sub.2 *.DELTA.t*.delta.(k-1),
and
.beta..sub.du =Arctan (v.sub.yd /v.sub.x),
where .DELTA.t is the sampling period (control loop time) and
a.sub.11 =-(c.sub.f +c.sub.r)/(M*v.sub.x), a.sub.12 =(-c.sub.f *a+c.sub.r *b)/(M*v.sub.x)-v.sub.x,
a.sub.21 =(-c.sub.f *a+c.sub.r *b)/(I.sub.zz *v.sub.x), a.sub.22 =-(c.sub.f *a.sup.2 +c.sub.r *b.sup.2)/(I.sub.zz *v.sub.x),
b.sub.1 =c.sub.f /M and b.sub.2 =a*c.sub.f /I.sub.zz,
where .delta. is the steering angle of the front wheels, M is the total mass of the vehicle, I.sub.zz is the moment of inertia of the vehicle about the yaw axis (passing through the center of gravity), a and b are distances from the center of gravity of the vehicle to the front and rear axles, c.sub.f and c.sub.r are cornering stiffness coefficients of both tires of front and rear axles, respectively, v.sub.x is the forward velocity of the vehicle, v.sub.yd (k) is the desired lateral velocity of the vehicle at time k, .OMEGA..sub.du (k) is the desired yaw rate (unlimited) of the vehicle at time k and .beta..sub.du is the unlimited desired slip angle of the vehicle.
It is noted that the above vehicle model is a preferred example and other vehicle models may be used as alternatives to determining the desired vehicle yaw rate and slip angles.
The reference model 102 then limits the desired values of slip angle and yaw rate, where the maximum value of the desired slip angle is determined responsive to the estimated surface coefficient of adhesion .mu..sub.c determined at block 120 and output on line 121. Typically, road to tire surface coefficient of adhesions are in the range of 0.2 to 1.0; 0.2 representing ice and 1.0 representing dry pavement. The maximum desired slip angle will be predetermined by the vehicle designer and may vary from vehicle type to vehicle type. In one example, the maximum desired slip angle on ice is 4.degree. of slip angle and on a dry surface is 10.degree.. Assuming these parameters, then the maximum desired slip angle, .beta..sub.max, is determined as follows: ##EQU1## and ##EQU2## The condition .beta..sub.du *.delta..gtoreq.0.005 may be replaced by the condition v.sub.x <[c.sub.r *b*(a+b)/(M*a)].sup.1/2 since, when this condition is met, the signs of .beta..sub.du and .delta. are the same. Once .beta..sub.max is determined, the desired slip angle is limited according to the following equation: ##EQU3## According to the above equations, .beta..sub.d is not limited when the signs of slip angle and steering angle are the same, or equivalently when vehicle speed is below the value defined above.
The desired yaw rate, .OMEGA..sub.d, is determined as .OMEGA..sub.du, limited to plus and minus a predetermined parameter set, for example equal to 0.2 or 0.3 radians per second above the maximum yaw rate sustainable by the vehicle on a dry (high coefficient of adhesion) surface. The limit on the desired yaw rate may be speed dependent (e.g., the maximum magnitude for .OMEGA..sub.d may be limited to a.sub.ymax /v.sub.x +0.3).
The desired lateral acceleration, a.sub.yd, is determined as:
a.sub.yd =v.sub.yd '+v.sub.x *.OMEGA..sub.du,
where v.sub.yd ' is the time derivative of v.sub.yd and may be computed as:
a.sub.11 *v.sub.yd +a.sub.12 *.OMEGA..sub.du +b.sub.1 *.delta.
or as
(v.sub.yd (k)-v.sub.yd (k-1))/.DELTA.t.
The reference model 102 outputs the desired slip angle, .beta..sub.d, on line 106, the desired yaw rate, .OMEGA..sub.d, on line 108 and the desired lateral acceleration, a.sub.yd, on line 110.
The desired lateral acceleration on line 110 and the actual vehicle lateral acceleration on line 99, are provided to block 120 along with the measured vehicle yaw rate, .OMEGA..sub.a, on line 81, desired yaw rate, .OMEGA..sub.d, steering angle, .delta., and vehicle speed, v.sub.x. Block 120 uses the actual and desired lateral accelerations and the actual and desired vehicle yaw rates to estimate a coefficient of adhesion between the road surface and the vehicle tires.
Before measured lateral acceleration is used in the algorithm, it is multiplied by a roll factor, r.sub.fac, in order to reduce the effect of vehicle roll during turning maneuvers on the measured lateral acceleration. The roll factor may be computed as:
r.sub.fac =1/(1+M*g*h/.phi.),
where h is the height of the vehicle center of gravity and .phi. is the total roll stiffness of the vehicle suspension. For a typical sedan, r.sub.fac .apprxeq.0.9. From this point on, the term measured lateral acceleration, a.sub.y, refers to the lateral acceleration measured by the sensor 98, multiplied by r.sub.fac and filtered through a low pass filter, e.g., a second order Butterworth filter having a cut off at 40 rad/s to reduce noise from the sensor signal.
The estimation at block 120 first uses the steering angle and vehicle velocity to compute a value, .OMEGA..sub.dss, referred to as the desired yaw rate at steady state, as follows:
.OMEGA..sub.dss =v.sub.x *.delta./((a+b)+K.sub.u *v.sub.x.sup.2),
where K.sub.u is the vehicle understeer coefficient, defined as:
K.sub.u =(c.sub.r *b-c.sub.f *a)*M/(c.sub.f *c.sub.r *(a+b)).
The value .OMEGA..sub.dss differs from .OMEGA..sub.d in that it does not account for the dynamic delay in the vehicle model that is included in the calculation of .OMEGA..sub.d. The measured and desired lateral accelerations are passed through identical low pass filters to attenuate noise in the measured lateral acceleration signal. The desired lateral acceleration is then filtered through another low pass filter, for example, a standard second order Butterworth filter with a cut off frequency of 22 radians per second in order to reduce or eliminate the phase difference between the two signals. Then a value, a.sub.ydfl, is determined by limiting the output of the Butterworth filter to .+-.a.sub.ymax, where a.sub.ymax is the maximum lateral acceleration that the vehicle can sustain on a dry surface. The magnitude of the lateral acceleration error, .DELTA.a.sub.y, is then determined according to:
.DELTA.a.sub.y =.vertline.a.sub.ydfl -a.sub.y .vertline.,
where a.sub.y denotes the measured and filtered lateral acceleration. The value .DELTA.a.sub.y is then filtered through a first order digital low pass filter, for example, with a cut off frequency of 2 radians per second, to yield the filtered lateral acceleration error, .DELTA.a.sub.yf.
A preliminary estimate of lateral surface coefficient of adhesion, .mu..sub.ay, is determined according to:
.mu..sub.ay =.vertline.a.sub.y .vertline./a.sub.ymax.
Then a value .mu..sub.temp is determined equal to .mu..sub.ay if all of the following conditions are met simultaneously:
.vertline.a.sub.ydfl .vertline.-.vertline.a.sub.y .vertline.>THRESH1;(a)
.vertline..OMEGA..sub.dss -.OMEGA..sub.a .vertline.>THRESH2;(b)
and (c) the signs of the desired and actual lateral accelerations are the same and have been the same for at least a specified period of time, e.g., 0.3 seconds.
In condition (b) above, .OMEGA..sub.d could be used instead of .OMEGA..sub.dss, but .OMEGA..sub.dss is preferable because the yaw rate error developed from .vertline..OMEGA..sub.dss -.OMEGA..sub.dss .vertline. is more likely to be in phase with lateral acceleration error than .vertline..OMEGA..sub.d -.OMEGA..sub.a .vertline..
In the condition (c) above, the time that desired and actual lateral accelerations have opposite signs is tracked, for example, with a timer Ti, defined as: ##EQU4## where a.sub.yd is the desired (unfiltered) lateral acceleration, .DELTA.t is the loop time of the control algorithm and 0.1 is an example constant to be determined as appropriate by the system designer. Condition (c) is met when Ti>0.3 seconds.
Also .mu..sub.temp is set equal to .mu..sub.ay if the following three conditions are met simultaneously: (a) the vehicle velocity is small, for example, below 7 meters/second; (b) the signs of a.sub.ydfl and a.sub.y are the same and have been the same for at least a specified period of time, e.g., 0.3 seconds; and
.vertline..OMEGA..sub.d -.OMEGA..sub.a .vertline.>THRESH3, (c)
where THRESH1, THRESH2 and THRESH3 are predetermined threshold values corresponding to lateral acceleration error and two yaw rate errors when the vehicle's behavior begins to deviate significantly from that of the linear model (i.e., the vehicle enters a non-linear range of operation). Example values for THRESH1, THRESH2 and THRESH3 are 1.2 m/s.sup.2, 0.10 rad/s and 0.14 rad/s, respectively. These threshold values may be made speed dependent. Also the value .mu..sub.temp is set equal to .mu..sub.ay regardless of the above conditions if the following condition is met:
.vertline.a.sub.y .vertline./a.sub.ymax >1.05*.mu..sub.temp.
This above condition corrects the surface estimate when the magnitudes of measured lateral acceleration rises at least a given percentage (e.g., 5%) above the value that the present surface estimate would permit (.mu..sub.temp *a.sub.ymax).
The reset value for .mu..sub.temp is 1.0 and .mu..sub.temp is reset to 1.0 when the following conditions are simultaneously met:
.vertline.a.sub.ydfl -a.sub.y .vertline..ltoreq.THRESH1, (a)
.DELTA.a.sub.yf <0.5*THRESH1, (b)
.vertline..OMEGA..sub.d -.OMEGA..sub.a .vertline.<THRESH3, (c)
and the a.sub.yd, a.sub.ydfl and a.sub.y have the same sign and have had the same sign for at least a specified time period, e.g., Ti>0.3 seconds.
If neither the set of criteria indicating linear operation nor the set of conditions triggering calculation of surface estimate from lateral acceleration are met, then the estimate .mu..sub.temp is maintained at its most recent estimated value, i.e., .mu..sub.temp (k)=.mu..sub.temp (k-1).
A value .mu..sub.new is determined according to:
.mu..sub.new =(0.85+0.15*.mu..sub.temp)*.mu..sub.temp,
where the parameters 0.85 and 0.15 may vary for different types of vehicles. The value .mu..sub.new is then limited to no less than 0.07 and no greater than 1.0 to get .mu..sub.L, which is output on line 123 as the estimated surface coefficient of adhesion used in the slip angle estimation block 122. The estimated surface coefficient of adhesion used for the control blocks 138 and 142 and used in the vehicle reference model 102 is determined by passing .mu..sub.new through a low pass filter, for example a second order Butterworth filter having a cut off frequency of 1.5 Hz. The filter output is then limited to no less than 0.2 and no greater than 1.0 to determine .mu..sub.e, the signal on line 121.
Block 122 estimates the actual slip angle of the vehicle using the steering wheel angle signal on line 62, the actual measured vehicle yaw rate on line 81, the actual measured vehicle lateral acceleration on line 99, estimated vehicle speed v.sub.x and the estimated lateral surface coefficient of adhesion, .mu..sub.L, on line 123. The slip angle estimation implements an iterative observer to determine the estimated vehicle slip angle, .beta..sub.e. The observer first estimates the side slip angles of front and rear axles using the following equations:
.alpha..sub.fe =(v.sub.ye (k-1)+a*.OMEGA..sub.a)/v.sub.x -.delta. and
.alpha..sub.re =(v.sub.ye (k-1)-b*.OMEGA..sub.a)/v.sub.x,
where v.sub.ye (k-1 ) is the estimated lateral velocity from the previous iteration of the observer, .alpha..sub.fe and .alpha..sub.re are the front and rear axle side slip angles.
The observer next estimates lateral forces of the front axle, F.sub.yf, according to: ##EQU5## where s.sub.f is a small non-negative number (the slope of the F.sub.yf -.alpha..sub.f curve at the limit of adhesion), e.g., s.sub.f =0.05, and where .alpha..sub.f* is defined by:
.alpha..sub.f* =1/(2*b.sub.cf')
where b.sub.cf is defined by:
b.sub.cf =c.sub.f /(4*N.sub.f*),
where
N.sub.f* =M*b*(a.sub.ymax +.DELTA..sub.a)/(a+b)
where a.sub.ymax is the maximum lateral acceleration that the vehicle can sustain on a dry surface in m/s.sup.2 and .DELTA..sub.a is a constant, e.g., .DELTA..sub.a =0.5 m/s.sup.2.
The observer next estimates lateral forces of the rear axle, F.sub.yre, according to: ##EQU6## where s.sub.r is a small non-negative number, e.g., s.sub.r =0.05 and where .alpha..sub.r* is defined by:
.alpha..sub.r* =1/(2*b.sub.cr')
where b.sub.cr is defined as:
b.sub.cr =c.sub.r /(4*N.sub.r*),
where
N.sub.r* =M*a*(a.sub.ymax +.DELTA..sub.a)/(a+b).
The observer then estimates a system state value, q(k), according to:
q(k)=q(k-1)+.DELTA.t*{-(1+g.sub.2)*v.sub.x *.OMEGA..sub.a +((1+g.sub.3)/M-a*g.sub.1 /I.sub.zz)*F.sub.yfe +((1+g.sub.3)/M+b*g.sub.1 /I.sub.zz)*F.sub.yre +(g.sub.2 -g.sub.3)*a.sub.y -g.sub.4 *.DELTA.A.sub.yf },
where .DELTA.A.sub.y is defined as:
.DELTA.A.sub.y =a.sub.y -(F.sub.yfe +F.sub.yre)/M,
and .DELTA.A.sub.yf is .DELTA.A.sub.y passed through a first order digital low pass filter, for example, with a cut off frequency of 1 rad/s.
The state value, q(k), is then used to determine estimates of lateral velocity, v.sub.ye, and slip angle, .beta..sub.e, as follows:
v.sub.ye (k)=(q(k)+g.sub.1 *.OMEGA..sub.a)/(1+g.sub.2) and
.beta..sub.e =Arctan (v.sub.ye (k)/v.sub.x).
The gains g.sub.1, g.sub.2, g.sub.3 and g.sub.4 are tuning parameters preset by a system designer, typically through experimentation on a test vehicle, and may vary from implementation to implementation. The estimated slip angle determined by block 122 is output on line 124.
The desired vehicle yaw rate, .OMEGA..sub.d, and actual vehicle yaw rate, .OMEGA..sub.a, are summed at block 134 to provide a yaw rate error signal on line 136, which is provided to the yaw rate command block 138. Similarly, the desired vehicle slip angle, .beta..sub.d, and the estimated vehicle slip angle, .beta..sub.e, are summed at block 135 to provide a slip angle error signal on line 137, which is provided to the slip angle command block 142.
Blocks 138 and 142 determine yaw rate and slip angle commands through a set of gains that are responsive to the vehicle speed signal on line 112 and to the estimated surface coefficient of adhesion, .mu..sub.e. The commands from blocks 138 and 142 are summed at block 146, which provides the summation result, .DELTA.M, on line 148 to block 154.
More particularly, the functions of blocks 134, 135, 138, 142 and 146 may be explained as follows. A set of control gains are determined by first determining a value k'.sub..beta.p according to: ##EQU7## where
v.sub.x1 =(1133.6-100/.mu..sub.e)/(141.7+75/.mu..sub.e).
The magnitude of the gain increases as .mu..sub.e decreases and increases with vehicle speed until it saturates at a predetermined vehicle speed, for example, at 20 m/s. The gains are represented graphically in FIG. 9 for three different surfaces, dry surface (reference 402) for which .mu.=1.0, snow (reference 404) for which .mu.=0.4 and ice (reference 406) for which .mu.=0.2. The gain calculation may be implemented as an equation or using loop-up tables providing the general shape shown in FIG. 9.
Next, a factor f.sub.1 is determined according to:
f.sub.1 =(k.sub.off +k.sub.mult *.vertline..beta..sub.e .vertline./.beta..sub.max).sup.2,
where k.sub.off and k.sub.mult are tuning parameters having example values of 1 and 0.5, respectively. The factor f.sub.1 is then limited to a maximum value, for example, 4. As can be seen by the above equation, f.sub.1, increases in value when the vehicle slip angle approaches or exceeds the maximum allowable limit. This function allows f.sub.1 to regulate the tradeoff between control of yaw rate and control of slip angle. As the vehicle slip angle approaches the limit .beta..sub.max, which occurrences may also be characterized by a high slip angle error, the factor f.sub.1 increases the control influence or authority of the slip angle correction control as compared to the yaw rate correction control, thus providing an advantageous tradeoff between yaw rate and slip angle control. The increase in slip angle correction control authority is reflected in the proportional and derivative gains, k.sub..beta.p and k.sub..beta.a, respectively, for the slip command, determined using f.sub.1 as follows:
k.sub..beta.p =c.sub.1 *f.sub.1 *k'.sub..beta.p and
k.sub..beta.d' =c.sub..beta.d *k.sub..beta.p,
where c.sub.1 is a tuning constant used to balance between slip angle control and yaw rate control and c.sub..beta.d is the ratio between the differential and proportional gains, e.g., c.sub..beta.d =0.7.
The yaw rate proportional and derivative gains, k.sub..OMEGA.p and k.sub..OMEGA.d, are determined as follows:
k.sub..OMEGA.p =f.sub.2 *k'.sub..OMEGA.p, and
k.sub..OMEGA.d =c.sub..OMEGA.d *k.sub..OMEGA.p,
where c.sub..OMEGA.d is a constant (i.e., c.sub..OMEGA.d =0.4), where k'.sub.106 p is a preliminary gain that may either be constant or velocity dependent and where f.sub.2 is a function of .mu..sub.e, determined according to
f.sub.2 =1.25*((c.sub.2 -0.2)+(1-c.sub.2)*.mu..sub.e),
where c.sub.2 is a calibration constant, 0.ltoreq.c.sub.2 <1, e.g., c.sub.2 =0.4. The above equations illustrate that the yaw rate gains, k.sub..OMEGA.p and k.sub..OMEGA.d, are responsive to f.sub.2, which in turn is a function of the estimated surface coefficient of adhesion, .mu..sub.e. The factor f.sub.2 decreases as .mu..sub.e decreases, thus f.sub.2 increases the yaw rate control gains on high coefficient of adhesion surfaces (i.e., dry pavement) and decreases the yaw rate control gains on lower coefficient of adhesion surfaces (i.e., ice). Like f.sub.1, then, f.sub.2 operates to regulate between yaw rate control and slip angle control, increasing yaw rate control authority on high coefficient of adhesion road surfaces and decreasing yaw rate control authority on low coefficient of adhesion road surfaces.
The slip angle and yaw gains are used together with the actual and desired slip angles and actual and desired yaw rates to determine the desired corrective yaw moment, .DELTA.M, for example, according to the following equation:
.DELTA.M=k.sub..beta.p *(.beta..sub.d -.beta..sub.e)+k.sub..beta.d *(a.sub.y /v.sub.x -.OMEGA..sub.a)+k.sub..OMEGA.p *(.OMEGA..sub.d -.OMEGA..sub.a)+k.sub..OMEGA.d *(.OMEGA..sub.du '-.OMEGA..sub.a '),
where .OMEGA..sub.du ' and .OMEGA..sub.a ' are the time derivatives of .OMEGA..sub.du and .OMEGA..sub.a, determined, for example, by passing each signal through a high pass filter. The value (a.sub.y /v.sub.x -.OMEGA..sub.a) may be passed through a high pass "wash-out" filter, for example, having a transfer function of s/(s+1), in order to reduce the effects of sensor bias and banking of the road.
In the above equation for .DELTA.M, the first two terms represent the slip angle command and the third and fourth terms represent the yaw rate command. The desired corrective yaw moment command, .DELTA.M, is output from block 146 to the output command block 154.
In one example, the first term of the above equation for .DELTA.M may be ignored. In that case the slip angle command is limited to control based on slip rate, since .beta.'.apprxeq.a.sub.y /v.sub.x -.OMEGA..sub.a. This simplified the algorithm since slip angle .beta. does not have to be estimated and the desired value of slip angle is not used. The control gain k.sub..beta.d is computed as described above, i.e., it varies with vehicle speed and with the surface coefficient of adhesion but with the factor f.sub.1 set equal to 1.0.
In another example, the term (a.sub.y /v.sub.x -.OMEGA..sub.a) may be replaced with a calculation of the slip angle error derivative .DELTA..beta.' determined as follows:
.DELTA..beta.'=(.beta..sub.e (k)-.beta..sub.du (k)-(.beta..sub.e (k-1)-.beta..sub.du (k-1)))/.DELTA.t,
and then filtered through a low pass filter having a bandwidth of about 26 Hz.
In another example, the first two terms of the equation for .DELTA.M are set to zero when a magnitude of the sum of the first two terms otherwise is not above a predetermined value, defining a dead zone below which slip angle control is not triggered. The predetermined value defining the dead zone is set as desired by the system designer.
Before the output command block 154 makes use of the corrective yaw moment command, it must first determine whether the vehicle is in an oversteer or understeer condition. An understeer condition is established if the sign of .DELTA.M and the steer angle .delta. are the same. If .delta. and .DELTA.M have opposite signs, i.e., the product of .delta. and .DELTA.M is less than zero, or if either of the values is equal to zero, then the vehicle is designated as being in oversteer mode.
In order to avoid frequent changes in the oversteer/understeer designation due to sensor noise when either .delta. or .DELTA.M are close to zero, a dead zone is introduced. That is, the vehicle is designated as being in oversteer when the product of .delta. and .DELTA.M is less than or equal to zero. The vehicle is designated as being in understeer when the product of .delta. and .DELTA.M is greater than THRESHD, where THRESHD is a dead zone threshold determined by the system designer. When the product of .delta. and .DELTA.M is greater than zero but not greater than THRESHD, the most recent under/oversteer designation is maintained.
The corrective yaw force command, F, is determined by dividing .DELTA.M by half of the vehicle's track width, d.
Applying the yaw force command to the actuators first involves distributing the force command to the various wheel brakes of the vehicle. As used herein, the designation of inside and outside are with respect to the direction of turn. If the vehicle is being steered right, then the right front and right rear wheels are inside wheels and the left front and rear wheels are the outside wheels. If the vehicle is being steered left, then the left front and rear wheels are the inside wheels and the right front and rear wheels are the outside wheels. The distribution of the commanded yaw force to the wheels described below is just one specific example of distribution, other examples are described in pending United States patent applications, Ser. No. 08/654,982 and Ser. No. 08/732,582, both assigned to the assignee of this invention.
If there is no driver commanded braking of the vehicle, i.e., if the brake pedal of the vehicle is not depressed as sensed by the brake pedal switch, then the distribution control is as follows. In an understeer condition, braking is applied in approximately equal distribution (the exact distribution may depend on a particular vehicle) to the inside rear and inside front wheels up to the point where ABS for the front and rear wheels is activated. At that point, the braking force applied to the wheels is not increased. If the rear wheels enters ABS control before the desired braking force is developed, the portion of the brake command set to the inside rear wheel that the inside rear wheel was not able to achieve before entering ABS control is sent to the front inside wheel. The exception to this general control is in the case when the estimated lateral force of the rear axle, F.sub.yr, and steering angle have opposite signs. In this case, the distribution is front biased, for example, 10% of the desired force to the inside rear wheel and 90% of the desired force to the inside front wheel. In the case of a two-channel system, the entire yaw force is applied to the inside front wheel.
In oversteer when the driver is not commanding braking, the brakes are applied to the outside front wheel only and braking force may be allowed to exceed the ABS limit. That is, the ABS control is overridden and the front wheel may be allowed to rise to higher slip levels and even to achieve a lock-up condition that the ABS control would normally prevent. The ABS control is overriden when the following conditions are simultaneously met: ABS control is active; the signs of estimated lateral force of the front axle, F.sub.yf, and steering angle are the same; the vehicle is and has been in oversteer condition for at least 0.1 seconds; and the total desired braking force of a particular wheel, F.sub.xd, is and has been for at least 0.1 seconds at least 1.5 times larger than the estimated braking force at the ABS limit, F.sub.xlim. F.sub.xd is determined by summing, for a particular wheel, the estimated brake force requested by the vehicle driver and the brake force resulting from the yaw force command. The forces F.sub.xlim for the front left and right wheels are computed as follows: ##EQU8## where .lambda..sub.max is the maximum brake slip at the ABS limit, e.g., .lambda..sub.max =0.1, and N.sub.lf and N.sub.rf are the estimated normal tire forces on the left and right front wheels, respectively, defined by:
N.sub.lf =M*g*b/(2*(a+b))+K.sub.rllf *M*h*a.sub.y /trw; and
N.sub.rf =M*g*b/(2*(a+b))-K.sub.rllf *M*h*a.sub.y /trw,
where K.sub.rllf is the fraction of total roll stiffness developed by the front suspension (e.g., K.sub.rllf =0.6), trw is the average of the front and rear track widths and h is the height of the vehicle center of gravity above the roll axis.
If there is driver commanded braking, the understeer condition is controlled as described above for the no driver-commanded braking mode, except that when both of the inside wheels (inside front wheel in a two channel system) reach an ABS limit before the total desired force is generated, then the brake command of the outside front wheel is reduced. The amount of brake command reduction to the outside front wheel is an amount necessary to transfer to the vehicle the difference between the yaw force command and the yaw force achieved by the two inside wheels before they went into ABS, except that the brake command reduction to the outside front wheel is limited so that at least fixed percentage (e.g., 50%) of the driver commanded braking to the outside front wheel is maintained.
In the oversteer condition while there is driver commanded braking, the yaw force command is first applied to the outside front wheel brake, increasing brake force, possibly including to a point allowing the wheel to override the ABS limit. If the force achieved by the outside front wheel is not sufficient to produce the desired corrective yaw moment on the vehicle, braking of the inside rear wheel may be reduced by up to 50% of the driver commanded braking force for that wheel and if the force achieved by the outside front wheel and inside rear wheel (outside front only for a two channel system) is still not sufficient, then braking of the inside front wheel may be reduced by up to 50% of the driver commanded braking force for that wheel. When the ABS is overridden, the locking of the outside front wheel reduces the lateral force of the front wheel, which reduction of lateral force may be taken into account when calculating the corrective yaw moment.
Once the force commands are determined, they may be applied to the actuators as represented by line 158 and block 132. In this control, it is necessary to reasonably estimate the amount of brake force applied at each particular wheel to determine the portion of the corrective yaw moment achieved by that wheel. There are many known ways of determining brake force in an individual wheel. In one example, hydraulic fluid pressure sensors in the individual wheel brake lines sense the amount of hydraulic pressure in the individual wheel brakes, and that sensed hydraulic pressure corresponds to a brake force measurement. In vehicles where the brake actuators are motor driven reciprocating piston devices, the brake force may be determined by either position control or motor current feedback to the actuators, which position and/or motor current signals are taken as measurements of brake force at the individual wheels. Any other known method for measuring brake force at the individual wheels may be used and provided as feedback as represented by line 152 to the output command block 154, for example to implement closed loop proportional derivative control of the actuators represented by block 132.
In vehicles where there is no means to provide a feedback of actual brake force through a brake actuator or pressure transducer, individual wheel speed control may be used to implement the brake force command in the vehicle wheel brakes. In one example, the desired yaw force, F, may be converted into a wheel speed difference command (commanding a speed difference between left and right wheels) as follows:
.DELTA.v.sub.x0 =F*g.sub.v1 *g.sub.v2,
where g.sub.v1 is a first gain value that varies linearly with vehicle speed and g.sub.v2 is a second gain value that varies non-linearly with the estimated surface coefficient of adhesion. An example graph of g.sub.2 is shown in FIG. 10.
In another example, the desired wheel speed difference, .DELTA.v.sub.x0, is related directly to the slip angle errors and yaw rate errors without the intermediate step of calculating the desired yaw force. In that case:
.DELTA.v.sub.x0 =[k.sub..beta..sub.p *(.beta..sub.d -.beta..sub.e)+k.sub..beta..sub.d *(a.sub.y /v.sub.x -.OMEGA..sub.a)+k.sub.106 p *(.OMEGA..sub.d -.OMEGA..sub.a)+k.sub..OMEGA..sub.d *(.OMEGA..sub.du '-.OMEGA..sub.a ')]*v.sub.x,
where the control gains k.sub..beta.p, k.sub..beta.d, k.sub..OMEGA. and k.sub..OMEGA.d are determined in the same manner as described above in connection with .DELTA.M, except that k'.sub..beta.p and k'.sub..OMEGA.p are determined as follows. The preliminary proportional gain k'.sub..beta.p is constant or speed dependent. The preliminary slip angle gain k'.sub..beta.p is determined (e.g., by using look-up tables) as a function of the estimated surface coefficient of adhesion, .mu..sub.e, and vehicle speed, v.sub.x. An example of relationships between k'.sub..beta.p and vehicle speed on three different road surfaces are shown in FIG. 11. Reference 420 illustrates the relationship for a dry road surface having .mu..congruent.1.0. Reference 422 illustrates the relationship for a snowy road surface having .mu..congruent.0.4 and reference 424 illustrates the relationship for an icy road surface having .mu..congruent.0.2. For intermediate coefficients of adhesion, linear interpolation may be used.
The wheel speed difference actually applied to the wheels, .DELTA.v.sub.x, is determined by .DELTA.v.sub.x0 and the kinematics of the turn, i.e.,
.DELTA.v.sub.x =.DELTA.v.sub.x0 +.OMEGA..sub.a *trw,
where trw is the track width (for the axle to which .DELTA.v.sub.x is applied).
The wheel speed difference command, .DELTA.v.sub.x, is distributed to the vehicle wheels as the yaw force command is distributed above. For example, in the understeer condition when no driver braking is applied, half of .DELTA.v.sub.x is applied to the inside rear wheel and half .DELTA.v.sub.x is applied to the inside front wheel to reduce the inside rear wheel speed by 0.5*.DELTA.v.sub.x less than its original speed prior to activation to the yaw control and to reduce the inside front wheel speed by 0.5*.DELTA.v.sub.x less than its original speed prior to activation of the yaw control. If the rear wheel enters ABS then the front wheel is slowed by an amount .DELTA.v.sub.xf equal to .DELTA.v.sub.x minus .DELTA.v.sub.xr, where .DELTA.v.sub.xr is the amount of inside rear wheel speed reduction achieved prior to the inside rear wheel entering ABS.
The wheel speed control is similarly applied for the other braking distributions described above. Thus closed loop wheel speed control may be used to transfer the desired corrective yaw force, F, capable of achieving the desired corrective yaw moment, .DELTA.M, to the vehicle body.
The commands determined at block 154 are only applied to the vehicle wheel brakes if the entry conditions for the active brake control are established and then are only applied until the exit conditions for active brake control are established. First the estimated vehicle speed must be above a certain speed of entry, v.sub.min, which is typically low, for example 5 miles per hour. If this condition is satisfied, then the system becomes active when either yaw rate error exceeds a yaw rate error threshold or when the corrective yaw moment, .DELTA.M, exceeds a corrective yaw moment threshold (or when wheel speed difference, .DELTA.v.sub.x, exceeds a threshold). The yaw rate error test may be implemented by:
.vertline..OMEGA..sub.d -.OMEGA.+k.sub.e *(.OMEGA..sub.du '-.OMEGA..sub.a ').vertline.<.OMEGA..sub.thresh,
where .OMEGA..sub.du ' and .OMEGA..sub.a ' may be determined by passing .OMEGA..sub.du and .OMEGA..sub.a through high pass filters to time differentiate them, k.sub.e is a fixed constant and .OMEGA..sub.thresh is determined in response to vehicle speed and steering wheel angle. In one example, .OMEGA..sub.thresh is determined as follows:
.OMEGA..sub.thresh =(9-0.036*v.sub.x +1.3*(v.sub.x *.delta.)/((a+b)+K.sub.u *v.sub.x.sup.2))/57.3,
if the vehicle is in understeer mode, and as:
.OMEGA..sub.thresh =(7+1.3*(v.sub.x *.delta.)/((a+b)+K.sub.u *v.sub.x.sup.2))/57.3,
if the vehicle is in oversteer mode. In the above equations, .OMEGA..sub.thresh is expressed in (rad/s), v.sub.x is expressed in (m/s), .delta. is expressed in (rad), a and b are expressed in (m) and K.sub.u is the vehicle understeer coefficient.
An exit condition is established if the total corrective yaw moment drops below a predetermined threshold value and remains below that value for a predetermined period of time of if the yaw rate error is below a predetermined yaw rate error threshold for a predetermined period of time. If either of these conditions exists, the output command block 154 is disabled and prevented from providing output commands to actuators 132 to establish corrective yaw moments on the vehicle. An exit condition is also established regardless of the above conditions if the vehicle speed drops below the speed of exit.
Referring now to FIG. 4, an example main flow control routine illustrating example steps performed by a controller for achieving the desired yaw rate and slip angle control herein is illustrated. At block 250 the system receives the inputs from the various system sensors and then at block 252 the vehicle determines the desired vehicle states as described above with reference to block 102 in FIG. 3. Block 254 estimates the lateral coefficient of adhesion between the vehicle tires and the road surface as described above with reference to block 120 in FIG. 3. At block 256, the routine estimates the actual vehicle slip angle as described above with reference to block 122 in FIG. 3. Block 258 then determines the control gains for the slip and yaw rate commands as described above with reference to blocks 138 and 142 in FIG. 3. Block 260 then determines the corrective yaw moment command, .DELTA.M, (or the desired wheel speed difference, .DELTA.v.sub.x) as described above with reference to block 154 in FIG. 3 and block 262 performs the enter/exit control determination. If the enter/exit control block 262 enables actuator control, then the actuator commands are determined at block 264 and output at block 266 to the various vehicle wheel brake actuators to achieve the desired corrective yaw moment on the vehicle body to minimize yaw rate error and vehicle slip angle error.
Referring now to FIG. 5, the steps for determining the desired vehicle states at block 252 (FIG. 4) are shown. At block 268, the vehicle model described above with reference to block 102 in FIG. 3 is used to determine v.sub.yd, .OMEGA..sub.du, a.sub.yd, and .beta..sub.du. Next, block 270 uses the estimated surface coefficient of adhesion and the steering wheel angle to determine .beta..sub.max, which is used with .beta..sub.du to determine .beta..sub.d at block 272. Block 274 determines .OMEGA..sub.d. All of the steps, 268, 270, 272 and 274 may be implemented as described above with reference to FIG. 3, block 102.
FIG. 6 illustrates the steps performed by block 258 in FIG. 4 for determining the control gains for the yaw rate command and slip angle command. More particularly, block 276 determines the preliminary proportional gain, k'.sub..beta.p, as a function of v.sub.x and .mu..sub.c and block 278 determines the slip angle gain factor, f.sub.1, as a function of .beta..sub.e and .beta..sub.max. Then block 280 determines the slip angle gains as a function of k'.sub..beta.p and f.sub.1. Block 282 determines the yaw rate proportional and derivative gains as a function of .mu..sub.e. The steps at blocks 276, 278, 280 and 282 may be implemented as described above with reference to blocks 138 and 142 in FIG. 3.
Referring now to FIG. 7, the steps performed by the enter/exit control block 262 in FIG. 4 are shown. First at block 302, the forward vehicle velocity, v.sub.x, is compared to a minimum velocity. If v.sub.x is not greater than the minimum vehicle velocity, the routine continues to block 320 where a flag is set, disabling the active brake control. If v.sub.x is grater than the minimum vehicle velocity, the routine continues to block 304 where it determines .OMEGA..sub.thresh, as described above with reference to block 154 in FIG. 3. If .OMEGA..sub.err is greater than .OMEGA..sub.thresh at block 306, then the routine continues to block 310. Otherwise, the routine continues to block 308 where it compares the magnitude of the command .DELTA.M to a threshold moment value. If .DELTA.M does not have a magnitude greater than the threshold moment value, then the routine continues to block 312. Otherwise, the routine continues to block 310, where a flag is set enabling control of the brake system through the active brake control.
At blocks 312 and 312, the absolute values of .DELTA.M (.DELTA.v.sub.x) and .OMEGA..sub.err are compared to the exit threshold values. If either .DELTA.M (.DELTA.v.sub.x) or .OMEGA..sub.err is less than the exit threshold values, the routine continues to block 314 where a timer is incremented. Otherwise, at block 316, the timer is reset. Block 318 compares the timer to a time out value. If the timer is greater than the time out value, the routine continues to block 320 where the flag is set disabling active brake control. Otherwise, the enter/exit control 262 is exited.
Another example of entry /exit conditions is set forth in pending U.S. patent application Ser. No. 08/732,582.
Referring now to FIG. 8, example steps performed by the actuator command block 264 in FIG. 4 are shown. First block 350 checks the understeer flag that, as described above with reference to block 154 in FIG. 3, indicates whether or not the vehicle is experiencing understeer or oversteer. If the understeer flag is set, the routine continues to block 352 where it compares the signs of the estimated lateral force at the rear axle, F.sub.yr, and a vehicle steering wheel angle. If they are different, for example, when the product F.sub.yr *.delta. is less than zero, then the routine continues to block 356 where it sets the rear inside wheel force command F.sub.ir equal to 0.1*F. If at block 352, F.sub.yr *.delta. is not less than zero, then block 354 sets F.sub.ir equal to 0.5*F. This portion of the algorithm is used only for a four channel system.
From blocks 354 or 356, the routine continues to block 358 where it checks whether or not the inside rear wheel is in ABS mode. If so, block 360 determined the actual force applied by the inside rear wheel when it entered ABS, F.sub.ira, and block 364 determines inside the front wheel force command, F.sub.if, equal to F minus F.sub.ira. If, at block 358, the rear wheel is not in ABS, then block 362 sets the inside front wheel command equal to F-F.sub.ir. Then at block 366, the routine checks whether or not braking is commanded by the vehicle driver, for example, by determining whether or not there is an output signal from the brake pedal switch or from the master cylinder pressure transducer. If not, the subroutine 264 exits. Otherwise, the routine continues to block 368 where it checks whether or not the inside front and rear wheels are in ABS. If so, block 370 determines the actual force achieved by the inside front and rear wheels, F.sub.ifa and F.sub.ira, and then block 372 determines an outside front wheel brake force command, F.sub.of, equal to F-F.sub.ifa -F.sub.ira. Block 374 limits the command F.sub.of to a value between zero and half of the driver commanded brake force of the outside front wheel. From block 374 the routine is exited.
If at block 350 the routine is not in understeer mode, then it proceeds to the oversteer steps at block 376 where the outside front wheel force command, F.sub.of, is set equal to F. Then block 378 checks whether or not braking is commanded. If not, block 380 sets a flag inhibiting activation of ABS control of the outside front wheel so that the outside front wheel is allowed to lock in the command, F.sub.of, so commands (the conditions under which the wheel is allowed to lock where specified above). From block 380, the subroutine 265 is exited.
If at block 378 there is driver commanded braking, the routine continues to block 382 where it checks whether the outside front wheel is in ABS. If not, the subroutine 264 is exited. If so, the subroutine continues to block 384 where it determines the actual braking force achieved by the outside front wheel, F.sub.ofa. The routine then moves to block 386 where an inside front wheel brake force command, F.sub.if, is determined equal to F-F.sub.ofa. If the outside front wheel is allowed to lock, then the effect to reduction in lateral force on the vehicle yaw moment is included in the above calculation; this yields:
F.sub.if =F-F.sub.ofa -.mu..sub.e *N.sub.of *a*2/trw,
where N.sub.of is the normal force on the outside front wheel determined as described above with reference to the lock-up conditions. The inside front wheel brake force command is then limited to half the driver-commanded braking to that wheel, as determined by the driver's brake request at block 378. Block 390 then determines the inside rear wheel brake force command as the difference between the commanded yaw force, F, and the yaw forces achieved by the outside and inside front wheels. At block 392, the inside rear wheel brake force is limited to no greater than one half the driver commanded braking to the inside rear wheel.
It is noted that in the oversteer mode when there is driver braking, the front and rear inside wheel brake force commands, F.sub.if and F.sub.of, command reduction in the braking force at the front and rear inside wheels. Similarly, in the understeer mode when there is driver braking, the outside front wheel brake command, F.sub.of, commands a reduction in the braking force applied to the outside front wheel.
For vehicles with no means to provide feedback of actual brake force through a brake actuator or pressure transducer, the same logic for distributing the command signal among the wheels applies with the brake forces replaced by the corresponding changes in wheel velocities.
FIG. 12 illustrates another example vehicle reference model for determining desired yaw rate, .OMEGA..sub.d, and desired slip angle, .beta..sub.d. The vehicle reference model 458 shown includes a single filter 450, four look up tables (or equations) 452, 454, 462 and 464 and three simple equation functions 456, 458 and 460. The filter 450 implements the desired vehicle dynamics as represented by the damping ratio and natural frequency in a single filter whose output is used by the relatively simple calculations in blocks 456, 458 and 460 to calculate both the desired slip angle and desired yaw rate.
More particularly, the damping ratio and natural frequency may be expressed according to the system parameters as follows:
.omega..sub.n =(a.sub.11 *a.sub.22 -a.sub.12 *a.sub.21).sup.1/2 and
.zeta.=-(a.sub.11 +a.sub.22)/(2*(a.sub.11 *a.sub.22 -a.sub.12 *a.sub.21).sup.1/2),
or in any reasonably desired values which vary with speed and which can be programmed into controller memory as look-up tables 462 and 464 responsive to the vehicle speed input v.sub.x or implemented as calculations.
Using .omega..sub.n and .zeta. and the steering wheel angle input .delta., the filter 450 performs a filter function as follows:
x.sub.1 '=.delta.-2*.zeta.*.omega..sub.n *x.sub.1 -.omega..sub.n.sup.2 *x.sub.2
x.sub.2 '=x.sub.1
with the filter result provided to blocks 456 and 460. Block 456 also receives the slip angle gain output of block 452, which is a three dimensional look up table implementing the following function:
v.sub.ydssgain =(.delta.*v.sub.x /((a+b)+K.sup.u *v.sub.x.sup.2))*(b-(a*M*v.sub.x.sup.2)/((a+b)*c.sub.r).
Using V.sub.ydssgain, .omega..sub.n and the output of filter 450, block 456 determines the desired lateral velocity v.sub.yd, according to:
v.sub.yd =b.sub.1 *x.sub.1 +V.sub.ydssgain *.omega..sub.n.sup.2 *x.sub.2.
Block 458 then determines .beta..sub.du according to:
.beta..sub.du =tan.sup.-1 (v.sub.yd /v.sub.x).
Block 454 is a look up table determining the yaw rate gain according to the function:
R.sub.gain =(.delta.*v.sub.x /((a+b)+K.sub.u *v.sub.x.sup.2))
Using R.sub.gain, .omega..sub.n and the output of filter 450, block 460 determines the desired yaw rate .OMEGA..sub.d, according to:
.OMEGA..sub.d =b.sub.2 *x.sub.1 +R.sub.gain *.omega..sub.n.sup.2 *x.sub.2.
Using the above approach allows the system designer to (a) select the damping ratio and natural frequency desired of the vehicle reference model, (b) define a single filter representing the selected damping ratio and natural frequency, (c) apply steering angle to the filter, (d) use the filter output with a predetermined slip angle gain function to determine desired vehicle slip angle and (e) use the filter output with a predetermined yaw gain function to determine the desired vehicle yaw rate.
FIG. 13 illustrates another example vehicle reference model using a single filter. The vehicle reference model 558 includes the single filter 550, look up tables 552, 554, 562 and 564 and functions 556, 558 and 560. The look up tables 562, 564 and 554 are the same as look up tables 462, 464 and 454 shown in FIG. 12. Similarly, the function blocks 558 and 560 are the same as function blocks 458 and 460 in FIG. 12.
Filter 550 is implemented in discrete form according to:
x.sub.1 (k+1)=c.sub.1 *x.sub.1 (k)+c.sub.2 *x.sub.2 (k)+c.sub.3 *V.sub.ydss (k+1),
and
x.sub.2 (k+1)=x.sub.2 (k)+T*x.sub.1 (k),
where
c.sub.1 =1/(1+2*.zeta.*.omega..sub.n *T),
c.sub.2 =-.omega..sub.n.sup.2 *c.sub.3,
and
c.sub.3 =T*c.sub.1,
where T is the sampling period, and where
V.sub.ydss (k+1)=(.delta.*v.sub.x (k)/((a+b)+K.sub.u *v.sub.x (k).sup.2))*(b-(a*M*v.sub.x (k).sup.2)/((a+b)*c.sub.r).
the output of filter 550 is used by block 556 to compute the desired lateral velocity, v.sub.yd (k+1), according to:
v.sub.yd (k+1)=.omega..sub.n.sup.2 *(x.sub.2 (k+1)+x.sub.1 (k+1)/z),
where z=a.sub.12 *b.sub.2 /b.sub.1 -a.sub.22. The computation at block 556 is performed in a two-step process. First the value of z is computed and, if z equals zero, then z is limited to a predetermined minimum magnitude.
Claims
  • 1. A brake system control method, comprising the steps of:
  • measuring a longitudinal speed and a steering angle of a vehicle;
  • specifying an un-damped natural frequency and a damping ratio for a linear reference model of said vehicle;
  • determining a first gain parameter relating a desired value of steady state lateral velocity to the vehicle steering angle;
  • computing a desired lateral velocity as a function of said first gain parameter, the measured longitudinal speed, the measured steering angle, and the specified un-damped natural frequency and damping ratio;
  • determining a second gain parameter relating a desired value of steady state yaw rate to the vehicle steering angle;
  • computing a desired yaw rate as a function of said second gain parameter, the measured longitudinal speed and steering angle, and the specified un-damped natural frequency and damping ratio;
  • measuring a lateral acceleration and yaw rate of said vehicle, and forming a yaw rate command for said vehicle based at least in part on a first deviation between said desired and measured yaw rates, and a second deviation between said measured lateral acceleration and a desired lateral acceleration based on said desired lateral velocity; and
  • differentially braking wheels of said vehicle to impart a yaw moment corresponding to said yaw rate command.
  • 2. A brake control method according to claim 1, wherein the step of specifying the un-damped natural frequency comprises calculating the un-damped natural frequency as a function of vehicle related coefficients of said linear reference model.
  • 3. A brake control method of claim 1, wherein the step of specifying the damping ratio comprises calculating the damping ratio as a function of vehicle related coefficients of said linear reference model.
  • 4. The brake control method of claim 1, wherein the step of specifying the un-damped natural frequency comprises storing specified values of the un-damped natural frequency in a look-up table as a function of vehicle speed, and retrieving the stored values from said look-up table during operation of said vehicle as a function of the measured speed.
  • 5. A brake control method according to claim 1, wherein the step of specifying the damping ratio comprises storing specified values of the damping ratio in a look-up table as a function of vehicle speed, and retrieving the stored values from said look-up table during operation of said vehicle as a function of the measured vehicle speed.
TECHNICAL FIELD

This application is a continuation in part of U.S. patent application, Ser. No. 08/967,091, filed Nov. 10, 1997. This invention relates to a brake system control.

US Referenced Citations (25)
Number Name Date Kind
4834205 Mizuno et al. May 1989
4998593 Karnopp et al. Mar 1991
5063514 Headley et al. Nov 1991
5172961 Inoue et al. Dec 1992
5229944 Yasuno Jul 1993
5275475 Hartmann et al. Jan 1994
5311431 Cao et al. May 1994
5313389 Yasui May 1994
5341297 Zomotor et al. Aug 1994
5366281 Littlejohn Nov 1994
5402342 Ehret et al. Mar 1995
5444621 Matsunaga et al. Aug 1995
5480219 Kost et al. Jan 1996
5524079 Ishida et al. Jun 1996
5636909 Hirao et al. Jun 1997
5641212 Sakai Jun 1997
5676433 Inagaki et al. Oct 1997
5700073 Hiwatashi et al. Dec 1997
5710705 Eckert Jan 1998
5720533 Pastor et al. Feb 1998
5742917 Matsuno Apr 1998
5742918 Ashrafi et al. Apr 1998
5746486 Paul et al. May 1998
5813732 Monzaki et al. Sep 1998
5931887 Hac Aug 1999
Foreign Referenced Citations (9)
Number Date Country
0 555 860 A1 Aug 1993 EPX
41 23 235 C1 Nov 1992 DEX
41 21 954 A1 Jan 1993 DEX
42 00 061 A1 Jul 1993 DEX
42 23 385 A1 Jan 1994 DEX
42 29 504 A1 Mar 1994 DEX
43 11 077 A1 Oct 1994 DEX
43 14 827 A1 Nov 1994 DEX
40 52 62213 Oct 1993 JPX
Continuation in Parts (1)
Number Date Country
Parent 967091 Nov 1997