Vehicle attitude angle estimator and method

• US 6,678,631 B2
• Filed: 03/06/2002
• Issued: 01/13/2004
• Est. Priority Date: 11/19/1998
• Status: Expired due to Fees

• Current Assignee: Invensense Incorporated (TDK Corporation)
• Original Assignee: Delphi Technologies, Inc. (BorgWarner Incorporated)
• Inventors: Schiffmann, Jan K.
• Primary Examiner(s): Barlow, John
• Assistant Examiner(s): LE, JOHN H
• Application Number:
  US10/092,037
• Publication Number:
  US 20020128795A1
• Time in Patent Office: 678 Days
• Field of Search: 702/150, 702/151, 702/152, 702/153, 701/4, 701/36, 701/37, 701/38, 701/41, 701/42, 701/43, 701/44, 701/45, 701/46, 340/429, 340/436, 340/440
• US Class Current: 702/151
• CPC Class Codes: B60R 2021/01304 monitoring rough road condition
• CPC Class Codes: B60R 2021/01325 Vertical acceleration
• CPC Class Codes: B60R 2021/01327 Angular velocity or angular acceleration
• CPC Class Codes: B60R 21/0132 responsive to vehicle motion parameters , e.g. to vehicle longitudinal or transversal deceleration or speed value
• CPC Class Codes: B60R 21/0133 by integrating the amplitude of the input signal
• CPC Class Codes: B60R 21/01336 using filtering
• CPC Class Codes: B60R 21/01338 using vector analysis
• CPC Class Codes: B60T 2210/14 Rough roads, bad roads, gravel roads
• CPC Class Codes: B60T 2230/02 Side slip angle, attitude angle, floating angle, drift angle
• CPC Class Codes: B60T 2230/03 Overturn, rollover
• CPC Class Codes: B60T 2250/06 Sensor zero-point adjustment; Offset compensation
• 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

Abstract

An attitude angle estimator and method of estimating attitude angle of a vehicle having an angular attitude rate sensor sensing angular attitude rate of a vehicle, a vertical accelerometer sensing vertical acceleration, and a lateral accelerometer sensing lateral acceleration. An attitude angle estimate is produced and is updated as a function of the sensed angular attitude rate. An acceleration-based attitude angle is determined as a function of the sensed accelerations, and a blending coefficient is provided. A current vehicle attitude angle estimate is generated as a function of the updated attitude angle estimate, the acceleration-based attitude angle, and the blending coefficient.

Claims

1. A vehicle attitude angle estimator for use in a vehicle, said angle estimator comprising:

a first accelerometer for sensing vertical acceleration of the vehicle and producing an output signal indicative thereof;

a second accelerometer for sensing a horizontal acceleration of the vehicle and producing an output signal indicative thereof; and

a controller for determining an acceleration-based attitude angle as a function of the sensed vertical acceleration and horizontal acceleration, wherein the acceleration-based attitude angle is determined absent a sensed angular attitude rate, said controller producing an attitude angle estimate as a function of the acceleration-based attitude angle.

2. The vehicle attitude angle estimator as defined in claim 1 further comprising an angular attitude rate sensor for sensing angular attitude rate of the vehicle and producing an output signal indicative thereof, wherein the controller produces the attitude angle estimate further as a function of the sensed attitude rate.

3. The vehicle attitude angle estimator as defined in claim 2, wherein the controller further provides a blending coefficient and generates the vehicle attitude angle estimate further as a function of the blending coefficient.

4. The vehicle attitude angle as defined in claim 3, wherein the blending coefficient has a value in the range of 0 to 1.

5. A vehicle attitude angle estimator for use in a vehicle, said angle estimator comprising:

an angular attitude rate sensor for sensing angular attitude rate of a vehicle and producing an output signal indicative thereof;

a first accelerometer for sensing vertical acceleration of the vehicle and producing an output signal indicative thereof;

a second accelerometer for sensing a horizontal acceleration of the vehicle and producing an output signal indicative thereof; and

a controller for producing an attitude angle estimate as a function of said sensed attitude rate, said sensed vertical acceleration, and said sensed horizontal acceleration, wherein said controller determines an acceleration-based attitude angle as a function of the sensed vertical acceleration and horizontal acceleration, said controller further providing a blending coefficient and generating a current vehicle attitude angle estimate as a function of the updated attitude angle estimate, said acceleration-based attitude angle, and said blending coefficient.

6. The vehicle attitude angle estimator as defined in claim 5, wherein said angular attitude rate sensor comprises an angular roll rate sensor for sensing angular roll rate, and said second accelerometer comprises a lateral accelerometer for sensing lateral acceleration.

7. The vehicle attitude angle estimator as defined in claim 6, wherein said controller produces a roll angle estimate and updates the roll angle estimate as a function of the sensed angular roll rate, said controller determining an acceleration-based roll angle as a function of the sensed lateral and vertical accelerations, said controller further providing a roll blending coefficient and generating a current vehicle roll angle estimate by further updating the roll angle estimate as a function of the acceleration-based roll angle and the roll blending coefficient.

8. The vehicle angle estimator as defined in claim 5, wherein said controller generates the vehicle attitude angle estimate by multiplying a blending coefficient by the difference between the acceleration-based angle estimate and the updated attitude angle estimate, said controller further adding the multiplication to the updated attitude angle estimate.

9. The vehicle angle estimator as defined in claim 5, wherein said second accelerometer comprises a lateral accelerometer for sensing lateral acceleration.

10. A vehicle attitude angle estimator for use in a vehicle, said vehicle angle estimator comprising:

an angular attitude rate sensor for sensing angular attitude rate of a vehicle and producing an output signal indicative thereof;

a vertical accelerometer for sensing vertical acceleration of the vehicle and producing an output signal indicative thereof;

a lateral accelerometer for sensing lateral acceleration of the vehicle and producing an output signal indicative thereof; and

a controller for producing an attitude angle estimate and updating the attitude angle estimate as a function of said sensed angular attitude rate, said controller determining an acceleration-based attitude angle as a function of said sensed lateral and vertical accelerations, said controller further providing a blending coefficient and generating a current vehicle attitude angle estimate as a function of said updated attitude angle estimate, said acceleration-based attitude angle, and the blending coefficient.

11. The vehicle angle estimator as defined in claim 10, wherein said controller generates the vehicle attitude angle estimate by multiplying a blending coefficient by the difference between the acceleration-based angle estimate and the updated attitude angle estimate, said controller further adding the multiplication to the updated attitude angle estimate.

12. A method for estimating an attitude angle of a vehicle, said method comprising the steps of:

sensing vertical acceleration of the vehicle and producing an output signal indicative thereof;

sensing horizontal acceleration of the vehicle and producing an output signal indicative thereof;

determining an acceleration-based attitude angle as a function of said sensed vertical and horizontal accelerations, wherein the acceleration-based attitude angle is determined absent a sensed angular attitude rate; and

generating a vehicle attitude angle estimate as a function of the acceleration-based attitude angle.

13. The method as defined in claim 12 further comprising the step of sensing angular attitude rate of a vehicle and producing an output signal indicative thereof, and wherein the step of generating a vehicle attitude angle estimate comprises generating the vehicle attitude angle estimate further as a function of the sensed angular attitude rate.

14. The method as defined in claim 13 further comprising the step of providing a blending coefficient, wherein the step of generating the vehicle attitude angle estimate comprises the vehicle attitude angle estimate further as a function of the blending coefficient.

15. The method as defined in claim 14, wherein the blending coefficient has a value in the range of 0 to 1.

16. A method for estimating an attitude angle of a vehicle, said method comprising the steps of:

sensing angular attitude rate of a vehicle and producing an output signal indicative thereof;

sensing vertical acceleration of the vehicle and producing an output signal indicative thereof;

sensing horizontal acceleration of the vehicle and producing an output signal indicative thereof;

generating a vehicle attitude angle estimate as a function of the sensed angular attitude rate, vertical acceleration, and horizontal acceleration;

updating said attitude angle estimate as a function of said sensed angular attitude rate;

determining an acceleration-based attitude angle as a function of said sensed vertical and horizontal accelerations;

providing a blending coefficient; and

generating the current vehicle attitude angle estimate as a function of said updated attitude angle estimate, said acceleration-based attitude angle and said blending coefficient.

17. The method as defined in claim 16, wherein said step of updating said attitude angle estimate includes a step of integrating said sensed angular attitude rate over a time period and adding said integration with said attitude angle estimate.

18. The method as defined in claim 16, wherein said step of generating said vehicle attitude angle estimate further comprises multiplying said blending coefficient by the difference between said acceleration-based angle estimate and said updated attitude angle estimate, and further adding said multiplication to said updated angle estimate.

19. The method as defined in claim 16, wherein said step of sensing horizontal acceleration comprises sensing lateral acceleration of the vehicle and said step of generating a current vehicle attitude angle estimate comprises generating a current vehicle roll angle estimate.

20. The method as defined in claim 16, wherein said attitude angle comprises a roll angle, and said sensed attitude rate comprises an angular roll rate, and said sensed horizontal acceleration comprises a lateral acceleration.

21. A method for estimating an attitude angle of a vehicle, said method comprising the steps of:

sensing angular attitude rate of a vehicle and producing an output signal indicative thereof;

providing a blending coefficient;

sensing vertical acceleration of the vehicle and producing an output signal indicative thereof;

sensing horizontal acceleration of the vehicle and producing an output signal indicative thereof; and

generating a vehicle attitude angle estimate as a function of the sensed angular attitude rate, vertical acceleration, horizontal acceleration, and said blending coefficient, wherein said blending coefficient has a value in the range of 0 to 1.