Reduced order parameter identification for vehicle rollover control system

Abstract

A system that detects a lateral acceleration and roll rate of the vehicle and estimates a mass distribution parameter. The system then generates a tuned mass distribution parameter that is based on the the lateral acceleration, the roll rate, and the mass distribution parameter and introduces the tuned mass distribution parameter to a rollover stability control system.

Description

BACKGROUND

This invention relates to a system and method of protecting against rollover in a motor vehicle.

Dynamic control systems have been recently introduced in automotive vehicles for measuring the body characteristics of the vehicle and controlling the dynamics of the vehicle based on the measured body characteristics. For example, certain systems measure vehicle characteristics to prevent vehicle rollover and for tilt control (or body roll). Tilt control maintains the vehicle body on a plane or nearly on a plane parallel to the road surface, and rollover control maintains the vehicle wheels on the road surface. Certain systems use a combination of yaw control and tilt control to maintain the vehicle body horizontal while turning. Commercial examples of these systems are known as active rollover prevention (ARP) and rollover stability control (RSC) systems.

The spectrum of conditions that may occur during the operation of the vehicle is too large to be practically evaluated during the development and production of the vehicle. As a result, the tuning of the rollover stability control system for the vehicle is typically performed with an extreme roof load to provide sufficient confidence that the system will perform suitably over road conditions that the vehicle will experience when being driven.

However, when the rollover stability control system is tuned in the roof-loaded condition, the gains are higher than those that would result from tuning in the normal-loaded condition. Thus, the system becomes very sensitive to small disturbances.

Moreover, conventional systems consider the longitudinal vehicle dynamics to estimate the mass of the system. Hence, these systems do not provide an indication about the way the mass is distributed with respect to the roll axis (i.e., the roll moment of inertia).

SUMMARY

In satisfying the above need, as well as overcoming the enumerated drawbacks and other limitations of the related art, the present invention provides a system and method that estimates a parameter related to the mass of the loaded vehicle as well as the mass distribution.

In a general aspect of the invention, the system detects a lateral acceleration and roll rate of the vehicle and estimates a mass distribution parameter. The system then generates a tuned mass distribution parameter that is based on the the lateral acceleration, the roll rate, and the mass distribution parameter and introduces the tuned mass distribution parameter to a rollover stability control system.

Further features and advantages will become apparent from the following description, and from the claims.

BRIEF DESCRIPTION OF THE DRAWINGS

FIG. 1 is a block diagram of a system that identifies a parameter related to the mass of a vehicle and the mass distribution in accordance with the invention; and

FIG. 2 is a free-body diagram of a vehicle illustrating forces acting on the vehicle.

DETAILED DESCRIPTION

Referring now to FIG. 1, a system embodying the principles of the present invention is illustrated therein and designated at 10. The system 10 provides corrected parameters for a rollover stability control system 11 implemented within a vehicle 100 (FIG. 2), to reduce the rollover propensity of the vehicle in actual driving conditions. Thus, the system 10 is able to adjust for changes in the load on the vehicle as well as the distribution of the load in real time.

With reference to FIG. 2, the following roll model is implemented in the system 10. The roll model requires that the sum of the moments is zero, that is, ΣM=O   Eqn. 1 which yields I{umlaut over (θ)}=mhu−K θ−c{dot over (θ)},   Eqn. 2 where

I is the moment of inertia in the roll direction,

{umlaut over (θ)} is the roll acceleration,

{dot over (θ)} is the roll rate,

θ is the roll angle,

m is the total mass,

K is the roll stiffness,

c is the roll damping coefficient,

u is the lateral acceleration, and

h is the height of the center of gravity from the roll axis. Rearranging Eqn. 2 provides $\begin{array}{cc}\ddot{\theta }=\frac{-c}{I}\stackrel{.}{\theta }-\frac{K}{I}\theta +\frac{\mathrm{mh}}{I}u& \mathrm{Eqn}.3\end{array}$

Thus, in state space, the continuous time system roll model is x(t)=Ax(t)+Bu(t), x(0)=0 if the initial time is set to zero, $\begin{array}{cc}\mathrm{and}y\left(t\right)=\mathrm{Cx}\left(t\right)\mathrm{where}x\left(t\right)=\left[\begin{array}{c}\theta \\ \stackrel{.}{\theta }\end{array}\right],\stackrel{.}{x}\left(t\right)=\left[\begin{array}{c}\stackrel{.}{\theta }\\ \ddot{\theta }\end{array}\right]A=\left[\begin{array}{cc}0& 1\\ -\frac{K}{I}& -\frac{c}{I}\end{array}\right]B=\left[\begin{array}{c}0\\ -\frac{m·h}{I}\end{array}\right]\mathrm{and}C=[\begin{array}{cc}0& 1]\end{array}& \mathrm{Eqn}.4\end{array}$ The C matrix is chosen depending on the type of sensor employed. In this case, a roll rate sensor is being employed, hence C=[0 1].

Note that the above discussion is directed to obtaining a solution for the state vector x(t) in continuous time. Therefore, the system described in Eqn. 4 is typically discretized according to the expression {dot over (x)}(k)=A_dx(k−1)+B_du(k)   Eqn. 5 y(k)=Cx(k) where k identifies the k^th time step and A_d=I_n+AT, B_d=BT, and where

I_n is the nth order identity matrix, which in this case is a second order identity matrix, and

T is the time step.

Converting the discretized state space equation (Eqn. 5) to transfer function space identified here as z yields: $\begin{array}{cc}\frac{Y\left(z\right)}{U\left(z\right)}={C\left({\mathrm{zI}}_n-A_d\right)}^{-1}{B}_d,\mathrm{thus},& \mathrm{Eqn}.6\\ \frac{Y\left(z\right)}{U\left(z\right)}=\frac{n_1·z^{-1}-n_2·z^{-2}}{1+d_1·z^{-1}+d_2·z^{-2}}\mathrm{where}{n}_1,n_2=\frac{\mathrm{Tmh}}{I},d_1=\frac{\mathrm{Tc}-2I}{I},\mathrm{and}{d}_2=I-\mathrm{Tc}+T^{2}K& \mathrm{Eqn}.7\end{array}$ Hence, U(z) is the lateral acceleration in z space and Y(z) is the corresponding roll rate.

Expanding Eqn. 7 yields:Y(z)+d₁Y(z)z⁻¹+d₂Y(z)z⁻²=n₁U(z)z⁻¹−n₂U(z)z⁻², or Y(z)=n₁U(z)z⁻¹−n₂U(z)z⁻²−d₁Y(z)z⁻¹−d₂Y(z)z⁻²   Eqn. 8

which can be generalized as Y(·)=U^T(·)*{circumflex over (θ)}  Eqn. 9 where {circumflex over (θ)}=[n₁, n₂, d₁, d₂] is the parameter vector and Y(·), U^T(·) are known (i.e., measured).

Since d₁, and d₂ are not functions of m and h, d₁ and d₂ can be calculated in advance so that only n₁ and n₂ need to be estimated. Observing that n₁=n₂, the inverse z transform of the transfer function is Y(k)+d₁Y(k−1)+d₂Y(k−2)=n₁[U(k−1)−U(k−2)],   Eqn. 10 In this way, the variables of Eqn. 9 are scalar. The estimated parameter n₁ is a function of the vehicle mass and moment of inertia of the body about the roll axis.

Turning again to FIG. 1, the system 10 detects a lateral acceleration U from accelerometer 13 and a roll rate Y from a roll rate sensor 15 and estimates a mass distribution parameter n₁. The system 10 then multiplies the mass distribution parameter n₁ with the lateral acceleration U in a multiplier 12 to define an estimated roll rate Ŷ. The roll rate Y is compared in a comparator 14 with the estimated roll rate Ŷ to define an error parameter e. The system 10 includes a tuning filter 16 which multiplies the error parameter e with the gain γ of the tuning filter 12 to define a revised mass distribution parameter {circumflex over (n)}₁. The system 10 also includes a second comparator 18 which compares the revised mass distribution parameter {circumflex over (n)}₁ with the estimated mass distribution parameter n₁ to define a tuned mass distribution parameter n*₁ that is introduced to the rollover stability control system 11.

The estimate for the mass distribution parameter n₁ can be performed by a recursive least squares (RLS) method or any other suitable method. An example of an RLS algorithm used in conjunction with the system shown in FIG. 1 is phi=P*u; gamma(k)=phi/(u*phi+lambda); Y_hat(k)=u*n_hat(:,k−2); n_hat(:,k−1)=n_hat(:,k−2)+gamma(k)*(Y(k)−Y_hat(k)); if (abs(U(k))>3 n_hat(:,k−1)=n_hat(:,k−2);

• • endif % if P=(eye(sysorder)−gamma(k)*u)*P/lamda; where the inputs:
  • U(k) is the current measured lateral acceleration, u=(U(k−1)−U(k−2)), and Y(k)=current measured roll rate; the estimates:
  • Y_hat(k) is the estimated value of the left hand side of Eqn. 10, and
  • n_hat(k) is the estimated value of n₁; the tunable parameters:
  • P is the convariance matrix in which the only initial condition, P(0), is chosen,
  • Lambda is a forgetting factor which lets the algorithm rely less on the older estimated values, and
  • the value “3” is a number to which U(k) is compare is also a tunable value depending on the roll model employed; and the other variables:
  • phi is an intermediate variable used to simplify the notation and reduce processing time,
  • gamma(k) is the gain,
  • k is the current time step, such that k−1 is the prior time step, and k−2 is two steps prior,
  • sysorder is the order of the system to be estimated, which in this case is one,
  • eye is the identity matrix, and
  • abs is the absolute value.

Other embodiments are within the scope of the following claims.

Claims

1. A method of protecting against rollover in a motor vehicle, the method comprising: detecting a lateral acceleration of the motor vehicle; detecting a roll rate of the motor vehicle; estimating a mass distribution parameter; generating a tuned mass distribution parameter based on the lateral acceleration, the roll rate, and the mass distribution parameter; and introducing the tuned mass distribution parameter to a rollover stability control system of the motor vehicle.

2. The method of claim 1 further comprising generating a revised mass distribution parameter, the tuned mass distribution parameter being based on the lateral acceleration, the roll rate, and a comparison between the mass distribution parameter and the revised mass distribution parameter.

3. The method of claim 2 further comprising multiplying the mass distribution parameter with the lateral acceleration of the motor vehicle to define an estimated roll rate, the revised mass distribution parameter being based on the estimated roll rate.

4. The method of claim 3 further comprising comparing the roll rate with the estimated roll rate to define an error parameter.

5. The method of claim 5 further comprising multiplying the error parameter with the gain of a tuning filter to define the revised mass distribution parameter;

6. A system of protecting against rollover in a vehicle, comprising: a sensor which measures a lateral acceleration of the vehicle; a second sensor which measures a roll rate of the vehicle; a multiplier which multiplies an estimated mass distribution parameter with the lateral acceleration to define an estimated roll rate; and a comparator which receives information regarding the roll rate, the estimated roll rate, and the estimated mass distribution parameter and generates a tuned mass distribution parameter that is transmitted to a rollover stability control system of the vehicle.

7. The system of claim 6 further comprising a second comparator which compares the roll rate with the estimated roll rate to define an error, the information received by the first comparator being based on the error and the estimated mass distribution parameter.

8. The system of claim 7 further comprising a tuning filter which multiplies the error with a gain to define a revised mass distribution parameter.

9. The system of claim 8 wherein the first comparator compares the revised mass distribution parameter with the estimated distribution parameter to define the tuned mass distribution parameter.