Publication number | US6725140 B2 |

Publication type | Grant |

Application number | US 10/140,240 |

Publication date | Apr 20, 2004 |

Filing date | May 7, 2002 |

Priority date | May 7, 2002 |

Fee status | Paid |

Also published as | DE10320544A1, DE10320544B4, US20030212482 |

Publication number | 10140240, 140240, US 6725140 B2, US 6725140B2, US-B2-6725140, US6725140 B2, US6725140B2 |

Inventors | Jianbo Lu, Todd Allen Brown |

Original Assignee | Ford Global Technologies, Llc |

Export Citation | BiBTeX, EndNote, RefMan |

Patent Citations (4), Referenced by (18), Classifications (26), Legal Events (4) | |

External Links: USPTO, USPTO Assignment, Espacenet | |

US 6725140 B2

Abstract

An apparatus for determining lateral velocity of an automotive vehicle (**10**) includes a vehicle speed sensor (**20**), a roll rate sensor (**34**), a yaw rate sensor (**28**), a lateral acceleration sensor (**32**), and a longitudinal acceleration sensor (**36**). A controller (**26**) is coupled to the sensors and determines a steady state pitch angle and a steady state roll angle as a function of the lateral acceleration signal, the longitudinal acceleration signal, the yaw rate signal, and the vehicle speed signal. The controller determines a sliding index as a function of the steady state pitch signal, the steady state roll angle, and the roll rate signal. The controller (**26**) determines lateral velocity as a function of the sliding index and controls the vehicle lateral motion based on the estimated lateral velocity.

Claims(17)

1. An apparatus for determining lateral velocity of an automotive vehicle comprising:

a vehicle speed sensor for generating a vehicle speed signal;

a roll rate sensor for generating a roll rate signal;

a yaw rate sensor for generating a yaw rate signal;

a lateral acceleration sensor for generating a lateral acceleration signal;

a longitudinal acceleration sensor for generating a longitudinal acceleration signal; and

a controller coupled to the sensors for determining a steady state pitch angle and a steady state roll angle as a function of the lateral acceleration signal, the longitudinal acceleration signal, the yaw rate signal, and the vehicle speed signal, determining a sliding index as a function of the steady state pitch angle, the steady state roll angle and the roll rate signal, and determining a lateral velocity as a function of the sliding index.

2. An apparatus as recited in claim 1 further comprising a safety system coupled to said controller, said safety system operating in response to said lateral velocity.

3. An apparatus as recited in claim 2 wherein the safety system comprises a yaw control system.

4. An apparatus as recited in claim 2 wherein the safety system comprises a roll stability control system.

5. An apparatus as recited in claim 1 wherein said controller determines a lateral velocity and a lateral velocity derivative as a function of the sliding index.

6. A method of controlling a vehicle comprising:

measuring a vehicle speed;

measuring a roll rate of the vehicle;

measuring a yaw rate of the vehicle;

measuring a lateral acceleration of the vehicle;

measuring a longitudinal acceleration of the vehicle; and

determining a lateral velocity as a function of the longitudinal acceleration, the vehicle speed, the lateral acceleration, the yaw rate and the roll rate; and

controlling a safety system in response to the lateral velocity.

7. A method as recited in claim 6 , wherein determining a lateral velocity further comprises determining a steady state pitch angle as a function of the longitudinal acceleration and the vehicle speed.

8. A method as recited in claim 7 , wherein determining a lateral velocity further comprises determining a steady state roll angle as a function of the lateral acceleration, the yaw rate, and the vehicle speed.

9. A method as recited in claim 8 , wherein determining a lateral velocity further comprises determining a sliding index as a function of the steady state pitch angle, the steady state roll angle and the roll rate.

10. A method of controlling a vehicle comprising:

measuring a vehicle speed;

measuring a roll rate of the vehicle;

measuring a yaw rate of the vehicle;

measuring a lateral acceleration of the vehicle;

measuring a longitudinal acceleration of the vehicle;

determining a steady state pitch angle as a function of the longitudinal acceleration and the vehicle speed;

determining a steady state roll angle as function of the lateral acceleration, the yaw rate, and the vehicle speed;

determining a sliding index as a function of the steady state pitch angle, the steady state roll angle and the roll rate; and

determining a lateral velocity as a function of the sliding index; and

controlling a safety system in response to the lateral velocity.

11. A method as recited in claim 10 further comprising determining a lateral velocity derivative as a function of the sliding index.

12. A method as recited in claim 10 wherein the safety system comprises a yaw control system.

13. A method as recited in claim 10 wherein the safety system comprises a rollover control system.

14. A method as recited in claim 10 further comprising generating a differential equation obeyed by the lateral velocity and its derivative by using the said sliding index.

15. A method as recited in claim 14 wherein said differential equation is derived by projecting the sliding index along a yaw angle direction.

16. A method as recited in claim 15 wherein the step of projecting the sliding index along the yaw angle directions is accomplished using an anti-drift-integration filter.

17. A method as recited in claim 16 wherein the anti-drift-integration filter is determined in response to the yaw angle, further comprising computing yaw angle through pure integration and 2π congruent mod operation, such that the accumulated integration error of the yaw angle is eliminated.

Description

The present invention relates generally to determining the dynamic state of an automotive vehicle, and more particularly, to a method and apparatus for determining lateral velocity of an automotive vehicle.

It is a well-known practice to control various operating dynamics of a motor vehicle to achieve active safety, using yaw and roll stability control systems. The effective operation of the various safety control devices requires high-accuracy and fast-response-time of the operating state of the motor vehicle, regarding the various road conditions and driving conditions. One important operating state used in such systems is the vehicle lateral velocity.

As a vehicle is driven, it may slide with respect to the road surface along the vehicle lateral axis, especially when it is driven on a low friction (low mu) road surface. This sliding can be quantitatively estimated using the lateral velocity of the center of gravity of the vehicle, projected on the lateral direction of the vehicle. The lateral velocity combined with other vehicle dynamic variables, such as longitudinal velocity and yaw rate, may be used for vehicle attitude sensing. The vehicle attitude may be used to generate control commands for vehicle yaw and roll stability control systems. Lateral velocity may be directly measured by sensors such as optical sensors or global positioning system (GPS) sensors. However, those sensors are very costly for the current vehicle dynamics controls. Hence it is desirable to use other available sensor signals to estimate the vehicle lateral velocity.

Many known systems rely upon basic assumptions regarding conditions such as driving on a flat surface (no pitch or bank angle), or on a high mu surface, or with a small vehicle attitude change. One example of such a system is found in U.S. Pat. No. 5,742,919, which provides a method to estimate the lateral velocity. The disclosed method is accurate only when the road is flat, the road surface has high mu, and vehicle has very small roll motion.

Another known method uses a lateral acceleration sensor signal to construct the time derivative of the vehicle lateral velocity by taking away the product of the yaw rate and the vehicle longitudinal velocity. Since the road condition (for example, the road bank and slope), the dynamic roll, and the dynamic pitch attitude of the vehicle will generate an extra component in the lateral acceleration, this method fails to detect accurate lateral velocity on banked/slope road or when the vehicle body has significant attitude changes. For example, an aggressive driver steering input may cause large roll attitude variation of the vehicle; during off-road driving, the large road bank and slope will be experienced through vehicle attitude changes. A vehicle with large lateral acceleration maneuvers could achieve 6 degrees of relative roll angle between the vehicle body and a level road surface. If such a vehicle is driven at 45 mph off camber on a 10 degree banked road, the lateral acceleration sensor reading will be increased by 2.7 m/s^{2 }solely due to gravity. Hence, neglecting the road bank and the vehicle roll information could introduce an error of 2.7 m/s per second. That is, a 2 second maneuver in this case will end up with around 5.4 m/s lateral velocity error which is more than 27% of the vehicle speed of 45 mph.

It would therefore be desirable to provide a robust determination of lateral velocity that is reliable on roads having banks, slopes, various surface mu's and when the vehicle is operating under changing dynamic conditions.

The present invention provides a robust determination of lateral velocity of the vehicle that maintains high accuracy by incorporating or compensating for various dynamic conditions of the vehicle and for various road conditions.

In one aspect of the invention, an apparatus for determining lateral velocity of an automotive vehicle includes a vehicle speed sensor that generates a vehicle speed signal, a roll rate sensor for generating a roll rate signal, a yaw rate sensor for generating a yaw rate signal, a lateral acceleration sensor for generating a lateral acceleration signal, and a longitudinal acceleration sensor for generating a longitudinal acceleration signal. A controller is coupled to the sensors and determines a steady state pitch angle and a steady state roll angle as a function of the lateral acceleration signal, the longitudinal acceleration signal, the yaw rate signal, and the vehicle speed signal. The controller determines a sliding index as a function of the steady state pitch signal, the steady state roll angle, and the roll rate signal. The controller determines lateral velocity as a function of the sliding index.

In a further aspect of the invention, a method of controlling a vehicle comprises measuring a vehicle speed; measuring a roll rate of the vehicle; measuring a yaw rate signal of the vehicle; measuring a lateral acceleration signal of the vehicle; measuring a longitudinal acceleration of the vehicle; and determining a lateral velocity as a function of the longitudinal acceleration, the vehicle speed, the lateral acceleration signal, the yaw rate signal and the roll rate signal; and controlling a safety system in response to the lateral velocity and the other calculated and measured variables.

It is an advantage of the present invention that a closed form formula for lateral velocity and a reliable computation provides an estimation of the vehicle lateral velocity. It is a further advantage of the present invention that the estimation of the lateral velocity is accurate regardless of road profile (flat, banked, or graded road surface), road surface condition (low or high mu), and driving conditions (large or small roll/pitch/yaw combined motion).

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.

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

FIG. 2 is an end view of an automotive vehicle on a bank.

FIG. 3 is a side view of a vehicle on a pitch slope.

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

FIG. 5 is a flow chart of the operation according to the present invention.

In the following figures the same reference numerals will be used to identify the same components. The present invention is preferably used in conjunction with a safety system such as a yaw stability control system or a roll stability control system for an automotive vehicle. However, the present invention may also be used with a deployed safety system device such as airbag. 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 various forces and moments acting thereon. Vehicle **10** has front right and front left tires **12** *a, * **12** *b *and rear right and rear left tires **13** *a, * **13** *b *respectively. The vehicle **10** may also have a number of different types of front steering systems **14** *a *and rear steering systems **14** *b *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^{2 }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** preferably uses a standard yaw stability control sensor set (including lateral acceleration sensor, yaw rate sensor, and wheel speed sensor) together with a roll rate sensor and a longitudinal acceleration sensor. 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_{1}, b_{2 }and b_{3 }is called a body frame **22**, whose origin is located at the center of gravity of the car body, with the b_{1 }corresponding to the longitudinal or x axis pointing forward, b_{2 }corresponding to the lateral or y axis pointing off the driving side (to the left), and the b_{3 }corresponding to the vertical or z axis pointing upward. The angular rates of the car body are denoted about their respective axes as w_{x }for the roll rate, w_{y }for the pitch rate and w_{z }for the yaw rate.

The angular rate sensors and the acceleration sensors are mounted on the vehicle car body along the body frame directions b_{1}, b_{2 }and b_{3}, which are the x-y-z axes of the vehicle's sprung mass.

The longitudinal acceleration sensor is mounted on the car body at the center of gravity with its sensing direction along b_{1}-axis, and its output is denoted as a_{x}. The lateral acceleration sensor is mounted on the car body at the center of gravity with its sensing direction along b_{2}-axis, and its output is denoted as a_{y}.

Referring now to FIG. 2, the present invention determines a lateral velocity by compensating a road bank angle θ_{bank }if the vehicle body has small roll attitude with respect to the road surface, or otherwise a vehicle roll attitude angle θ_{x }which is the global roll angle of the vehicle body with respect to the sea level. A steady state roll angle may be used in the determination. Thus, the presence of either road bank or large vehicle roll attitude change will still allow an accurate determination of lateral velocity of the vehicle using the present invention.

Referring now to FIG. 3, the present invention determines lateral velocity by compensating a slope or pitch angle θ_{slope }if the vehicle body has small pitch attitude with respect to the road surface, or otherwise a vehicle pitch attitude angle θ_{y }which is the global pitch angle of the vehicle body with respect to the sea level. A steady state pitch angle may be used in the determination. Thus, the presence of either road pitch or large vehicle pitch attitude will still allow an accurate determination of lateral velocity with the system of the present invention.

Referring now to FIG. 4, control system **18** is illustrated in further detail having a controller **26** used for receiving information from a number of sensors which may include a yaw rate sensor **28**, a speed sensor **20**, a lateral acceleration sensor **32**, a roll rate sensor **34**, a steering angle sensor (hand wheel position) **35**, a longitudinal acceleration sensor **36**, a pitch rate sensor **37** and steering angle position sensor **39**.

In the preferred embodiment, only two axial rate sensors are used. When two of these axial rates are known, the other may be derived using other commonly available sensors. Preferably, yaw rate and roll rate are used as the axial rate sensors. Although pitch rate sensor **37** is illustrated, it may be eliminated in the preferred embodiment.

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, control circuit **26** may control a safety device **38**. Depending on the desired sensitivity of the system and various other factors, not all the sensors **28**-**39** may be used in a commercial embodiment. Safety device **38** may control an airbag **40**, an active braking system **41**, an active front steering system **42**, an active rear steering system **43**, an active suspension system **44**, and an active anti-roll bar system **45**, or combinations thereof. Each of the systems **40**-**44** may have their own controllers for activating each one. As mentioned above, the safety system **38** is preferably at least the active braking system **41**.

Roll rate sensor **34** and pitch rate sensor **37** 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** and pitch rate sensor **37** 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. Roll and pitch rate sensors **34**,**37** may comprise 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/or a driver heading command input from an electronic component that may include steer by wire using a hand wheel or joy stick.

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

The roll rate of the vehicle may also be established by one or more of the following: translational or rotational positions, velocities or accelerations of the vehicle. These parameters may me determined by one or more of the following: 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.

Based on the inputs from sensors **28** through **39**, controller **26** determines a roll condition and controls any one or more of the safety devices **40**-**45**.

Speed sensor **30** 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.

From a basic dynamics consideration, there are kinematic relationships among the following variables for a moving vehicle: the lateral acceleration a_{y}, the longitudinal acceleration a_{x}, the roll rate ω_{x}, the yaw rate ω_{y}, the vehicle reference velocity ν_{x}, the vehicle body roll attitude θ_{x}, the vehicle body pitch attitude (slope angle) θ_{y}, the vehicle lateral velocity ν_{y }and the pitch rate ω_{y}. These kinematic relationships can be expressed through the following nonlinear and differential equations

*a* _{x} *={dot over (ν)}* _{x}−ω_{z} *ν* _{y} *−g *sin(θ_{y})

*a* _{y} *={dot over (ν)}* _{y}+ω_{z} *ν* _{x} *+g *sin(θ_{x})cos(θ_{y})

_{x}=ω_{x}+[ω_{y }sin(θ_{x})+ω_{z3 }cos(θ_{x})]tan(θ_{y})

_{y}=ω_{y }cos(θ_{x})−ω_{z }sin(θ_{x}) (1.1)

As mentioned before, the determination of lateral velocity used through the first equation of (1.1) might be expressed as

*{dot over (ν)}* _{y} *=a* _{y}−[ω_{z} *ν* _{x} *+g *sin(θ_{x})cos(θ_{y})]

and the existing methods in current literature neglecting the vehicle global pitch and roll attitudes leads to

*{dot over (ν)}* _{y} *≈a* _{y}−ω_{z} *ν* _{x}

Also notice that even though the vehicle global attitudes θ_{x }and θ_{y }are available, a careful integration scheme needs to be chosen in order to get ν_{y }through integrating a_{y}−[ω_{z}ν_{x}+g sin(θ_{x})cos(θ_{y})]. Since ν_{y }could have both high frequency and low frequency components, a simple integration with high-pass filter may not obtain the desired result. This difficulty is because it is hard to distinguish between the integration drifting and the actual low frequency sliding of the vehicle. The present invention obtains an accurate estimation regardless of such difficulties.

In the current vehicular yaw or roll stability control, a_{y}, a_{x}, ω_{x }and ω_{y }are measured sensor signals, and ν_{x }is known (calculated from the wheel speed sensor signals and the other calculated signals used in yaw stability controls), while θ_{x}, θ_{y}, ν_{y }and ω_{y }are unknown. Hence, computing the vehicle lateral velocity from Equation (1.1) requires solving a set of nonlinear differential equations. The solution to the above nonlinear differential equations can be obtained through solving a single linear but time-varying differential equation. The advantage of solving a linear-time varying differential equation over solving nonlinear differential equations is that the closed-form solution for linear differential equations in general can be found, which is usually impossible for nonlinear differential equations. The closed-form solution directly calculates lateral velocity ν_{y }from the known signals a_{y}, a_{x}, ω_{x}, ω_{y }and ν_{x }by eliminating the known variables θ_{x}, θ_{y }and ω_{y}. One advantage of this treatment is that potential numerical errors found in integration for θ_{x}, θ_{y }and ω_{y }will be eliminated. Therefore, the system is more robust and reliable.

If a vehicle is driving on a stable condition, the lateral velocity is likely to be close to zero. In this case, the corresponding vehicle roll and pitch attitudes are denoted as θ_{xss }and θ_{yss}, which can be obtained by setting ν_{y}=0 in the first two equations of Equation (1.1).

Notice that Equation (1.2) does not correspond to any real values of the vehicle attitudes if the vehicle has significant sliding motion in the lateral direction, and in this case, the vehicle attitudes obey the following

Considering the vehicle attitudes are small enough such that the small angle assumption holds, then (1.3) can be simplified to the following

Further, using a small angle assumption to the third equation of Equation (1.1), the following relationship is true

Define the following as the slide index

*SI*=({dot over (θ)}_{xss}−ω_{x}−ω_{z}θ_{yss})*g* (1.6)

then the lateral velocity satisfies the following single differential equation at any time instant t

{umlaut over (ν)}_{y}(*t*)+ω_{z}(*t*)^{2}ν_{y}(*t*)=*SI*(*t*) (1.7)

Notice that SI characterize the strength of the sliding of the vehicle by using the known or the calculated and the measured variables. If SI=0, (1.7) leads to

_{y}(*t*)+ω_{z}(*t*)^{2}ν_{y}(*t*)=0

and the only solution ν_{y }satisfying the above is ν_{y}=0. Therefore, a small magnitude of SI implies a small amount of lateral velocity, hence small sliding of the vehicle; a large magnitude of SI implies a large magnitude of lateral velocity, hence large sliding of the vehicle. This is also the reason this quantity is called a sliding index. Based on the above discussion, the determination of the lateral velocity might be conducted as in the following for some threshold s of the sliding index

if |SI(k)|≦s

{

vehicle lateral velocity is negligible.

}

else if |SI(k)|>s

{

vehicle lateral velocity is significant

quantitatively computing vehicle lateral velocity }

Although Equation (1.7) could be used to solve for lateral velocity in real-time using Tyler expansion plus difference equations and numerical integration, such an approach is not robust and reliable for real time implementation due to potential uncontrollable accumulative error and low frequency drifting of the integration.

If the vehicle yaw rate ω_{z}(t) is kept constant, for instance ω_{z}(t)=Ω, with time elapse, the lateral velocity could be directly solved in closed form expression as

Since the vehicle yaw rate is usually time-varying, hence the above closed form solution in (1.8) might not be useful. However, if we replace the constant Ω by the integration of the yaw rate as in the following

_{t}=∫_{0} ^{t}ω_{z}(τ)*dτ* (1.9)

then the lateral velocity and its derivative can be expressed as in the following

That is, the lateral acceleration is related to the projection of the sliding index using the yaw angle of the vehicle.

In order to verify that the solution documented in Equation (1.10) does obey the linear time varying differential Equation (1.7), the time derivative for {dot over (ν)}_{y}(t) is found. Notice that {dot over (Ω)}_{t}=ω_{z}(t), hence

which implies that the solution expressed in Equation (1.10) does satisfy Equation (1.7).

Since the lateral velocity ν_{y}(t) and its derivative {dot over (ν)}{dot over (ν**1**)}_{y}(t) described in Equation (1.10) come from a kinematic equation, they are accurate regardless of the vehicle's driving condition, the road condition, the road surface condition and the vehicle platform as soon as the sensors are mounted on the center of gravity of the car body and the relative attitudes of the vehicle with respect to the average road surface are accurately calculated. Another advantage of the above computation of the lateral velocity is that it does not explicitly involve the road bank, road slope and vehicle attitude information, and the influence of all those variables is reflected by the relationship shown in the differential Equation (1.7) through the sliding index.

A numerical implementation of the closed-form solution in Equation (1.10) is performed to allow the implementation in a useful manner. The yaw angle of the vehicle car body Ω_{t}, as defined in Equation (1.9), can be computed using the following pure integration scheme

_{k+1}=Ω_{k}+ω_{z} _{ k+1 } *ΔT* (1.11)

where ΔT is the sampling time of the control system, Ω_{k+1 }and ω_{z} _{ k+1 }are the values of the yaw angle and the yaw rate sensor at time instant t=(k+1)ΔT. Because of the potential drift problem, Equation (1.11) may not be close to the actual yaw angle. However, Ω_{k+1 }appears only in sine and cosine functions, drifting may be eliminated by using the following congruent mod operation

Combining (1.11) and (1.12), the following iterative scheme can be used to compute the congruent-mod yaw angle

Notice that Ω_{g} _{ k+1 }calculated in (1.12) falls always within 0 and 2τ. The floor(•) is a function which is the largest integer bounded by the real number •. That is,

always removes out of the portion that are integer times of 2τ from Ω(k+1), and it outputs a quantity with value falling in between 0 and 2τ. This function is common in “C” programming language. The following intermediate variables may be computed.

The projections of the sliding index SI along the yaw angle directions can now be computed based on the computed Ω_{g} _{ k+1 }. Define

*SI *sin int=∫_{0} ^{t} *SI*(τ)sin(Ω_{τ})*dτ*

*SI *cos int=∫_{0} ^{t} *SI*(τ)cos(Ω_{τ})*dτ*

then the numerical computation of them using the following anti-drift-integration filter

can be obtained as the following

*SI *sin int_{k+1} *=c* _{1} *SI *sin int_{k} *−c* _{2} *SI *sin int_{k−1} *+d[SI* _{k+1 }sin(Ω_{g} _{ k+1 })−*SI* _{k−1 }sin(Ω_{g} _{ k−1 })]

*SI *sin int_{k+1} *=c* _{1} *SI *sin int_{k} *−c* _{2} *SI *sin int_{k−1} *+d[SI* _{k+1 }cos(Ω_{g} _{ k+1 })−*SI* _{k−1 }cos(Ω_{g} _{ k−1 })] (1.13)

Using the numerical scheme shown in Equation (1.13), the following computation for the lateral velocity and its derivative based upon the sliding index along the yaw angle direction is shown as

As mentioned above, a control signal may then be developed based on the lateral velocity and perhaps the lateral velocity derivative found in Equation (1.14). For example, a roll or a yaw stability control system may derive the control signal therefrom. Of course, multiple systems may simultaneously use the lateral velocity and/or the lateral velocity derivative in its computations.

Referring now to FIG. 5, a summary flow chart illustrating the process is illustrated. The various sensors are read in step **70**. In the following examples the yaw rate sensor **28**, the roll rate sensor **34**, the speed sensor **20**, lateral acceleration sensor **32**, and longitudinal acceleration sensor **36** are used. A steady state pitch and roll angle in step **72** is obtained from Equation (1.2) above. A sliding index is determined in step **74** which corresponds to Equation (1.6) above. The sliding index is projected along the yaw angle direction in step **76**. The yaw angle projection is set forth in Equation (1.13).

Based upon the projection of the sliding index along the yaw angle direction, step **78** determines a linear time varying differential equation as a function of the sliding index projection. In step **80**, the lateral velocity and the velocity derivative are obtained. In step **82**, a control system such as a safety system is controlled in response to the lateral velocity and/or the lateral velocity derivative.

While particular embodiments of the invention have been shown and described, numerous variations and alternate embodiments will occur to those skilled in the art. Accordingly, it is intended that the invention be limited only in terms of the appended claims.

Patent Citations

Cited Patent | Filing date | Publication date | Applicant | Title |
---|---|---|---|---|

US5311431 * | Jul 1, 1992 | May 10, 1994 | Robert Bosch Gmbh | Method of obtaining the yawing velocity and/or transverse velocity of a vehicle |

US5742919 | Apr 26, 1996 | Apr 21, 1998 | Ford Global Technologies, Inc. | Method and apparatus for dynamically determining a lateral velocity of a motor vehicle |

US6195606 * | Dec 7, 1998 | Feb 27, 2001 | General Motors Corporation | Vehicle active brake control with bank angle compensation |

US6477480 * | Nov 15, 2000 | Nov 5, 2002 | Ford Global Technologies, Inc. | Method and apparatus for determining lateral velocity of a vehicle |

Referenced by

Citing Patent | Filing date | Publication date | Applicant | Title |
---|---|---|---|---|

US6847875 * | Oct 30, 2003 | Jan 25, 2005 | Ford Global Technologies, Llc | Method for determining a longitudinal vehicle velocity by compensating individual wheel speeds |

US7451033 | Jun 10, 2005 | Nov 11, 2008 | Ford Global Technologies, Llc | Lateral and longitudinal velocity determination for an automotive vehicle |

US7653471 | Feb 26, 2004 | Jan 26, 2010 | Ford Global Technologies, Llc | Active driven wheel lift identification for an automotive vehicle |

US7668645 | Oct 15, 2004 | Feb 23, 2010 | Ford Global Technologies | System and method for dynamically determining vehicle loading and vertical loading distance for use in a vehicle dynamic control system |

US7715965 | Oct 25, 2004 | May 11, 2010 | Ford Global Technologies | System and method for qualitatively determining vehicle loading conditions |

US7877178 | Jan 5, 2010 | Jan 25, 2011 | Ford Global Technologies | System and method for dynamically determining vehicle loading and vertical loading distance for use in a vehicle dynamic control system |

US7877199 | Jan 5, 2010 | Jan 25, 2011 | Ford Global Technologies | System and method for dynamically determining vehicle loading and vertical loading distance for use in a vehicle dynamic control system |

US7877200 | Jan 5, 2010 | Jan 25, 2011 | Ford Global Technologies | |

US7877201 | Jan 5, 2010 | Jan 25, 2011 | Ford Global Technologies | |

US7899594 | Mar 10, 2010 | Mar 1, 2011 | Ford Global Technologies | System and method for qualitatively determining vehicle loading conditions |

US8457832 * | Sep 9, 2008 | Jun 4, 2013 | Toyota Jidosha Kabushiki Kaisha | Vehicle body speed estimating device |

US8855866 * | Nov 22, 2011 | Oct 7, 2014 | Continental Automotive Systems, Inc. | Rear end advanced collision technology |

US20040167692 * | Oct 30, 2003 | Aug 26, 2004 | Ford Global Technologies, Llc | Method for determining a longitudinal vehicle velocity by compensating individual wheel speeds |

US20040167701 * | Feb 26, 2004 | Aug 26, 2004 | Mattson Keith Glenn | Active driven wheel lift identification for an automotive vehicle |

US20100198448 * | Sep 9, 2008 | Aug 5, 2010 | Toyota Jidosha Kabushiki Kaisha | Vehicle body speed estimating device |

US20130131928 * | May 23, 2013 | Continental Automotive Systems, Inc. | Rear End Advanced Collision Technology | |

USRE41617 * | Oct 27, 2005 | Aug 31, 2010 | Ford Global Technologies & Ford Motor Company | Method for determining a longitudinal vehicle by compensating individual wheel speeds |

DE102009005123A1 | Jan 19, 2009 | Jul 30, 2009 | Ford Global Technologies, LLC, Dearborn | Fahrzeugstabilitäts-Steuersystem und Verfahren |

Classifications

U.S. Classification | 701/45, 701/70 |

International Classification | B60T8/172, B60G17/0195, B60G17/016 |

Cooperative Classification | B60G2800/702, B60G2400/0511, B60G2400/2042, B60G2400/104, B60G2400/0521, B60G2400/0523, B60G2400/204, B60T2250/04, B60T8/172, B60G17/0162, B60W2520/14, B60W2520/16, B60W2520/10, B60G2400/106, B60W2520/18, B60G17/0195, B60G2800/0194, B60G2400/20 |

European Classification | B60G17/016F, B60G17/0195, B60T8/172 |

Legal Events

Date | Code | Event | Description |
---|---|---|---|

May 7, 2002 | AS | Assignment | |

Apr 22, 2003 | AS | Assignment | Owner name: FORD GLOBAL TECHNOLOGIES, LLC,MICHIGAN Free format text: MERGER;ASSIGNOR:FORD GLOBAL TECHNOLOGIES, INC.;REEL/FRAME:013987/0838 Effective date: 20030301 |

Sep 14, 2007 | FPAY | Fee payment | Year of fee payment: 4 |

Sep 23, 2011 | FPAY | Fee payment | Year of fee payment: 8 |

Rotate