Method and apparatus for determining lateral velocity of a motor vehicle in closed form for all road and driving conditions

• US 6,725,140 B2
• Filed: 05/07/2002
• Issued: 04/20/2004
• Est. Priority Date: 05/07/2002
• Status: Active Grant

• Current Assignee: Ford Global Technologies, LLC (Ford Motor Company)
• Original Assignee: Ford Global Technologies, LLC (Ford Motor Company)
• Inventors: Lu, Jianbo, Brown, Todd Allen
• Primary Examiner(s): Zanelli, Michael J.
• Application Number:
  US10/140,240
• Publication Number:
  US 20030212482A1
• Time in Patent Office: 714 Days
• Field of Search: 701/45, 701/72, 701/37, 701/38, 701/70, 280/5.507, 280/5.508
• US Class Current: 701/45
• CPC Class Codes: B60G 17/0162 mainly during a motion involving steering operation, e.g. cornering, overtaking B60G17/0164 takes precedence
• CPC Class Codes: B60G 17/0195 characterised by the regulation being combined with other vehicle control systems conjoint control of vehicle sub-units including control of suspension systems B60W10/22
• CPC Class Codes: B60G 2400/0511 Roll angle
• CPC Class Codes: B60G 2400/0521 Roll rate
• CPC Class Codes: B60G 2400/0523 Yaw rate
• CPC Class Codes: B60G 2400/104 lateral or transversal with regard to vehicle
• CPC Class Codes: B60G 2400/106 longitudinal with regard to vehicle, e.g. braking
• CPC Class Codes: B60G 2400/20 Speed
• CPC Class Codes: B60G 2400/204 Vehicle speed
• CPC Class Codes: B60G 2400/2042 Lateral speed
• CPC Class Codes: B60G 2800/0194 transversal with regard to vehicle
• CPC Class Codes: B60G 2800/702 Improving accuracy of a sensor signal
• CPC Class Codes: B60T 2250/04 Vehicle reference speed; Vehicle body speed
• CPC Class Codes: B60T 8/172 Determining control parameters used in the regulation, e.g. by calculations involving measured or detected parameters B60T8/17551 takes precedence
• CPC Class Codes: B60W 2520/10 Longitudinal speed
• CPC Class Codes: B60W 2520/14 Yaw
• CPC Class Codes: B60W 2520/16 Pitch
• CPC Class Codes: B60W 2520/18 Roll

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

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.