1. Field of the Invention
This invention relates generally to automatic rear-wheel steering control for a vehicle/trailer combination and, more particularly, to automatic rear-wheel steering control for a vehicle/trailer combination that employs both feed-forward (open-loop) control and feedback (closed-loop) control, where the feedback control employs vehicle yaw rate, trailer yaw rate and vehicle lateral acceleration feedback to improve both vehicle and trailer stability and handling performance.
2. Discussion of the Related Art
It is known in the art to employ automatic rear-wheel vehicle steering based on vehicle dynamic information during a vehicle turn, or yaw. Active rear-wheel steering control can improve vehicle stability over a conventional vehicle having only two steerable front wheels. The rear-wheel steering control can be in-phase steering or out-of-phase steering. In-phase rear-wheel steering steers the rear wheels in the same direction as the front wheels, and is typically provided at higher vehicle speeds. Out-of-phase rear-wheel steering steers the rear wheels in an opposite direction as the front wheels to provide a tighter turning radius, and is typically provided at lower vehicle speeds.
Open-loop rear-wheel steering provides a certain amount of rear-wheel steering control depending on the amount of hand-wheel steering provided by the vehicle operator and the vehicle speed. It is known to provide closed-loop rear-wheel steering based on certain feedback signals in the event that the vehicle is not following the steering path requested by the vehicle operator. Closed-loop rear-wheel steering assist systems sense the actual vehicle yaw rate and the intended yaw rate, and generate an error signal that provides the steering control by the rear wheels if the vehicle yaw rate and the intended yaw rate are not the same.
Directional dynamics and stability have been a primary concern for vehicle/trailer combinations because of certain undesirable response properties for heavy trailers when traveling at high speeds and/or on low coefficient friction surfaces. The handling performance of a vehicle towing a trailer can also be deteriorated as a result of the adverse influence of the trailer dynamics and kinematics. Because the vehicle/trailer combination is a two pivot-connected unit, the trailer is more prone to instability, such as lateral swing or even a jackknife condition. The vehicle is more related to the handling performance because the vehicle operator typically perceives only the vehicle's dynamics.
Compared to the single-unit vehicle, the vehicle operator of a vehicle/trailer combination has an additional task of coping with trailer oscillation, possible instability and the path followed by the trailer. Sometimes, these conditions conflict with each other in control design, particularly for vehicles including automatic rear-wheel steering control. For example, control systems for vehicles including automatic rear-wheel steering control typically attempt to keep the vehicle side-slip zero at the vehicle's center of gravity. However, the center of gravity of the vehicle/trailer combination is different than the center of gravity of the vehicle. The balance between overall system stability and vehicle handling performance often becomes a compromise due to limited control channel availability. In addition, the vehicle/trailer combination has a higher order, and thus is more complex, which further makes the control design more complicated.
In accordance with the teachings of the present invention, a vehicle steering control system for a vehicle/trailer combination is disclosed that provides rear-wheel steering control to improve the vehicle/trailer combination stability and handling performance. The control system provides an open-loop feed-forward control signal based on hand-wheel angle and vehicle speed. The control system includes a vehicle yaw rate command interpreter, a trailer yaw rate command interpreter and a vehicle lateral acceleration command interpreter for closed-loop feedback control. The vehicle yaw rate command interpreter provides a vehicle closed-loop feedback control signal based on the yaw rate of the vehicle. The trailer yaw rate command interpreter provides a trailer closed-loop feedback control signal based on the yaw rate of the trailer. The vehicle lateral acceleration command interpreter provides a closed-loop feedback control signal based on the lateral acceleration of the vehicle. The closed-loop feedback signals are added together and then combined with the open-loop feed-forward control signal to provide the rear-wheel steering control.
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.
The following discussion of the embodiments of the invention directed to automatic rear-wheel steering control for a vehicle/trailer combination is merely exemplary in nature, and is in no way intended to limit the invention or its applications or uses.
The trailer 14 includes a trailer hitch post 26 and the vehicle 12 includes a vehicle hitch post 28 including a hitch 30. The open-loop control in controller 16 attempts to provide zero side-slip at the hitch 30 to provide the vehicle stability and performance control of the invention.
The vehicle 12 includes a hand-wheel 34 and a hand-wheel position sensor 36 for measuring the angle of the hand-wheel 34 and providing a hand-wheel angle signal to the controller 16. The vehicle 12 further includes a vehicle speed sensor 38 for providing a vehicle speed signal to the controller 16 of the speed of the vehicle 12, a vehicle yaw rate sensor 40 for providing a vehicle yaw rate signal to the controller 16 of the yaw rate of the vehicle 12, and a vehicle lateral acceleration sensor 42 for providing a vehicle lateral acceleration signal to the controller 16 of the side-slip of the vehicle 12. Further, the trailer 14 includes a trailer yaw rate sensor 44 for providing a trailer yaw rate signal to the controller 16 of the yaw rate of the trailer 14. In this design, the trailer yaw rate sensor 44 is positioned within the hitch post 26, although this is by way of a non-limiting example. The various sensors discussed above can be any sensor that is suitable for the purpose discussed herein.
To calculate the closed-loop feedback control referred to above, the vehicle/trailer combination 10 is modeled as a tricycle model 50 as shown in
Based on the tricycle model 50, a model equation in linear form can be written as:
Equation (1) can be simplified as:
Equation (2) can be written in space form as:
{dot over (X)}=A·X+B1δf+B2δr
Where the open-loop command signal δr
The feed-forward rear-front (R/F) ratio Kf(u) is determined based on the criteria of zero lateral speed at the hitch 30 with respect to the vehicle 12. This kinematically minimizes the coupling between the vehicle 12 and the trailer 14, and thus minimizes the adverse lateral motion influence between the vehicle 12 and the trailer 14. The lateral velocity v at the hitch 30 is given as:
vyh=V−rc (5)
The feed-forward R/F ratio Kf(u) can be determined by letting {dot over (X)}=0 and vyh=0 from equation (4).
The controller 16 includes a vehicle acceleration command interpreter, discussed below, that determines a vehicle lateral acceleration closed-loop feedback control signal that minimizes the dynamic coupling between the vehicle 12 and the trailer 14 to maintain the total velocity of the trailer 14 at the hitch 30 in line with the longitudinal axis of the trailer 14, or to maintain zero lateral vehicle acceleration at the hitch 30 with respect to the trailer, where:
vth cos θ=u (6)
vth sin θ=vyh (7)
This leads to:
v=u tan θ+rc (8)
Assuming a constant vehicle speed u and a small hitch angle θ, the derivative of the lateral velocity v (lateral acceleration) is given as:
Because {dot over (θ)}=r−rt, then:
{dot over (v)}=u(rt−r)+{dot over (r)}c (10)
Further:
Thus, the lateral acceleration feedback command Ay
Ay
The controller 16 also includes a vehicle yaw rate command interpreter, discussed below, that determines a closed-loop vehicle yaw rate command signal. Due to the high order of the vehicle/trailer model, the present invention provides a simplified technique for determining the vehicle yaw rate command. Particularly, the vehicle yaw rate command includes two terms as a steady-state value derived from equation (3) with {dot over (X)}=0, i.e., the vehicle yaw rate steady-state value, and a second-order dynamic filter based on a second-order bicycle model of the vehicle 12 without the trailer 14.
From equation (3); let {dot over (X)}=A·X+B1δf+B2δr
Where ωn is the un-damped natural frequency and ξ is the damping ratio, and where both values can be derived from a second-order bicycle model of the vehicle 12 without the trailer 14 as:
{dot over (v)}=a11v+a12r+b11δf+b12δr
{dot over (r)}=a21v+a22r+b21δf+b22δr
Where δf and δr
By taking the Laplace transform of the linear state equations (15) and (16), the linear vehicle model can be described in terms of velocity-dependent transfer functions between the steering input δ, the lateral acceleration v and the vehicle yaw rate r as:
Both transfer functions have the same second-order characteristic equation as:
s2+2ξωns+ωn2=0 (27)
With:
Therefore, the un-damped natural frequency ωn and the damping ratio ξ are given as:
This derivation maintains the steady-state performance of the vehicle/trailer combination 10, improves the vehicle dynamic response during its transient state to be more vehicle-like, and simplifies the on-board computation without computing a fourth-order derivative equation.
The controller 16 also includes a trailer yaw rate command interpreter, discussed below, that determines a closed-loop trailer yaw rate command signal. To avoid the higher-order model, the trailer yaw rate command is comprised of the steady-state value of the trailer yaw rate derived from equation (3), with {dot over (X)}=0, and a second-order dynamic filter as:
The trailer's un-damped natural frequency ωn2 and damping ratio ξ2 can be derived from a second-order model, which approximates the trailer 14 alone as a pendulum.
The trailer wheel slip angle at is approximated as:
Thus, the trailer wheel lateral force is Fty=Ctαt. By letting L2=a2+b2, and from Newton's law, the system equation can be derived as:
A standard second-order form of equation (36) is given as:
{umlaut over (θ)}+2ξ2ωn2{dot over (θ)}+ωn22θ=0 (37)
Where ωn2 is the trailer un-damped natural frequency and ξ2 is the trailer damping ratio as:
The control system 70 includes a vehicle yaw rate command interpreter 74 that also receives the vehicle speed signal u and the steering wheel angle command signal δf
The vehicle yaw rate error signal is applied to a vehicle yaw rate feedback controller 78 that generates a vehicle yaw rate steering control signal based on the vehicle yaw rate error signal. The feedback controller 78 can be any controller suitable for the purposes described herein, such as a proportional-integral-derivative (PID) controller, well known to those skilled in the art. If the vehicle yaw rate error signal is not large enough, the system 70 does not provide vehicle yaw rate feedback.
The hand-wheel angle signal δr
The steady-state trailer yaw rate command signal rt
The system 70 also includes a vehicle lateral acceleration command interpreter 86 that receives the hand-wheel angle signal δr
The control signals from the controllers 78, 84 and 90 are applied to an adder 92 that generates a combined closed-loop feedback steering command signal δr
The process block 102 uses equation (1), where {dot over (X)}=0, and generates the vehicle steady-state yaw rate signal rss and the trailer steady-state yaw rate signal r2ss, as discussed above. The second-order vehicle dynamic model process block 104 generates the un-damped natural frequency ωn and the damping ratio ξ from equations (30) and (31), respectively, for the vehicle 12. The second-order trailer dynamic model process block 106 generates the un-damped natural frequency ωn2 and the damping ratio ξ2 from equations (38) and (39), respectively, for the trailer 14. The vehicle signals from the process blocks 102 and 104 are applied to a second-order dynamic filter 108 that generates the vehicle yaw rate command signal Ωcmd(s) from equation (14). The trailer signals from the process blocks 102 and 106 are applied to a second-order dynamic filter 110 that generates the trailer yaw rate command signal Ωcmd(s) from equation (32).
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.