Roll over detection for an automotive vehicle

Abstract: A stability control system 24 for an automotive vehicle as includes a plurality of sensors 28-37 sensing the dynamic conditions of the vehicle and a controller 26 that controls a distributed brake pressure to reduce a tire moment so the net moment of the vehicle is counter to the roll direction. The sensors include a speed sensor 30, a lateral acceleration sensor 32, a roll rate sensor 34, and a yaw rate sensor 28. The controller 26 is coupled to the speed sensor 30, the lateral acceleration sensor 32, the roll rate sensor 34, the yaw rate sensor 28. The controller 26 determines a roll angle estimate in response to lateral acceleration, roll rate, vehicle speed, and yaw rate. The controller 26 may ultimately be used to determine a tire force vector such as brake pressure distribution or a steering angle change in response to the relative roll angle estimate.

Description: The present invention relates generally to a dynamic behaviour control apparatus for an automotive vehicle, and more specifically, to a method and apparatus for detecting rollover of a vehicle. Dynamic control systems for automotive vehicles have recently begun to be offered on various products. Dynamic control systems typically control the yaw of the vehicle by controlling the braking effort at the various wheels of the vehicle. Yaw control systems typically compare the desired direction of the vehicle based upon the steering wheel angle and the direction of travel. By regulating the amount of braking at each corner of the vehicle, the desired direction of travel may be maintained. Typically, the dynamic control systems do not address roll of the vehicle. For high profile vehicles in particular, it would be desirable to control the roll over characteristic of the vehicle to maintain the vehicle position with respect to the road. That is, it is desirable to maintain contact of each of the four tires of the vehicle on the road. Vehicle rollover and tilt control (or body roll) are distinguishable dynamic characteristics. Tilt control maintains the vehicle body on a plane or nearly on a plane parallel to the road surface. Roll over control is maintaining the vehicle wheels on the road surface. One system of tilt control system is described in U.S. Patent 5,869,943. The '943 patent uses the combination of yaw control and tilt control to maintain the vehicle body horizontal while turning. The system is used in conjunction with the front outside wheels only. To control tilt, a brake force is applied to the front outside wheels of a turn. One problem with the application of a brake force to only the front wheels is that the cornering ability of the vehicle may be reduced. Another disadvantage of the system is that the yaw control system is used to trigger the tilt control system. During certain vehicle manoeuvres, the vehicle may not be in a turning or yawing condition but may be in a rollover condition. Such a system does not address preventing rollover in a vehicle. It would therefore be desirable to provide a roll stability system that detects a potential rollover condition as well as to provide a system not dependent upon a yaw condition. US patent 5 408 411 describes a vehicle system that includes a 6 freedom motion sensor. The sensor is capable of detecting a number of quantities including the variation rate of the vehicular longitudinal acceleration, the vehicular longitudinal acceleration, the vehicular longitudinal speed, the variation rate of the lateral acceleration, the lateral acceleration, the lateral speed, the variation rate of the vertical acceleration, the vertical acceleration, the vertical speed, the roll rate and yaw rate. A controller is coupled to the sensor to detect the rolling angle about the x and y axes and thus detects the vehicle attitude for detecting the load on the respective wheels. US patent 5 548 536 describes a vehicle system in which signals indicative of steering angle, longitudinal speed and two transverse accelerations located one behind the other in the longitudinal direction of the vehicle are fed to a computing device. The measured quantities are used to derive further quantities including the roll angle of the vehicle. DE 199 18 525 A describes a vehicle system including a number of sensors including a yaw sensor, a transverse acceleration sensor, a roll rate sensor and forward and backward acceleration sensors. A roll angle is estimated with a transfer function dependent on the steering angle of the vehicle. EP-A-0 943 513 describes a vehicle system which senses roll rate, lateral acceleration and the angle of rotation of the steering shaft. A combined airbag and brake control is operated based on the measured values and a determination that a measured value above a threshold indicates that an inner wheel has lifted from the road surface. In one aspect of the invention there is now provided a rollover detection system for a vehicle rollover comprising a speed sensor; a lateral acceleration sensor; a roll rate sensor; a yaw rate sensor; and a controller coupled to said speed sensor, said lateral acceleration sensor, said roll rate sensor and said yaw rate sensor said controller determining a roll angle estimate in response to lateral acceleration, roll rate, vehicle speed, and yaw rate, characterised in that said controller comprises iterative roll rate offset logic to derive a roll rate offset, the controller determining roll rate in response to a raw roll rate signal from the roll rate sensor and the roll rate offset from the roll rate offset logic, the roll rate offset logic including roll rate offset initialisation means and roll rate offset compensation logic to determine an initial roll rate offset of zero when the vehicle is at rest. The controller may also use longitudinal acceleration and pitch rate to determine the roll angle estimate. In a further aspect of the invention, a method of controlling roll stability of the vehicle comprises the steps of: determining a yaw rate for the vehicle; determining a roll rate for the vehicle; determining a lateral acceleration for the vehicle; determining vehicle speed; and determining a vehicle roll rate in response to yaw rate, roll rate, lateral acceleration and vehicle speed characterised by employing iterative roll rate offset logic to derive a roll rate offset, the roll rate being determined in response to a raw roll rate signal from a roll rate sensor and the roll rate offset from the roll rate offset logic, the roll rate offset logic including roll rate offset initialisation means and roll rate offset compensation logic to determine an initial roll rate offset of zero when the vehicle is at rest. One advantage of the invention is that the turning radius of the vehicle is not affected by the roll stability control. The present invention will now be described further, by way of example, with reference to the accompanying drawings, in which: Figure 1 is a diagrammatic rear view of a vehicle with force vectors not having a roll stability system according to the present invention; Figure 2 is a diagrammatic rear view of a vehicle with force vectors having a roll stability system according to the present invention; Figure 3 is a block diagram of a roll stability system according to the present invention; Figure 4 is a flow chart of a yaw rate determination according to the present invention; Figure 5 is a flow chart of roll rate determination according to the present invention; Figure 6 is a flow chart of a lateral acceleration determination according to the present invention; Figure 7 is a flow chart of chassis roll angle estimation and compensation; Figure 8 is a flow chart of a relative roll calculation; Figure 9 is a flow chart of system feedback for the right side of the vehicle resulting in brake distribution force; Figure 10 is a flow chart of system feedback for the left side of the vehicle; and Figure 11 is a flow chart of another embodiment similar to that of Figures 9 and 10 resulting in change in steering position. Referring to Figure 1, an automotive vehicle 10 without a rollover stability system of the present invention is illustrated with the various forces and moments thereon during a rollover condition. Vehicle 10 has right and left tires 12 and 13 respectively. Generally, the vehicle has a weight represented as M*g at the centre of gravity of the vehicle. A gravity moment 14 acts about the centre of gravity (CG) in a counter-clockwise direction. A tire moment 16 acts in a clockwise direction about the centre of gravity. Thus, the net moment 18 acting upon the vehicle is in a clockwise direction and thus increases the roll angle 20 of the vehicle. The lateral force 22 at the tire 12 on the ground (tire vector) is a significant force to the left of the diagram capable of overturning the vehicle is uncorrected. Referring now to Figure 2, a roll stability control system 24 is included within vehicle 10, which is in a roll condition. The forces illustrated in Figure 2 are given the same reference numerals as the forces and moments in Figure 1. In Figure 2, however, roll stability controller 24 reduces the tire moment 16 to provide a net moment 18 in a counter-clockwise direction. Thus, the tire vector or lateral force 22 at tire 12 is reduced as well. This tendency allows the vehicle to tend toward the horizontal and thus reduce angle 20. Referring now to Figure 3, roll stability control system 24 has a controller 26 used for receiving information from a yaw rate sensor 28, a speed sensor 30, a lateral acceleration sensor 32, a roll rate sensor 34, a steering angle sensor 35, a longitudinal acceleration sensor 36 and a pitch rate sensor 37. Lateral acceleration and speed may be obtained using a global positioning system (GPS). Based upon inputs from the sensors, controller 26 controls a tire force vector by brake control 38 as will be further described below or changing the steering angle. Depending on the desired sensitivity of the system and various other factors, not all the sensors 28-37 may be used in a commercial embodiment. Brake control 38 controls the front right brake 40, the front left brake 42, the rear left brake 44, and the right rear brake 46. Based on the inputs from sensors 28 through 34, controller 26 determines a roll condition and controls the brake pressure of the brakes on the appropriate side of the vehicle. The braking pressure is balanced on the side of the vehicle to be controlled between the front and rear brakes to minimise the induced yaw torque and induced path deviation. The yaw rate sensor 28 generates a raw yaw rate signal (YR_Raw). 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 centre of gravity (V_CG). Various other algorithms are known to those skilled in the art. For example, if speed is determined while speeding up or braking around a corner, the lowest or highest wheel speed may be not used because of its error. Referring now to Figure 4, a yaw rate compensated and filtered signal (YR_CompFlt) is determined. The velocity of the vehicle at centre of gravity (V_CG), the yaw rate offset (YR_Offset) and the raw yaw rate signal from the yaw rate sensor (YR_Raw) are used in a yaw rate offset initialisation block 40 to determine an initial yaw rate offset. Because this is an iterative process, the yaw rate offset from the previous calculation is used by yaw rate offset initialisation block 40. If the vehicle is not moving as during start-up, the yaw rate offset signal is that value which results in a compensated yaw rate of zero. This yaw rate offset signal helps provide an accurate reading. For example, if the vehicle is at rest, the yaw rate signal should be zero. However, if the vehicle is reading a yaw rate value then that yaw rate value is used as the yaw rate offset. The yaw rate offset signal along with the raw yaw rate signal is used in the anti-windup logic block 42. The anti-windup logic block 42 is used to cancel drift in the yaw rate signal. The yaw rate signal may have drift over time due to temperature or other environmental factors. The anti-windup logic block also helps compensate for when the vehicle is travelling constantly in a turn for a relatively long period. The anti-windup logic block 42 generates either a positive compensation OK signal (Pos Comp OK) or a negative compensation OK signal (Neg Comp OK). Positive and negative in this manner have been arbitrarily chosen to be the right and left direction with respect to the forward direction of the vehicle, respectively. The positive compensation OK signal, the negative compensation OK signal and the yaw rate offset signal are inputs to yaw rate offset compensation logic block 44. The yaw rate offset compensation logic block 44 is used to take data over a long period of time. The data over time should have an average yaw of zero. This calculation may be done over a number of minutes. A yaw rate offset signal is generated by yaw rate offset compensation logic 44. A summing block 46 sums the raw yaw rate signal and the yaw rate offset signal to obtain a yaw rate compensated signal (YR_Comp). A low pass filter 48 is used to filter the yaw rate compensated signal for noise. A suitable cut-off frequency for low pass filter 48 is 20 Hz. Referring now to Figure 5, a roll rate compensated and filtered signal (RR_CompFlt). The roll rate compensated and filtered signal is generated in a similar manner to that described above with respect to yaw rate. A roll rate offset initialisation block 50 receives the velocity at centre of gravity signal and a roll rate offset signal. The roll rate offset signal is generated from a previous iteration. Like the yaw rate, when the vehicle is at rest such as during start-up, the roll rate offset signal is zero. A roll rate offset compensation logic block 52 receives the initialised roll rate offset signal. The roll rate offset compensation logic generates a roll rate offset signal which is combined with the roll rate raw signal obtained from the roll rate sensor in a summing block 54. A roll rate compensated signal (RR_Comp) is generated. The roll rate compensated signal is filtered in low pass filter 56 to obtain the roll rate compensated and filtered signal that will be used in later calculations. Referring now to Figure 6, the raw lateral acceleration signal (Lat Acc Raw) is obtained from lateral acceleration sensor 32. The raw lateral acceleration signal is filtered by a low pass filter to obtain the filtered lateral acceleration signal (Lat Acc Flt). The filter, for example, may be a 20 Hz low pass filter. Referring now to Figure 7, a roll angle estimation signal (RollAngleEst) is determined by chassis roll estimation and compensation procedure 62. Block 64 is used to obtain a longitudinal vehicle speed estimation at the centre of gravity of the vehicle. Various signals are used to determine the longitudinal vehicle speed at the centre of gravity including the velocity of the vehicle at centre of gravity determined in a previous loop, the compensated and filtered yaw rate signal determined in Figure 4, the steering angle, the body slip angle, the front left wheel speed, the front right wheel speed, the rear left wheel speed, and the rear right wheel speed. The new velocity of the centre of gravity of the vehicle is an input to body roll angle initialisation block 66. Other inputs to body roll angle initialisation block 66 include roll angle estimate from the previous loop and a filtered lateral acceleration signal derived in Figure 6. An updated roll angle estimate is obtained from body roll angle initialisation. The updated roll angle estimate, the compensation and filtered roll rate determination from Figure 5, and the time of the loop is used in body roll angle integration block 68. The updated roll angle estimate is equal to the loop time multiplied by the compensated and filtered roll rate which is added to the previous roll angle estimate obtained in block 66. The updated roll angle estimate is an input to roll angle estimate offset compensation block 70. The velocity at the centre of gravity of the vehicle is also an input to instantaneous roll angle reference block 72. Other inputs to instantaneous roll angle reference block 72 include the compensated and filtered yaw rate from Figure 4 and the filtered lateral acceleration signal from Figure 6. The following formula is used to determine a reference roll angle: Reference Roll Angle = ARCSin[1/g(VCG*YRCompFlt-LatAccFlt)] Where g is the gravitational constant 9.81 m/s 2 The reference roll angle from block 72 is also an input to roll angle estimate offset compensation. The updated roll angle estimation is given by the formula: RollAngleEst = RollAngleEst(from Block68) + (Reference Roll Angle-RollAngleEst(Block68)) loop time Tau Where Tau is a time constant and may be a function of steering velocity, LatAcc and V-CG. A suitable time constant may, for example, be 30 seconds. Referring now to Figure 8, a relative roll angle estimation (RelativeRollAngleEst) and a road bank angle estimate signal is determined. The first step of the relative roll angle calculation involves the determination of road bank angle compensation time constant (Tau) block 72. The velocity at the centre of gravity, the steering velocity and the filtered lateral acceleration signal from Figure 6 are used as inputs. A compensated and filtered roll rate (RR_CompFlt) is used as an input to a differentiator 74 to determine the roll acceleration (Roll Acc). Differentiator 74 takes the difference between the compensated and filtered roll rate signal from the previous loop and the compensated and filtered roll rate from the current loop divided by the loop time to attain the roll acceleration. The roll acceleration signal is coupled to a low pass filter 76. The filtered roll acceleration signal (Roll Acc Flt), roll angle estimate, the filtered lateral acceleration signal and the loop time are coupled to chassis relative roll observer block 78. The chassis roll observer 78 determines the model roll angle estimation (Model Roll Angle Est). The model roll angle is a stable estimation of the roll dynamics of the vehicle which allows the estimates to converge to a stable condition over time. From the model roll angle estimation from block 78, the initial relative roll angle estimation from block 72, a road bank angle initialisation from a block 79 loop time and a roll angle estimate, road bank angle compensation block 80 determines a new road bank angle estimate. The formula for road bank angle is: The roll angle estimate may be summed with the road bank angle estimate from block 80 in summer 82 to obtain a relative roll angle estimate. The road bank angle estimate may be used by other dynamic control systems. Referring now to Figure 9, the relative roll angle estimate from Figure 8 and a relative roll deadband are summed in summer 84 to obtain an upper roll error. The upper roll error is amplified in KP_Roll Amplifier 86 and is coupled to summer 88. The roll rate compensated and filtered signal from Figure 5 is coupled to KD_Roll Amplifier 90. The amplified roll rate signal is coupled to summer 88. The filtered roll acceleration signal from block 8 is coupled to KDD_Roll Amplifier 82. The amplified signal is also coupled to summer 88. The proportioned sum of the amplified signals is the right side braking force effort. From this, the right side brake force distribution calculation block 94 is used to determine the distribution of brake pressure between the front and rear wheels. The front right normal load estimate and the rear right normal load estimate are inputs to block 94. The front right roll control desired pressure and the right rear roll control desire pressure are outputs of block 94. The block 94 proportions the pressure between the front right and rear right signals to prevent roll. The front right, for example, is proportional according to the following formula: The output of block 94 is used by the brake controller of Figure 3 to apply brake pressure to the front right and rear right wheels. The brake controller factors in inputs such as the brake pressure currently applied to the vehicle through the application of pressure by the driver on the brake pedal. Other inputs include inputs from other dynamic control systems such as a yaw control system. Referring now to Figure 10, a similar calculation to that of Figure 9 is performed for the left side of the vehicle. The relative roll angle estimate and relative roll deadband are inputs to summing block 96. However, the signs are changed to reflect that the left side of the vehicle is a negative side of the vehicle. Therefore, relative roll angle estimate and relative roll deadband are purely summed together 96 in summing block 96 to obtain the lower roll error. The lower roll error is passed through KP_Roll amplifier 98. The compensated and filtered roll rate is passed through KD_Roll amplifier 100 and the filtered roll acceleration signal is passed through KDD_Roll amplifier 102. The inverse of the signals from amplifiers 98, 100 and 102 are input and summed in summer 104 to obtain the left side braking effort. A left side brake force distribution calculation block 106 receives the left side braking effort from summer 104. The front left normal load estimate and the rear left normal load estimate. In a similar manner to that above, the front left and rear left roll control brake pressures are determined. By properly applying the brakes to the vehicle, the tire moment is reduced and the net moment of the vehicle is counter to a roll direction to reduce the roll angle and maintain the vehicle in a horizontal plane. Referring now to Figure 11, a change in steering angle may be effectuated rather than or in combination with a change in brake force distribution. In either case, however, the tire force vector is changed. In Figure 11, the same reference numerals as those in Figures 9 and 10 are used but are primed. Everything prior to blocks 88' and 104' is identical. Blocks 88' and 104' determine right side steering effort and left side steering effort, respectively. The right side steering effort is placed through a clamping circuit 108 to ensure that a positive value is obtained. The left side steering effort is likewise placed through a clamping circuit 110 to ensure a positive value is obtained. A summing block 112 receives the output from circuits 198 and 110 where the right side is negative and the left side is positive. A delta steering angle is obtained from block 112. The method of Figure 11 is particularly suited for drive-by-wire systems or other systems that allow the steering angle to be directly controlled. The delta steering angle is an amount that changes the tire force vector to counteract roll. The delta steering angle can be used to directly move the wheels of the vehicle to physically change the direction of steering. If both steering and brake distribution are used controller 26 will be used to apportion the amount of correction provided by steering and brake distribution. The amount of apportionment will depend on the roll rate and other variables for the particular vehicle. The amount of apportionment will thus be determined for each vehicle. For example, higher profile vehicles will be apportioned differently from a low profile vehicle. As described above the longitudinal acceleration sensor and a pitch rate sensor may be incorporated into the above tire force vector determination. These sensors may be used as a verification as well as an integral part of the calculations. For example, the pitch rate or the longitudinal acceleration or both can be used to construct a vehicle pitch angle estimate. This estimate along with its derivative can be used to improve the calculation of the vehicle roll angle. An example of how the rate of change of the vehicle roll angle using theses variables may be constructed is: GlobalRR ≈ RRComp_Flt+PitchRateCompFlt (-YawRate+Sin(GlobalRollAngleEst)*Tan(VehiclePitchAngleEst))+ (YawRateCompFlt*Cos(GlobalRR)*Tan(PitchAngleEst)) Where PitchRateCompFlt is a compensated and filtered pitch rate signal, GlobalRollAngleEst is an estimated global roll angle, VehiclePitchAngleEst is an estimated vehicle pitch angle estimate, and GlobalRR is a global roll rate signal. Of course, those skilled in the art may vary the above based upon various other factors depending on the particular system needs.

Claims: A rollover detection system for a vehicle rollover comprising: a speed sensor (30); a lateral acceleration sensor (32); a roll rate sensor (34); a yaw rate sensor (28); and a controller (26) coupled to said speed sensor (30), said lateral acceleration sensor (34), said roll rate sensor (34) and said yaw rate sensor (28) said controller (26) determining a roll angle estimate in response to lateral acceleration, roll rate, vehicle speed, and yaw rate, characterised in that ; said controller (26) comprises iterative roll rate offset logic (50, 52) to derive a roll rate offset, the controller (26) determining roll rate in response to a raw roll rate signal from the roll rate sensor (34) and the roll rate offset from the roll rate offset logic (50,52), the roll rate offset logic (50,52) including roll rate offset initialisation means (50) and roll rate offset compensation logic (52) to determine an initial roll rate offset of zero when the vehicle is at rest. A rollover detection system as claimed in claim 1 further comprising a sensor selected from the group of a steering angle sensor (35), a longitudinal acceleration sensor (36) and a pitch rate sensor (37). A rollover detection system as claimed in claim 2, wherein said controller (26) determines vehicle speed at a centre of gravity of the vehicle in response to said steering sensor (35). A method of determining roll over of a vehicle comprising: determining a yaw rate for the vehicle; determining a roll rate for the vehicle; determining a lateral acceleration for the vehicle; determining vehicle speed; and determining a vehicle roll angle in response to yaw rate, roll rate, lateral acceleration and vehicle speed, characterised by employing iterative roll rate offset logic (50, 52) to derive a roll rate offset, the roll rate being determined in response to a raw roll rate signal from a roll rate sensor (34) and the roll rate offset from the roll rate offset logic (50,52), the roll rate offset logic (50,52) including roll rate offset initialisation means (50) and roll rate offset compensation logic (52) to determine an initial roll rate offset of zero when the vehicle is at rest. A method as claimed in claim 4 further comprising the step of determining roll rate in response to a yaw rate signal and a yaw rate offset. A method as claimed in claim 4 further comprising the step of determining vehicle speed at the centre of gravity of the vehicle as a function of a front right wheel speed, a rear right wheel speed, a front left wheel speed, a rear left wheel speed, and a steering wheel angle. A method as claimed in claim 4 further comprising the step of determining vehicle speed at the centre of gravity of the vehicle as a function of body slip angle. A rollover detection system according to claim 1 further comprising: a steering angle sensor (35); a longitudinal acceleration sensor (36); and a pitch rate sensor (37); said controller (26) determining a roll angle estimate in response to lateral acceleration, roll rate, vehicle speed, yaw rate, steering angle, longitudinal acceleration and pitch rate.

Inventors: BROWN TODD ALLEN, RHODE DOUGLAS SCOTT, BROWN, TODD ALLEN, RHODE, DOUGLAS SCOTT
Applicants: FORD GLOBAL TECH LLC, FORD GLOBAL TECHNOLOGIES, LLC
Application year: 2000
Main classification: B60R21
IPC codes: B60T8, B62D137, B60R21, B62D111, B62D6, B62D103, B62D101, B62D113