Control method using trailer yaw rate measurements for trailer backup assist
10773721 ยท 2020-09-15
Assignee
Inventors
Cpc classification
B62D6/003
PERFORMING OPERATIONS; TRANSPORTING
B60T8/1708
PERFORMING OPERATIONS; TRANSPORTING
B60W10/18
PERFORMING OPERATIONS; TRANSPORTING
B60W30/06
PERFORMING OPERATIONS; TRANSPORTING
B62D6/007
PERFORMING OPERATIONS; TRANSPORTING
B62D13/06
PERFORMING OPERATIONS; TRANSPORTING
B60W2300/14
PERFORMING OPERATIONS; TRANSPORTING
B62D13/005
PERFORMING OPERATIONS; TRANSPORTING
B62D15/027
PERFORMING OPERATIONS; TRANSPORTING
B60W2520/22
PERFORMING OPERATIONS; TRANSPORTING
B60T8/1708
PERFORMING OPERATIONS; TRANSPORTING
B60W10/20
PERFORMING OPERATIONS; TRANSPORTING
International classification
B60W30/06
PERFORMING OPERATIONS; TRANSPORTING
B62D13/00
PERFORMING OPERATIONS; TRANSPORTING
B60W10/20
PERFORMING OPERATIONS; TRANSPORTING
B62D13/06
PERFORMING OPERATIONS; TRANSPORTING
B60W10/18
PERFORMING OPERATIONS; TRANSPORTING
Abstract
A system for assisting a vehicle in reversing a trailer includes a vehicle steering system, a vehicle sensor outputting a vehicle velocity and a trailer sensor outputting a trailer yaw rate. The system further includes a controller controlling the vehicle steering system in reversing the trailer to cause a control parameter based on the trailer yaw rate and the vehicle velocity to converge toward a predetermined value.
Claims
1. A system for assisting a vehicle in reversing a trailer, comprising: a vehicle steering system; a trailer control input device outputting a user-selectable control value indicating a desired trailer path radius of curvature about a center of rotation; a vehicle sensor outputting a vehicle velocity; a trailer sensor outputting data including a trailer yaw rate; and a controller: receiving the control value, vehicle velocity and trailer yaw rate; determining a vehicle path radius of curvature about the center of rotation using the trailer yaw rate received from the trailer sensor and the vehicle velocity; and controlling the steering system during reversing of the vehicle and trailer to maintain the vehicle path on the desired trailer path.
2. The system of claim 1, wherein the vehicle curvature is determined by the controller as the trailer yaw rate received from the trailer sensor divided by the vehicle velocity received from the vehicle sensor.
3. The system of claim 1, wherein: the controller determines the control value as a function of a position of the trailer control input device.
4. The system of claim 3, wherein the controller scales the position of the trailer control input device when determining the predetermined value by a constant.
5. The system of claim 1, wherein: the vehicle sensor further outputs a vehicle yaw rate; the controller further: estimates a hitch angle using the vehicle yaw rate received from the vehicle sensor and the trailer yaw rate received from the trailer sensor; determines an estimated trailer length using the estimated hitch angle and the vehicle velocity received from the vehicle sensor, in view of a kinematic relationship; controls the vehicle steering system in reversing the trailer to maintain the vehicle path on the desired trailer path, until the estimated trailer length is determined; and upon determining the estimated length of the trailer, controls the vehicle steering system in reversing the trailer using the estimated length of the trailer and an instantaneous hitch angle to maintain the trailer along the desired trailer path.
6. The system of claim 5, wherein the controller controls the vehicle steering system in reversing the trailer to cause the control parameter based on the trailer yaw rate and the vehicle velocity to converge toward the predetermined value, until the estimated trailer length is determined within a predetermined accuracy range.
7. The system of claim 1, wherein the controller further controls the steering system to maintain a condition of the vehicle in reversing the trailer outside a jackknife condition.
8. The system of claim 1, further including a vehicle brake system, wherein the controller further controls the vehicle brake system to attempt to maintain the vehicle velocity below a limit that is a function of the vehicle path radius of curvature.
9. The system of claim 1, wherein the controller implements a control scheme including proportional and integral gains determined using an estimated maximum trailer length and an estimated minimum hitch offset to determine a steering angle of the steering system to maintain the vehicle path on the desired trailer path.
10. A vehicle, comprising: a steering system; a trailer control input device outputting a user-selectable curvature; a vehicle sensor outputting a velocity of the vehicle; and a controller: determining a trailer yaw rate based on data received from a trailer sensor coupled with the controller; determining a vehicle path curvature using the vehicle velocity received from the vehicle sensor and the trailer yaw rate received from the trailer sensor; and controlling the vehicle steering system to converge the vehicle path curvature to the user-selectable curvature received from the trailer control input device.
11. The vehicle of claim 10, wherein: the vehicle path curvature is determined by the controller as the trailer yaw rate received from the trailer sensor divided by the vehicle velocity received from the vehicle sensor.
12. The vehicle of claim 10, wherein the controller scales the user-selectable curvature by a constant.
13. The vehicle of claim 10, wherein: the vehicle sensor further outputs a vehicle yaw rate; and the controller: determines an estimated trailer length using the vehicle yaw rate received from the vehicle sensor and the trailer yaw rate received from the trailer sensor; determines that the estimated trailer length is unavailable when either no estimate has been obtained or when the estimated trailer length is outside an acceptable accuracy range; and controls the vehicle steering system to converge the vehicle path curvature to the user-selectable curvature received from the trailer control input device when the estimated trailer length is determined to be unavailable.
14. The vehicle of claim 13, wherein the controller further: estimates a hitch angle using the vehicle yaw rate received from the vehicle sensor and the trailer yaw rate received from the trailer sensor; determines the estimated length of the trailer using the estimated hitch angle and the vehicle speed in view of a kinematic relationship of the vehicle in combination with the trailer; and upon determining the estimated length of the trailer, controls the vehicle steering system in reversing the trailer to cause a curvature of the trailer, derived using the estimated length of the trailer and the estimated hitch angle, to converge toward the user-selectable curvature.
15. The vehicle of claim 10, wherein the controller further controls the steering system to maintain a condition of the vehicle in reversing the trailer outside a jackknife condition.
16. A method for assisting a vehicle in reversing a trailer, comprising: receiving a user-selected curvature; receiving a vehicle velocity signal; receiving a trailer yaw rate signal; and controlling a vehicle steering system by: determining a vehicle path curvature of the vehicle reversing the trailer using the vehicle velocity signal and the trailer yaw rate signal; and causing the vehicle path to converge toward the user-selected curvature.
17. The method of claim 16, wherein the user-selected curvature is received as a position of a curvature input device and is scaled by a constant.
18. The method of claim 16, further including: receiving a vehicle yaw rate signal; determining an estimated trailer length using the vehicle yaw rate signal and the trailer yaw rate signal; when the estimated trailer length is unavailable or when the estimated trailer length is outside an acceptable accuracy range, controlling a vehicle steering system by causing the vehicle path to converge toward the user-selected curvature.
19. The method of claim 18, further including: determining an estimated hitch angle using the vehicle yaw rate signal and the trailer yaw rate signal, wherein the estimated length of the trailer is further determined using the vehicle velocity signal and the estimated hitch angle in view of a kinematic relationship of the vehicle in combination with the trailer; and upon determining the estimated length of the trailer, controlling the vehicle steering system by causing a trailer path to converge toward the user-selected curvature.
20. The method of claim 16, wherein controlling the steering system further includes maintaining a condition of the vehicle in reversing the trailer outside a jackknife condition.
Description
BRIEF DESCRIPTION OF THE DRAWINGS
(1) In the drawings:
(2)
(3)
(4)
(5)
(6)
(7)
(8)
(9)
(10)
(11)
(12)
(13)
(14)
DETAILED DESCRIPTION OF THE PREFERRED EMBODIMENTS
(15) For purposes of description herein, the terms upper, lower, right, left, rear, front, vertical, horizontal, interior, exterior, and derivatives thereof shall relate to the invention as oriented in
(16) Referring to
(17) With reference to the embodiment shown in
(18) With additional reference to
(19) In the illustrated embodiment, the trailer yaw rate sensor 25 is contained within the housed sensor cluster 21, although other configurations are conceivable. It is contemplated that the sensor signal could be compensated and filtered to remove offsets or drifts, and smooth out noise. Further, the controller 28 may utilize processed signals received outside of the sensor system. The controller 28 of the trailer backup assist system 10 uses the trailer yaw rate .sub.2 to control the steering system 62, brake control system 72, and the powertrain control system 74, such as to assist backing the vehicle-trailer combination. Other vehicle information received by the trailer backup assist system 10 may include a speed of the vehicle 14 from a speed sensor 58 and a yaw rate of the vehicle 14 from a vehicle yaw rate sensor 60. It is contemplated that in additional embodiments, other vehicle sensors and devices may provide sensor signals or other information, such as proximity sensor signals or successive images of the trailer 12, that the controller 28 of the trailer backup assist system 10 may process with various routines to determine an indicator of the hitch angle , such as an indicator of the hitch angle being within a certain range of hitch angles .
(20) As further shown in
(21) In alternative embodiments, some vehicles have a power assist steering system 62 that allows a steering wheel 68 to be partially decoupled from movement of the steered wheels 64 of such a vehicle. Accordingly, the steering wheel 68 can be rotated independent of the manner in which the power assist steering system 62 of the vehicle controls the steered wheels 64 (e.g., autonomous steering as commanded by the trailer backup assist system 10). As such, in these types of vehicles where the steering wheel 68 can be selectively decoupled from the steered wheels 64 to allow independent operation thereof, the steering wheel 68 may be used as a steering input device 18 for the trailer backup assist system 10, in the same manner as the knob 30 described in greater detail herein.
(22) Referring again to the embodiment illustrated in
(23) As also illustrated in
(24) The powertrain control system 74, as shown in the embodiment illustrated in
(25) With continued reference to
(26) As further illustrated in
(27) As will be discussed below in more detail, the steering input device 18 according to one embodiment may include a movable control input device for allowing a driver of the vehicle 14 to command desired trailer steering actions to cause a control parameter based on the trailer yaw rate .sub.2 and the vehicle speed .sub.1 of the vehicle in reversing the trailer to converge toward a predetermined value, which may be based on a desired curvature path of the vehicle-trailer combination. In this manner, the steering input device may be considered a curvature input device. For instance, the moveable control input device may be the rotatable knob 30, which can be rotatable about a rotational axis extending through a top surface or face of the knob 30. In other embodiments, the rotatable knob 30 may be rotatable about a rotational axis extending substantially parallel to a top surface or face of the rotatable knob 30. Furthermore, the steering input device 18, according to additional embodiments, may include alternative devices for providing the desired input, such as a joystick, a keypad, a series of depressible buttons or switches, a sliding input device, various user interfaces on a touch-screen display, a vision based system for receiving gestures, a control interface on a portable device, and other conceivable input devices as generally understood by one having ordinary skill in the art. It is contemplated that the steering input device 18 may also function as an input device for other features, such as providing inputs for other vehicle features or systems.
(28) Still referring to the embodiment shown in
(29) A method has been established for controlling the curvature of a conventional trailer 12 while backing. Such method takes advantage of the offset between the hitch 40 and the rear vehicle axle to directly adjust the trailer curvature .sub.2 by appropriate commands to steering system 62. Such a control scheme relies on knowledge of the trailer length and the instantaneous hitch angle and was developed by studying the scenario of backing a trailer 12 using tow vehicle 14 at slow speeds, where vehicle dynamics are negligible, and on a rigid, flat surface with sufficient friction to prevent tire slip. Under these conditions, and as illustrated in
(30)
where:
(31) = is the hitch angle,
(32) .sub.1 is the velocity of a midpoint of the rear axle of the tow vehicle 14,
(33) is the road wheel angle (or steering angle) of the tow vehicle 14, measured along a midpoint between the steered wheels 64,
(34) L is the hitch offset,
(35) D is the trailer 12 length (from hitch to the effective axle), and
(36) W is the tow vehicle wheelbase.
(37) The hitch angle is taken to be positive when to the right side of a longitudinal axis of vehicle 14.
(38) The convention that .sub.10 when the vehicle is in reverse is also taken.
(39) The vehicle 14 curvature .sub.1 is defined as the curvature of a path traced by the midpoint of the rear axle of vehicle 14. The trailer 12 curvature .sub.2 is defined analogously as the curvature of a path traced by the midpoint of the axle of the trailer 12. The vehicle 14 and trailer 12 curvatures .sub.1,.sub.2 are, respectively, given by:
(40)
The vehicle 14 and trailer 12 curvatures .sub.1,.sub.2 can also be computed as .sub.1=.sub.1/.sub.1 and .sub.2=.sub.2/.sub.2, where .sub.1={dot over ()} is the vehicle yaw rate, .sub.1={dot over ()} is the trailer yaw rate, and .sub.2 is the velocity of the midpoint of the axle of the trailer 12.
(41) In one aspect, the road wheel angle can be regarded as the control input into the dynamic system (as given in equation (1), above). However, in light of equation (2), it is possible, as an alternative, to use the vehicle curvature .sub.1 as the control input. Doing so not only simplifies many of the expressions that follow, but also aids in establishing a number of useable geometric relationships within the system. Accordingly, herein the control laws for system 10 are expressed in terms of curvature .sub.1, or its equivalent tan ()/W. Because a physical implementation of the control law ultimately includes the conversion to a wheel angle , the conversion is shown in block diagrams (e.g., as shown in
h(.sub.1):=tan.sup.1(W.sub.1).(4)
(42) If it is assumed, as stated above, that the steering angle is limited such that ||.sub.max<90, it is implicit that the vehicle has a maximum curvature of .sub.1,max=tan(.sub.max)/W. As a result, there may be some hitch angles from which it is impossible to straighten out the trailer 12 without driving forward. Whenever the trailer 12 is in such a configuration, it is said to be jackknifed. The smallest positive hitch angle for which the trailer 12 is jackknifed is the jackknife angle .sub.jk. The jackknife angle .sub.jk is understood to be a special case of equilibrium hitch angle; specifically, the jackknife angle .sub.jk is one of two equilibria associated with the road wheel angle =.sub.max.
(43) To find the equilibria, the right hand side of (1) is set as equal to zero and is solved for as a function of trailer curvature .sub.1, trailer length D, and hitch offset L. As shown in equation (3), the solution involves a quadratic equation, and therefore defines a pair of functions .sub.+ and .sub. which differ only in one operation (addition or subtraction, as indicated by the subscript). These two functions are expressed succinctly as
(44)
Notably, there are no equilibria when D.sup.2L.sup.2>1/.sub.1.sup.2, or equivalently, when D>D.sub.max(.sub.1), where:
D.sub.max(.sub.1)={square root over (1/.sub.1.sup.2+L.sup.2)}.
It follows, then, that because the jackknife angle .sub.jk corresponds to the solution given by .sub.+ (that is, .sub.jk=.sub.+(.sub.1max, D, L)), a jackknife condition is not possible when D>D.sub.max(.sub.1,max).
(45) The control methodology discussed thus far has been incorporated into a trailer backup assist (TBA) framework where the driver provides reference commands to the controller 28, and the controller 28 determines an appropriate steering wheel angle in order to meet certain objectives including, but not limited to, steering the combined vehicle 14 and trailer 12 according to the reference command. The driver reference herein is interpreted as a normalized trailer curvature command k(t). The controller objectives are to prevent jackknife and to drive the trailer curvature .sub.2 approximately to a desired curvature that corresponds with the normalized commanded curvature k(t).
(46) Because both the jackknife angle .sub.jk and the general responsiveness of system 10 are dependent on the trailer length D and the hitch offset L, a direct determination of the maximum trailer curvature .sub.2,max requires knowledge of trailer length D and the hitch offset L. In this manner, previously-developed TBA systems have required both trailer length D and the hitch offset L to be known by system 10 prior to initiation of what may be considered a parameter-based control, as it requires the prior knowledge or input of system parameters (i.e. trailer length D and hitch offset L), and is referred to herein as the standard curvature control routine 98 (
(47) Existing TBA systems may require an operator to measure the trailer length D and the hitch offset L for input into system memory or may include the capability to estimate the trailer length D and the hitch offset L. Both of these variations exhibit certain drawbacks, such as the introduction of human error and/or the inability for the systems to operate immediately upon connecting, for example, a new trailer 12 with the vehicle 14. Accordingly, the present TBA controller 28 and method incorporates a trailer yaw rate-based routine 134 that uses trailer yaw rate .sub.2 measurements, but does not require knowledge or estimates of instantaneous hitch angle , trailer length D, or hitch offset L in order to ensure stability and jackknife avoidance. As disclosed below the trailer yaw rate-based routine 134 may, more particularly, be a modified curvature-based routine, and may be referred to as such, as the modified curvature described herein is determined including the trailer yaw rate .sub.2. It is noted that, in other embodiments, controller 28 can use trailer yaw rate .sub.2 and vehicle velocity .sub.1 measurements to track a control parameter that is different from the modified curvature discussed herein, but, in a similar manner, tracks stability of the trailer 12 and vehicle 14 system to control vehicle 14 in reversing trailer 12 while maintaining a hitch angle below the jackknife angle .sub.jk using the trailer yaw rate .sub.2 as an input and accordingly falls within the discussion of the trailer yaw rate-based routine 134. In the present example, the control method utilizing the modified curvature can control the trailer 12 close to jackknife without the addition of overly-conservative supplemental measures. Further, the present system 10 and related method is applicable to fifth wheel and conventional trailers 12, and relies on a choice of a controlled variable different from the trailer curvature .sub.2 used in the standard control routine 98, as discussed above. As discussed herein, the variable is referred to as the modified trailer curvature . Notably, when the hitch angle is small, the modified curvature is approximately equal to the trailer curvature .sub.2, making it an intuitive quantity for a driver to command.
(48) As shown in
.sub.d(t):=.sub.d,maxk(t).(6)
Selection of the maximum modified curvature .sub.d,max does not require a knowledge of D and L, but only an upper limit D.sub.upper on the length of any trailer that will be used with the system. Given D.sub.upper and the maximum vehicle curvature .sub.1,max, .sub.d,max can be chosen as any positive constant less than min(1/D.sub.upper, .sub.1,max). The actual curvature .sub.2 of the path followed by the trailer in response to a modified curvature command .sub.d=.sub.d,maxk(t) will be similar, but not necessarily equal, to .sub.2,maxk(t). In this way, the normalized curvature input k(t) can be thought of in terms of the desired backing path for trailer 12, independent of whether the system 10 uses the standard or the yaw-rate-based curvature controller disclosed herein.
(49) As shown in
(50) As used herein the modified trailer curvature is defined as:
(51)
Rewriting the hitch angle dynamics from equation (1) in terms of modified curvature results in the equation:
(52)
Because {dot over ()}=.sub.2.sub.1 and .sub.1=.sub.1 tan ()/W, it can be determined that .sub.2=.sub.1, or, when |.sub.1|>0,
(53)
Thus, as long as the vehicle is moving, it is possible to compute the modified curvature from measurements of vehicle velocity .sub.1 and trailer yaw rate .sub.2 without knowing hitch angle , trailer length D, or hitch offset L.
(54) As shown in
(55) The trailer curvature .sub.2 is related to the modified curvature by:
(56)
From this it can be seen that the modified hitch angle is approximately equal to the trailer curvature .sub.2 when the hitch angle is small. The center of rotation 110 of the trailer 12 is collinear with the hitch location 40 and the center of rotation 114 of the vehicle 14 and lies along the line 120 perpendicular to the trailer 12 wheels. The modified curvature is the reciprocal of the length of the perpendicular line segment 116 from the center of rotation 110 of the trailer 12 to the vehicle 14 longitudinal axis 112. In equilibrium, the two centers of rotation 110 and 114 coincide such that the vehicle curvature .sub.1 is equal to the modified curvature .
(57) Although it is possible to derive a feedback law for the dynamic equation (8), it is noted that the resulting closed loop system would have velocity-dependent behavior. Alternatively, it is possible to rewrite the hitch angle dynamics {dot over ()} in terms of the distance s.sub.1 traveled by the rear vehicle 14 axle. Because .sub.1=ds.sub.1/dt, the chain law implies that:
(58)
From this, we see that the hitch angle is in equilibrium
(59) The preceding observations justify regarding the driver input k(t) as a normalized, desired modified curvature command, which can be formalized through the definition:
.sub.d(t):=.sub.d,maxk(t).(12)
This relationship can be considered within the feedback control law:
(60)
As in the trailer curvature .sub.2 based control scheme, the vehicle curvature .sub.1 is taken as the control input, instead of the road wheel angle (with .sub.1=tan ()/W). The controller 28 structure is depicted in
(61) For any constant curvature command .sub.d such that |.sub.d|<1/(D.sup.2L.sup.2), there is a unique equilibrium hitch angle
(62) In general, it can be shown that local asymptotic stability of the equilibrium (
(63)
(64) It follows, then, that an appropriate choice of feedback gains can be made after determining limits on the acceptable range of trailer lengths D (specifically, a minimum allowable trailer length D) and hitch offsets L. The upper limit K.sub.p<K.sub.p,max is of particular relevance with respect to the implementation of system 10. In particular, when the limit is not satisfied, the equilibrium will not be stable; instead, the hitch angle may oscillate in a region around the equilibrium. This behavior is a consequence of the feedback implementation, as explained below.
(65) When L0, there is an algebraic relationship between the vehicle curvature .sub.1 and the modified curvature given in equation (7). The control law of equations (13)-(14) imposes an additional algebraic relationship between these two quantities. In the implementation of the control law within system 10, the vehicle-trailer kinematics interacts with the controller 28 to determine a solution to the algebraic system of equations. However, the solution process is iterative, with the controller 28 first measuring the modified curvature , then updating the vehicle curvature .sub.1 to then derive the steering angle corresponding to that curvature .sub.1 (using .sub.1=tan()W), which in turn changes the modified curvature . As illustrated in
(66) If the proportional gain is to high (K.sub.pK.sub.p,max), the system 10 will, through iterations 143, increase the steering angle until the error changes in sign or until the steering angle reaches the maximum steering angle .sub.max. The steering angle may then alternate between +.sub.max and .sub.max, as the hitch angle oscillates in an interval around the equilibrium hitch angle. In this manner, the real-world system in which the restriction K.sub.p<K.sub.p,max is not satisfied may still act to prevent the trailer 12 from reaching a jackknife condition, although the behavior may be uncomfortable to the driver and may not accurately maintain the commanded curvature k(t).
(67) In this manner, controller 28 stabilizes the hitch angle dynamics {dot over ()} with a large basin of attraction, providing a foundation for the described trailer backup system 10 that can operate without measurements for hitch angle , trailer length D, or hitch offset L. The modified curvature can be used to implement additional functionality and various controller modifications can be added for improved real-world performance.
(68) Controller 28 is able to track desired modified curvature commands .sub.d and to prevent jackknife as long as the initial hitch angle is controllable (i.e. the system 10 is not initially jackknifed). However, if the trailer is initially jackknifed, then it is not possible to control the hitch angle without driving forward. Because of this, system 10 implements a scheme to detect when jackknife has occurred in order to be able to alert the driver. System 10 further includes a measure of detecting the proximity of system 10 to jackknife and of implementing speed limiting functionality when such proximity is detected.
(69) Recalling the previous explanation, the system is said to be jackknifed when the hitch angle is locally uncontrollable, in other words, when the hitch angle is such that there is no admissible choice of wheel angle which reverses the sign of d/ds.sub.1 (or, equivalently, of {dot over ()}). The boundary of the jackknife region corresponds to the equilibrium
(70) In some conditions, however, it is desirable to detect jackknife and to determine proximity to jackknife without saturating the wheel angle , even if such methods are approximate. In one example, when it is known that L=0, the modified curvature makes these problems trivial. In this case, the modified curvature is independent of the wheel angle , so it is sufficient to compare the instantaneous value of to .sub.1,max; if ||.sub.1,max, then the system is jackknifed. Furthermore, the function .sub.0():=/.sub.1,max can be used in such an instance to provide a measure of the proximity to jackknife, with small values (i.e. .sub.0()<<1) indicating a large jackknife margin, and values closer to unity indicating a smaller jackknife margin.
(71) For general hitch offset L, the value .sub.0() provides a measure of the proximity to jackknife when the system is in equilibrium, that is, when =.sub.1. Thus, one heuristic measure of proximity to jackknife is the absolute value of the function:
(72)
where c is a constant parameter and satisfies 0c<1. The use of the constant c penalizes deviations from equilibrium that tend to drive the hitch angle closer to jackknife. The controller 28 can utilize the quantities .sub.0() and/or (, .sub.1) to implement additional measures to improve responsiveness and to further protect against jackknife. Such measures might include further limiting the scaled curvature input k(t) or, as explained below, limiting the vehicle speed.
(73) It may be desirable to limit vehicle velocity .sub.1 to ensure that the system 10 remains active. Furthermore, jackknife avoidance is improved by reducing the maximum allowed vehicle speed as the hitch angle approaches .sub.jk. Therefore, hitch angle-dependent speed limiting is a desirable component of the current TBA system.
(74) Previously disclosed systems, including the above-mentioned co-pending, commonly assigned U.S. Patent Application Pub. No. 2016/0288786, now U.S. Pat. No. 9,623,859, the entire disclosure of which is hereby incorporated by reference herein, have employed a speed limiting system consisting of a speed limit generation module and a controller that issues commands to the powertrain and brakes in order to attempt to maintain the vehicle velocity .sub.1 at or below the given limit. The speed limit generation module takes the hitch angle as an input. The speed limit output is maximal when the hitch angle is near zero, and decreases as the hitch angle approaches the boundary of the jackknife region. This approach to speed limit generation therefore requires knowledge of the hitch angle , trailer length D and hitch offset L.
(75) A parameterless scheme of speed limiting hitch angle , without directly measuring it, and without knowing trailer length D or hitch offset L can be realized by specifying the desired speed limit .sub.max as a function of the modified curvature or, specifically, of the jackknife proximity measures .sub.0() and/or (, .sub.1). When L=0, this method is completely analogous to the current, hitch angle-based method. When L0, we can instead use the value (,.sub.1) in place of , and the limits1 in place of +.sub.max, as illustrated in
(76) As discussed above, controller 28 can compute the modified curvature from velocity .sub.1 and trailer yaw rate .sub.2 measurements as long as the vehicle velocity .sub.1 is nonzero. Furthermore, if the vehicle 14 is in motion and subsequently comes to a stop, we have only to recall the last value of before the velocity .sub.1 reaches zero, as long as it is safe to assume that the hitch angle is unchanged. In practice, however, it is useful to modify this strategy for estimating the modified curvature .
(77) First, it may be desirable to specify some positive threshold .sub.1, and to update the estimate of only when |.sub.1>.sub.1. In addition to avoiding an indeterminate condition (i.e. divide-by-zero), this modification may also reduce the effect of velocity sensor nonlinearities.
(78) Second, a low-pass filter can be applied to the estimate of the modified curvature . The filter attenuates sensor noise (including quantization noise), which would otherwise have a significant effect on the estimate of at low speeds. With a suitable realization, the filter state can be used to hold the value of the modified curvature while updates are disabled. One such realization in discrete-time is given by:
(79)
where a[0,1] is the normalized filter bandwidth.
(80) Steering dynamics and steering angle rate limiting may introduce a variable delay between steering commands from controller 28 and the resulting wheel angle . This delay can cause oscillation of the steering angle . The frequency of oscillation is largely determined by the steering dynamics and the effective delay. One method to reduce or eliminate such oscillation is to apply a notch filter to the steering command output. Doing so may be achieved with a two-pole discrete time filter according to:
(81)
where a.sub.1, a.sub.2[0,1] are the normalized lower and upper stopband limits.
(82) Returning to the proportional gain K.sub.p used by controller 28, the maximum admissible gain K.sub.p,max is noted as being proportional to D+L cos
(83) In a further aspect, the above-described TBA system incorporating the disclosed modified curvature (or other trailer yaw rate-based) control scheme can be used as a quick-start function in a variation of system 10 that includes a variation of controller 28 capable of implementing at least the standard curvature control routine 98 according to a curvature command k(t) received from knob 30 and to output a control signal to the steering system 62 (
(84)
Such a variation of system 10 is further described in co-pending, commonly-assigned U.S. Pat. No. 9,340,228, the entirety of which is incorporated herein by reference.
(85) In order to cope with an unknown trailer length, specific conditions were identified under which the instantaneous hitch angle may be estimated independent of trailer length D. As discussed further in co-pending, commonly-assigned U.S. patent application Ser. No. 14/736,391, now U.S. Pat. No. 9,821,845, the entirety of which is incorporated herein by reference, a controller 28, as shown in
(86) It is noted that both the standard curvature routine 98 and estimation routine 131 are illustrated in dashed lines in
(87) Whether the hitch angle or only the trailer yaw rate .sub.2 is measured, reliable estimation of trailer length D requires a moderate change in hitch angle . Accordingly, the accuracy of an estimate depends on the maneuver executed. Furthermore, when the hitch angle must be estimated on the basis of trailer yaw rate .sub.2 measurements, current methods cannot provide either a trailer length D or a hitch angle estimate until the maneuver satisfies particular conditions. These factors limit the ability of the controller 98 to meet desired performance criteria during some initial learning period whose duration is maneuver-dependent. During such a learning period, the controller 28 may be conservative with respect to meeting driver-requested curvature, and may fail to prevent jackknife under certain conditions.
(88) As discussed above, the modified curvature can use the trailer yaw rate .sub.2, as well as the vehicle velocity .sub.1 to control vehicle 14 in reversing trailer 12 without knowing hitch angle , trailer length D, or hitch offset L. Because both the trailer yaw rate .sub.2, as well as the vehicle velocity .sub.1, are used in estimating hitch angle and trailer length D in the controller 28 implementing the modified curvature routine 134 depicted in
(89) As shown in
(90) If, however, in step 216, it is determined that acceptable estimates for trailer length D and hitch offset L are available, controller 28 can implement the standard curvature routine 98 according to
(91) It is to be understood that variations and modifications can be made on the aforementioned structure without departing from the concepts of the present invention, and further it is to be understood that such concepts are intended to be covered by the following claims unless these claims by their language expressly state otherwise.
(92) For purposes of this disclosure, the term coupled (in all of its forms, couple, coupling, coupled, etc.) generally means the joining of two components (electrical or mechanical) directly or indirectly to one another. Such joining may be stationary in nature or movable in nature. Such joining may be achieved with the two components (electrical or mechanical) and any additional intermediate members being integrally formed as a single unitary body with one another or with the two components. Such joining may be permanent in nature or may be removable or releasable in nature unless otherwise stated.
(93) It is also important to note that the construction and arrangement of the elements of the invention as shown in the exemplary embodiments is illustrative only. Although only a few embodiments of the present innovations have been described in detail in this disclosure, those skilled in the art who review this disclosure will readily appreciate that many modifications are possible (e.g., variations in sizes, dimensions, structures, shapes and proportions of the various elements, values of parameters, mounting arrangements, use of materials, colors, orientations, etc.) without materially departing from the novel teachings and advantages of the subject matter recited. For example, elements shown as integrally formed may be constructed of multiple parts or elements shown as multiple parts may be integrally formed, the operation of the interfaces may be reversed or otherwise varied, the length or width of the structures and/or members or connector or other elements of the system may be varied, the nature or number of adjustment positions provided between the elements may be varied. It should be noted that the elements and/or assemblies of the system may be constructed from any of a wide variety of materials that provide sufficient strength or durability, in any of a wide variety of colors, textures, and combinations. Accordingly, all such modifications are intended to be included within the scope of the present innovations. Other substitutions, modifications, changes, and omissions may be made in the design, operating conditions, and arrangement of the desired and other exemplary embodiments without departing from the spirit of the present innovations.
(94) It will be understood that any described processes or steps within described processes may be combined with other disclosed processes or steps to form structures within the scope of the present invention. The exemplary structures and processes disclosed herein are for illustrative purposes and are not to be construed as limiting.