Method and apparatus for estimating incline and bank angles of a road surface

• US 5,446,658 A
• Filed: 06/22/1994
• Issued: 08/29/1995
• Est. Priority Date: 06/22/1994
• Status: Expired due to Fees

• Current Assignee: General Motors Corporation (Motors Liquidation Co. GUC Trust)
• Original Assignee: General Motors Corporation (Motors Liquidation Co. GUC Trust)
• Inventors: Pastor, Stephen R., Tierney, Gordon L.
• Primary Examiner(s): Teska, Kevin J.
• Assistant Examiner(s): NGUYEN, TAN QUANG
• Application Number:
  US08/263,694
• Time in Patent Office: 433 Days
• Field of Search: 364/426.02, 364/426.01, 364/424.01, 364/426.03, 364/551.01, 364/559, 364/560, 180/197, 73/104, 73/105, 33/328, 33/343, 33/365
• US Class Current: 701/1
• CPC Class Codes: B60G 17/019 characterised by the type of sensor or the arrangement thereof B60G17/01941 takes precedence
• CPC Class Codes: B60G 2400/0523 Yaw rate
• CPC Class Codes: B60G 2400/106 longitudinal with regard to vehicle, e.g. braking
• CPC Class Codes: B60G 2400/82 Ground surface
• CPC Class Codes: B60G 2800/019 Inclination due to load distribution or road gradient
• CPC Class Codes: B60G 2800/0192 longitudinal with regard to vehicle
• CPC Class Codes: B60G 2800/0194 transversal with regard to vehicle
• CPC Class Codes: B60T 2210/22 Banked curves
• 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/14 Yaw
• CPC Class Codes: B60W 2552/15 Road slope, i.e. the inclination of a road segment in the longitudinal direction
• CPC Class Codes: G01C 9/00 Measuring inclination, e.g. by clinometers, by levels

Abstract

The present invention is directed to a method and apparatus for estimating incline and bank angles of a road surface upon which a front wheel drive vehicle is travelling. Each nondriven rear wheel is equipped with a rotational speed sensor. The vehicle is further equipped with longitudinal and lateral accelerometers mounted to the vehicle chassis above the centerline of the rear axle. Outputs from the speed sensors and accelerometers are fed into a vehicle on-board controller and utilized in computing the incline and bank angles of the road surface. Updated incline and bank angles are maintained in the controller'"'"'s memory for access by various control systems to alter vehicle attributes for improved handling and operation.

Claims

1. An apparatus for estimating an incline angle of a road surface upon which a front wheel drive vehicle is travelling, the apparatus comprising:

a first sensor for providing a first output signal responsive to a rotational speed of a first rear wheel;

a second sensor for providing a second output signal responsive to a rotational speed of a second rear wheel;

a third sensor for providing a third output signal responsive to a sensed longitudinal acceleration of the vehicle; and

a controller for processing the first, second and third output signals to arrive at an estimated incline angle, the controller comprising;

means for computing a longitudinal acceleration as a function of the rotational speeds of the first and second rear wheels in accordance with the first and second output signals;

means for determining a pitch angle of the vehicle as a function of the sensed longitudinal acceleration in accordance with the third output signal; and

means for estimating the road surface incline angle as a function of the computed longitudinal acceleration, sensed longitudinal acceleration in accordance with the third output signal and pitch angle.

2. The apparatus for estimating an incline angle of a road surface according to claim 1, the controller further comprising a means for storing the estimated road surface incline angle in a memory location for use by vehicle control systems to alter vehicle attributes for improved operation and handling.

3. The apparatus for estimating an incline angle of a road surface according to claim 1, further comprising:

means for determining a yaw rate of the vehicle as a function of a difference between the sensed rotational speeds of the first and second rear wheels in accordance with the first and second output signals, and a distance between the first and second rear wheels;

means for computing a change in yaw rate over a predetermined time period; and

means for inhibiting incline angle estimation if the change in yaw rate is greater than a predetermined threshold.

4. The apparatus for estimating ant incline angle of a road surface according to claim 1, wherein the means for computing a longitudinal acceleration comprises:

means for determining an average rotational speed of the first and second rear wheels in accordance with the first and second output signals; and

means for determining a change in the average rotational speed over a predetermined time period.

5. The apparatus for estimating an incline angle of a road surface according to claim 1, wherein the incline angle is estimated in accordance with the following function:

space="preserve" listing-type="equation">θ

.sub.I =SIN.sup.-1 [SENSED LONGITUDINAL ACCELERATION-COMPUTED LONGITUDINAL ACCELERATION-BIAS.sub.LONG ]-θ

.sub.P

where,

θ

_I =incline angle,

θ

_P =pitch angle, and

BIAS_LONG =a constant.

6. A method for estimating an incline angle of a road surface upon which a front wheel drive vehicle is travelling, the method comprising:

providing a first output signal responsive to a rotational speed of a first rear wheel;

providing a second output signal responsive to a rotational speed of a second rear wheel;

providing a third output signal responsive to a sensed longitudinal acceleration of file vehicle;

computing a longitudinal acceleration as a function of the rotational speeds of the first and second rear wheels in accordance with the first and second output signals;

determining a pitch angle of the vehicle as a function of the sensed longitudinal acceleration in accordance with the third output signal;

estimating the road surface incline angle as a function of the computed longitudinal acceleration, sensed longitudinal acceleration in accordance with the third output signal and pitch angle,

wherein the estimated road surface incline angle is used by a vehicle control systems to alter vehicle attributes for improved operation and handling.

7. The method for estimating an incline angle of a road surface according to claim 6, further comprising:

determining a yaw rate of the vehicle as a function of a difference between the sensed rotational speeds of the first and second rear wheels in accordance with the first and second output signals, and a distance between the first and second rear wheels;

computing a change in yaw rate over a predetermined time period; and

inhibiting incline angle estimation if the change in yaw rate is greater than a predetermined threshold.

8. The method for estimating an incline angle of a road surface according to claim 6, wherein computing a longitudinal acceleration comprises:

determining an average rotational speed of the first and second rear wheels in accordance with the first and second output signals; and

determining a change in the average rotational speed over a predetermined time period.

9. The method for estimating an incline angle of a road surface according to claim 6, wherein the incline angle is estimated in accordance with the following function:

space="preserve" listing-type="equation">θ

.sub.I =SIN.sup.-1 [SENSED LONGITUDINAL ACCELERATION-COMPUTED LONGITUDINAL ACCELERATION-BIAS.sub.LONG ]-θ

.sub.P

where,

θ

_I =incline angle,

θ

_P =pitch angle, and

BIAS_LONG =a constant.

10. An apparatus for estimating a bank angle of a road surface upon which a front wheel drive vehicle is travelling, the apparatus comprising:

a first sensor for providing a first output signal responsive to a rotational speed of a first rear wheel;

a second sensor for providing a second output signal responsive to a rotational speed of a second rear wheel;

a third sensor for providing a third output signal responsive to a sensed lateral acceleration of the vehicle; and

a controller for processing the first, second and third output signals to arrive at an estimated bank angle, the controller comprising;

means for computing a longitudinal velocity as an average of the sensed rotational speeds of the first and second rear wheels in accordance with the first and second output signals;

means for determining a roll angle of the vehicle as a function of the sensed lateral acceleration in accordance with the third output signal;

means for determining a yaw rate of the vehicle as a function of a difference between the sensed rotational speeds of the first and second rear wheels in accordance with the first and second output signals, and a distance between the first and second rear wheels; and

means for estimating the road surface bank angle as a function of the computed longitudinal velocity, sensed lateral acceleration in accordance with the third output signal, roll angle and yaw rate.

11. The, apparatus for estimating a bank angle of a road surface according to claim 10, the controller further comprising a means for storing the estimated road surface bank angle in a memory location for use by vehicle control systems to alter vehicle attributes for improved operation and handling.

12. The apparatus for estimating a bank angle of a road surface according to claim 10, further comprising:

means for computing a change in yaw rate over a predetermined time period; and

means for inhibiting bank angle estimation if the change in yaw rate is greater than a predetermined threshold.

13. The apparatus for estimating a bank angle of a road surface according to claim 10, wherein the bank angle is estimated in accordance with the following function:

##EQU4## where, θ

_B =bank angle,

θ

_R =roll angle, and

BIAS_LAT =a constant

14. A method for estimating a bank angle of a road surface upon which a front wheel drive vehicle is travelling, the method comprising:

providing a first output responsive to a rotational speed of a first rear wheel;

providing a second output responsive to a rotational speed of a second rear wheel;

providing a third output responsive to a sensed lateral acceleration of the vehicle;

computing a longitudinal velocity as an average of the sensed rotational speeds of the first and second rear wheels in accordance with the first and second output signals;

determining a roll angle of the vehicle as a function of the sensed lateral acceleration in accordance with the third output signal;

determining a yaw rate of the vehicle as a function of a difference between the sensed rotational speeds of the first and second rear wheels in accordance with the first and second output signals, and a distance between the first and second rear wheels;

estimating the road surface bank angle as a function of the computed longitudinal velocity, sensed lateral acceleration in accordance with the third output signal, roll angle and yaw rate,

wherein the estimated road surface bank angle is used by a vehicle control systems to alter vehicle attributes for improved handling and operation.

15. The method for estimating a bank angle of a road surface according to claim 14, further comprising:

computing a change in yaw rate over a predetermined time period; and

inhibiting bank angle estimation if the change in yaw rate is greater than a predetermined threshold.

16. The method for estimating a bank angle of a road surface according to claim 14, wherein the bank angle is estimated in accordance with the following function:

##EQU5## where, θ

_B =bank angle,

θ

_R =roll angle, and

BIAS_LAT =a constant.