Device for estimating slip angle of vehicle body through interrelation thereof with yaw rate

Abstract: A device for estimating slip angle of vehicle body of a vehicle, having: means for calculating yaw rate based upon such parameters as detected steering angle, vehicle speed, lateral acceleration and braking forces as variable parameters, the slip angle of the vehicle body estimated by the vehicle body slip angle estimation device, a first feedback factor multiplied to difference between the detected yaw rate and the yaw rate calculated by the yaw rate calculation means, and fixed parameters particular to the vehicle, such that the calculated yaw rate converges to the detected yaw rate; means for calculating slip angle of the vehicle body based upon such parameters as detected steering angle, vehicle speed, lateral acceleration, braking forces and yaw rate, the yaw rate calculated by the yaw rate calculation means, a second feedback factor multiplied to the difference between the detected yaw rate and the yaw rate calculated by the yaw rate calculation means, and fixed parameters particular to the vehicle, such that the calculated yaw rate converges to the detected yaw rate; means for detecting saturation index against the difference between a standard yaw rate based upon the calculations by the yaw rate calculation means and the detected yaw rate; and means for modifying the first and second feedback factors according to the saturation index such that non-linearity between lateral forces acting at the wheels and slip angles of the wheels is compensated for by the modification of the first and second feedback factors.

Description: Background of the Invention Field of the Invention The present invention relates to a device for estimating slip angle of vehicle body, and more particularly, a device for estimating slip angle of vehicle body through cyclically repeated computer feedback calculations of related parameters. Description of the Prior Art In the vehicle stability control recently getting more popular in the art of computer based running behavior control of vehicles, the slip angle of vehicle body is one of the most desired parameters useful for effectively controlling the running behavior of vehicles. The slip angle of vehicle body is not directly detectable. It must be estimated based upon various directly detectable parameters such as steering angle, vehicle speed, lateral acceleration, yaw rate, etc. However, more essentially, the slip angle of vehicle body is dependent upon the friction coefficient between the wheel tires and the road surface which is not directly detectable, and, still worse, has a non-linearly saturating characteristic. Therefore, it was very difficult to estimate the slip angle of the vehicle body at high accuracy. In Japanese Patent Laid-open Publication 62-83247, it is described to estimate the slip angle of vehicle body through a comparison of a slip angle of vehicle body estimated from a vehicle model inputted with input data such as steering angle and vehicle speed and a slip angle of vehicle body calculated from lateral acceleration, yaw rate and vehicle speed, while making an adjustment modification of cornering power of the front and rear wheels. When a vehicle model is employed to estimate running behaviors of a vehicle, estimations are available generally at relatively high accuracy in a linear zone where the tire grip force against the road surface is proportional to the slip angle of wheel, but the accuracy rapidly lowers when the vehicle gets out of the linear zone according to increase of the slip angle of wheel. Attempts have been made to solve this problem, e.g. in German Patent Laid-open Publication DE 42 00 061, which forms the preamble of claim 1 and wherein a method for determining the lateral velocity and the float angle of a vehicle is discosed. There, in a closed control loop, an estimated output variable of the lateral velocity of the vehicle is fed back to serve as calculation variable for calculating a slip angle of each wheel. To avoid errors due to the non-linear behaviour of the slip angle to the friction coefficient, it uses a characteristic mapping to determine a relationship between lateral force and tire contact force out of the slip angle and the utilized friction coefficient with the utilized friction coefficient being calculated out of lateral acceleration and velocity of the vehicle, the slip angle out of steering angle, yaw velocity and the feedback value of the lateral velocity. Out of the so determined relationship, through various transfer operators, the lateral velocity is calculated, outputted and fed back. In the art of estimating a certain parameter by cyclically repeated computer calculations of related parameters, even a minute error of a parameter can be integrated to produce a large error which renders the estimation almost useless. Summary of the Invention In view of such difficulties in estimating a parameter influenced by the non-linearly saturable frictional contact between the vehicle wheels and the road surface by cyclically repeated computer calculations of related parameters, it is the object of the present invention to provide an improved device for estimating the slip angle of vehicle body at high accuracy throughout a linear zone where the tire grip force is proportional to the slip angle of wheel and a non-linear zone where the tire grip force saturates against increase of the slip angle of wheel. According to the present invention, the above-mentioned object is accomplished by a device for estimating slip angle of vehicle body of a vehicle having front and rear wheels supporting the vehicle body, the vehicle being equipped with means for detecting at least steering angle, vehicle speed, yaw rate, the device comprising: means for calculating yaw rate based upon at least the detected steering angle, vehicle speed, as variable parameters, the slip angle of the vehicle body estimated by the vehicle body slip angle estimation device, a first feedback factor multiplied to difference between the detected yaw rate and the yaw rate calculated by said yaw rate calculation means, and fixed parameters particular to the vehicle, such that the calculated yaw rate converges to the detected yaw rate; means for calculating slip angle of the vehicle body based upon at least the detected steering angle, vehicle speed and yaw rate, the yaw rate calculated by said yaw rate calculation means, a second feedback factor multiplied to the difference between the detected yaw rate and the yaw rate calculated by said yaw rate calculation means, and fixed parameters particular to the vehicle, such that the calculated yaw rate converges to the detected yaw rate; means for detecting saturation index against the difference between a standard yaw rate based upon the calculations by said yaw rate calculation means and the detected yaw rate; and means for modifying said first and second feedback factors according to said saturation index such that non-linearity between lateral forces acting at the wheels and slip angles of the wheels is compensated for by the modification of said first and second feedback factors. In the above-mentioned device, said first and second feedback factors may each be calculated in at least three different manners according to increase of the value of said saturation index to provide at least first, second and third gain components, while at least three weighing factors such as first, second and third weighing factors are prepared corresponding to the value of said saturation index so that said first, second and third weighing factors have peak points at different values of said saturation index, and said first and second feedback factors may each be generated by the sum of said first, second and third gain components each being weighed by the corresponding weighing factor. Further, in the above-mentioned device, when said saturation index is so high as to indicate that said non-linearity substantially exists, said second feedback factor may be determined such that the estimated slip angle of the vehicle body increases in an orientation opposite to that in which the detected yaw rate increases. Further, in the above-mentioned device, when said difference between the standard yaw rate and the detected yaw rate is different from the yaw rate (either detected or calculated) with respect to the orientation thereof, at least one of said first and second feedback factors may be modified such that lateral force acting at the rear wheels is estimated to be less in said yaw rate and vehicle body slip angle calculations, and when said difference between the standard yaw rate and the detected yaw rate is the same as the yaw rate (either detected or calculated) with respect to the orientation thereof, at least one of said first and second feedback factors may be modified such that lateral force acting at the front wheels is estimated to be less in said yaw rate and vehicle body slip angle calculations. The present invention attempts to estimate the slip angle of vehicle body through cyclically repeated computer calculations of interrelation between the slip angle of vehicle body and the yaw rate of vehicle body with a feedback gain which conducts the calculations into a convergence. The yaw rate of vehicle body is closely interrelated with the slip angle of vehicle body such that a change of the yaw rate is reflected on a corresponding change of the slip angular velocity (i.e. differential of the slip angle) of vehicle body and vice versa. The yaw rate of vehicle body is directly detectable. Therefore, if an error in the estimation of the slip angle of vehicle body is checked by a corresponding error in the estimation of the yaw rate, while the estimation error of the yaw rate is converged into zero in reference to the directly detected yaw rate, a correct estimation of the slip angle of vehicle body will be available. According to an advantageous embodiment of the invention, the above-mentioned device may further be equipped with means for detecting lateral acceleration and braking forces of the front and rear wheels said yaw rate calculation means cyclically calculating yaw rate based upon at least the last detected steering angle, vehicle speed, lateral acceleration, and braking forces as variable parameters, the slip angle of the vehicle body last estimated by the vehicle body slip angle estimation device, the first feedback factor multiplied to the difference between the last detected yaw rate and the yaw rate last calculated by said yaw rate calculation means, and the fixed parameters particular to the vehicle, such that the cyclically calculated yaw rate converges to the last detected yaw rate, while said slip angle calculation means cyclically calculating the slip angle of the vehicle body based upon at least the last detected steering angle, vehicle speed, lateral acceleration, braking forces and yaw rate, the yaw rate last calculated by said yaw rate calculation means, the second feedback factor multiplied to the difference between the last detected yaw rate and the yaw rate last calculated by said yaw rate calculation means, and the fixed parameters particular to the vehicle, such that the cyclically calculated yaw rate converges to the last detected yaw rate. In more detail, denoting the of estimated slip angle of vehicle body βe as β ˙e, the differential of estimated yaw rate of vehicle body γe as γ ˙e, detected yaw rate of vehicle body as γ, feedback gain of a difference between the detected yaw rate and the estimated yaw rate (γ - γ e) against the slip angle of vehicle body as Kb, feedback gain of the difference between the detected value and the estimated value of the yaw rate against the estimation thereof as Kg, mass of the vehicle body as m, vehicle speed as V, lateral forces acting at the front and rear wheels as Ff and Fr, respectively, the inertial moment of the vehicle body as Iz and longitudinal distances of the front and rear wheels from the center of gravity of the vehicle body as Lf and Lr, respectively, the following relationships are assumed: β e = Ff + Fr m*V - γe + Kb(γ - γe) γ e = Lf*Ff + Lr*Fr Iz + Kg(γ - γe) The lateral forces Ff and Fr acting at the front and rear wheels are estimated from the slip angles βf and βr of the front and rear wheels, respectively, and the cornering powers Cf and Cr of the front and rear wheels, respectively, as follows: Ff = Cf* βf Fr = Cr* βf As well known in the art, the cornering powers Cf and Cr are constant only when the slip angles βf and βr are relatively small, and gradually decreases to each minimum value when the slip angles βf and β r increase. βf and βr can be estimated from the steering angles δf and δr of the front and rear wheels, the estimated slip angle of vehicle body βe, the longitudinal distances Lf and Lr of the front and rear wheels from the center of gravity of the vehicle body, yaw rate (as estimated γe), and vehicle speed V as follows: βfe = δf - βe - Lf*γe/V βre = δr - βe + Lr*γe/V Substituting Equations 5 and 6 for βfe and βre of Equations 3 and 4, then further substituting Equations 3 and 4 for Ff and Fr of Equations 1 and 3, and expressing the resultant in determination, the following relationship is obtained: Denoting, for the convenience of operations, Equation 7 is rewritten as follows: X = (A - LC)*X + B*d + γ*K Further modifying Equation 8: X = (A - LC)*X + (A - LC)(A - LC) -1 (B*d + γ*K) = (A - LC){X - (A - LC) -1 (-B*d-γ*K)} Therefore, when (A - LC) -1 (-B*d - γ *K) is denoted by X = (A - LC)(X - Xc) It is expected that Equation 10 can be solved such that X converges to Xc. Since this system is two dimensional, it has two poles which will be denoted as p1 and p2. Then, by using the poles p1 and p2, βc and γc are expressed as follows: βc = (-a11+p1+p2)|A|-a22*p1*p2 a2*p1*p2 γ + βo γc = (1- |A| p1*p2 )γ + γo wherein βo and γo are those defined by the following: Kb and Kg are as follows: Kb = (a11-p1-p2)+p1*p2 a21 + a12 Kg = a11 + a22 - p1 - p2 As a first kind of feedback gains Kb and Kg when the slip angles of wheel βf and βr are within a relatively small value, they may be determined as described in the specification of Japanese Patent Application 7-10782 by the same assignee as the present application, according to which p1 and p2 are expressed by using certain positive constants C11, C12, C21 and C22 as follows: p1 = -C11 - C12/V p2 = -C21 - C22/V When the slipping condition advances such that the vehicle spins, the slip angle of vehicle body would be increasing in a direction opposite to the yaw rate. Therefore, if the vehicle performance is simulated such that, in the relationship of Equation 11, the proportioning factor of γ is negative, in other words, the estimated slip angle increases in the orientation opposite to that in which the estimated yaw rate increases, the estimation will be more correct. On the other hand, since the estimated yaw rate is to converge to the detected yaw rate, the proportioning factor of γ in Equation 12 should be positive. Therefore, in such a vehicle operating condition, p1 and p2 may desirably be set to satisfy the following conditions: (-a11+p1+p2)|A|-a22*p1*p2 a2*p1*p2 < 0 (1- |A| p1*p2 ) > 0 The values of p1 and p2 which satisfy the conditions of Equations 17 and 18 are plotted to present such hatched patterns in the coordinates of p1 and p2 as shown in Figs. 15 and 16, wherein Fig. 15 represents a pattern when the vehicle speed is relatively low, while Fig. 16 represents a pattern when the vehicle speed is relatively high. The pattern changes gradually from that shown in Fig. 15 to that shown in Fig. 16 along with increase of vehicle speed. When the slip angle of wheels βf and βr increase further to such a value around βm in Fig. 17 where the lateral forces Ff and Fr acting at the front and rear wheels have largely lost the proportional relationship against the slip angle of wheels, the estimation is further modified. For such a zone as around βm the relationship between the lateral forces Ff and Fr and the estimated slip angles of wheel βfe and βre are assumed as follows: Ff = Cf * βfe + Ff0 + Δ Ff Fr = Cr * βre + Fr0 + Δ Fr wherein Δ Ff and Δ Fr include estimation errors of the cornering power and the road surface friction coefficient µ. Although Ff0 and Fr0 are not constants but are in fact functions of βfe and βre, Ff0 and Fr0 can be approximated to as constants at and around βm. Substituting Equations 19 and 20 for Ff and Fr of Equations 1 and 2, and rearranging the resultant, with Laplace transformation, the relationships between Δ Ff, Δ Fr and βe and γe are obtained as follows: and, as further rearranged, wherein α = - (1 + Kg), and Since the lateral force estimated in the non-linear zone would include a large error, it is considered to be desirable that, if the front wheels are in saturation of tire grip, the transfer function from Δ Ff to βe is made zero, while if the rear wheels are in saturation of tire grip, the transfer function from Fr to βe is made zero, by α being so adjusted. In order to make the transfer function from Δ Ff to βe zero, α is to be such as α = - Iz*(Kg+s) m*V*Lf - Cr*Lr*(Lf+Lr) m*V*Lf 2 In order to make the transfer function from Δ Fr to βe zero, α is to be such as α = Iz*(Kg+s) m*V*Lr + Cf*Lf*(Lf+Lr) m*V*Lr 2 Further, since it is considered that Cf and Cr are both small in such a non-linear zone, they will be approximated to zero. Thus, the value of α is finally to be made as follows: α = - Iz*Kg m*V*Lf when the front wheels are saturated, i.e. in understeer, and α = Iz*Kg m*V*Lr when the rear wheels are saturated, i.e. in oversteer. Brief Description of the Drawing In the accompanying drawing, Fig. 1 is a diagrammatical illustration of a vehicle stability control system in which the device for estimating slip angle of vehicle body according to the present invention is incorporated; Fig. 2 is a flowchart showing the overall operation carried out by the device for estimating slip angle of vehicle body according to the present invention; Fig. 3 is a flowchart showing the operation of step 100 of Fig. 2 for the calculation of saturation index Sa and estimation error Δµ of road surface friction coefficient µ in more detail; Fig. 4 is a flowchart showing the operation of step 200 of Fig. 2 for the calculation of wheel lateral forces based upon vehicle model and yaw moment in more detail; Fig. 5 is a flowchart showing the operation of step 300 of Fig. 2 for the calculation of road surface friction coefficient in more detail; Fig. 6 is a flowchart showing the operation of step 400 of Fig. 2 for the calculation of feedback gains Kb and Kg in more detail; Fig. 7 is a flowchart showing the operation of step 500 of Fig. 2 in more detail; Fig. 8 is a map set up for the relationship between the absolute value of yaw rate difference Δγ and saturation index Sa; Fig. 9 is a map set up for the relationship between saturation index Sa and estimation error of road surface friction coefficient Δµ; Fig. 10 is a map showing the relationship between slip angles of wheels βi (i = f, r) and lateral forces of wheels; Fig. 11 is a map set up for the relationship between saturation index Sa and filtration time constant Tm; Fig. 12 is a map set up for the relationship between saturation index Sa and weighing factors W1, W2 and W3; Fig. 13 is a map set up for the relationship between saturation index Sa and weighing factor for rear wheels in oversteer state; Fig. 14 is a map set up for the relationship between saturation index Sa and weighing factor for front wheels in understeer state; Fig. 15 is a graph showing distribution area of p1 and p2 of tire grip saturating state at relatively low vehicle speed; Fig. 16 is a graph showing distribution area of p1 and p2 of tire grip saturating state at relatively high vehicle speed; and Fig. 17 is a map showing the relationship between slip angles of wheels βi (i = f, r) and lateral forces of wheels for a local estimation in a tire grip saturated zone. Description of the Embodiment In the following, the present invention will be described with respect to an embodiment thereof with reference to the accompanying drawings. Referring Fig. 1, the device for estimating slip angle of vehicle body according to the present invention is incorporated in a vehicle stability control device 12 of a vehicle 10 diagrammatically illustrated by front right, front left, rear right and rear left wheels 18FR, 18FL, 18RR and 18RL. The block of the vehicle stability control device 12 may be deemed to also represent the body of the vehicle, if necessary. The vehicle stability control device 12 is supplied with signals representing vehicle speed V from a vehicle speed sensor 20, longitudinal acceleration Gx from a longitudinal acceleration sensor 22, lateral acceleration Gy from a lateral acceleration sensor 24, yaw rate γ from a yaw rate sensor 26, brake fluid pressures Pbi of wheel cylinders of the respective wheels from pressure sensors 28, front steering angle δf and rear steering angle δr from a four wheel steering means 31, and traction forces Ti of the respective wheels from an engine control means 32. The vehicle is equipped with a brake control means 14 and brakes 16, so that the brakes are actuated by the brake control means 14 under the control of the vehicle stability control device 12, as described in detail in co-pending patent applications assigned to the same assignee as the present application. U.S. Patents 5,704,696; 5,704,695; 5 782,543; 5,813,732; 5,707,120; 5,727,853; and 5,703,439 should be referred to for such vehicle stability controls when desired. Although not shown in detail in the figure, the vehicle stability control device 12 and the device for estimating slip angle of vehicle body according to the present invention incorporated therein may, in fact, be constructed by an electronic computer of a standard construction including a central processing unit, a read only memory, a random access memory, input port means, output port means, and bi-lateral common bus means interconnecting these elements. The device for estimating slip angle of vehicle body according to the present invention carries out a series of calculations described hereinbelow with reference to Figs. 2-7, repetitively at a predetermined time cycle, so as continually to pursue converged solutions of Equations 1 and 2 while maintaining interrelation therebetween, replacing changes of analogue quantities by digital integration with feedback adjustment, particular to electronic computers. Referring to Fig. 2 showing the outline of calculations, in step 100, the input signals are read in, and a parameter herein called "saturation index Sa" and estimation error Δµ of friction coefficient of road surface, both described in detail hereinbelow, are calculated according to the routine shown in Fig. 3. In step 200, tire lateral forces are calculated in two different ways according to the routine shown in Fig. 4, such that a first tire lateral force is calculated based upon a vehicle model and a second tire lateral force is calculated based upon yaw moment which is substantially dependent upon difference of braking and traction forces acting at four wheels. In step 300, friction coefficient µ of road surface is estimated according to the routine shown in Fig. 5, such that the estimation is repetitively adjusted by comparison of the tire lateral forces calculated based upon the vehicle model and the tire lateral forces calculated based upon the yaw moment. In step 400, the feedback gains Kb and Kg are calculated according to the routine shown in Fig. 6. In step 500, slip angle βe and yaw rate γe of the vehicle body are estimated according to the routine shown in Fig. 7. Next, each step will be described in more detail. Referring first to Fig. 3, the calculation of the saturation index Sa and the estimation error Δµ of road surface friction coefficient µ will be described. In step 110, a target yaw rate γc is calculated based upon vehicle speed V, steering angle δf and δr, wheel base H, and an appropriate proportional constant Kh, and then γc is modified for a primary delay by the well know Laplace function 1/(Tt+s) to obtain a standard yaw rate γt as follows: γc =V*(δf - δr)/{(1+Kh*V 2 )*H} γt = γc /(1 +Tt * s) In step 120, yaw rate difference Δγ is calculated as follows: Δγ =(γt - γ)/V In step 130, referring to a map such as shown in Fig. 8, the saturation index Sa is calculated against the absolute value of Δγ, so as to generate a parameter which indicates the degree of tire grip saturation such as to increase along with increase of the absolute value of Δγ until it saturates. In step 140, referring to a map such as shown in Fig. 9, the estimation error Δµ of road surface friction coefficient µ is calculated against the saturation index Sa, such as to get smaller as the saturation index Sa increases. Next, referring to Fig. 4, the calculation of tire lateral forces based upon vehicle model and yaw moment will be described. In step 210, denoting the longitudinal distance of front and rear wheels (axles) from the center of gravity of the vehicle body as Lf and Lr, respectively, slip angles βi (i = fr, fl, rr, rl) of the respective wheels are estimated based upon steering angles δf and δr, vehicle speed V, vehicle body slip angle βe (as estimated in a previous cycle), and yaw rate γe (also as estimated in a previous cycle), as follows: βfr = βfl = δf - βe -Lf*γe /V βrr = βrl = δr - βe + Lr*γe /V In step 220, denoting a conversion factor of brake fluid pressures Pbi (i = fr, fl, rr, rl) to braking forces, i.e. longitudinal forces Fxi (i = fr, fl, rr, rl) of the respective wheels as B, the longitudinal forces Fxi are estimated as follows: Fxi = B * Pbi - Ti In step 230, loads Wi (i = fr, fl, rr, rl) on respective wheels are calculated based upon vehicle weight m, longitudinal acceleration Gx and lateral acceleration Gy, and maximum lateral forces Fymaxi (i = fr, fl, rr, rl) of the respective wheels are estimated as follows: Fymaxi = {(µ*Wi) 2 - Fxi 2 } 1/2 In step 240, denoting the cornering power of the respective wheels as Cpi (i = fr, fl, rr, rl), lateral forces Fyi (i = fr, fl, rr, rl) of the respective wheels are estimated as follows: Fyi = Fymaxi * tanh (Cpi * βi / Fymaxi) Or, lateral forces Fyi of the respective wheels may be obtained from a map such as shown in Fig. 10 against the slip angle βi, wherein the straight line Lcp represents the cornering power. In step 250, first estimated lateral forces of the front and rear wheels Fyf1 and Fyr1 are estimated as follows: Fyf1 = Fyfl + Fyfr Fyr1 = Fyrl + Fyrr In step 260, denoting the tread of the vehicle as T, yaw moment M due to difference of the braking forces at the respective wheels is calculated as follows: M = (Fxfr - Fxfl + Fxrr - Fxrl)*T/2 In step 270, based upon the inertial moment of the vehicle Iz and differential γ ˙ (denoted as γdif) of yaw rate γ, second estimated lateral forces of the front and rear wheels Fyf2 and Fyr2 are estimated as follows: Fyf2 = (Lr * Gy * 9.8 * m + Iz * γdif - M)/H Fyr2 = (Lf * Gy * 9.8 * m - Iz * γdif + M)/H Next, referring to Fig. 5, the estimation of road surface friction coefficient µ will be described. In step 310, assuming that the ratio of the tire grip force based upon the second estimated lateral force to that based upon the first estimated lateral force is equivalent to the ratio of the real value of road surface friction coefficient to the value of the road surface friction coefficient estimated in the previous cycle, the real values of the friction coefficient of the front and rear wheels are estimated as follows: µtmpf= µ * (Fyf2 2 + Fxf 2 ) 1/2 / (Fyf1 2 + Fxf 2 ) 1/2 µtmpr= µ * (Fyr2 2 + Fxr 2 ) 1/2 / (Fyr1 2 + Fxr 2 ) 1/2 In step 320, the larger of µt mpf and µt mpr is selected as an estimated road surface friction coefficient µtmp. The reason for selecting the larger of µtmpf and µtmpr for use is in that, when the road surface friction coefficient is estimated to be smaller than the actual value thereof, the vehicle stability control may allow the slip angle of the vehicle body to become too much. In step 330, referring to a map such as shown in Fig. 11, a time constant Tm for filtrating µtmp is determined against the saturation index Sa, to be smaller as the saturation index Sa increases. In step 340, denoting a sampling time as Tsp, a filtrating factor R is calculated as follows: R=Tsp/Tm In step 350, µtmp is filtrated according to the filtrating factor R to obtain estimated friction coefficient µe as follows: µe =(1-R)* µe + µ tmp*R In step 360, the road surface friction coefficient µ is finally estimated by compensating µe by Δµ obtained in step 140, as follows: µ = µe + Δµ Next, referring to Fig. 6, the calculation of the feedback gains Kb for the estimation of the slip angle of vehicle body and Kg for the estimation of the yaw rate will be described. In this routine, three kinds of feedback gains are calculated as first, second and third feedback gain components Kb1, Kb2 and Kb3 and Kg1, Kg2 and Kg3 to estimate Kb and Kg, respectively, by weighed summing combination of such gain components. In step 410, based upon calculations of p1 and p2 according to Equations 15 and 16, the first feedback gain components Kb1 and Kg1 are calculated according to Equations 13 and 14, as follows: Kb1 = {(all - p1 - p2) + p1 * p2} / a21 + a12 Kg1 = all + a22 - p1 - p2 In step 420, parameters p1 and p2 for calculating the second feedback gain components Kb2 and Kg2 are determined according to vehicle speed to be such values as described with reference to Figs. 15 and 16, so as to be in the hatched area of Fig. 15 when the vehicle speed is relatively low, or to be in the hatched area of Fig. 16 when the vehicle speed is relatively high. In step 430, by using the values of p1 and p2 obtained above, the second feedback gain components Kb2 and Kg2 are calculated as follows. Further detail is described later: Kb2 = {(all - p1 - p2) + p1 * p2} / a21 + a12 Kg2 = all + a22 - p1 - p2 In step 440, the third feedback gain components Kb3 and Kg3 are calculated as follows, wherein τ is a constant: Kb3 = 1/τ Kg3 = -(1 + α) α = -(Iz * Kg3)/(m * V * Lf) when Δγ * γ > 0 α = (Iz * Kg3)/(m * V * Lf) when Δγ * γ < 0 In step 450, referring to a map such as shown in Fig. 12, weighing factors W1, W2 and W3 for the first, second and third feedback gain components are determined against the saturation index Sa. In step 460, the feedback gains Kb and Kg are finally calculated as a weighed sum of Kb1, Kb2 and Kb3 and Kg1, Kg2 and Kg3, respectively, follows: Kb = W1 * Kb1 + W2 * Kb2 + W3 * Kb3 Kg = W1 * Kg1 + W2 * Kg2 + W3 * Kg3 Next, referring to Fig. 7, the final calculation of the slip angle of vehicle body βe and yaw rate γe will be described. In step 510, it is judged if the vehicle is in an oversteered condition with the tire grip force of the rear wheels being saturated with Δγ*γ being negative, or in an understeered condition with the tire grip force of the front wheels being saturated with Δγ*γ being positive. (In this judgment, γ may be either the detected yaw rate or the estimated yaw rate.) When the judgment of step 510 is no, i.e. the vehicle is in an oversteer, the control process proceeds to step 520, whereas when the judgment is yes, i.e. the vehicle is an understeer, the control process proceeds to step 530. In step 520, referring to a map such as shown in Fig. 15, a weighing factor Wdr for the second estimated lateral force Fyr2 of the rear wheels is determined against the saturation index Sa. In step 540, lateral forces Fyf and Fyr of the front and rear wheels are calculated by using Wdr, so that, in the estimation of lateral force acting at the rear wheels, the weight of the first estimated lateral force Fyr1 is more decreased relative to the second estimated lateral force Fyr2 as the saturation index is larger, as follows: Fyf = Fyf1 Fyr = (1 - Wdr) * Fyr1 + Wdr * Fyr2 On the other hand, in step 530, referring to a map such as shown in Fig. 14, a weighing factor Wdf is estimated against the saturation index Sa for the second estimated lateral force Fyf2 of the front wheels. In step 550, lateral forces Fyf and Fyr of the front and rear wheels are calculated by using Wdf as follows: Fyf = (1 - Wdf) * Fyr1 + Wdf * Fyf2 Fyr = Fyr1 In step 560, the slip angle of vehicle body βe and the yaw rate γe are estimated as follows: βe = βe + { Fyf + Fyr m*V - γe + Kb(γ - γe) }*Tsp γe = γe+{ Lf*Fyf - Lr*Fyr + M Iz + Kg(γ-γe) }*Tsp

Claims: A device for estimating slip angle of vehicle body of a vehicle having front and rear wheels (18FL, 18FR, 18RL, 18RR) supporting the vehicle body, the vehicle being equipped with means (31, 20, 26) for detecting at least steering angle, vehicle speed, and yaw rate characterized by comprising: means (12) for calculating yaw rate based upon at least the detected steering angle, and vehicle speed as variable parameters, the slip angle of the vehicle body estimated by the vehicle body slip angle estimation device, a first feedback factor multiplied to a difference between the last detected yaw rate and the yaw rate last calculated by said yaw rate calculation means, and fixed parameters particular to the vehicle, such that the cyclically calculated yaw rate converges to the last detected yaw rate; means (12) for calculating slip angle of the vehicle body based upon at least the detected steering angle, vehicle speed and yaw rate, the yaw rate last calculated by said yaw rate calculation means, a second feedback factor multiplied to the difference between the last detected yaw rate and the yaw rate last calculated by said yaw rate calculation means, and fixed parameters particular to the vehicle, such that the cyclically calculated yaw rate converges to the last detected yaw rate; means (12) for detecting saturation index against a difference between a standard yaw rate last calculated by said yaw rate calculation means and the last detected yaw rate; and means (12) for modifying said first and second feedback factors according to said saturation index such that non-linearity between lateral forces acting at the wheels and slip angles of the wheels is compensated for by the modification of said first and second feedback factors. The device of claim 1, wherein said first and second feedback gains are each calculated in at least three different manners according to increase of the value of said saturation index to provide at least first, second and third gain components, while at least three weighing factors such as first, second and third weighing factors are prepared corresponding to the value of said saturation index so that said first, second and third weighing factors have peak points at different values of said saturation index, and said first and second feedback factors are each generated by the sum of said first, second and third gain components each being weighed by the corresponding weighing factor. The device of claim 1, wherein, when said saturation index is so high as to indicate that said non-linearity substantially exists, said second feedback factor is determined such that the estimated slip angle of the vehicle body increases in an orientation opposite to that in which the detected yaw rate increases. The device of claim 1, wherein, when said difference between the standard yaw rate and the detected yaw is different from the yaw rate (either detected or calculated) with respect to the orientation thereof, at least one of said first and second feedback factors is modified such that lateral force acting at the rear wheels is estimated to be less in said yaw rate and vehicle body slip angle calculations, and when said difference between the standard yaw rate and the detected yaw rate is the same as the yaw rate (either detected or calculated) with respect to the orientation thereof, at least one of said first and second feedback factors is modified such that lateral force acting at the front wheels is estimated to be less in said yaw rate and vehicle body slip angle calculations. The device of one of the claims 1 to 4, wherein the device is further equipped with means (24, 14) for detecting lateral acceleration and braking forces of the front and rear wheels said yaw rate calculation means (12) cyclically calculating yaw rate based upon at least the last detected steering angle, vehicle speed, lateral acceleration, and braking forces as variable parameters, the slip angle of the vehicle body last estimated by the vehicle body slip angle estimation device, the first feedback factor multiplied to the difference between the last detected yaw rate and the yaw rate last calculated by said yaw rate calculation means, and the fixed parameters particular to the vehicle, such that the cyclically calculated yaw rate converges to the last detected yaw rate, while said slip angle calculation means (12) cyclically calculating the slip angle of the vehicle body based upon at least the last detected steering angle, vehicle speed, lateral acceleration, braking forces and yaw rate, the yaw rate last calculated by said yaw rate calculation means, the second feedback factor multiplied to the difference between the last detected yaw rate and the yaw rate last calculated by said yaw rate calculation means, and the fixed parameters particular to the vehicle, such that the cyclically calculated yaw rate converges to the last detected yaw rate. The device of one of the claims 1 to 5 being incorporated in a vehicle stability control device.

Inventors: FUKADA YOSHIKI, FUKADA, YOSHIKI
Applicants: TOYOTA MOTOR CO LTD, TOYOTA JIDOSHA KABUSHIKI KAISHA
Application year: 1996
Main classification: B60T8
IPC codes: B60T8