1. Field of the Invention
This invention relates generally to a control system and method for preventing a vehicle-trailer from jackknifing and, more particularly, to a control system and method that selectively controls rear-wheel steering of a vehicle to assist the vehicle operator when backing up a trailer to prevent a jackknife condition.
2. Discussion of the Related Art
Automotive vehicles that employ coordinated front wheel steering and rear-wheel steering systems are known in the art. Typically in such coordinated vehicle wheel steering systems, the driver controls the steering of the vehicle's front wheels and a computer-based on-board steering controller controls the steering of the vehicle's rear wheels in response thereto. In one example, the computer controlled rear-wheel steering system employs an electric motor driven rack and pinion rear-wheel steering actuator.
Backing up a vehicle-trailer is typically a complex task, and requires a certain level of skill. A jackknife condition may occur when a vehicle-trailer is moving away from its equilibrium position, where the system becomes unstable. In other words, the relative angle between the vehicle and trailer is diverging from the driver's intended target angle, which usually increases if proper steering and/or breaking actions are not taken.
It is known in the art to employ the coordinated front and rear wheel steering system referred to above to assist a driver operating a vehicle pulling a trailer. Particularly, U.S. Pat. No. 6,292,094, issued Sep. 18, 2001 to Deng et al., discloses a vehicle/trailer backing-up control system in connection with a computer controlled rear-wheel steering system. The '094 patent employs an algorithm that uses front wheel angle, vehicle speed, vehicle yaw rate and hitch angle to control the rear-wheel steering angle to assist the operator in backing up the vehicle-trailer. U.S. patent application Ser. No. 10/336,120, filed Jan. 3, 2003, titled “Trailer Tongue Length Estimation Using a Hitch Angle Sensor,” is a modification of the '094 patent that provides an estimation of the trailer tongue length to further help the system in the back-up control.
U.S. patent application Ser. No. 10/435,209, filed May 9, 2003, titled “Vehicle Trailer Backing Up Jackknife Detection And Warning System,” assigned to the assignee of this application, discloses a jackknife warning system for a vehicle. This jackknife warning system uses vehicle steering angle, vehicle speed and hitch angle to determine a potential jackknife condition. The system warns the driver if the trailer is moving towards a jackknife condition, and provides steering direction assistance.
In accordance with the teachings of the present invention, a vehicle control system and associated method is disclosed that selectively provides rear-wheel steering to prevent a vehicle-trailer from jackknifing during a back-up maneuver. The system senses a steering angle of the vehicle, a rearward speed of the vehicle and a hitch angle between the vehicle and the trailer. The system calculates an equilibrium hitch angle that is a steady-state hitch angle position based on the steering angle and the vehicle speed. The system also calculates a pseudo-equilibrium hitch angle that is a steady-state hitch angle position at a maximum rear-wheel steering input. The system then determines whether a rear-wheel steering assist should be provided based on a predetermined relationship between the sensed hitch angle, the equilibrium hitch angle and the pseudo-equilibrium hitch angle.
If the predetermined relationship exists, the system provides the rear-wheel steering assist to prevent the vehicle-trailer from jackknifing. If the rear-wheel assist is being provided, the system will periodically determine if the predetermined relationship between the sensed hitch angle, the equilibrium hitch angle and the pseudo-equilibrium hitch angle still exists, and will remove the rear-wheel steering assist when the relationship does not exist. The relationship includes the direction that the sensed hitch angle is moving and the rate at which the sensed hitch angle is moving.
Additional advantages and features of the present invention will become apparent from the following description and appended claims, taken in conjunction with the accompanying drawings.
FIGS. 6(a) and 6(b) are graphs showing simulation results with and without the rear-wheel steering control of the invention.
The following discussion of the embodiments of the invention directed to a system and method for selectively assisting a vehicle operator with rear-wheel steering when backing up a vehicle-trailer to prevent a jackknife condition is merely exemplary in nature, and is in no way intended to limit the invention or its applications or uses.
As will be discussed in detail below, the present invention employs computer controlled rear-wheel steering to selectively assist a vehicle operator when backing up a vehicle-trailer. The algorithm of the invention allows the driver to make the back-up maneuver without automatic input from the rear-wheel steering, unless the operator gets into trouble and a jackknife condition is probable without the assistance.
To selectively provide this assist, the present invention defines an equilibrium hitch angle and a pseudo-equilibrium hitch angle that are used to determine when and how to automatically steer the vehicles rear wheels to stabilize the system so that interference from the rear-wheel steering to the operator is minimized. The vehicle-trailer hitch angle is the angle between the longitudinal axis of the vehicle relative to the longitudinal axis of the trailer. The equilibrium hitch angle is the hitch angle when the system is stable, i.e., the hitch angle does not change under the current vehicle speed and steering angle. The pseudo-equilibrium hitch angle is the hitch angle outside of which the system will not be able to recover to prevent the jackknife condition. The equilibrium hitch angles are determined in real-time using sensor inputs from the driver's steering angle and vehicle speed. If the measured hitch angle diverges from the two equilibrium hitch angles, and its absolute value is increasing towards the pseudo-equilibrium hitch angle and the jackknife condition, the algorithm automatically provides rear-wheel steering to help stabilize the motion, thus preventing the jackknife condition without the vehicle operator's input.
The algorithm reads sensor input signals of the steering wheel angle δsw(n), the rearward vehicle speed u1(n) and the hitch angle θ(n) to calculate the equilibrium hitch angle {overscore (θ)}eq(n) and the pseudo-equilibrium hitch angle {circumflex over (θ)}eq(n) at box 32. The equilibrium hitch angle {overscore (θ)}eq(n) is calculated by:
where
δr=0,
is the front-wheel angle, δr is the rear-wheel angle, rgearratio is the gear ratio in the front steering system, and Γ represents the dynamic and kinematical parameters of the vehicle-trailer combination.
It is noted that this model is based on a slow motion assumption with kinematics only taken into consideration. Also, it is assumed that the roll and pitch motion of the vehicle is small and is neglected, and the tire slip is negligible during the vehicle-trailer back-up maneuver.
For a vehicle-trailer, there is only one equilibrium hitch angle {overscore (θ)}eq(n) regardless of whether the vehicle-trailer is moving forward or backward. However, during back-up maneuvers, it is possible that the system may never reach steady state before a jackknife condition occurs. Therefore, the present invention calculates the pseudo-equilibrium hitch angle {circumflex over (θ)}eq(n) , which is a steady-state hitch angle when the rear-wheel steering angle reaches its maximum value {overscore (δ)}r
But,
δr={overscore (δ)}r
δr=−{overscore (δ)}r
From equation (2), the pseudo-equilibrium hitch angle varies as the driver's steering changes, and has two values corresponding to {overscore (δ)}r
The anti-jackknifing control is activated only when necessary and possible. Therefore, for a given front steering angle δf(n)>0, the pseudo-equilibrium hitch angle {circumflex over (θ)}eq is determined by equation (2) at {overscore (δ)}r
Once the equilibrium hitch angle {overscore (θ)}eq(n) and the pseudo-equilibrium hitch angle {circumflex over (θ)}eq(n) are calculated, the algorithm determines whether the control flag has been set to true (T) at decision diamond 34. If the control flag is false (F), the system is currently not assisting the driver with rear-wheel steering and if the control flag is true (T), the system is currently providing rear-wheel steering assistance.
If the control flag has not been set to true (T), then the algorithm determines if predetermined entrance criteria have been met to provide the automatic rear-wheel steering assist at decision diamond 36. In other words, the system determines if it should be providing rear-wheel steering assistance to prevent a jackknife condition. As discussed above, the system does not assist the vehicle operator with the back-up maneuver unless certain criteria are met so that the automatic rear-wheel steering control is activated only when necessary, so as to minimize rear-wheel steering interference with the vehicle operator.
If, δf(n)>0 then,
θ(n)−{overscore (θ)}eq(n)>κ1 and θ(n)−{circumflex over (θ)}eq(n)<κ2 (3)
or,
If, δf(n)<0 then,
θ(n)−{overscore (θ)}eq(n)<κ3 and θ(n)−{circumflex over (θ)}eq(n)>κ4
κi are predetermined positive constants for calibration.
In equation (3), the algorithm determines whether the measured hitch angle θ(n) is greater than the equilibrium hitch angle {overscore (θ)}eq(n), and if so, by how much, and whether the measured hitch angle θ(n) is near the pseudo-equilibrium hitch angle {circumflex over (θ)}eq(n), depending on the orientation δf of the front wheels of the vehicle. In other words, the system provides rear-wheel steering assist only when the measured hitch angle θ(n) falls into the range set by the equilibrium hitch angle {overscore (θ)}eq(n) and pseudo-equilibrium hitch angle {circumflex over (θ)}eq(n) as defined in equation (3). The constants κi provide these values for calibration purpose.
If the algorithm determines that, for example, when δf(n)>0, the measured hitch angle θ(n) is greater than the equilibrium hitch angle {overscore (θ)}eq(n) and less than the pseudo-equilibrium hitch angle {circumflex over (θ)}eq(n) by the predetermined κi values, then the algorithm determines the rate that the hitch angle θ(n) is converging or diverging relative to the equilibrium hitch angle {overscore (θ)}eq(n) at box 44. In other words, the algorithm determines how fast the hitch angle is changing by:
The sign of the hitch angle rate {dot over (θ)}(n) determines which direction the hitch angle θ(n) is moving. The algorithm then uses the hitch angle rate {dot over (θ)}(n) at decision diamond 46 to determine the convergence or divergence of the hitch angle θ(n) by:
If, θ(n)>0, then
{dot over (θ)}(n)<0 (5)
or,
If, θ(n)<0, then
{dot over (θ)}(n)>0
The step of the decision diamond 46 multiplies the measured hitch angle θ(n) by the hitch angle rate {dot over (θ)}(n) to determine whether a positive hitch angle θ(n) is moving to decrease its value or a negative hitch angle θ(n) is moving to increase its value. If this is true, then the measured hitch angle θ(n) is converging towards the equilibrium position, the output of the decision diamond 46 is yes, and rear-wheel steering assist is not required. Otherwise, the output of the decision diamond 46 is no, and the entrance criteria are met.
If the entrance criteria are met, the output of the decision diamond 46 is yes, and the control flag is set to true (T) at box 48. The algorithm then determines the appropriate rear-wheel steering angle command δr
δr
Kp and Kd are proportional and derivative gains, respectively, and are functions of the vehicle speed u1(n).
If the algorithm determines that, for example, when δf(n)>0, the measured hitch angle θ(n) is not greater than the equilibrium hitch angle {overscore (θ)}eq(n), or not less than the pseudo-equilibrium hitch angle {circumflex over (θ)}eq(n), by the predetermined κi values at the decision diamond 42, or the measured hitch angle is converging towards the equilibrium position at the decision diamond 46, the output of the decision diamond 36 is no, and the rear-wheel steering angle command is set to zero (δr
The algorithm, at box 58, processes the rear-wheel steering angle command δr
|δr
Δ{overscore (δ)}r
Decision diamond 66 determines whether the current rear-wheel command δr
δr
If the current rear-wheel command {overscore (δ)}r
δr
If the difference between the two commands determined at the decision diamond 64 is less than Δ{overscore (δ)}r
Returning to the flow chart diagram 24, the current rear-wheel command δr
{overscore (δ)}r
The current rear-wheel command δr
If the control flag is set to true (T) at the box 48, the output of the decision diamond 34 is yes. The algorithm then determines whether predetermined exit criteria are met at decision diamond 80 to remove the rear-wheel steering angle command, if applicable.
|{overscore (δ)}r
If the absolute value of the previously stored rear-wheel angle command {overscore (δ)}r
If, δf(n)>0, then
θ(n)−{overscore (θ)}eq(n)>κ5 and θ(n)−{circumflex over (θ)}eq(n)<κ6 (12)
or,
If δf(n)<0, then
θ(n)−{overscore (θ)}eq(n)<κ7 and θ(n)−{circumflex over (θ)}eq(n)>κ8
κi are predetermined positive constants for calibration. The exit condition criteria parallel the entrance criteria of equation (3).
If the hitch angle position does not meet the exit criteria of equation (12) at the decision diamond 86, then the algorithm again proceeds to determine the current rear-wheel angle command δr
The foregoing discussion discloses and describes merely exemplary embodiments of the present invention. One skilled in the art will readily recognize from such discussion and from the accompanying drawings and claims, that various changes, modifications and variations can be made therein without departing from the spirit and scope of the invention as defined in the following claims.