The present invention relates generally to a control apparatus for controlling a system of an automotive vehicle in response to sensed dynamic behavior, and more specifically, to a method and apparatus for determining a desired yaw rate and lateral velocity from a driver's input.
Dynamic control system are currently offered in various vehicles. Dynamic control systems include roll stability control systems and yaw stability control systems. Other types of safety systems are also offered in vehicles such as deployment devices including active roll bars and side impact airbags. In such systems various control angles are determined which, in turn, are converted to control signals for deployment or control.
Various conditions of the road such as a bank or road crown affect how the driver must compensate. For example, the driver must compensate to the left when driving on a crowned road. The tire steering angles are also affected by the pitch or bank angles. Typically, control system models do not take into consideration the bank angles with respect to the driver steering input. Thus, such models are not capable of differentiating between a steering input that could cause a yaw vehicle response on a level road surface and one that is needed to maintain the vehicle path when compensating for a bank.
It is therefore desirable to provide a stability control system that takes into account the bank angle with respect to the control system.
It is therefore one object of the invention to provide a detection scheme that may be used in conjunction with the dynamic stability control system of the vehicle to determine the presence of a rollover.
In one aspect of the invention, a method of controlling a vehicle comprises determining a calculated lateral velocity from a front lateral tire force, a rear lateral tire force and a bank angle, determining a calculated yaw rate from the front lateral tire force and the rear lateral tire force, and controlling a safety system in response to the calculated lateral velocity and the calculated yaw rate.
In another aspect of the invention, control system for an automotive vehicle includes a lateral acceleration sensor generating a lateral acceleration signal, a yaw rate sensor generating a yaw rate signal and a safety system. A safety system and the sensors are coupled to a controller. The controller determines a front lateral tire force and a rear lateral tire force from the vehicle yaw rate signal and the vehicle lateral acceleration signal, determines a calculated lateral velocity from the front lateral tire force, the rear lateral tire force and a bank angle, determines a calculated yaw rate from the front lateral tire force and the rear lateral tire force, said controller controlling a safety system in response to the calculated lateral velocity and the calculated yaw rate.
One advantage of the invention is that the driver's intent may be easily determined to take into account road angle variation.
Other advantages and features of the present invention will become apparent when viewed in light of the detailed description of the preferred embodiment when taken in conjunction with the attached drawings and appended claims.
In the following figures the same reference numerals will be used to identify the same components. The present invention is may be used in conjunction with a rollover control system for a vehicle. However, the present invention may also be used with a deployment device such as airbag or active roll bar. The present invention will be discussed below in terms of preferred embodiments relating to an automotive vehicle moving in a three-dimensional road terrain.
Referring to
As mentioned above, the system may also be used with safety systems including active/semi-active suspension systems, anti-roll bar, or airbags or other safety devices deployed or activated upon sensing predetermined dynamic conditions of the vehicle.
The sensing system 16 is coupled to a control system 18. The sensing system 16 may comprise many different sensors including the sensor set typically found in a dynamic control system (including lateral accelerometer, yaw rate sensor, steering angle sensor and wheel speed sensor) together with a roll rate sensor, a vertical accelerometer, and a longitudinal accelerometer. The various sensors will be further described below. The wheel speed sensors 20 are mounted at each corner of the vehicle and generate signals corresponding to the rotational speed of each wheel. The rest of the sensors of sensing system 16 may be mounted directly on the center of gravity of the vehicle body, along the directions x, y and z shown in
The angular rate sensors and the accelerometers may be mounted on the vehicle car body along the body frame directions b1, b2 and b3, which are the x-y-z axes of the sprung mass of the vehicle.
The longitudinal acceleration sensor is mounted on the car body located at the center of gravity, with its sensing direction along b1-axis, whose output is denoted as ax. The lateral acceleration sensor is mounted on the car body located at the center of gravity, with its sensing direction along b2-axis, whose output is denoted as ay.
The other frame used in the following discussion includes the road frame, as depicted in
In the following discussion, the Euler angles of the body frame b1b2b3 with respect to the road frame r1r2r3 are denoted as θxbr, θybr, and θzbr, which are also called the relative Euler angles (i.e., relative roll, relative pitch and relative yaw angles, respectively).
Referring now to
Controller 26 may include a signal multiplexer 50 that is used to receive the signals from the sensors 28-42. The signal multiplexer 50 that provides the signals to a wheel lift detector 52, a vehicle roll angle calculator 54, and to a roll stability control (RSC) feedback control command 56. Also, wheel lift detector 52 may be coupled to the vehicle roll angle calculator 54. The vehicle roll angle calculator 54 may also be coupled to the RSC feedback command 56. Vehicle roll angle calculator 54 is described in provisional applications 60/400,376 and 60/400,172, and U.S. application Ser. No. 10/459,697, the disclosures of which are incorporated herein by reference.
In the preferred embodiment the sensors are located at the center of gravity of the vehicle. Those skilled in the art will recognize that the sensor may also be located off the center of gravity and translated equivalently thereto.
Lateral acceleration, roll orientation and speed may be obtained using a global positioning system (GPS). Based upon inputs from the sensors, controller 26 may control a safety device 44. Depending on the desired sensitivity of the system and various other factors, not all the sensors 28-42 may be used in a commercial embodiment. Safety device 44 may control an airbag 45 or a steering actuator 46A-46D at one or more of the wheels 12a, 12b, 13a, 13b of the vehicle 10. Also, other vehicle components such as a suspension control 48 may be used to adjust the suspension to prevent rollover.
Roll angular rate sensor 34 and pitch rate sensor 37 may sense the roll condition or lifting of the vehicle based on sensing the height of one or more points on the vehicle relative to the road surface. Sensors that may be used to achieve this include a radar-based proximity sensor, a laser-based proximity sensor and a sonar-based proximity sensor.
Roll rate sensor 34 and pitch rate sensor 37 may also sense the roll condition or lifting based on sensing the linear or rotational relative displacement or displacement velocity of one or more of the suspension chassis components. This may be in addition to or in combination with suspension position sensor 42. The position sensor 42, roll rate sensor 34 and/or the pitch rate sensor 37 may include a linear height or travel sensor, a rotary height or travel sensor, a wheel speed sensor used to look for a change in velocity, a steering wheel position sensor, a steering wheel velocity sensor and a driver heading command input from an electronic component that may include steer by wire using a hand wheel or joy stick.
The roll condition or lifting may also be sensed by sensing directly or estimating the force or torque associated with the loading condition of one or more suspension or chassis components including a pressure transducer in an act of air suspension, a shock absorber sensor such as a load sensor 40, a strain gauge, the steering system absolute or relative motor load, the steering system pressure of the hydraulic lines, a tire lateral force sensor or sensors, a longitudinal tire force sensor, a vertical tire force sensor or a tire sidewall torsion sensor. The yaw rate sensor 28, the roll rate sensor 34, the lateral acceleration sensor 32, and the longitudinal acceleration sensor 36 may be used together to determine that the wheel has lifted. Such sensors may be used to determine wheel lift or estimate normal loading associated with wheel lift. These are passive methods as well.
The roll condition of the vehicle may also be established by one or more of the following translational or rotational positions, velocities or accelerations of the vehicle including a roll gyro, the roll rate sensor 34, the yaw rate sensor 28, the lateral acceleration sensor 32, the vertical acceleration sensor 33, a vehicle longitudinal acceleration sensor 36, lateral or vertical speed sensor including a wheel-based speed sensor 20, a radar-based speed sensor, a sonar-based speed sensor, a laser-based speed sensor or an optical-based speed sensor.
Safety device 44 may control the position of the front right wheel actuator 46A, the front left wheel actuator 46B, the rear left wheel actuator 46C, and the right rear wheel actuator 46D. Although as described above, two or more of the actuators may be simultaneously controlled. For example, in a rack-and-pinion system, the two wheels coupled thereto are simultaneously controlled. Based on the inputs from sensors 28 through 42, controller 26 determines a roll condition and/or wheel lift and controls the steering position of the wheels.
Safety device 44 may be coupled to a brake controller 60. Brake controller 60 controls the amount of brake torque at a front right brake 62A, front left brake 62b, rear left brake 62c and a rear right brake 62d. Other safety systems such as an antilock brake system 64, a yaw stability control system 66 and a traction control system 68 may also benefit from the dynamic conditions determined herein. Using this information, the control strategy such as an amount of braking may be modified.
Speed sensor 20 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. The controller may translate 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 center of gravity. Various other algorithms are known to those skilled in the art. Speed may also be obtained from a transmission sensor. For example, if speed is determined while speeding up or braking around a corner, the lowest or highest wheel speed may not be used because of its error. Also, a transmission sensor may be used to determine vehicle speed.
Load sensor 40 may be a load cell coupled to one or more suspension components. By measuring the stress, strain or weight on the load sensor a shifting of the load can be determined.
The roll condition of a vehicle can be characterized by the relative roll angle between the vehicle body and the wheel axle and the wheel departure angle (between the wheel axle and the average road surface). Both the relative roll angle and the wheel departure angle may be calculated in relative roll angle estimation module by using the roll rate and lateral acceleration sensor signals. If both the relative roll angle and the wheel departure angles are large enough, the vehicle may be in either single wheel lifting or double wheel lifting. On the other hand if the magnitude of both angles are small enough, the wheels are likely all grounded.
The roll condition of a vehicle can be characterized by rolling radius-based wheel departure roll angle, which captures the angle between the wheel axle and the average road surface through the dynamic rolling radii of the left and right wheels when both of the wheels are grounded. Since the computation of the rolling radius is related to the wheel speed and the linear velocity of the wheel, such rolling-radius based wheel departure angle will assume abnormal values when there are large wheel slips. This happens when a wheel is lifted and there is torque applied to the wheel. Therefore, if this rolling radius-based wheel departure angle is increasing rapidly, the vehicle might have lifted wheels. Small magnitude of this angle indicates the wheels are all grounded.
The roll condition of the vehicle can be seen indirectly from the wheel longitudinal slip. If during a normal braking or driving torque the wheels at one side of the vehicle experience increased magnitude of slip, then the wheels of that side are losing longitudinal road torque. This implies that the wheels are either driven on a low mu surface or lifted up.
The roll condition of the vehicle can be characterized by the normal loading sustained at each wheel. Theoretically, when a normal loading at a wheel decreases to zero, the wheel is no longer contacting the road surface. In this case a potential rollover is under the way. Large magnitude of this loading indicates that the wheel is grounded.
The roll condition can be identified by checking the actual road torques applied to the wheels and the road torques which are needed to sustain the wheels when they are grounded. The actual road torques can be obtained through torque balancing for each wheel using wheel acceleration, driving torque and braking torque. If the wheel is contacting the road surface, the calculated actual road torques must match or be larger than the torques determined from the nonlinear torques calculated from the normal loading and the longitudinal slip at each wheel.
The roll condition of a vehicle can be characterized by the relative roll angle θxr the vehicle body and the wheel axle, which has been calculated by using the roll rate and lateral acceleration sensor signals. If this roll angle is increasing rapidly, the vehicle might be in the edge of wheel lifting or rollover. Small magnitude of this angle indicates the wheels are not lifted or are all grounded.
The roll condition of a vehicle can also be characterized by the roll angle between the wheel axle and the average road surface, this is called wheel departure angle. If this roll angle is increasing rapidly, the vehicle has lifted wheel or wheels and aggressive control action needs to be taken in order to prevent the vehicle from rolling over. Small magnitude of this angle indicates the wheels are not lifted. This section describes how to quantitatively determine the vehicle roll angle when a qualitative wheel lifting is identified. That is, if a qualitative wheel lifting is detected, a quantitative computation of the wheel lifting may be initiated.
Referring now to
In the following description the following inputs are used:
In the following description the following intermediate variables are used:
In the following description the following state variable are used:
In the following description the following assumptions are used:
Referring now to
Referring now to
Referring now to
Referring now to
Equations of motion are formulated in the plane of the road. The rear tire force in the x direction is calculated by the following relation in step 102.
where the rear slip angle αr is:
The rear steering angle is given by:
In the front of the vehicle δf is not necessarily small as in the case of δr. The front tire force in the x direction is determined in step 104 by:
Additionally, to determine the angle αf between the resultant velocity of the front tires (velf) and the longitudinal axis of the tire (x′), the resultant velocity is projected onto lateral and longitudinal axes perpendicular and parallel to the wheel (x′ and y′). To do this, the longitudinal velocity (u) and lateral velocity (v+a*r) components of the front tire velocity, in the body coordinate axes (x and y), can be projected onto the x′ and y′ axes through trigonometry. These projections, vlatf and vlongf can then be used to determine the slip angle of the tire.
Taking the sum of forces in the y direction in step 108 and the sum of moments about the center of gravity in the z direction in step 110, the equations of motion are:
Note that the component of gravity due to the bank angle only affects the sum of forces in the y direction since the moments are summed about the center of gravity.
In step 112, the differential equations from steps 108 and 112 can be numerically integrated to obtain the vehicle state variables, a desired or calculated yaw rate and a desired or calculated lateral velocity. The control system may then be controlled in step 114 according to the desired values. For example a yaw rate system using these values takes into consideration values such as pitching and road bank angle such as in a crowning of the road.
Safety systems such as yaw control and rollover control systems may particularly benefit fro such determinations. Deploying device type safety devices such as side airbags and active roll bars may also benefit.
While particular embodiments of the invention have been shown and described, numerous variations and alternate embodiments will occur to those skilled in the art. Accordingly, it is intended that the invention be limited only in terms of the appended claims.