Method for determining the roll angle of a vehicle using an estimation of road bank angle

• US 20030182025A1
• Filed: 03/20/2002
• Published: 09/25/2003
• Est. Priority Date: 03/20/2002
• Status: Active Grant

• Current Assignee: Ford Global Technologies, LLC (Ford Motor Company)
• Original Assignee: Ford Global Technologies, LLC (Ford Motor Company)
• Inventors: Tseng, Hongtei Eric, Hrovat, Davorin David, Fodor, Michael G.
• Granted Patent: US 6,804,584 B2
• Time in Patent Office: Days
• US Class Current: 701/1
• 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/019 characterised by the type of sensor or the arrangement thereof B60G17/01941 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/104 lateral or transversal with regard to vehicle
• CPC Class Codes: B60G 2400/204 Vehicle speed
• CPC Class Codes: B60G 2400/41 Steering angle
• CPC Class Codes: B60G 2400/82 Ground surface
• CPC Class Codes: B60G 2600/602 high pass
• CPC Class Codes: B60G 2600/604 low pass
• CPC Class Codes: B60G 2800/012 Rolling condition
• CPC Class Codes: B60G 2800/0194 transversal with regard to vehicle
• CPC Class Codes: B60G 2800/24 Steering, cornering
• CPC Class Codes: B60G 2800/702 Improving accuracy of a sensor signal
• CPC Class Codes: B60T 2210/22 Banked curves
• CPC Class Codes: B60T 2230/03 Overturn, rollover
• 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 2050/0055 High-pass filters
• CPC Class Codes: B60W 2050/0056 Low-pass filters
• CPC Class Codes: B60W 2510/20 : Steering systems
• CPC Class Codes: B60W 2520/10 : Longitudinal speed
• CPC Class Codes: B60W 2520/125 : Lateral acceleration
• CPC Class Codes: B60W 2520/18 : Roll
• CPC Class Codes: B60W 2540/18 : Steering angle
• CPC Class Codes: B60W 2552/00 : Input parameters relating to infrastructure
• CPC Class Codes: B60W 2552/15 : Road slope, i.e. the inclination of a road segment in the longitudinal direction
• CPC Class Codes: B60W 2720/18 : Roll
• CPC Class Codes: B60W 30/04 : related to roll-over prevention
• CPC Class Codes: B60W 40/112 : Roll movement

Abstract

A method for determining road bank angle in a vehicle includes a lateral acceleration sensor (22) that generates a lateral acceleration signal. A yaw rate sensor (18) generates a yaw rate signal. A roll rate sensor (23) generates a yaw rate signal. A controller (14) coupled to the sensors calculates a first roll angle signal in response to the roll rate signal and calculates a second roll angle signal corresponding to a suspension reference roll angle in response to the lateral acceleration signal. The controller calculates a bank angle signal in response to the lateral acceleration signal, the yaw rate signal, the steering wheel signal and the speed signal. The controller sums the first roll angle signal, the second roll angle signal and the bank angle signal to obtain a final roll angle estimate.

Claims

1. A system for controlling a vehicle comprising:

a lateral acceleration sensor generating a lateral acceleration signal corresponding to a lateral acceleration of the vehicle;

a yaw rate sensor generating a yaw rate signal corresponding to a yaw rate of the vehicle;

a steering wheel angle sensor generating a steering wheel angle signal corresponding to a steering wheel angle of the vehicle;

a speed sensor generating a speed signal corresponding to the longitudinal speed of the vehicle;

a roll rate sensor generating a roll rate signal; and

a controller coupled to said lateral acceleration sensor and said yaw rate sensor, said steering wheel angle sensor and said speed sensor, said controller calculating a first roll angle signal in response to said roll rate signal;

calculating a bank angle signal in response to said lateral acceleration signal, said yaw rate signal, said steering wheel signal and said speed signal, and summing the first roll angle signal and the bank angle signal to obtain a final roll angle estimate.

2. A system as recited in claim 1 further comprising a high pass filter filtering the first roll angle signal.

3. A system as recited in claim 1 wherein said controller calculates a second roll angle signal corresponding to a suspension reference roll angle in response to said lateral acceleration signal, and sums the first roll angle signal, the second roll angle signal and the bank angle signal to obtain a final roll angle estimate.

4. A system as recited in claim 3 further comprising a first low pass filter filtering the second roll angle signal.

5. A system as recited in claim 1 further comprising a bank angle filter filtering the bank angle signal.

6. A system as recited in claim 1 wherein said controller comprises an integrator integrating said roll rate signal to obtain the first roll angle signal.

7. A system as recited in claim 1 wherein said controller calculates a first bank angle estimate dependent on said lateral acceleration signal, calculating a second bank angle estimate dependent on said yaw rate signal, calculating a third bank angle estimate dependent on both said lateral acceleration signal and second yaw rate signal, calculating a dynamic compensation factor based as a function of said first bank angle estimate, said second bank angle estimate and said third bank angle estimate, decomposing the third bank angle estimate into a plurality of third bank angle frequency bands, reducing each of the plurality of third bank angle frequency bands in response to a multiplicative factor, said multiplicative factor being a function of said dynamic compensation factor to obtain a plurality of reduced third bank angles, and calculating a final bank angle bias estimate based on a sum of the plurality of reduced third bank angles.

8. A method of determining a roll angle comprising:

providing a lateral acceleration signal corresponding to a lateral acceleration of the vehicle;

providing a yaw rate signal corresponding to a yaw rate of the vehicle;

providing a steering wheel signal responsive to a sensed steering wheel angle of the vehicle;

providing a speed signal corresponding to a vehicle speed;

calculating a first bank angle estimate dependent on said lateral acceleration signal, said yaw rate signal, said steering wheel signal and said speed signal;

calculating a suspension reference roll angle in response to said lateral acceleration signal; and

calculating a conservative bank angle estimate signal in response to the first bank angle estimate and the suspension roll reference angle.

9. A method as recited in claim 8 further comprising providing a roll rate signal corresponding to the roll rate of the vehicle;

integrating the roll rate signal to obtain a roll-rate based roll angle; and

summing the conservative bank angle estimate, the suspension reference roll angle and the roll-rate based roll angle to obtain a final roll angle estimate.

10. A method as recited in claim 9 further comprising high pass filtering said roll-rate based roll angle prior to the summing.

11. A method as recited in claim 8 further comprising low pass filtering said conservative bank angle estimate signal.

12. A method as recited in claim 8 wherein calculating a first bank angle estimate comprises calculating a first bank angle estimate dependent on said lateral acceleration signal;

calculating a second bank angle estimate dependent on said yaw rate signal;

calculating a third bank angle estimate dependent on both said lateral acceleration signal and the yaw rate signal;

calculating a dynamic compensation factor based as a function of said first bank angle estimate, said second bank angle estimate and said third bank angle estimate;

decomposing the third bank angle estimate into a plurality of third bank angle frequency bands;

reducing each of the plurality of third bank angle frequency bands in response to a multiplicative factor, said multiplicative factor being a function of said dynamic compensation factor to obtain a plurality of reduced third bank angles; and

calculating a final bank angle bias estimate based on a sum of the plurality of reduced third bank angles.

13. The method according to claim 8, further comprising calculating said first and second bank angle estimates using said steering wheel angle signal and speed signal.

14. A method of determining a roll angle of a vehicle comprising:

providing a lateral acceleration signal corresponding to a lateral acceleration of the vehicle;

providing a yaw rate signal corresponding to a yaw rate of the vehicle;

providing a steering wheel signal responsive to a sensed steering wheel angle of the vehicle;

providing a speed signal corresponding to a vehicle speed;

providing a roll rate signal corresponding to the roll rate of the vehicle;

calculating a first roll angle signal in response to said roll rate signal;

calculating a bank angle signal in response to said lateral acceleration signal, said yaw rate signal, said steering wheel signal and said speed signal; and

summing the first roll angle signal, and the bank angle signal to obtain a final roll angle estimate.

15. A method as recited in claim 14 further comprising high pass filtering said first roll angle signal before the step of summing.

16. A method as recited in claim 14 further comprising calculating a second roll angle signal corresponding to a suspension reference roll angle in response to said lateral acceleration signal;

and wherein summing comprises summing the first roll angle signal, the second roll angle signal and the bank angle signal to obtain a final roll angle estimate.

17. A method as recited in claim 16 further comprising low pass filtering said second roll angle signal before summing.

18. A method as recited in claim 14 further comprising low pass filtering said bank angle signal before summing.

19. A method as recited in claim 14 wherein calculating a first roll angle signal comprises providing integrating the roll rate signal to obtain the roll-rate based roll angle.

20. A method as recited in claim 14 wherein calculating a bank angle comprises

calculating a first bank angle estimate dependent on said lateral acceleration signal;

calculating a second bank angle estimate dependent on said yaw rate signal;

calculating a third bank angle estimate dependent on both said lateral acceleration signal and the yaw rate signal;

calculating a dynamic compensation factor based as a function of said first bank angle estimate, said second bank angle estimate and said third bank angle estimate;

decomposing the third bank angle estimate into a plurality of third bank angle frequency bands;

reducing each of the plurality of third bank angle frequency bands in response to a multiplicative factor, said multiplicative factor being a function of said dynamic compensation factor to obtain a plurality of reduced third bank angles; and

calculating a final bank angle bias estimate based on a sum of the plurality of reduced third bank angles.