The disclosures made herein relate generally to steering assist technologies in vehicles and, more particularly, to trailer path curvature control for trailer backup assist.
It is well-known that backing up a vehicle with a trailer attached is a difficult task for many drivers. This is particularly true for drivers that are untrained at backing with trailers such as, for example, those that drive with an attached trailer on an infrequent basis (e.g., have rented a trailer, use a personal trailer on an infrequent basis, etc.). One reason for such difficulty is that backing a vehicle with an attached trailer requires counter-steering that is opposite to normal steering when backing the vehicle without a trailer attached and/or requires braking to stabilize the vehicle-trailer combination before a jackknife condition occurs. Another reason for such difficulty is that small errors in steering while backing a vehicle with an attached trailer are amplified thereby causing the trailer to depart from a desired path.
To assist the driver in steering a vehicle with trailer attached, a trailer backup assist system needs to know the driver's intention. One common assumption with known trailer backup assist systems is that a driver of a vehicle with an attached trailer wants to back up straight and the system either implicitly or explicitly assumes a zero curvature path for the vehicle-trailer combination. Unfortunately most of real-world use cases of backing a trailer involve a curved path and, thus, assuming a path of zero curvature would significantly limit usefulness of the system. Some known systems assume that a path is known from a map or path planner. To this end, some known trailer backup assist systems operate under a requirement that a trailer back-up path is known before backing of the trailer commences such as, for example, from a map or a path planning algorithm. Undesirably, such implementations of the trailer backup assist systems are known to have a relatively complex Human Machine Interface (HMI) to specify the path, obstacles and/or goal of the backup maneuver. Furthermore, such systems also require some way to determine how well the desired path is being followed and to know when the desired goal, or stopping point and orientation, has been met, using approaches such as cameras, inertial navigation, or high precision GPS. These requirements lead to a relatively complex and costly system.
Therefore, implementing trailer backup assist using a trailer path curvature control approach that is relatively simple and that enables an intuitive vehicle operator interface would be advantageous, desirable and useful.
Embodiments of the inventive subject matter are directed to trailer backup assist functionality that provides for controlling curvature of a path of a trailer attached to a vehicle. More specifically, trailer backup assist functionality configured in accordance with embodiments of the disclosed subject matter provide for such trailer path curvature control by allowing a driver of the vehicle to specify a desired path of the trailer by inputting a desired trailer path curvature as the backup maneuver of the vehicle and trailer progresses. In response to such path of the trailer being specified by the driver, embodiments of the inventive subject matter control a power assisted steering system (e.g., electric power assisted steering (EPAS) system) of the vehicle for implementing steering angle changes of steered wheels of the vehicle to achieve the specified trailer path. Kinematics of the vehicle and the trailer are used to determine the steering angle changes that are required for achieving the specified trailer path. Accordingly, embodiments of the inventive subject matter provide for implementation of trailer backup assist functionality in a manner that is relatively simple and that enables use of an intuitive vehicle operator interface for specifying trailer path curvature control.
In one embodiment of the inventive subject matter, a method of controlling a path of travel of a trailer towably coupled to a vehicle during backing of the trailer by the vehicle comprises a plurality of operations. An operation is performed for receiving trailer path curvature information characterizing a desired curvature for the path of travel of the trailer and an operation is performed for determining vehicle steering information through assessment of kinematical information of a system defined by the vehicle and the trailer. Assessment of the kinematical information is performed as a function of the trailer path curvature information. Thereafter, an operation is performed for generating a steering command for a steering system of the vehicle as a function of the vehicle steering information.
In another embodiment of the inventive subject matter, an electronic control system having a set of instructions tangibly embodied on a non-transitory processor-readable medium thereof. The set of instructions are accessible from the non-transitory processor-readable medium by at least one data processing device of the electronic controller system for being interpreted thereby. The set of instructions is configured for causing the at least one data processing device to carry out an operation for of operations receiving trailer path curvature information for a trailer towably connected to a vehicle, an operations for determining vehicle steering information, and an operations for generating a steering command for a steering system of the vehicle. The trailer path curvature information characterizes a desired curvature for the path of travel of the trailer during backing of the trailer by the vehicle. The vehicle steering information is determined through assessment of kinematical information of a system defined by the vehicle and the trailer. Such assessment of the kinematical information is performed as a function of the trailer path curvature information. The steering command is generated as a function of the vehicle steering information.
In another embodiment of the inventive subject matter, a vehicle comprises a trailer backup steering input apparatus, a trailer backup assist control module coupled to the a trailer backup steering input apparatus, and an electric power assist steering system coupled to the trailer backup assist control module. The trailer backup steering input apparatus is configured for outputting a trailer path curvature signal approximating a desired curvature for a path of travel of a trailer towably coupled to the vehicle. The trailer backup assist control module is configured for determining vehicle steering information as a function of the trailer path curvature signal. The electric power assist steering system is configured for controlling steering of steered wheels of the vehicle as a function of the vehicle steering information.
In another embodiment of the inventive subject matter, a trailer backup assist system for a vehicle backing a trailer includes a steering input apparatus that provides a desired curvature for the trailer. The trailer backup assist system also includes a control module that generates a steering command for the vehicle to guide the trailer on the desired curvature based on a hitch angle and a kinematic relationship determined between the vehicle and the trailer.
In another embodiment of the inventive subject matter, a trailer backup assist system for a vehicle backing a trailer includes a camera-based apparatus that determines a hitch angle between a vehicle and a trailer. The trailer backup assist system also includes a steering input apparatus that commands a path of the trailer. Further, the trailer backup assist system includes a control module that generates a steering command for guiding the trailer on the path based on the hitch angle and a kinematic relationship between the vehicle and the trailer. A power-steering system controls steered wheels of the vehicle based on the steering command.
In yet another embodiment of the inventive subject matter, a method of reversing a trailer includes a step of determining a kinematic relationship between a vehicle and the trailer. The method also includes a step of determining a hitch angle between the vehicle and the trailer. Also, the method includes a step of commanding a path of the trailer. In addition, the method includes a step of generating a steering command for guiding the trailer on the path based on the hitch angle and the kinematic relationship. The method further includes a step of controlling steered wheels of the vehicle with a power-steering system based on the steering command.
These and other objects, embodiments, advantages and/or distinctions of the disclosed subject matter will become readily apparent upon further review of the following specification, associated drawings and appended claims.
In the drawings:
The inventive subject matter is directed to providing trailer backup assist functionality in a manner that is relatively low cost and that offers an intuitive user interface. In particular, such trailer backup assist functionality provides for controlling curvature of a path of travel of a trailer attached to a vehicle (i.e., trailer path curvature control) by allowing a driver of the vehicle to specify a desired path of the trailer by inputting a desired trailer path curvature as the backup maneuver of the vehicle and trailer progresses. Although a control knob, a set of virtual buttons, or a touch screen can each be implemented for enabling trailer path curvature control, the inventive subject matter is not unnecessarily limited to any particular configuration of interface through which a desired trailer path curvature is inputted. Furthermore, in the case where a steering wheel can be mechanically decoupled from steered wheels of the vehicle, the steering wheel can also be used as an interface through which a desired trailer path curvature is inputted. As will be discussed herein in greater detail, kinematical information of a system defined by the vehicle and the trailer are used to calculate a relationship (i.e., kinematics) between the trailer's curvature and the steering angle of the vehicle for determining steering angle changes of the vehicle for achieving the specified trailer path. Steering commands corresponding to the steering angle changes are used for controlling a steering system of the vehicle (e.g., electric power assisted steering (EPAS) system) of the vehicle for implementing steering angle changes of steered wheels of the vehicle to achieve (e.g., to approximate) the specified path of travel of the trailer.
Referring to
The trailer backup assist system 105 includes a trailer backup assist control module 120, a trailer backup steering input apparatus 125, and a hitch angle detecting apparatus 130. The trailer backup assist control module 120 is connected to the trailer backup steering input apparatus 125 and the hitch angle detecting apparatus 130 for allowing communication of information therebetween. It is disclosed herein that the trailer backup steering input apparatus can be coupled to the trailer backup assist control module 120 in a wired or wireless manner. The trailer backup assist system control module 120 is attached to a power-steering assist control module 135 of the power-steering assist system 115 for allowing information to be communicated therebetween. A steering angle detecting apparatus 140 of the power-steering assist system 115 is connected to the power-steering assist control module 125 for providing information thereto. The trailer backup assist system is also attached to a brake system control module 145 and a powertrain control module 150 for allowing communication of information therebetween. Jointly, the trailer backup assist system 105, the power-steering assist system 115, the brake system control module 145, the powertrain control module 150 define a trailer backup assist architecture configured in accordance with an embodiment of the inventive subject matter.
The trailer backup assist control module 120 is configured for implementing logic (i.e., instructions) for receiving information from the trailer backup steering input apparatus 125, the hitch angle detecting apparatus 130, the power-steering assist control module 135, the brake system control module 145, and the powertrain control module 150. The trailer backup assist control module 120 (e.g., a trailer curvature algorithm thereof) generates vehicle steering information as a function of all or a portion of the information received from the trailer backup steering input apparatus 125, the hitch angle detecting apparatus 130, the power-steering assist control module 135, the brake system control module 145, and the powertrain control module 150. Thereafter, the vehicle steering information is provided to the power-steering assist control module 135 for affecting steering of the vehicle 100 by the power-steering assist system 115 to achieve a commanded path of travel for the trailer 110.
The trailer backup steering input apparatus 125 provides the trailer backup assist control module 120 with information defining the commanded path of travel of the trailer 110 to the trailer backup assist control module 120 (i.e., trailer steering information). The trailer steering information can include information relating to a commanded change in the path of travel (e.g., a change in radius of path curvature) and information relating to an indication that the trailer is to travel along a path defined by a longitudinal centerline axis of the trailer (i.e., along a substantially straight path of travel). As will be discussed below in detail, the trailer backup steering input apparatus 125 preferably includes a rotational control input device for allowing a driver of the vehicle 100 to interface with the trailer backup steering input apparatus 125 to command desired trailer steering actions (e.g., commanding a desired change in radius of the path of travel of the trailer and/or commanding that the trailer travel along a substantially straight path of travel as defined by a longitudinal centerline axis of the trailer). In a preferred embodiment, the rotational control input device is a knob rotatable about a rotational axis extending through a top surface/face of the knob. In other embodiments, the rotational control input device is a knob rotatable about a rotational axis extending substantially parallel to a top surface/face of the knob.
Some vehicles (e.g., those with active front steer) have a power-steering assist system configuration that allows a steering wheel to be decoupled from movement of the steered wheels of such a vehicle. Accordingly, the steering wheel can be rotated independent of the manner in which the power-steering assist system of the vehicle controls the steered wheels (e.g., as commanded by vehicle steering information provided by to a power-steering assist system control module from a trailer backup assist system control module configured in accordance with an embodiment of the inventive subject matter). As such, in these types of vehicles where the steering wheel can be selectively decoupled from the steered wheels to allow independent operation thereof, trailer steering information of a trailer backup assist system configured in accordance with the inventive subject matter can be provided through rotation of the steering wheel. Accordingly, it is disclosed herein that in certain embodiments of the inventive subject matter, the steering wheel is an embodiment of a rotational control input device in the context of the inventive subject matter. In such embodiments, the steering wheel would be biased (e.g., by an apparatus that is selectively engagable/activatable) to an at-rest position between opposing rotational ranges of motion.
The hitch angle detecting apparatus 130, which operates in conjunction with a hitch angle detection component 155 of the trailer 110, provides the trailer backup assist control module 120 with information relating to an angle between the vehicle 100 and the trailer 110 (i.e., hitch angle information). In a preferred embodiment, the hitch angle detecting apparatus 130 is a camera-based apparatus such as, for example, an existing rear view camera of the vehicle 100 that images (i.e., visually monitors) a target (i.e., the hitch angle detection component 155) attached the trailer 110 as the trailer 110 is being backed by the vehicle 100. Preferably, but not necessarily, the hitch angle detection component 155 is a dedicated component (e.g., an item attached to/integral with a surface of the trailer 110 for the express purpose of being recognized by the hitch angle detecting apparatus 130. Alternatively, the hitch angle detecting apparatus 130 can be a device that is physically mounted on a hitch component of the vehicle 100 and/or a mating hitch component of the trailer 110 for determining an angle between centerline longitudinal axes of the vehicle 100 and the trailer 110.
The power-steering assist control module 135 provides the trailer backup assist control module 120 with information relating to a rotational position (e.g., angle) of the steering wheel angle and/or a rotational position (e.g., turning angle(s)) of steered wheels of the vehicle 100. In certain embodiments of the inventive subject matter, the trailer backup assist control module 120 can be an integrated component of the power steering assist system 115. For example, the power-steering assist control module 135 can include a trailer back-up assist algorithm for generating vehicle steering information as a function of all or a portion of information received from the trailer backup steering input apparatus 125, the hitch angle detecting apparatus 130, the power-steering assist control module 135, the brake system control module 145, and the powertrain control module 150.
The brake system control module 145 provides the trailer backup assist control module 120 with information relating to vehicle speed. Such vehicle speed information can be determined from individual wheel speeds as monitored by the brake system control module 145. In some instances, individual wheel speeds can also be used to determine a vehicle yaw rate and such yaw rate can be provided to the trailer backup assist control module 120 for use in determining the vehicle steering information. In certain embodiments, the trailer backup assist control module 120 can provide vehicle braking information to the brake system control module 145 for allowing the trailer backup assist control module 120 to control braking of the vehicle 100 during backing of the trailer 110. For example, using the trailer backup assist control module 120 to regulate speed of the vehicle 100 during backing of the trailer 110 can reduce the potential for unacceptable trailer backup conditions. Examples of unacceptable trailer backup conditions include, but are not limited to, a vehicle overspeed condition, a trailer jackknife condition as defined by an angular displacement limit relative to the vehicle 100 and the trailer 110, and the like. It is disclosed herein that the backup assist control module 120 can issue a signal corresponding to a notification (e.g., a warning) of an actual, impending, and/or anticipated unacceptable trailer backup condition.
The powertrain control module 150 interacts with the trailer backup assist control module 120 for regulating speed and acceleration of the vehicle 100 during backing of the trailer 110. As mentioned above, regulation of the speed of the vehicle 100 is necessary to limit the potential for unacceptable trailer backup conditions such as, for example, jackknifing. Similar to high-speed considerations as they relate to unacceptable trailer backup conditions, high acceleration can also lead to such unacceptable trailer backup conditions.
Referring now to
The movement sensing device 175 is configured for sensing movement of the knob 170 and outputting a corresponding signal (i.e., movement sensing device signal) to the trailer assist backup input apparatus 125 shown in
Use of the knob 170 decouples trailer steering inputs from being made at a steering wheel of the vehicle 100. In use, as a driver of the vehicle 100 backs the trailer 110, the driver can turn the knob 170 to dictate a curvature of a path of the trailer 110 to follow and returns the knob 170 to the at-rest position P(AR) for causing the trailer 110 to be backed along a straight line. Accordingly, in embodiments of trailer backup assist systems where the steering wheel remains physically coupled to the steerable wheels of a vehicle during backup of an attached trailer, a rotatable control element configured in accordance with the inventive subject matter (e.g., the knob 170) provides a simple and user-friendly means of allowing a driver of a vehicle to input trailer steering commands.
It is disclosed herein that a rotational control input device configured in accordance with embodiments of the inventive subject matter (e.g., the knob 170 and associated movement sensing device) can omit a means for being biased to an at-rest position between opposing rotational ranges of motion. Lack of such biasing allows a current rotational position of the rotational control input device to be maintained until the rotational control input device is manually moved to a different position. Preferably, but not necessarily, when such biasing is omitted, a means is provided for indicating that the rotational control input device is positioned in a zero curvature commanding position (e.g., at the same position as the at-rest position in embodiments where the rotational control input device is biased). Examples of means for indicating that the rotational control input device is positioned in the zero curvature commanding position include, but are not limited to, a detent that the rotational control input device engages when in the zero curvature commanding position, a visual marking indicating that the rotational control input device is in the zero curvature commanding position, an active vibratory signal indicating that the rotational control input device is in or approaching the zero curvature commanding position, an audible message indicating that the rotational control input device is in of approaching the zero curvature commanding position, and the like.
It is also disclosed herein that embodiments of the inventive subject matter can be configured with a control input device that is not rotational (i.e., a non-rotational control input device). Similar to a rotational control input device configured in accordance with embodiments of the inventive subject matter (e.g., the knob 170 and associated movement sensing device), such a non-rotational control input device is configured to selectively provide a signal causing a trailer to follow a path of travel segment that is substantially straight and to selectively provide a signal causing the trailer to follow a path of travel segment that is substantially curved. Examples of such a non-rotational control input device include, but are not limited to, a plurality of depressible buttons (e.g., curve left, curve right, and travel straight), a touch screen on which a driver traces or otherwise inputs a curvature for path of travel commands, a button that is translatable along an axis for allowing a driver to input path of travel commands, and the like.
The trailer backup steering input apparatus 125 can be configured to provide various feedback information to a driver of the vehicle 100. Examples of situation that such feedback information can indicate include, but are not limited to, a status of the trailer backup assist system 105 (e.g., active, in standby (e.g., when driving forward to reduce the trailer angle), faulted, inactive, etc), that a curvature limit has been reached (i.e., maximum commanded curvature of a path of travel of the trailer 110), etc. To this end, the trailer backup steering input apparatus 125 can be configured to provide a tactile feedback signal (e.g., a vibration through the knob 170) as a warning if any one of a variety of conditions occur. Examples of such conditions include, but are not limited to, the trailer 110 having jackknifed, the trailer backup assist system 105 has had a failure, the trailer backup assist system 105 or other system of the vehicle 100 has predicted a collision on the present path of travel of the trailer 110, the trailer backup system 105 has restricted a commanded curvature of a trailer's path of travel (e.g., due to excessive speed or acceleration of the vehicle 100), and the like. Still further, it is disclosed that the trailer backup steering input apparatus 125 can use illumination (e.g., an LED 180) and/or an audible signal output (e.g., an audible output device 185) to provide certain feedback information (e.g., notification/warning of an unacceptable trailer backup condition).
Referring now to
After activating the trailer backup assist system 105 (e.g., before, after, or during the pull-thru sequence), the driver begins to back the trailer 110 by reversing the vehicle 100 from the first backup position B1. So long as the knob 170 of the trailer backup steering input apparatus 125 remains in the at-rest position P(AR), the trailer backup assist system 105 will steer the vehicle 100 as necessary for causing the trailer 110 to be backed along a substantially straight path of travel as defined by the longitudinal centerline axis L2 of the trailer 110 at the time when backing of the trailer 110 began. When the trailer reaches the second backup position B2, the driver rotates the knob 170 to command the trailer 110 to be steered to the right (i.e., a knob position R(R)). Accordingly, the trailer backup assist system 105 will steer the vehicle 100 for causing the trailer 110 to be steered to the right as a function of an amount of rotation of the knob 170 with respect to the at-rest position P(AR), a rate movement of the knob 170, and/or a direction of movement of the knob 170 with respect to the at-rest position P(AR). Similarly, the trailer 110 can be commanded to steer to the left by rotating the knob 170 to the left. When the trailer reaches backup position B3, the driver allows the knob 170 to return to the at-rest position P(AR) thereby causing the trailer backup assist system 105 to steer the vehicle 100 as necessary for causing the trailer 110 to be backed along a substantially straight path of travel as defined by the longitudinal centerline axis L2 of the trailer 110 at the time when the knob 170 was returned to the at-rest position P(AR). Thereafter, the trailer backup assist system 105 steers the vehicle 100 as necessary for causing the trailer 110 to be backed along this substantially straight path to the fourth backup position B4. In this regard, arcuate portions of a path of travel POT of the trailer 110 are dictated by rotation of the knob 170 and straight portions of the path of travel POT are dictated by an orientation of the centerline longitudinal axis L2 of the trailer when the knob 170 is in/returned to the at-rest position P(AR).
An operation 202 is performed for receiving a trailer backup assist request. Examples of receiving the trailer backup assist request include activating the trailer backup assist system and providing confirmation that the vehicle and trailer are ready to be backed. After receiving a trailer backup assist request (i.e., while the vehicle is being reversed), an operation 204 is performed for receiving a trailer backup information signal. Examples of information carried by the trailer backup information signal include, but are not limited to, information from the trailer backup steering input apparatus 125, information from the hitch angle detecting apparatus 130, information from the power-steering assist control module 135, information from the brake system control module 145, and information from the powertrain control module 150. It is disclosed herein that information from the trailer backup steering input apparatus 125 preferably includes trailer path curvature information characterizing a desired curvature for the path of travel of the trailer, such as provided by the trailer backup steering input apparatus 125 discussed above in reference to
If the trailer backup information signal indicates that a change in curvature of the trailer's path of travel is requested (i.e., commanded via the knob 170), an operation 206 is performed for determining vehicle steering information for providing the requested change in curvature of the trailer's path of travel. Otherwise, an operation 208 is performed for determining vehicle steering information for maintaining a current straight-line heading of the trailer (i.e., as defined by the longitudinal centerline axis of the trailer). Thereafter, an operation 210 is performed for providing the vehicle steering information to a power-steering assist system of the vehicle, followed by an operation 212 being performed for determining the trailer backup assist status. If it is determined that trailer backup is complete, an operation 214 is performed for ending the current trailer backup assist instance. Otherwise the method 200 returns to the operation 204 for receiving trailer backup information. Preferably, the operation for receiving the trailer backup information signal, determining the vehicle steering information, providing the vehicle steering information, and determining the trailer backup assist status are performed in a monitoring fashion (e.g., at a high rate of speed of a digital data processing device). Accordingly, unless it is determined that reversing of the vehicle for backing the trailer is completed (e.g., due to the vehicle having been successfully backed to a desired location during a trailer backup assist instance, the vehicle having to be pulled forward to begin another trailer backup assist instance, etc), the method 200 will continually be performing the operations for receiving the trailer backup information signal, determining the vehicle steering information, providing the vehicle steering information, and determining the trailer backup assist status.
It is disclosed herein that the operation 206 for determining vehicle steering information for providing the requested change in curvature of the trailer's path of travel preferably includes determining vehicle steering information as a function of trailer path curvature information contained within the trailer backup information signal. As will be discussed below in greater detail, determining vehicle steering information can be accomplished through a low order kinematic model defined by the vehicle and the trailer. Through such a model, a relationship between the trailer path curvature and commanded steering angles of steered wheels of the vehicle can be generated for determining steering angle changes of the steered wheels for achieving a specified trailer path curvature. In this manner, the operation 206 for determining vehicle steering information can be configured for generating information necessary for providing trailer path curvature control in accordance with the inventive subject matter.
In some embodiments of the inventive subject matter, the operation 210 for providing the vehicle steering information to the power-steering assist system of the vehicle causes the steering system to generate a corresponding steering command as a function of the vehicle steering information. The steering command is interpretable by the steering system and is configured for causing the steering system to move steered wheels of the steering system for achieving a steered angle as specified by the vehicle steering information. Alternatively, the steering command can be generated by a controller, module or computer external to the steering system (e.g., a trailer backup assist control module) and be provided to the steering system.
In parallel with performing the operations for receiving the trailer backup information signal, determining the vehicle steering information, providing the vehicle steering information, and determining the trailer backup assist status, the method 200 performs an operation 216 for monitoring the trailer backup information for determining if an unacceptable trailer backup condition exists. Examples of such monitoring include, but are not limited to assessing a hitch angle to determine if a hitch angle threshold is exceeded, assessing a backup speed to determine if a backup speed threshold is exceeded, assessing vehicle steering angle to determining if a vehicle steering angle threshold is exceeded, and the like. If it is determined that an unacceptable trailer backup condition exists, an operation 218 is performed for causing the current path of travel of the trailer to be inhibited (e.g., stopping motion of the vehicle), followed by the operation 214 being performed for ending the current trailer backup assist instance. It is disclosed herein that prior to and/or in conjunction with causing the current trailer path to be inhibited, one or more actions (e.g., operations) can be implemented for providing the driver with feedback (e.g., a warning) that such an unacceptable trailer angle condition is impending or approaching. In one example, if such feedback results in the unacceptable trailer angle condition being remedied prior to achieving a critical condition, the method can continue with providing trailer backup assist functionality in accordance with operations 204-212. Otherwise, the method can proceed to operation 214 for ending the current trailer backup assist instance. In conjunction with performing the operation 214 for ending the current trailer backup assist instance, an operation can be performed for controlling movement of the vehicle to correct or limit a jackknife condition (e.g., steering and/or decelerating the vehicle to preclude the hitch angle from being exceeded).
Turning now to a discussion of a kinematic model used to calculate a relationship between a curvature of a path of travel of a trailer and the steering angle of a vehicle towing the trailer, a low order kinematic model can be desirable for a trailer back-up assist system configured in accordance with some embodiments of the inventive subject matter. To achieve such a low order kinematic model, certain assumptions are made with regard to parameters associated with the vehicle/trailer system. Examples of such assumptions include, but are not limited to, the trailer being backed by the vehicle at a relatively low speed, wheels of the vehicle and the trailer having negligible (e.g., no) slip, tires of the vehicle and the trailer having negligible (e.g., no) deformation, actuator dynamics of the vehicle being negligible, the vehicle and the trailer exhibiting negligible (e.g., no) roll or pitch motions.
As shown in
The kinematic model 300 of
Or, this relationship can be expressed to provide the steering angle δ as a function of trailer path curvature κ2 and hitch angle γ.
Accordingly, for a particular vehicle and trailer combination, certain kinematic model parameters (e.g., D, W and L) are constant and assumed known. V is the vehicle longitudinal speed and g is the acceleration due to gravity. K is a speed dependent parameter which when set to zero makes the calculation of steering angle independent of vehicle speed. For example, vehicle-specific kinematic model parameters can be predefined in an electronic control system of a vehicle and trailer-specific kinematic model parameters can be inputted by a driver of the vehicle. Trailer path curvature κ2 is determined from the driver input via a trailer backup steering input apparatus. Through the use of the equation for providing steering angle, a corresponding steering command can be generated for controlling a steering system (e.g., an actuator thereof) of the vehicle.
Referring to
Referring to
Solving the above equation for hitch angle allows jackknife angle γ(j) to be determined. This solution, which is shown in the following equation, can be used in implementing trailer backup assist functionality in accordance with the inventive subject matter for monitoring hitch angle in relation to jackknife angle.
where,
Referring now to instructions processible by a data processing device, it will be understood from the disclosures made herein that methods, processes and/or operations adapted for carrying out trailer backup assist functionality as disclosed herein are tangibly embodied by non-transitory computer readable medium having instructions thereon that are configured for carrying out such functionality. The instructions are tangibly embodied for carrying out the method 200 disclosed and discussed above and can be further configured for limiting the potential for a jackknife condition such as, for example, by monitoring jackknife angle through use of the equations discussed in reference to
In a preferred embodiment of the inventive subject matter, a trailer back-up assist control module (e.g., the trailer back-up assist control module 120 discussed above in reference to
In the preceding detailed description, reference has been made to the accompanying drawings that form a part hereof, and in which are shown by way of illustration specific embodiments in which the inventive subject matter may be practiced. These embodiments, and certain variants thereof, have been described in sufficient detail to enable those skilled in the art to practice embodiments of the inventive subject matter. It is to be understood that other suitable embodiments may be utilized and that logical, mechanical, chemical and electrical changes may be made without departing from the spirit or scope of such inventive disclosures. To avoid unnecessary detail, the description omits certain information known to those skilled in the art. The preceding detailed description is, therefore, not intended to be limited to the specific forms set forth herein, but on the contrary, it is intended to cover such alternatives, modifications, and equivalents, as can be reasonably included within the spirit and scope of the appended claims.
This patent application is a continuation of U.S. patent application Ser. No. 16/419,193, which was filed May 22, 2019, entitled “Trailer Backup Assist Curvature Control,” which is a continuation of U.S. patent application Ser. No. 14/482,604, which was filed Sep. 10, 2014, entitled “Trailer Backup Assist Curvature Control,” now U.S. Pat. No. 10,370,030, which is a continuation of U.S. patent application Ser. No. 13/336,060, which was filed on Dec. 23, 2011, entitled “Trailer Path Curvature Control for Trailer Backup Assist,” now U.S. Pat. No. 8,909,426 which claims benefit from U.S. Provisional Patent Application No. 61/477,132, which was filed Apr. 19, 2011, entitled “Trailer Backup Assist Curvature Control,” and which has a common applicant herewith and is hereby incorporated by reference in its entirety.
Number | Name | Date | Kind |
---|---|---|---|
3542390 | Fikse | Nov 1970 | A |
3756624 | Taylor | Sep 1973 | A |
3860257 | Mesly | Jan 1975 | A |
3944972 | Chandler | Mar 1976 | A |
4042132 | Bohman et al. | Aug 1977 | A |
4212483 | Howard | Jul 1980 | A |
4277804 | Robison | Jul 1981 | A |
4518044 | Wiegardt et al. | May 1985 | A |
4735432 | Brown | Apr 1988 | A |
4752080 | Rogers | Jun 1988 | A |
4848499 | Martinet et al. | Jul 1989 | A |
4947097 | Tao | Aug 1990 | A |
5001639 | Breen | Mar 1991 | A |
5108158 | Breen | Apr 1992 | A |
5246242 | Penzotti | Sep 1993 | A |
5247442 | Kendall | Sep 1993 | A |
5261495 | Szymczak | Nov 1993 | A |
5270689 | Hermann | Dec 1993 | A |
5313389 | Yasui | May 1994 | A |
5427195 | Paul et al. | Jun 1995 | A |
5558350 | Kimbrough et al. | Sep 1996 | A |
5579228 | Kimbrough et al. | Nov 1996 | A |
5586814 | Steiner | Dec 1996 | A |
5957232 | Shimizu et al. | Sep 1999 | A |
6042196 | Nakamura et al. | Mar 2000 | A |
6056371 | Lin et al. | May 2000 | A |
6292094 | Deng et al. | Sep 2001 | B1 |
6351698 | Kubota et al. | Feb 2002 | B1 |
6409288 | Yoshida et al. | Jun 2002 | B2 |
6494476 | Masters et al. | Dec 2002 | B2 |
6498977 | Wetzel et al. | Dec 2002 | B2 |
6567731 | Chandy | May 2003 | B2 |
6636197 | Goldenberg et al. | Oct 2003 | B1 |
6838979 | Deng et al. | Jan 2005 | B2 |
6854557 | Deng et al. | Feb 2005 | B1 |
6904823 | Levin et al. | Jun 2005 | B2 |
7032705 | Zheng et al. | Apr 2006 | B2 |
7038667 | Vassallo et al. | May 2006 | B1 |
7085634 | Endo et al. | Aug 2006 | B2 |
7117077 | Michi et al. | Oct 2006 | B2 |
7136754 | Hahn et al. | Nov 2006 | B2 |
7139650 | Lubischer | Nov 2006 | B2 |
7154385 | Lee et al. | Dec 2006 | B2 |
7165820 | Rudd, III | Jan 2007 | B2 |
7191865 | Spari | Mar 2007 | B2 |
7219913 | Atley | May 2007 | B2 |
7225891 | Gehring et al. | Jun 2007 | B2 |
7255061 | Denton | Aug 2007 | B2 |
7309075 | Ramsey et al. | Dec 2007 | B2 |
7310084 | Shitanaka et al. | Dec 2007 | B2 |
7315299 | Sunda et al. | Jan 2008 | B2 |
7319927 | Sun et al. | Jan 2008 | B1 |
7436298 | Yuasa et al. | Oct 2008 | B2 |
7489309 | Levin et al. | Feb 2009 | B2 |
7550686 | Girke et al. | Jun 2009 | B2 |
7690737 | Lu | Apr 2010 | B2 |
7715953 | Shepard | May 2010 | B2 |
7793965 | Padula | Sep 2010 | B2 |
7827917 | Henderson | Nov 2010 | B1 |
7837004 | Yasuda | Nov 2010 | B2 |
7932623 | Burlak et al. | Apr 2011 | B2 |
7969326 | Sakakibara | Jun 2011 | B2 |
8010253 | Lundquist | Aug 2011 | B2 |
8033955 | Farnsworth | Oct 2011 | B2 |
8036792 | Dechamp | Oct 2011 | B2 |
8108116 | Mori et al. | Jan 2012 | B2 |
8138865 | North et al. | Mar 2012 | B2 |
8170726 | Chen et al. | May 2012 | B2 |
8188850 | Smith | May 2012 | B2 |
8244442 | Craig et al. | Aug 2012 | B2 |
8246226 | Stempinski | Aug 2012 | B2 |
8260518 | Englert | Sep 2012 | B2 |
8267485 | Barlsen et al. | Sep 2012 | B2 |
8280607 | Gatti et al. | Oct 2012 | B2 |
8374749 | Tanaka | Feb 2013 | B2 |
8430792 | Noll | Apr 2013 | B2 |
8469125 | Yu et al. | Jun 2013 | B2 |
8519948 | Cruz-Hernandez et al. | Aug 2013 | B2 |
8571758 | Klier et al. | Oct 2013 | B2 |
8752989 | Roberts | Jun 2014 | B2 |
8755982 | Heckel et al. | Jun 2014 | B2 |
8755984 | Rupp et al. | Jun 2014 | B2 |
8786417 | Holmen et al. | Jul 2014 | B2 |
8798860 | Dechamp | Aug 2014 | B2 |
8909426 | Rhode et al. | Dec 2014 | B2 |
8930140 | Trombley et al. | Jan 2015 | B2 |
8972109 | Lavoie et al. | Mar 2015 | B2 |
9102271 | Trombley | Aug 2015 | B2 |
9108598 | Headley | Aug 2015 | B2 |
9132856 | Shepard | Sep 2015 | B2 |
9248858 | Lavoie et al. | Feb 2016 | B2 |
9315212 | Kyrtsos et al. | Apr 2016 | B1 |
9335162 | Kyrtsos et al. | May 2016 | B2 |
9340228 | Xu et al. | May 2016 | B2 |
11338852 | Stabel | May 2022 | B2 |
11341678 | Jin | May 2022 | B2 |
11364885 | Viele | Jun 2022 | B2 |
11410431 | Pliefke | Aug 2022 | B2 |
11420678 | Maruoka | Aug 2022 | B2 |
11422519 | Anderson | Aug 2022 | B2 |
11440585 | Lavoie | Sep 2022 | B2 |
11447132 | Simmons | Sep 2022 | B2 |
20010037164 | Hecker | Nov 2001 | A1 |
20010052434 | Ehrlich et al. | Dec 2001 | A1 |
20040093139 | Wildey et al. | May 2004 | A1 |
20040136175 | Lewis et al. | Jul 2004 | A1 |
20040189595 | Yuasa et al. | Sep 2004 | A1 |
20040215374 | Shepard | Oct 2004 | A1 |
20050000738 | Gehring et al. | Jan 2005 | A1 |
20050206225 | Offerle et al. | Sep 2005 | A1 |
20050206229 | Lu et al. | Sep 2005 | A1 |
20050206232 | Offerle | Sep 2005 | A1 |
20050209763 | Offerle et al. | Sep 2005 | A1 |
20050236201 | Spannheimer et al. | Oct 2005 | A1 |
20050236894 | Lu et al. | Oct 2005 | A1 |
20050236896 | Offerle et al. | Oct 2005 | A1 |
20060092129 | Choquet et al. | May 2006 | A1 |
20060103511 | Lee et al. | May 2006 | A1 |
20060142936 | Dix | Jun 2006 | A1 |
20070027581 | Bauer et al. | Feb 2007 | A1 |
20070198190 | Bauer et al. | Aug 2007 | A1 |
20070252359 | Wishart et al. | Nov 2007 | A1 |
20080030361 | Peissner et al. | Feb 2008 | A1 |
20080177443 | Lee et al. | Jul 2008 | A1 |
20080231701 | Greenwood et al. | Sep 2008 | A1 |
20080312792 | Dechamp | Dec 2008 | A1 |
20090082935 | Leschuk | Mar 2009 | A1 |
20090093928 | Getman et al. | Apr 2009 | A1 |
20090101429 | Williams | Apr 2009 | A1 |
20090157260 | Lee | Jun 2009 | A1 |
20090198425 | Englert | Aug 2009 | A1 |
20090271078 | Dickinson | Oct 2009 | A1 |
20090306854 | Dechamp | Dec 2009 | A1 |
20090306861 | Schumann et al. | Dec 2009 | A1 |
20090326775 | Nishida | Dec 2009 | A1 |
20100063670 | Menzel | Mar 2010 | A1 |
20100152989 | Smith et al. | Jun 2010 | A1 |
20100222964 | Dechamp | Sep 2010 | A1 |
20110087398 | Lu et al. | Apr 2011 | A1 |
20110149077 | Robert | Jun 2011 | A1 |
20110160956 | Chung et al. | Jun 2011 | A1 |
20110257860 | Getman et al. | Oct 2011 | A1 |
20110257973 | Chutorash et al. | Oct 2011 | A1 |
20120030626 | Hopkins et al. | Feb 2012 | A1 |
20120041658 | Turner | Feb 2012 | A1 |
20120041659 | Greene | Feb 2012 | A1 |
20120087480 | Yang et al. | Apr 2012 | A1 |
20120095649 | Klier et al. | Apr 2012 | A1 |
20120185131 | Headley | Jul 2012 | A1 |
20120200706 | Greenwood et al. | Aug 2012 | A1 |
20120271512 | Rupp et al. | Oct 2012 | A1 |
20120271514 | Lavoie et al. | Oct 2012 | A1 |
20120271515 | Rhode et al. | Oct 2012 | A1 |
20120271522 | Rupp et al. | Oct 2012 | A1 |
20120283909 | Dix | Nov 2012 | A1 |
20120310594 | Watanabe | Dec 2012 | A1 |
20120316732 | Aver | Dec 2012 | A1 |
20130006472 | McClain et al. | Jan 2013 | A1 |
20130024064 | Shepard | Jan 2013 | A1 |
20130148748 | Suda | Jun 2013 | A1 |
20130158803 | Headley | Jun 2013 | A1 |
20130158863 | Skvarce et al. | Jun 2013 | A1 |
20130179038 | Goswami et al. | Jul 2013 | A1 |
20130268160 | Trombley et al. | Oct 2013 | A1 |
20140052337 | Lavoie et al. | Feb 2014 | A1 |
20140058614 | Trombley et al. | Feb 2014 | A1 |
20140058622 | Trombley et al. | Feb 2014 | A1 |
20140058655 | Trombley et al. | Feb 2014 | A1 |
20140058668 | Trombley et al. | Feb 2014 | A1 |
20140067154 | Yu et al. | Mar 2014 | A1 |
20140067155 | Yu et al. | Mar 2014 | A1 |
20140085472 | Lu et al. | Mar 2014 | A1 |
20140088797 | McClain et al. | Mar 2014 | A1 |
20140121930 | Allexi et al. | May 2014 | A1 |
20140156148 | Kikuchi | Jun 2014 | A1 |
20140160276 | Pliefke et al. | Jun 2014 | A1 |
20140172232 | Rupp et al. | Jun 2014 | A1 |
20140188344 | Lavoie | Jul 2014 | A1 |
20140188346 | Lavoie | Jul 2014 | A1 |
20140210456 | Crossman | Jul 2014 | A1 |
20140218506 | Trombley et al. | Aug 2014 | A1 |
20140218522 | Lavoie et al. | Aug 2014 | A1 |
20140222288 | Lavoie et al. | Aug 2014 | A1 |
20140236532 | Trombley et al. | Aug 2014 | A1 |
20140249691 | Hafner et al. | Sep 2014 | A1 |
20140267688 | Aich et al. | Sep 2014 | A1 |
20140267689 | Lavoie | Sep 2014 | A1 |
20140267868 | Mazzola et al. | Sep 2014 | A1 |
20140267869 | Sawa | Sep 2014 | A1 |
20140277942 | Kyrtsos et al. | Sep 2014 | A1 |
20140297128 | Lavoie et al. | Oct 2014 | A1 |
20140297129 | Lavoie et al. | Oct 2014 | A1 |
20140303847 | Lavoie | Oct 2014 | A1 |
20140309888 | Smit et al. | Oct 2014 | A1 |
20140324295 | Lavoie | Oct 2014 | A1 |
20140343795 | Lavoie | Nov 2014 | A1 |
20140379217 | Rupp et al. | Dec 2014 | A1 |
20150025732 | Min et al. | Jan 2015 | A1 |
20150057903 | Rhode et al. | Feb 2015 | A1 |
20150066296 | Trombley et al. | Mar 2015 | A1 |
20150066298 | Sharma et al. | Mar 2015 | A1 |
20150070161 | Mizuno et al. | Mar 2015 | A1 |
20150120141 | Lavoie et al. | Apr 2015 | A1 |
20150134183 | Lavoie et al. | May 2015 | A1 |
20150138340 | Lavoie | May 2015 | A1 |
20150158527 | Hafner et al. | Jun 2015 | A1 |
20150203156 | Hafner et al. | Jul 2015 | A1 |
20150210317 | Hafner et al. | Jul 2015 | A1 |
20150217693 | Pliefke et al. | Aug 2015 | A1 |
20150232092 | Fairgrieve et al. | Aug 2015 | A1 |
20160009288 | Yu | Jan 2016 | A1 |
20160052548 | Singh et al. | Feb 2016 | A1 |
Number | Date | Country |
---|---|---|
202159367 | Mar 2012 | CN |
3923676 | Jan 1991 | DE |
3931518 | Apr 1991 | DE |
9208595 | Aug 1992 | DE |
19526702 | Feb 1997 | DE |
10154612 | May 2003 | DE |
102005043466 | Mar 2007 | DE |
102005043467 | Mar 2007 | DE |
102005043468 | Mar 2007 | DE |
102006002294 | Jul 2007 | DE |
102006035021 | Jan 2008 | DE |
102007029413 | Jan 2009 | DE |
102008004160 | Aug 2009 | DE |
102006035021 | Apr 2010 | DE |
102008043675 | May 2010 | DE |
102009007990 | Aug 2010 | DE |
102009012253 | Sep 2010 | DE |
102008004158 | Oct 2011 | DE |
102008004159 | Oct 2011 | DE |
102008004160 | Oct 2011 | DE |
102010021052 | Nov 2011 | DE |
102010029184 | Nov 2011 | DE |
0418653 | Mar 1991 | EP |
0849144 | Jun 1998 | EP |
1361543 | Nov 2003 | EP |
1655191 | May 2006 | EP |
1810913 | Jul 2007 | EP |
2388180 | Nov 2011 | EP |
2644477 | Oct 2013 | EP |
1569073 | Sep 2014 | EP |
2515379 | Apr 1983 | FR |
2398048 | Aug 2004 | GB |
2398049 | Aug 2004 | GB |
2398050 | Aug 2004 | GB |
09267762 | Oct 1997 | JP |
1019739 | May 1998 | JP |
2003045269 | Feb 2003 | JP |
2003175852 | Jun 2003 | JP |
2005053454 | Mar 2005 | JP |
2007186118 | Jul 2007 | JP |
2012166580 | Sep 2012 | JP |
20140105199 | Sep 2014 | KR |
8503263 | Aug 1985 | WO |
0044605 | Aug 2000 | WO |
2012059207 | May 2012 | WO |
2012103193 | Aug 2012 | WO |
2013186208 | Dec 2013 | WO |
Entry |
---|
Zhe Leng, Mark Minor, “A Simple Tractor-Trailer Backing Control Law for Path Following,” Oct. 18-22, 2010, 5538-5542, The 2010 IEEE/RJS International Conference on Intelligent Robots and Systems, Taipei, Taiwan. |
“Audi Full Luminated Glow LED Badge Light Emblem,” http://parts.worldtuning fans.com/audi-full-illuminated-glow-led-badge-light-emblem-3125-p.asp#.VAm6AGMvCZU, access from internet: Aug. 18, 2014. |
Khatib, M., Jaouni, H., Chatila, R., and Laumond, J.P. “Dynamic Path Modification for Car-Like Nonholonomic Mobile Robots,” IEEE International Conference on Robotics and Automation, Albuquerque, New Mexico, Apr. 1997, 6 pages. |
Roh, J., Lee, H., Chung, W. “Control of a Car with a Trailer Using the Driver Assistance System,” IEEE, International Conference on Robotics and Biomimetrics, Dec. 7-11, 2011; Phuket, Thailand, pp. 2890-2895. |
Azadi, SH., Nedamani, H.R. Rezaei, and Kazemi, R., “Automatic Parking of an Articulated Vehicle Using ANFIS,” Global Journal of Science, Engineering and Technology, 2013, pp. 93-104, Issue No. 14. |
Cuesta, F., and Ollero, A. “Intelligent System for Parallel Parking of Cars and Tractor-Trailers,” Intelligent Mobile Robot Navigation, Star 2005, pp. 159-188, Springer-Verlag Berlin Heidelberg. |
Zoebel, D., Polock, D., Wojke, P. “Steering Assistance for Backing Up Articulated Vehicles,” Systemics, Cybernetics and Informatics, Universitaet Koblenz-Landau, Germany, 2003, vol. 1, No. 5, pp. 101-106. |
Steele, M., Gillespie, R. “Shared Control Between Human and Machine: Using a Haptic Steering Wheel to Aid in Land Vehicle Guidance,” University of Michigan, pp. 1-5, date unknown. |
C. Lundquist; W. Reinelt; O. Enqvist, “Back Driving Assistant for Passenger Cars with Trailer”, ZF Lenksysteme GmbH, Schwäbisch Gmünd, Germany, 2006 (SAE Int'l) Jan. 2006, 8 pgs. |
Guanrong, Chen; Zhang, Dellin; “Backing up a truck-trailer with suboptimal distance trajectories” IEEE, Aug. 6, 2002, New Orleans, LA, 1 pg. |
Payne, M.L.;Hung, J.Y, and Bevy, D.M; “Control of a Robot-Trailer System Using a Single Non-Collacted Sensor”, IEEE, 38th Annual Conference on IEEE Industrial Electronics Society, Oct. 25-28, 2012; pp. 2674-2679. |
Altafini, C.; Speranzon, A.; Wahlberg, B., “A Feedback Control Scheme for Reversing a Truck and Trailer Vehicle”, IEEE, Robotics and Automation, IEEE Transactions, Dec. 2001, vol. 17, No. 6, 2 pgs. |
Cedric Pradalier and Kane Usher, “Experiments in Autonomous Reversing of a Tractor-Trailer System”, 6th International Conference on Field and Service Robotics, inria-00195700, Version 1, Dec. 2007, pp. 1-10. |
Claudio Altafini, Alberto Speranzon, and Karl Henrik Johansson, “Hybrid Control of a Truck and Trailer Vehicle”, Springer-Verlag Berlin Heidelberg, HSCC 2002, LNCS 2289; 2002, pp. 21-34. |
Cedric Pradalier and Kane Usher, “Robust Trajectory Tracking for a Reversing Tractor-Trailer System”, (Draft), Field and Service Robotics Conference, CSIRO ICT Centre, Jul. 2007, 16 pgs. |
A. Gonzalez-Cantos, A.Ollero, “Backing-Up Maneuvers of Autonomous Tractor-Trailer Vehicles Using the Qualitative Theory of Nonlinear Dynamical Systems”, ACM Digital Library, International Journal of Robotics Research, Jan. 2009, vol. 28, No. 1, 2 pgs. |
P. Bolzern, R.M. Desantis, A. Locatelli, “An Input-Output Linearization Approach to the Control of an n-Body Articulated Vehicle”, J. Dyn. Sys., Meas., Control, Sep. 2001, vol. 123, No. 3, 3 pgs. |
Divelbiss, A.W.; Wen, J.T.; “Trajectory Tracking Control of a Car-Trailer System”, IEEE, Control Systems Technology, Aug. 6, 2002, vol. 5, No. 3, pp. 269-278. |
“Optionally Unmanned Ground Systems for any Steering-Wheel Based Vehicle” Universal. Unmanned., Kairos Autonomi, website: http://www.kairosautonomi.com/pronto4_system.html[Sep. 26, 2014 3:22:48 PM], 2008, pp. 1-2. |
“Ford Super Duty: Truck Technologies”, Brochure, Sep. 2011, pp. 1-2. |
“Understanding Tractor-Trailer Performance”, Caterpillar, 2006, pp. 1-28. |
Hodo, D. W.; Hung, J.Y.; Bevly, D. M.; Millhouse, S., “Effects of Sensor Placement and Errors on Path Following Control of a Mobile Robot-Trailer System”, IEEE, American Control Conference, Jul. 2007, pp. 1-1. |
“2012 Edge—Trailer Towing Selector”, Brochure, Preliminary 2012 RV & Trailer Towing Guide Information, pp. 1-3. |
Haviland, G S, “Automatic Brake Control For Trucks—What Good Is It?”, TRID, Society of Automotive Engineers, Sep. 1968, pp. 1-1. |
Olof Enqvist, “AFS—Assisted Trailer Reversing,” Institutionen för systemteknik Deartment of Electrical Engineering, Jan. 27, 2006, pp. 1-57. |
Number | Date | Country | |
---|---|---|---|
20210291901 A1 | Sep 2021 | US |
Number | Date | Country | |
---|---|---|---|
61477132 | Apr 2011 | US |
Number | Date | Country | |
---|---|---|---|
Parent | 16419193 | May 2019 | US |
Child | 17341598 | US | |
Parent | 14482604 | Sep 2014 | US |
Child | 16419193 | US | |
Parent | 13336060 | Dec 2011 | US |
Child | 14482604 | US |