Attitude sensing system for an automotive vehicle relative to the road

Abstract

A system (18) for controlling a system or device (44) of an automotive vehicle (10) includes a roll rate sensor (34). A controller (26) determines a lateral velocity of the automotive vehicle (10) in response to the roll rate. The controller (26) also controls the vehicle system or device (44) in response to the lateral velocity.

Description

TECHNICAL FIELD

The present invention relates generally to a control apparatus for controlling a system of an automotive vehicle in response to sensed dynamic behavior and, more specifically, to a method and apparatus for controlling the system of the automotive vehicle by determining an attitude of the vehicle.

BACKGROUND

In recent years, many vehicle control systems have been developed to enhance vehicle stability and tracking performance in critical dynamic situations. Such vehicle control systems include yaw stability control (YSC) systems, roll stability control (RSC) systems, integrated vehicle dynamic control systems, and others. In these systems, knowledge of the vehicle roll and pitch attitude is very important. For example, in yaw stability control systems, the effect of vehicle body roll and pitch, as well as the dynamically changing road super-elevations and road grades, is significant because it directly influences both the vehicle lateral dynamics and lateral acceleration measurements. In roll stability control systems, roll angle is one of the most important variables used to construct feedback pressure command and combat the detected roll instability. Hence, a successful vehicle dynamics control must involve an accurate determination of the vehicle roll and pitch attitude. However, values of roll and pitch are not directly measured on production vehicles and therefore must be estimated instead.

When actively controlling a vehicle's motion using systems such as the braking system, it is important to accurately estimate the state and attitudes of the vehicle. Achieving an accurate sideslip estimate will provide the opportunity to control the vehicle's sideslip to an appropriate value. To those familiar with the art, it is known that sideslip is difficult to determine using inertial sensors due mainly to integration drift, which is caused by sensor offset and contamination of the lateral acceleration signal by gravity. To accurately account for the acceleration due to gravity, it is necessary to know the global roll angle. A roll rate sensor alone can give you an indication of global roll angle, but due to offsets in the roll rate sensor and inaccuracy in the pitch estimate, the error in the global roll angle can quickly accumulate. Therefore, it would be desirable to control this accumulation of error.

SUMMARY OF THE INVENTION

The present invention includes a method to control and account for the accumulation of error in the global roll estimate, and thereby allow for the same in the side slip estimate. This is done through the use of a roll rate sensor and leveraging properties of land vehicle tires. There are several areas in which the teaching of the present invention may be applied. One is for improving side slip estimation using a roll rate sensor. Another is for leveraging linear sideslip angle of the tire to correct for errors in the global roll angle. Yet another is for tire relaxation in the linear sideslip estimate, And yet another is for improving global pitch angle by using improved sideslip estimate. Still another is for accounting for errors in pitch, roll, and sideslip by using robust bounds on each signal.

In one aspect of the invention, a method of controlling a vehicle system comprises determining a vehicle roll rate, determining a lateral velocity of the vehicle in response to the roll rate, and controlling the vehicle system in response to the lateral velocity. It should be noted that the lateral velocity may be used in conjunction with a longitudinal velocity and the controlling may be performed in response to a side slip angle determined in response to the lateral velocity and the longitudinal velocity.

In a further aspect of the invention, a method of controlling a vehicle system includes determining an upper bound pitch angle and a lower bound pitch angle, determining an upper bound roll angle corresponding to the upper bound pitch angle and a lower bound pitch angle corresponding to the lower bound pitch angle. The method further includes determining a lower bound lateral velocity corresponding to the lower bound roll angle and an upper bound lateral velocity corresponding to the upper bound roll angle. The method further includes determining a linear lateral velocity of the vehicle and, when the lower bound lateral velocity is below the linear lateral velocity, adjusting the lower bound to the linear lateral velocity for an adjusted lower bound lateral velocity. In response to the adjusted lower bound lateral velocity, the vehicle system is controlled.

In yet another aspect of the invention, a system for controlling a vehicle system of an automotive vehicle comprises a roll rate sensor for generating a roll rate signal and also a controller coupled to the roll rate sensor. The controller determines a lateral velocity of the automotive vehicle in response to the roll rate signal. The controller also controls the vehicle system in response to the lateral velocity.

Other advantages and features of the present invention will become apparent when viewed in light of the detailed description of the preferred embodiment when taken in conjunction with the attached drawings and appended claims.

BRIEF DESCRIPTION OF THE DRAWINGS

FIG. 1 is a diagrammatic view of a vehicle with variable vectors and coordinator frames according to the present invention.

FIG. 2 is a block diagram of a stability system according to the present invention.

FIG. 3 is a front view of an automotive vehicle illustrating various angles according to the present invention.

FIG. 4 is a side view of an automotive vehicle illustrating various variables thereon.

FIG. 5 is a top view of a motor vehicle illustrating various operating parameters of a vehicle experiencing a turning maneuver on a road surface.

FIG. 6 is a block diagrammatic view of the controller of FIG. 2 according to the present invention.

FIG. 7 is a flow chart illustrating a method of controlling a vehicle system in accordance with the present invention.

FIG. 8 is a plot illustrating error in dV_x caused by longitudinal tire slip in a global pitch determination.

FIG. 9 is a plot of force versus slip angle for a tire illustrating invalid ranges for tire force at a given slip angle.

FIG. 10 are timing plots of the correction strategy for lateral velocity and the global roll angle.

DETAILED DESCRIPTION

In the following figures the same reference numerals will be used to identify the same components.

The present invention may be used in conjunction with a rollover control system or a yaw control system for a vehicle. However, the present invention may also be used with a deployment device such as airbag or roll bar. The present invention will be discussed below in terms of preferred embodiments relating to an automotive vehicle moving in a three-dimensional road terrain.

Referring to FIG. 1, an automotive vehicle 10 with a safety system of the present invention is illustrated with the various forces and moments thereon during a rollover condition. Vehicle 10 has front right and front left tires 12a and 12b and rear right tires 13a and left rear tires 13b respectively. The vehicle 10 may also have a number of different types of front steering systems 14a and rear steering systems 14b including having each of the front and rear wheels configured with a respective controllable actuator, the front and rear wheels having a conventional type system in which both of the front wheels are controlled together and both of the rear wheels are controlled together, a system having conventional front steering and independently controllable rear steering for each of the wheels or vice versa. Generally, the vehicle has a weight represented as Mg at the center of gravity of the vehicle, where g=9.8 m/s² and M is the total mass of the vehicle.

As mentioned above, the system may also be used with active/semi-active suspension systems, anti-roll bar or other safety devices deployed or activated upon sensing predetermined dynamic conditions of the vehicle.

The sensing system 16 is coupled to a control system 18. The sensing system 16 may use a standard yaw stability control sensor set (including lateral accelerometer, yaw rate sensor, steering angle sensor and wheel speed sensor) together with a roll rate sensor and a longitudinal accelerometer. The various sensors will be further described below. The wheel speed sensors 20 are mounted at each corner of the vehicle, and the rest of the sensors of sensing system 16 are preferably mounted directly on the center of gravity of the vehicle body, along the directions x,y and z shown in FIG. 1. As those skilled in the art will recognize, the frame from b₁, b₂ and b₃ is called a body frame 22, whose origin is located at the center of gravity of the car body, with the b₁ corresponding to the x axis pointing forward, b₂ corresponding to the y axis pointing off the driving side (to the left), and the b₃ corresponding to the z axis pointing upward. The angular rates of the car body are denoted about their respective axes as ω_x for the roll rate, ω_y for the pitch rate and ω_z for the yaw rate. The present invention calculations preferably take place in an inertial frame 24 that may be derived from the body frame 22 as described below.

The angular rate sensors and the accelerometers are mounted on the vehicle car body along the body frame directions b₁, b₂ and b₃, which are the x-y-z axes of the vehicle's sprung mass.

The longitudinal acceleration sensor is mounted on the car body located at the center of gravity, with its sensing direction along b₁-axis, whose output is denoted as a_x. The lateral acceleration sensor is mounted on the car body located at the center of gravity, with its sensing direction along b₂-axis, whose output is denoted as a_y.

The other frame used in the following discussion includes the road frame, as depicted in FIG. 1. The road frame system r₁r₂r₃ is fixed on the driven road surface, where the r₃ axis is along the average road normal direction computed from the normal directions of the four tire/road contact patches.

In the following discussion, the Euler angles of the body frame b₁b₂b₃ with respect to the road frame r₁r₂r₃ are denoted as θ_xbr, θ_ybr and θ_zbr, which are also called the relative Euler angles.

Referring now to FIG. 2, roll stability control system 18 is illustrated in further detail having a controller 26 used for receiving information from a number of sensors which may include speed sensors 20, a yaw rate sensor 28, a lateral acceleration sensor 32, a roll rate sensor 34, a vertical acceleration sensor 35, a longitudinal acceleration sensor 36, and steering angle position sensor 38.

In the preferred embodiment the sensors are located at the center of gravity of the vehicle. Those skilled in the art will recognize that the sensor may also be located off the center of gravity and translated equivalently thereto.

Lateral acceleration, roll orientation and speed may be obtained using a global positioning system (GPS). Based upon inputs from the sensors, controller 26 may control a safety device 44. Depending on the desired sensitivity of the system and various other factors, not all the sensors 28-38 may be used in a commercial embodiment. Safety device 44 is part of a vehicle subsystem control. Safety device 44 may control a passive safety device 46 such as an airbag or a steering actuator 48, a braking actuator 50 at one or more of the wheels 12a, 12b, 13a, 13b of the vehicle. Engine intervention 52 may act to reduce engine power to provide a safety function. Also, other vehicle components such as a suspension control 54 may be used to adjust the suspension to prevent rollover.

Roll rate sensor 34 may sense the roll condition of the vehicle based on sensing the height of one or more points on the vehicle relative to the road surface. Sensors that may be used to achieve this include a radar-based proximity sensor, a laser-based proximity sensor and a sonar-based proximity sensor.

Roll rate sensor 34 may also sense the roll condition based on sensing the linear or rotational relative displacement or displacement velocity of one or more of the suspension chassis components which may include a linear height or travel sensor, a rotary height or travel sensor, a wheel speed sensor used to look for a change in velocity, a steering wheel position sensor, a steering wheel velocity sensor and a driver heading command input from an electronic component that may include steer by wire using a hand wheel or joy stick.

The roll condition may also be sensed by sensing the force or torque associated with the loading condition of one or more suspension or chassis components including a pressure transducer in an act of air suspension, a shock absorber sensor such as a load cell, a strain gauge, the steering system absolute or relative motor load, the steering system pressure of the hydraulic lines, a tire laterally force sensor or sensors, a longitudinal tire force sensor, a vertical tire force sensor or a tire sidewall torsion sensor.

The roll condition of the vehicle may also be established by one or more of the following translational or rotational positions, velocities or accelerations of the vehicle including a roll gyro, the roll rate sensor 34, the yaw rate sensor 28, the lateral acceleration sensor 32, a vertical acceleration sensor, a vehicle longitudinal acceleration sensor, lateral or vertical speed sensor including a wheel-based speed sensor, a radar-based speed sensor, a sonar-based speed sensor, a laser-based speed sensor or an optical-based speed sensor.

Steering control 48 may control the position of the front right wheel actuator, the front left wheel actuator, the rear left wheel actuator, and the right rear wheel actuator. Although as described above, two or more of the actuators may be simultaneously controlled. For example, in a rack-and-pinion system, the two wheels coupled thereto are simultaneously controlled. Based on the inputs from sensors 28 through 38, controller 26 determines a roll condition and controls the steering position of the wheels.

Speed sensor 20 may be one of a variety of speed sensors known to those skilled in the art. For example, a suitable speed sensor may include a sensor at every wheel that is averaged by controller 26. Preferably, the controller translates the wheel speeds into the speed of the vehicle. Yaw rate, steering angle, wheel speed and possibly a slip angle estimate at each wheel may be translated back to the speed of the vehicle at the center of gravity. Various other algorithms are known to those skilled in the art. Speed may also be obtained from a transmission sensor. For example, if speed is determined while speeding up or braking around a corner, the lowest or highest wheel speed may not be used because of its error. Also, a transmission sensor may be used to determine vehicle speed.

Referring now to FIG. 3, the relationship of the various angles of the vehicle 10 relative to the road surface 11 is illustrated. In the following, a reference road bank angle θ_bank is shown relative to the vehicle 10 on a road surface 11. The vehicle has a vehicle body 10a and wheel axle 10b. The wheel departure angle θ_wda is the angle between the wheel axle and the road. The relative roll angle θ_xr is the angle between the wheel axle 10b and the body 10a. The global roll angle θ_x is the angle between the horizontal plane (e.g., at sea level) and the vehicle body 10a.

During an event causing the vehicle to roll, the vehicle body is subject to a roll moment due to the coupling of the lateral tire force and the lateral acceleration applied to the center of gravity of vehicle body. This roll moment causes suspension height variation, which in turn results in a vehicle relative roll angle (also called chassis roll angle or suspension roll angle). The relative roll angle is an important variable that is used as an input to the activation criteria and to construct the feedback brake pressure command, since it captures the relative roll between the vehicle body and the axle. The sum of such a chassis roll angle and the roll angle between wheel axle and the road surface (called wheel departure angle) provides the roll angle between the vehicle body and the average road surface, which is one of the important variables feeding back to the roll stability control module.

The relative or chassis roll angle and the relative pitch angle can be calculated as in U.S. Pat. No. 6,556,908 using the lateral acceleration of the center of gravity of the vehicle body, the roll angular acceleration, and the roll angular velocity, together with vehicle-specific parameters such as the sprung mass, the vehicle body roll moment of inertia, the roll stiffness and damping ratio of the suspensions and the anti-roll-bars, and the distance between the center of gravity of the vehicle body and the floor of the vehicle body. The disclosure of U.S. Pat. No. 6,556,908 is hereby incorporated by reference.

Referring now to FIGS. 4 and 5, an automotive vehicle 10 is illustrated with various parameters illustrated thereon. The side view of automotive vehicle 10 is illustrated. A front suspension 82 and a rear suspension 82r is illustrated. The suspensions are coupled to the body at a respective suspension point 84f, 84r. The distance from the suspension point 84f to the center of the wheel is labeled z_sh. The distance from the center of gravity CG to the front suspension is labeled as b_f. The distance from the CG to the rear suspension point 84r is labeled as b_r. The vertical distance between the center of gravity and the suspension point are labeled respectively as h_f and h_r. A portion of the body axis b₃ and the road axis r₃ are illustrated. The angle therebetween is the relative pitch angle θ_yr. The rolling radius of the tire is labeled as z_w. The global pitch angle is θ_y.

Referring now to FIG. 5, a top view of vehicle 10. Those skilled in the art will immediately recognize the basic physics represented by these illustrations, thereby making the adaptation to different types of vehicles easily within their reach. Lateral and longitudinal velocities of the center of gravity are denoted as V_x and V_y, a yaw angular rate is denoted as ω_z, a front wheel steering angle is denoted as δ, lateral acceleration is represented by a_y, and longitudinal acceleration is represented by a_x.

The following description addresses the determination of a side slip angle used for controlling a system of the vehicle. The side slip angle is the arc tangent of the longitudinal velocity divided by the lateral velocity.

Referring now to FIG. 6, a block diagrammatic view of controller 26 is illustrated. A pitch estimator 100 is used to generate a maximum or upper global pitch angle boundary θ_ymax and a lower global pitch angle boundary θ_ymin. These signals are coupled to a roll estimator 102 that is used to generate a maximum and minimum global roll estimate for the vehicle. The maximum global roll estimate may be modified in the correction box 104. That is, the maximum global roll angle may be modified by the linear lateral velocity as will be further described below. The minimum global roll angle is provided to the lateral velocity estimator 106. It should be noted that the roll estimator maximum or upper boundary, and minimum or lower boundary are derived respectively from the pitch global roll angles. The lateral velocity estimator generates a minimum lateral velocity from the maximum global roll angle. The minimum and maximum lateral velocity is provided to a tire relaxation delay box 108. The tire relaxation delay box 108 generates a filtered lateral velocity that accounts for tire relaxation. A linear lateral velocity block 110 has an output v_ylin corresponds to the lateral velocity at the rear axle calculated from the tire properties. The signals from box 108 and 110 are provided to box 112, which corrects the minimum lateral velocity at the rear axle calculated from the inertial sensors provides these signals to the roll estimator 102, the pitch estimator 100, and the correction box 104. As will further be described below, when the minimum lateral velocity falls below the linear lateral velocity, the linear lateral velocity is used in the calculation.

The following variables are used throughout this description:

V_x≡Longitudinal velocity calculated from the reference velocity module (from the wheel speed sensors)

• dV_x≡Time derivative of longitudinal velocity (V_x)
• V_y≡Lateral velocity at the sensor cluster
• A_x≡Longitudinal acceleration measured by the vehicle longitudinal acceleration sensor
• r≡dynamic rolling radius
• ω≡raw wheel speed from the wheel speed sensor
• α≡slip angle of the tire
• N≡Normal force on a tire
• V_ymax≡Maximum lateral velocity at the rear axel calculated from the inertial sensors
• V_ynom≡Nominal lateral velocity at the rear axel calculated from the inertial sensors
• V_ymin≡Minimum lateral velocity at the rear axel calculated from the inertial sensors
• V_ylin≡Linear lateral velocity at the rear axel calculated from tire properties
• V_ymin_lag≡V_ymin, filtered to account for tire relaxation
• V_ymin_corr≡V_ymin, corrected for V_ylin
• θ_x≡Global/Euler Roll Angle
• θ_y≡Global/Euler Pitch Angle
• ω_x≡Roll rate measured by the vehicle roll rate sensor
• ω_z≡Yaw rate measured by the vehicle yaw rate sensor
• g≡Acceleration due to gravity

The present invention is applicable to any sign combination of lateral velocity and roll angle, but for simplicity, this description is written for a vehicle in a right-hand turn (negative ω_z and positive V_y) and a leftward bank angle (negative θ_x). For a turn in the opposite direction, similar calculations would be used, but V_ymax would be used in place of V_ymin.

Referring now to FIG. 7, sensors are read in step 120 to obtain their associated signals. The sensor signals may be filtered, fault checked and plausibility checked prior to use below. In step 122 the longitudinal velocity is determined. Various methods for determining longitudinal velocity of a vehicle are known. A method for correcting longitudinal velocity is set forth below.

The other variable needed for a side slip angle determination is the lateral velocity. The lateral velocity of a land vehicle can be calculated from the inertial sensor output and the previous vehicle state. In this embodiment, it can be estimated by integrating either equation 1 or 2.dVy/dt=A_y−ω_zV_x−g cos θ_y sin θ_x  (1)or removing the less significant pitch termdVy/dt≈A_y−ω_zV_x−g sin θ_x  (2)where θ_x can be found by integrating Equation (4),dθ_x/dt=ω_x+(ω_z sin θ_x+ω_z cos θ_x)tan θ_y  (3)removing the less significant terms, and using a small angle approximation,dθ_x/dt=ω_x+θ_yω_z  (4)

Determining Global Pitch Angle

From Equation (4), the unknown is the global pitch angle θ_y is determined in step 124. The yaw rate ω_z and roll rate are determined from the various sensors. To those skilled in the art, it is know that the instantaneous global pitch angle of a vehicle can be estimated using the following equation:θ_y=arcsin((dV_x−A_x−ω_zV_y)/g)  (5)

The longitudinal acceleration, A_x, and the yaw rate, ω_z, are trivial to determine since they are available sensor signals. Accurately determining the vehicle longitudinal acceleration, dV_x, from the wheel speed sensors is desirable. However, if some error can be tolerated the wheel speed sensors alone may be used. A more accurate result is desirable and is sets forth below. That is, when actively controlling vehicle motion using systems such as the braking system, it is important to accurately estimate the state and attitude of the vehicle. The reference velocity is based off of raw wheel speeds and is an important part of the global pitch equation. The global pitch estimate becomes inaccurate during mid to high brake torque gradients because the wheels decelerate at a faster rate than the vehicle until the longitudinal slip ratio reaches equilibrium. The global pitch estimate becomes inaccurate during this transient period because the reference velocity follows the decelerating wheels instead of the actual deceleration of the vehicle.

Accounting for Longitudinal Slip in the Reference Velocity Calculation

The time derivative of the longitudinal velocity, dV_x, can often be inaccurate due to brake and drive torque which creates longitudinal slip on the tires.

In order for a tire to produce a longitudinal force, it must have a longitudinal slip, Y. Defined asY≡(V_x−r·ω)/V_x  (6)

Due to this tire property, a high brake torque gradient will cause the wheel speeds to decelerate faster than the vehicle, as shown in FIG. 8.

This error in dV_x will cause large errors in estimated global pitch angle. Patent application Ser. No. 10/710,248 filed Jun. 29, 2004, (that is incorporated by reference herein) describes an effective way to produce a reliable longitudinal velocity V_x signal. In order to create a dV_x signal appropriate for use in the pitch equation, the V_x signal is modified to take into account this error caused by linear longitudinal slip.

The longitudinal force, F_x, on any given tire can be described the following equation.F_x=C_xYN  (7)

C_x is a function of tire side slip angle, and can be approximated as follows:C_x=C_xNOM−C_{x α}α  (8)

Where C_{x α} and C_xNOM are constants based on tire properties. Combining Equations (7) and (8), F_x is a function of Normal force N, slip angle α, slip ratio γ, and two tire constants C_xNOM and C_{x α}.F_x=(C_xNOM−C_{x α}α)·YN  (9)

Solving for slip ratioY=F_x/(N·(C_xNOM−C_xαα))  (10)

In a roll stability control system, everything on the right side of this equation is known, or can be determined empirically. Therefore, using this equation, an estimate of the slip ratio at each wheel may be determined. It is important to note that this equation describes the linear portion of the slip-force curve, and therefore will never overestimate the slip ratio.

Finally, correct the wheel speed for each wheel by using the definition of the slip ratio. Equation (11) is shown for the front left wheel. Each of the other wheels may be determined in a similar manner.V_{xCORRECTED FL}=r·ω/(1−Y)  (11)

The vehicle reference velocity calculations as described in patent application Ser. No. 10/710,248 can then be performed using V_xCORRECRED for each of the wheels, instead of the raw wheel speeds.

To summarize, when the applied wheel torque is small enough to allow a wheel to remain in its linear slip range, the wheel speed will be accurately corrected to the vehicle's actual speed. When the applied wheel torque causes more slip than predicted (i.e. Low mu), the corrected wheel speed will be closer to the actual vehicle speed than the raw wheel speed, but will not totally account the extreme slip ratio caused by the low mu.

Until this invention, the reference velocity of a vehicle has been based off of raw wheel speeds. Using this method it is possible to correct (at least, partially) the raw wheel speed for the theoretical longitudinal slip ratio. This so called, “corrected wheel speed”, should have a value closer to the actual longitudinal speed of the vehicle and therefore will provide the reference velocity calculation a more accurate indication of forward velocity.

Once the longitudinal velocity of the vehicle is known, Equation (5) can be used to determine the global pitch angle. This may in turn be used to determine the global roll angle in Equation (4). In step 126, the process is executed three times, once for each of θ_xmax, θ_xmin, and θ_xnom. The max and min values are maximum and minimum values corresponding to the sensor tolerances used in the determination of θ_y. The max and min values are determined from the nominal values plus or minus the tolerance. These values correspond to V_ymin, V_ymax, and V_ynom from Equation (2). Since these V_y signals are from the inertial sensor information, they have no phase delay and can be considered the nominal lateral velocity and its robust bounds. All three values tend to drift over time due to uncertainties and offsets accumulated over the period of integration.

In step 128 a linear lateral velocity is determined. The linear lateral velocity (V_y-lin) is based on the tire properties described in FIG. 9. Mainly, the sign of the lateral force of a tire opposes the sign of the sideslip angle. Additionally, there is a minimum slip angle required in order to generate a given lateral force. This minimum slip angle is proportional to the lateral force. Because tire lateral forces can saturate on a given mu level, an upper bound on the slip angle for a given lateral force is not assumed.

In equation form, and using a small angle approximation for arc tangent,V_y-lin=V_x*RearCorneringCompliance*A_yrear_axle  (12)

This relationship is valid for steady state conditions, however, in a dynamic situation, there is a delay between the build up of lateral velocity and the onset of lateral acceleration. This is referred to as the “tire relaxation.”

Due to the tire relaxation delay, it is not possible to compare the lateral velocity from the inertial measurements directly to the lateral velocity calculated from the tire properties. Therefore, the inertial lateral velocity is delayed using a first order filter which approximates the effects of the tire relaxation. This process produces V_yminlag which can be compared directly to V_ylin. If V_ylin is greater than V_yminlag, it is known that V_ymin cannot be correct due to the tire property described in FIG. 9. V_ymin is then corrected, by forcing it towards the V_ylin value. V_ymin will be corrected at t₁ in FIG. 10, using the following equations:ΔV_ymin=V_yminlag−V_ylin  (13)V_ymin₂=V_ymin₁−ΔV_ymin  (14)

The knowledge that V_ymin is incorrect can provide input to the global roll calculation of Equation (4) in step 132. The three global roll angles θ_xmax, θ_xmin, and θ_xnom are calculated using the process described in patent application Ser. No. 10/752,741 filed Jan. 7, 2004, which is incorporated by reference herein, with the exception that the θ_xmax value can be corrected when it is determined that V_ylin exceeds V_ymin. This is because the primary source of uncertainty in Equation (2) is the global roll angle, it can be assumed that any error in V_ymin can be attributed to an error in θ_xmax. Therefore, θ_xmax can be corrected appropriately whenever V_ymin is corrected.

In the general form, ΔV_ymin is a complex function of the time history of roll error, speed, pitch error, and yaw rate. A simplifying assumption that global roll rate is constant over the interval for which V_ymin is exceeded by V_ylin is made. This allows for a relatively straight forward adjustment of θ_xmax based on ΔV_ymin using linear interpolation. Equation (15) completes this interpolation and FIG. 10 shows one of the ways that this process will reduce the lateral velocity and global roll uncertainties in step 134.θ_xmax₂=θ_xmax₁−(θ_xmax−θ_xmin)·ΔV_ymin/(V_ymax−V_ymin)  (15)

The example above illustrates one scenario where the uncertainties in lateral velocity and global roll angle are reduced. A second scenario occurs whenever V_ylin makes a zero crossing. At that time V_ymax will be corrected to V_ylin (instead of V_ymin being corrected). Therefore, any time there is a zero crossing, the uncertainties on lateral velocity and global roll angle will tend to collapse to very small values.

The global pitch angle module can benefit from an improved lateral velocity estimate. The difficulty with feeding the nominal lateral velocity back into the pitch calculation is that it is possible to create an unstable system. In order to remove that instability from the system, the minimum lateral velocity is feed back into pitch calculation. Even though minimum lateral velocity will still underestimate actual lateral velocity, it will provide an improvement to the pitch calculation over the using V_ylin, which often drastically underestimates V_y.

In step 136 the adjusted lateral velocity and the longitudinal velocity are used to determine the side slip angle. In step 138 a vehicle system is controlled in response to the side slip angle. It should also be noted that various vehicle systems may be controlled in response to the adjusted lateral velocity, the adjusted roll angle, and the like. Also, it should be noted that various vehicle systems such as safety systems that include dynamic control systems which in themselves may include a yaw stability control or roll stability control systems may be controlled.

While the invention has been described in connection with one or more embodiments, it should be understood that the invention is not limited to those embodiments. On the contrary, the invention is intended to cover all alternatives, modifications, and equivalents, as may be included within the spirit and scope of the appended claims.

Claims

1. A method of controlling a system onboard a vehicle having wheels, said method comprising the steps of: determining the speed of each of said wheels on said vehicle;determining the longitudinal velocity of said vehicle;determining the longitudinal slip of each of said wheels;determining the longitudinal acceleration of said vehicle;determining the yaw rate of said vehicle;determining the roll rate of said vehicle;estimating the pitch angle of said vehicle from said longitudinal velocity, said longitudinal slip, and said longitudinal acceleration;estimating the roll angle of said vehicle from said yaw rate, said roll rate, and said pitch angle;estimating the lateral velocity of said vehicle from said roll angle;estimating a slip angle from said longitudinal velocity and said lateral velocity; andcontrolling said system onboard said vehicle according to said slip angle.

2. A method of controlling a system onboard a vehicle as recited in claim 1, said method further comprising the step of adjusting said lateral velocity so as to approximate the effects of tire relaxation on said wheels.

3. A method of controlling a system onboard a vehicle as recited in claim 1, wherein said slip angle is a side slip angle.

4. A method of controlling a system onboard a vehicle as recited in claim 1, wherein said lateral velocity is estimated from signals received from at least one inertial sensor onboard said vehicle.

5. A method of controlling a system onboard a vehicle as recited in claim 1, said method further comprising the step of adjusting said lateral velocity according to the properties of tires on said wheels.

6. A method of controlling a system onboard a vehicle as recited in claim 1, said method further comprising the steps of: calculating a linear lateral velocity; andadjusting the estimated lateral velocity with said linear lateral velocity.

7. A method of controlling a system onboard a vehicle as recited in claim 6, wherein said linear lateral velocity is calculated based on the properties of tires on said wheels.

8. A method of controlling a system onboard a vehicle as recited in claim 1, said method further comprising the steps of: calculating a linear lateral velocity; andadjusting the estimated roll angle based on said linear lateral velocity.

9. A method of controlling a system onboard a vehicle as recited in claim 1, wherein said longitudinal slip of each of said wheels is determined from said speed of each of said wheels and said longitudinal velocity of said vehicle.

10. A method of controlling a system onboard a vehicle as recited in claim 1, wherein said longitudinal slip of each of said wheels is determined from the properties of tires on said wheels.

11. A method of controlling a system onboard a vehicle as recited in claim 1, wherein said system comprises a safety device.

12. A method of controlling a system onboard a vehicle as recited in claim 1, wherein said system comprises a dynamic control system.

13. A method of controlling a system onboard a vehicle as recited in claim 1, wherein said system comprises a roll stability control system.

14. A method of controlling a system onboard a vehicle as recited in claim 1, wherein said system comprises a yaw stability control system.

15. A method of controlling a system on a vehicle, said method comprising the steps of: determining an upper bound pitch angle and a lower bound pitch angle;determining an upper bound roll angle corresponding to said upper bound pitch angle and a lower bound roll angle corresponding to said lower bound pitch angle;determining a lower bound lateral velocity corresponding to said lower bound roll angle and an upper bound lateral velocity corresponding to said upper bound roll angle;determining a linear lateral velocity of said vehicle;when said lower bound lateral velocity is below said linear lateral velocity, adjusting said lower bound lateral velocity to said linear lateral velocity to form an adjusted lower bound lateral velocity; andcontrolling said system on said vehicle in response to said adjusted lower bound lateral velocity.

16. A method of controlling a system on a vehicle as recited in claim 15, said method further comprising the step of: when said linear lateral velocity crosses zero, adjusting said upper bound lateral velocity to said linear lateral velocity.

17. A method of controlling a system on a vehicle as recited in claim 15, said method further comprising the step of: adjusting a global roll angle to form an adjusted global roll angle in response to said upper bound roll angle in response to the adjusted lower bound; andwherein the step of controlling comprises controlling said system on said vehicle in response to said adjusted global roll angle.

18. A method of controlling a system on a vehicle as recited in claim 17, said method further comprising the steps of: determining a side slip angle in response to said adjusted global roll angle; andcontrolling said system on said vehicle in response to said side slip angle.

19. A method of controlling a system on a vehicle as recited in claim 15, said method further comprising the step of: determining an adjusted lateral velocity in response to tire characteristics.

20. A method of controlling a system on a vehicle as recited in claim 15, wherein said system on said vehicle comprises a safety system.

21. A method of controlling a system on a vehicle as recited in claim 15, wherein said system on said vehicle comprises a dynamic control system.

22. A method of controlling a system on a vehicle as recited in claim 21, wherein said dynamic control system comprises a roll stability control system.

23. A method of controlling a system on a vehicle as recited in claim 21, wherein said dynamic control system comprises a yaw stability control system.

24. A method of controlling a system on a vehicle as recited in claim 15, wherein said linear lateral velocity corresponds to tire properties of said vehicle.

25. A system for controlling a device onboard a vehicle having wheels, said system comprising: a plurality of wheel speed sensors for generating wheel speed signals;a longitudinal acceleration sensor for generating a longitudinal acceleration signal;a yaw rate sensor for generating a yaw rate signal;a roll rate sensor for generating a roll rate signal; anda controller for being coupled to said device, said wheel speed sensors, said longitudinal acceleration sensor, said yaw rate sensor, and said roll rate sensor;wherein said controller is operable to:determine the speed of each of said wheels on said vehicle;determine the longitudinal velocity of said vehicle;determine the longitudinal slip of each of said wheels;determine the longitudinal acceleration of said vehicle;determine the yaw rate of said vehicle;determine the roll rate of said vehicle;estimate the pitch angle of said vehicle from said longitudinal velocity, said longitudinal slip, and said longitudinal acceleration;estimate the roll angle of said vehicle from said yaw rate, said roll rate, and said pitch angle;estimate the lateral velocity of said vehicle from said roll angle;estimate a slip angle from said longitudinal velocity and said lateral velocity; andcontrol said device onboard said vehicle according to said slip angle.

26. A system as recited in claim 25, wherein said controller is further operable to adjust said lateral velocity so as to approximate the effects of tire relaxation on said wheels.

27. A system as recited in claim 25, said system further comprising a longitudinal velocity sensor for generating a longitudinal velocity signal, wherein said controller is operable to determine said longitudinal velocity of said vehicle from said longitudinal velocity signal.

28. A system as recited in claim 25, said system further comprising at least one inertial sensor coupled to said controller, wherein said controller is operable to estimate said lateral velocity of said vehicle based on signals received from at least one said inertial sensor.

29. A system as recited in claim 25, wherein said controller is operable to calculate a linear lateral velocity and adjust the estimated lateral velocity with said linear lateral velocity.

30. A system as recited in claim 25, wherein said controller is operable to calculate a linear lateral velocity and adjust the estimated roll angle based on said linear lateral velocity.

31. A system as recited in claim 25, wherein said controller is operable to determine said longitudinal velocity from said wheel speed signals.