Kinematic-based method of estimating the absolute roll angle of a vehicle body

Abstract

The absolute roll angle of a vehicle body is estimated by blending two preliminary roll angle estimates based on their frequency so that the blended estimate continuously favors the more accurate of the preliminary roll angle estimates. A first preliminary roll angle estimate based on the measured roll rate is improved by initially compensating the roll rate signal for bias error using roll rate estimates inferred from other measured parameters. And a second preliminary roll angle estimate is determined based on the kinematic relationship among roll angle, lateral acceleration, yaw rate and vehicle speed. The blended estimate of roll angle utilizes a blending coefficient that varies with the frequency of the preliminary roll angle signals, and a blending factor used in the blending coefficient is set to different values depending whether the vehicle is in a steady-state or transient condition.

Description

TECHNICAL FIELD

The present invention relates to estimation of the absolute roll angle of a vehicle body for side airbag deployment and/or brake control, and more particularly to an improved kinematic-based estimation method.

BACKGROUND OF THE INVENTION

A number of vehicular control systems including vehicle stability control (VSC) systems and rollover detection/prevention systems utilize various sensed parameters to estimate the absolute roll angle of the vehicle body—that is, the angle of rotation of the vehicle body about its longitudinal axis relative to the level ground plane. In addition, knowledge of absolute roll angle is required to fully compensate measured lateral acceleration for the effects of gravity when the vehicle body is inclined relative to the level ground plane.

In general, the absolute roll angle of a vehicle must be estimated or inferred because it cannot be measured directly in a cost effective manner. Ideally, it would be possible to determine the absolute roll angle by simply integrating the output of a roll rate sensor, and in fact most vehicles equipped with VSC and/or rollover detection/prevention systems have at least one roll rate sensor. However, the output of a typical roll rate sensor includes some DC bias or offset that would be integrated along with the portion of the output actually due to roll rate. For this reason, many systems attempt to remove the sensor bias prior to integration. As disclosed in the U.S. Pat. No. 6,542,792 to Schubert et al., for example, the roll rate sensor output can be dead-banded and high-pass filtered prior to integration. While these techniques can be useful under highly transient conditions where the actual roll rate signal is relatively high, they can result in severe under-estimation of roll angle in slow or nearly steady-state maneuvers where it is not possible to separate the bias from the portion of the sensor output actually due to roll rate.

A more effective approach, disclosed in the U.S. Pat. Nos. 6,292,759 and 6,678,631 to Schiffmann, is to form an additional estimate of roll angle that is particularly reliable in slow or nearly steady-state maneuvers, and blend the two roll angle estimates based on specified operating conditions of the vehicle to form the roll angle estimate that is supplied to the VSC and/or rollover detection/prevention systems. In the Shiffmann patents, the additional estimate of roll angle is based on vehicle acceleration measurements, and a coefficient used to blend the two roll angle estimates has a nominal value except under rough-road or airborne driving conditions during which the coefficient is changed to favor the estimate based on the measured roll rate.

Of course, any of the above-mentioned approaches are only as good as the individual roll angle estimates. For example, the additional roll angle estimate used in the above-mentioned Schiffmann patents tends to be inaccurate during turning maneuvers. Accordingly, what is needed is a way of forming a more accurate estimate of absolute roll angle.

SUMMARY OF THE INVENTION

The present invention provides an improved method of estimating the absolute roll angle of a vehicle body under any operating condition, including normal driving, emergency maneuvers, driving on banked roads and near rollover situations. The roll angle estimate is based on typically sensed parameters, including roll rate, lateral acceleration, yaw rate, vehicle speed, and optionally, longitudinal acceleration. Roll rate sensor bias is identified by comparing the sensed roll rate with roll rate estimates inferred from other measured parameters for fast and accurate removal of the bias. A first preliminary estimate of roll angle, generally reliable in nearly steady-state conditions, is determined from a kinematic relationship involving lateral acceleration, yaw rate and vehicle speed. The final or blended estimate of roll angle is then determined by blending the preliminary estimate with a second preliminary estimate based on the bias-corrected measure of roll rate. In the blending process, the relative weighting between two preliminary roll angle estimates depends on their frequency and on the driving conditions so that the final estimate continuously favors the more accurate of the preliminary estimates. The blended estimate is used for several purposes, including estimating the lateral velocity and side-slip angle of the vehicle.

BRIEF DESCRIPTION OF THE DRAWINGS

FIG. 1 is a diagram of a vehicle during a cornering maneuver on a banked road;

FIG. 2 is a diagram of a system for the vehicle of FIG. 1, including a microprocessor-based controller for carrying out the method of this invention; and

FIG. 3 is a flow diagram representative of a software routine periodically executed by the microprocessor-based controller of FIG. 2 for carrying out the method of this invention.

DESCRIPTION OF THE PREFERRED EMBODIMENT

Referring to FIG. 1, the reference numeral 10 generally designates a vehicle being operated on a road surface 12. In the illustration, the road surface 12 is laterally inclined (i.e., banked) relative to the level ground plane 14 by an angle φ_bank. Additionally, the body 16 of vehicle 10 has a roll angle φ_rel relative to the road surface 12 due to suspension and tire compliance. The total or absolute roll angle φ of the vehicle body 16 thus includes both the bank angle φ_bank and the relative roll angle φ_rel.

If the roll rate w of vehicle 10 about its longitudinal axis is measured, an estimate φ_eω of the total roll angle φ can be determined in principle by integrating the measured roll rate, as follows:

$\begin{array}{cc}{\phi }_{e\omega }\left(t\right)={\int }_0^t{\omega }_m\left(\tau \right)\tau & \left(1\right)\end{array}$

where t denotes time and ω_m is the measured roll rate. Unfortunately, the output of a typical roll rate sensor includes some bias error that would be integrated along with the portion of the output actually due to roll rate. Thus, pure integration of the measured roll rate has infinite sensitivity to the bias error because the error is integrated over time. When dead-banding and high-pass (i.e., wash-out) filtering are used to compensate for the bias error, there is still a conflict between the immunity to bias and the ability to track slowly-varying (or constant) roll angles because the bias compensation also reduces the portion of the signal actually due to roll rate. As a result, a roll angle estimate based on roll rate integration is reasonably good during quick transient maneuvers, but less accurate during slow maneuvers or in nearly steady-state conditions when the roll angle changes slowly. As explained below, one aspect of the present invention is directed to an improved method of compensating for the bias error in a measured roll rate signal without substantially diminishing the portion of the signal actually due to roll rate.

An alternative way of determining the total roll angle θ is to consider it in the context of the kinematic relationship:

a _ym ={dot over (v)} _y +v _x Ω−g sin φ  (2)

where v_y is the lateral velocity of vehicle center-of-gravity, v_x is the vehicle longitudinal velocity, Ω is vehicle yaw rate, and g is the acceleration of gravity (9.806 m/s²). The sign convention used in equation (2) assumes that lateral acceleration a_ym and yaw rate Ω are positive in a right turn, but the roll angle φ due to the turning maneuver is negative.

During nearly steady-state conditions, the derivative of lateral velocity (i.e., {dot over (v)}_y) is relatively small, and an estimate φ_ek of the roll angle φ can be obtained by ignoring {dot over (v)}_y and solving equation (2) for 0 as follows:

$\begin{array}{cc}{\phi }_{\mathrm{ek}}={\sin }^{-1}\frac{v_x\Omega -a_{\mathrm{ym}}}{g}& \left(3\right)\end{array}$

The longitudinal velocity v_x, the yaw rate Ω, and the lateral acceleration a_ym can be measured, and g is simply a gravitational constant as mentioned above. Thus, a reasonably good estimate φ_ek of roll angle φ under nearly steady-state conditions may be easily calculated. However, the accuracy of the estimate φ_ek deteriorates in transient maneuvers where the derivative of lateral velocity is non-negligible.

In summary, the foregoing methods of estimating absolute roll angle each have significant limitations that limit their usefulness. As explained above, a roll angle estimate based on roll rate integration is reasonably good during quick transient maneuvers, but less accurate during slow maneuvers or in nearly steady-state conditions when roll angle changes slowly due to inability to separate the bias error from the portion of the signal actually due to roll rate. On the other hand, the roll angle estimate φ_ek based on the kinematic relationship of equations (2) and (3) is reasonably good during nearly steady-state (low frequency) maneuvers, but unreliable during transient (high frequency) maneuvers.

It can be seen from the above that the two roll angle estimation methods are complementary in that conditions that produce an unreliable estimate from one estimation method produce an accurate estimate from the other estimation method, and vice versa. Accordingly, the method of this invention blends both estimates in such a manner that the blended roll angle estimate is always closer to the initial estimate that is more accurate.

FIG. 2 is a diagram of an electronic control system 20 installed in vehicle 10 for enhancing vehicle stability and occupant safety. For example, the system 20 may include a vehicle stability control (VSC) system for dynamically activating the vehicle brakes to enhance stability and reduce the likelihood of rollover, and a supplemental restraint system (SRS) for deploying occupant protection devices such as seat belt pretensioners and side curtain air bags in response to detection of an impending rollover event. System sensors include a roll rate sensor 22 responsive to the time rate of angular roll about the vehicle longitudinal axis, a lateral acceleration sensor 24 responsive to the vehicle acceleration along its lateral axis, a yaw rate sensor 26 responsive to the time rate of yaw motion about the vehicle vertical axis, and at least one wheel speed sensor 28 for estimating the vehicle velocity along its longitudinal axis. Optionally, the system 20 additionally includes a longitudinal acceleration sensor 30 responsive to the vehicle acceleration along its longitudinal axis. In practice, ordinary VSC systems include most if not all of the above sensors. Output signals produced by the sensors 22-30 are supplied to a microprocessor-based controller 34 which samples and processes the measured signals, carries out various control algorithms, and produces outputs 36 for achieving condition-appropriate control responses such as brake activation and deployment of occupant restraints. Of course, the depicted arrangement is only illustrative; for example, the functionality of controller 34 may be performed by two or more individual controllers if desired.

FIG. 3 depicts a flow diagram representative of a software routine periodically executed by the microprocessor-based controller 34 of FIG. 2 for carrying out the method of the present invention. The input signals read at block 40 of the flow diagram include measured uncompensated roll rate ω_m—un, measured lateral acceleration a_ym, yaw rate Ω, vehicle speed v_x, and optionally, hand-wheel (steering) angle HWA and measured longitudinal acceleration a_xm. It is assumed for purposes of the present disclosure that the yaw rate Ω and lateral acceleration a_ym input signals have already been compensated for bias error, as is customarily done in VSC systems. Furthermore, it is assumed that all the input signals have been low-pass filtered to reduce the effect of measurement noise.

Block 42 pertains to systems that include a sensor 30 for measuring longitudinal acceleration a_xm, and functions to compensate the measured roll rate ω_m—un for pitching of vehicle 10 about the lateral axis. Pitching motion affects the roll rate detected by sensor 22 due to cross coupling between the yaw rate and roll rate vectors when the vehicle longitudinal axis is inclined with respect to the horizontal plane 14. This occurs, for example, during driving on a spiral ramp. Under such conditions the vertical yaw rate vector has a component along the longitudinal (i.e. roll) axis, to which sensor 22 responds. This component is not due to change in roll angle and should be rejected before the roll rate signal is further processed. In general, the false component is equal to the product of the yaw rate Ω and the tangent of the pitch angle θ. The absolute pitch angle θ is estimated using the following kinematic relationship:

a _xm ={dot over (v)} _x −v _y Ω+g sin θ  (4)

where a_xm is the measured longitudinal acceleration, {dot over (v)}_x is the time rate of change in longitudinal speed v_x, v_y is the vehicle's side-slip or lateral velocity, Ω is the measured yaw rate, and g is the acceleration of gravity. Equation (4) can be rearranged to solve for pitch angle θ as follows:

$\begin{array}{cc}\theta ={\sin }^{-1}\frac{a_{\mathrm{xm}}-{\stackrel{.}{v}}_x+v_y\Omega }{g}& \left(5\right)\end{array}$

The term {dot over (v)}_x is obtained by differentiating (i.e., high-pass filtering) the estimated vehicle speed v_x. If the lateral velocity v_y is not available, the product (v_yΩ) can be ignored because it tends to be relatively small as a practical matter. However, it is also possible to use a roll angle estimate to estimate the lateral velocity v_y, and to feed that estimate back to the pitch angle calculation, as indicated by the dashed flow line 60. Also, the accuracy of the pitch angle calculation can be improved by magnitude limiting the numerator of the inverse-sine function to a predefined threshold such as 4 m/s². The magnitude-limited numerator is then low-pass filtered with, for example, a second-order filter of the form b_nf²/(s²+2ζb_nf+b_nf²), where b_nf is the undamped natural frequency of the filter and ζ is the damping ratio (example values are b_nf=3 rad/sec and ζ=0.7). Also, modifications in the pitch angle calculation may be made during special conditions such as heavy braking when the vehicle speed estimate v_x may be inaccurate. In any event, the result of the calculation is an estimated pitch angle θ_e, which may be subjected to a narrow dead-zone to effectively ignore small pitch angle estimates. Of course, various other pitch angle estimation enhancements may be used, and additional sensors such as a pitch rate sensor can be used to estimate θ.

Once the pitch angle estimate θ_e is determined, the measured roll rate is corrected by adding the product of the yaw rate Ω and the tangent of the pitch angle θ_e to the measured roll rate ∫_m—un to form the pitch-compensated roll rate ω_m as follows:

ω_m=ω_m—un+Ω tan θ_e  (6)

Since in nearly all cases, the pitch angle θ_e is less than 20° or so, equations (5) and (6) can be simplified by assuming that sin θ≅tan θ≅θ. And as mentioned above, the measured roll rate ω_m—un can be used as the pitch-compensated roll rate ω_m if the system 20 does not include the longitudinal acceleration sensor 30.

Block 44 is then executed to convert the measured roll rate signal dim into a bias-compensated roll rate signal ω_m—cor suitable for integrating. In general, this is achieved by comparing ω_m with two or more roll rate estimates obtained from other sensors during nearly steady-state driving to determine the bias, and then gradually removing the determined bias from ω_m.

A first roll rate estimate ω_eay is obtained by using the relationship:

φ_eay=−R_gaina_ym  (7)

to calculate a roll angle Ota corresponding to the measured lateral acceleration a_ym, and differentiating the result. The term R_gain in equation (7) is the roll gain of vehicle 10, which can be estimated for a given vehicle as a function of the total roll stiffness of the suspension and tires, the vehicle mass, and distance from the road surface 12 to the vehicle's center-of-gravity. However, the measured lateral acceleration a_ym is first low-pass filtered to reduce the effect of measurement noise. Preferably, the filter is a second-order filter of the form b_nf²/(s²+2ζb_nf+b_nf²), where b_nf is the un-damped natural frequency of the filter and ζ is the damping ratio (example values are b_nf=20 rad/s and ζ=0.7). And differentiation of the calculated roll angle φ_eay is achieved by passing φ_eay through a first-order high-pass filter of the form b_fs/(s+b_f), where b_f is the filter cut off frequency (an example value is b_f=20 rad/sec).

A second roll rate estimate ω_ek is obtained by using equation (3) to calculate a roll angle φ_ek and differentiating the result. The derivative of lateral velocity, {dot over (v)}_y, is neglected since near steady-state driving conditions are assumed. Algebraically, φ_ek is given as:

$\begin{array}{cc}{\phi }_{\mathrm{ek}}={\sin }^{-1}\frac{{\left(v_x\Omega -a_{\mathrm{ym}}\right)}_{\mathrm{filt}}}{g}& \left(8\right)\end{array}$

As indicated in the above equation, the numerator (v_xΩ−a_ym) of the inverse sine function is also low-pass filtered, preferably with the same form of filter used for the a_ym in the preceding paragraph. As a practical matter, the inverse sine function can be omitted since the calculation is only performed for small roll angles (less than 3° or so). Differentiation of the calculated roll angle φ_ek to produce a corresponding roll rate ω_ek is achieved in the same way as described for roll angle φ_eay in the preceding paragraph.

Once the roll rate estimates ω_eay and ω_ek have been calculated, a number of tests are performed to determine their stability and reliability. First, the absolute value of each estimate must be below a threshold value for at least a predefined time on the order of 0.3-0.5 sec. Second, the absolute value of their difference (that is, |ω_eay−ω_ek|) must be below another smaller threshold value for at least a predefined time such as 0.3-0.5 sec. And finally, the absolute value of the difference between the measured lateral acceleration and the product of yaw rate and vehicle speed (that is, |a_ym−v_xΩ|) must be below a threshold value such as 1 m/sec² for at least a predefined time such as 0.3-0.5 sec. Instead of requiring the conditions to be met for a predefined time period, it is sufficient to require that the rate-limited versions of these signals satisfy specified conditions.

When the above conditions are all satisfied, the roll rate estimates ω_eay and ω_ek are deemed to be sufficiently stable and reliable, and sufficiently close to each other, to be used for isolating the roll rate sensor bias error. In such a case, inconsistencies between the estimated roll rates and the measured roll rate are considered to be attributable to roll rate sensor bias error. First, the difference Δω_m—ay between the measured roll rate ω_m and the estimated roll rate ω_eay is computed and limited in magnitude to a predefined value such as 0.14 rad/sec to form a limited difference Δω_m—ay—lim. Then the roll rate sensor bias error ω_bias is calculated (and subsequently updated) using the following low-pass filter function:

ω_bias(t_i+1)=(1−bΔt)ω_bias(t_i)+bΔtΔω_m—ay—lim(t_i)  (9)

where t_i+1 denotes the current value, t_i denotes a previous value, b is the filter cut off frequency (0.3 rad/sec, for example), and Δt is the sampling period. The initial value of ω_bias (that is, ω_bias (t₀)) is either zero or the value of ω_bias from a previous driving cycle. The roll rate bias error ω_bias is periodically updated so long as the stability and reliability conditions are met, but updating is suspended when one or more of the specified conditions is not satisfied. As a practical matter, updating can be suspended by setting b=0 in equation (9) so that ω_bias(t_i+1)=ω_bias(t_i). Finally, the calculated bias error ω_bias is subtracted from the measured roll rate ω_m, yielding the corrected roll rate ω_m—cor. And if desired, a narrow dead-band may be applied to ω_m—cor to minimize any remaining uncompensated bias. Alternately, the kinematic-based roll rate estimate ω_ek can be used instead of the acceleration-based estimate ω_eay to calculate bias error ω_bias.

The block 46 is then executed to determine the roll angle estimate from a kinematic relationship using measured lateral acceleration, yaw rate and estimated vehicle speed. Fundamentally, the estimate of roll angle is obtained from equation (3), but with additional processing of the numerator term (v_xΩ−a_ym) of the inverse sine function. The value of the numerator term is determined and then limited in magnitude to a threshold value a_thresh such as 5 m/sec²; the limiting serves to reduce error due to the neglected derivative of lateral velocity when it is large, as may occur during very quick transient maneuvers. The limited difference (v_xΩ−a_ym)_lim is then passed through a low pass filter to attenuate the effect of noise; for example, the filter may be a second order filter of the form b_nf²/(s²+2ζb_nf+b_nf²) where b_nf is the undamped natural frequency of the filter and ζ is the damping ratio (example values are b_nf=3 rad/sed and ζ=0.7). The filter output (v_xΩ−a_ym)_lim—filt is then used as the numerator of equation (3) to calculate the roll angle estimate ω_ek as follows:

$\begin{array}{cc}{\phi }_{\mathrm{ek}}={\sin }^{-1}\frac{{\left(v_x\Omega -a_{\mathrm{ym}}\right)}_{\mathrm{lim\_filt}}}{g}& \left(10\right)\end{array}$

Block 48 is then executed to determine a blended estimate φ_ebl of the total roll angle φ by blending φ_ek with a roll angle determined by integrating the bias-compensated roll rate measurement ω_m—cor. To avoid explicitly integrating ω_m—cor, the terms ω_m—cor, φ_ek and {dot over (φ)}_ebl can be combined with a blending factor b_bl—f in a differential equation as follows:

{dot over (φ)}_ebl+b_bl—fφ_ebl=b_bl—fφ_etot+ω_m—cor  (11)

Representing equation (11) in the Laplace domain, and solving for the blended roll angle estimate φ_ebl yields:

$\begin{array}{cc}{\phi }_{ebl}=\frac{b_{\mathrm{bl\_f}}}{s+b_{\mathrm{bl\_f}}}{\phi }_{\mathrm{ek}}+\frac{1}{s+b_{\mathrm{bl\_f}}}{\omega }_{\mathrm{m\_cor}}& \left(12\right)\end{array}$

which in practice is calculated on a discrete-time domain basis as follows:

φ_ebl(t_i+1)=(1−b_bl—fΔt)[φ_ebl(t_i)+Δtω_m—cor(t_i+1)]+b_bl—fΔtφ_ek(t_i+1)  (13)

where t_i+1 denotes the current value, t_i denotes a previous value, and Δt is the sampling period. If the roll angle obtained by integrating ω_m—cor is denoted by φ_w, the blended roll angle estimate φ_ebl may be equivalently expressed as:

$\begin{array}{cc}{\phi }_{ebl}=\frac{b_{\mathrm{bl\_f}}}{s+b_{\mathrm{bl\_f}}}{\phi }_{\mathrm{ek}}+\frac{s}{s+b_{\mathrm{bl\_f}}}{\phi }_{\omega }& \left(14\right)\end{array}$

In this form, it is evident that the blended roll angle estimate φ_ebl is a weighted sum of φ_ek and φ_w, with the weight dependent on the frequency of the signals (designated by the Laplace operand “s”) so that the blended estimate φ_ebl is always closer to the preliminary estimate that is most reliable at the moment. During steady-state conditions, the body roll rate is near-zero and the signal frequencies are also near-zero. Under such steady-state conditions, the coefficient of φ_ek approaches one and the coefficient of φ_w approaches zero, with the result that φ_ek principally contributes to φ_ebl. During transient conditions, on the other hand, the body roll rate is significant, and the signal frequencies are high. Under such transient conditions, the coefficient of φ_ek approaches zero and the coefficient of φ_w approaches one, with the result that φ_w principally contributes to φ_ebl. The change between these two extreme situations is gradual and the transition depends on the value of blending factor b_bl—f (i.e., the filter cut off frequency).

The blending factor b_bl—f may be a fixed value, but is preferably adjusted in value depending on whether the vehicle 10 is in a nearly steady-state condition or a transient condition in terms of either the roll motion or the yaw motion of the vehicle. If vehicle 10 is in a nearly steady-state condition, the blending factor b_bl—f is set to a relatively high value such as 0.488 rad/sec. to emphasize the contribution of the roll angle estimate φ_ek to φ_ebl while de-emphasizing the estimate φ_w based on measured roll rate. If vehicle 10 is in a transient condition, the blending factor b_bl—f is set to a relatively low value such as 0.048 rad/sec. to emphasize the contribution of the roll angle estimate φ_w to φ_ebl, while de-emphasizing the contribution of the kinematic-based roll angle estimate φ_ek.

According to a preferred embodiment, the presence of a nearly steady-state condition is detected when a set of three predefined conditions have been met for a specified period of time such as 0.5 seconds. First, the magnitude of the bias-compensated roll rate (i.e., |ω_m—cor|) must be below a first threshold such as 0.25 rad/sec. The second and third conditions pertain to the numerator (v_xΩ−a_ym) of equation (3), which is generally proportional to the relative roll angle φ_rel. The difference (v_xΩ−a_ym) is passed through a first-order low pass filter to form (v_xΩ−a_ym)_fil, and then differentiated to form (v_xΩ−a_ym)_fil—der, an indicator of roll rate. The second condition for detecting a nearly steady-state condition is that |(v_xΩ−a_ym)_fil| must be below a threshold such as 4.0 m/sec², and the third condition is that |(v_xΩ−a_ym)_fil—der|must be below a threshold such as 2.0 m/sec³. If all three conditions are satisfied for the specified time period, a nearly steady-state condition is detected and b_bl—f is set to the relatively high value of 0.488 rad/sec. Otherwise, a nearly steady-state condition is not detected and b_bl—f is set to the relatively low value of 0.048 rad/sec. Of course, those skilled in art will recognize that various other conditions can be established to determine whether the vehicle 10 is in a nearly steady-state condition or a transient condition, using measured or calculated parameters such as change of yaw rate, handwheel (steering) angle HWA, and so on.

Block 50 is then executed to compensate the measured lateral acceleration ay, for the gravity component due to roll angle. The corrected lateral acceleration a_ycor is given by the sum (a_ym+g sin φ_ebl), where φ_ebl is the blended roll angle estimate determined at block 48. The corrected lateral acceleration a_ycor can be used in conjunction with other parameters such as roll rate and vehicle speed for detecting the onset of a rollover event.

Finally, block 52 is executed to use the blended roll angle estimate φ_ebl to estimate other useful parameters including the vehicle side slip (i.e., lateral) velocity v_y and side-slip angle β. The derivative of lateral velocity can alternately be expressed as (a_y−v_xΩ) or (a_ym+g sin φ−v_xΩ), where a_y in the expression (a_y−v_xΩ) is the actual lateral acceleration, estimated in block 50 as corrected lateral acceleration a_ycor. Thus, derivative of lateral velocity may be calculated using a_ycor for a_y in the expression (a_y−v_xΩ), or using the blended roll angle estimate φ_ebl for φ in the expression (a_ym+g sin φ−v_xΩ). Integrating either expression then yields a reasonably accurate estimate v_ye of side slip velocity v_y, which can be supplied to block 42 for use in the pitch angle calculation, as indicated by the broken flow line 60. And once the side-slip velocity estimate V_ye has been determined, the side-slip angle β at the vehicle's center of gravity is calculated as:

$\begin{array}{cc}\beta ={\tan }^{-1}\frac{v_{\mathrm{ye}}}{v_x}& \left(15\right)\end{array}$

In summary, the present invention provides a novel and useful way of accurately estimating the absolute roll angle of a vehicle body under any vehicle operating condition by blending two preliminary estimates of roll angle according to their frequency. A first preliminary roll angle estimate based on the measured roll rate is improved by initially compensating the roll rate signal for bias error using roll rate estimates inferred from other measured parameters. And a second preliminary roll angle estimate is determined based on the kinematic relationship among roll angle, lateral acceleration, yaw rate and vehicle speed. The blended estimate of roll angle utilizes a blending coefficient that varies with the frequency of the preliminary roll angle signals so that the blended estimate continuously favors the more accurate of the preliminary roll angle estimates, and a blending factor used in the blending coefficient is set to different values depending whether the vehicle is in a steady-state or transient condition. The blended estimate is used to estimate the actual lateral acceleration, the lateral velocity and side-slip angle of the vehicle, all of which are useful in applications such as rollover detection and vehicle stability control.

While the present invention has been described with respect to the illustrated embodiment, it is recognized that numerous modifications and variations in addition to those mentioned herein will occur to those skilled in the art. For example, the some or all of equations be characterized as look-up tables to minimize computation requirements, and trigonometric functions may be approximated by their Fourier expansion series. Also, the lateral velocity may be determined using a model-based (i.e., observer) technique with the corrected lateral acceleration a_ycor as an input, instead of integrating the estimated derivative of lateral velocity. Finally, it is also possible to apply the blending method of this invention to estimation of absolute pitch angle θ in systems including a pitch rate sensor; in that case, a first preliminary pitch angle estimate would be obtained by integrating a bias-compensated measure of the pitch rate, and a second preliminary pitch angle estimate would be obtained from equation (5). Of course, other modifications and variations are also possible. Accordingly, it is intended that the invention not be limited to the disclosed embodiment, but that it have the full scope permitted by the language of the following claims.

Claims

1. A method of operation for a vehicle having a body that rolls about a longitudinal axis relative to a level ground plane, comprising the steps of: determining a first preliminary estimate of a total roll angle of the vehicle body based on a signal produced by a roll rate sensor, said first preliminary estimate having an accuracy that is highest under transient conditions when a roll rate of the vehicle body is relatively high;determining a second preliminary estimate of the total roll angle based on a measured yaw rate of the vehicle body, an estimated longitudinal velocity of the vehicle body and a measured lateral acceleration of the vehicle body, said second preliminary estimate having an accuracy that is highest under near steady-state conditions when the roll rate of the vehicle body is relatively low;blending the first and second preliminary estimates of the total roll angle with blending coefficients to form a blended estimate of the total roll angle, where the blending coefficients are continuously variable according to a frequency of said first and second preliminary estimates so that the blended estimate favors the first preliminary estimate under the transient conditions and the second preliminary estimate under the near steady-state conditions; andcontrolling a vehicle system based on the blended estimate of the total roll angle.

2. The method of claim 1, including the steps of: determining a bias error in the signal produced by the roll rate sensor; andremoving the determined bias error from the signal produced by the roll rate sensor before determining said first preliminary estimate of the total roll angle.

3. The method of claim 2, where the step of determining the bias error in the signal produced by the roll rate sensor includes the steps of: determining at least one auxiliary roll rate estimate based on sensed parameters other than the roll rate during the steady-state conditions;determining a difference between the auxiliary roll rate estimate and the signal produced by the roll rate sensor;limiting a magnitude of said difference to form a limited difference; anddetermining said bias error by low-pass filtering said limited difference.

4. The method of claim 3, where the step of determining at least one auxiliary roll rate estimate includes the steps of: determining a roll angle estimate based on sensed parameters other than the roll rate during the steady-state conditions; anddifferentiating the determined roll angle estimate to form the auxiliary roll rate estimate.

5. The method of claim 1, including the step of: determining the second preliminary estimate φek of the total roll angle according to:

6. The method of claim 5, including the step of: magnitude limiting and low-pass filtering the difference (vxΩ−aym) before determining the second preliminary estimate φek of the total roll angle.

7. The method of claim 1, including the steps of: measuring a lateral acceleration of the vehicle body; andcompensating the measured lateral acceleration for a gravity component due to the blended estimate of the total roll angle; andcontrolling the vehicle system based on compensated lateral acceleration.

8. The method of claim 1, including the steps of: determining a lateral velocity of the vehicle body based on the blended estimate of the total roll angle; andcontrolling the vehicle system based on determined lateral velocity.

9. The method of claim 8, including the steps of: determining a pitch angle of the vehicle body based on the determined lateral velocity, measures of longitudinal acceleration and yaw rate of the vehicle body, and an estimated longitudinal velocity of the vehicle;compensating the signal produced by the roll rate sensor due to the determined pitch angle; anddetermining said first preliminary estimate of the total roll angle based on the compensated roll rate sensor signal.

10. The method of claim 8, including the step of: determining a side-slip angle of the vehicle based on the determined lateral velocity and an estimate of a longitudinal velocity of the vehicle; andcontrolling the vehicle system based on determined side-slip angle.