Many vehicles are designed to accommodate the towing or trailering of various loads, including without limitation: cargo, campers, boats, and sometimes other vehicles. Trailering presents challenges to the operator of the tow vehicle who must maneuver the tow vehicle in consideration of the pavement geometry and trailer tracking.
Active rear steering (ARS) systems are known for controlling steering angles of the rear wheels of a vehicle. Such systems are known to steer the rear wheels substantially proportionally to the steering of the front wheels within limits of the rear steering mechanism. Moreover, at low speeds the rear wheels may be steered in the direction opposite to the front wheel steering, while at high speeds the rear wheels may be steered in the same direction as the front wheel steering, though rear wheel steering direction is application specific. At low speeds, ARS may reduce the effective turning radius of the vehicle which improves maneuverability of vehicles with a longer wheelbase.
In one exemplary embodiment, an apparatus may include a trailer coupled to a tow vehicle having an active rear steering system with a controller. The controller may be configured to control the active rear steering system such that the trailer follows a predetermined path of travel.
In addition to one or more of the features described herein, the predetermined path of travel may include a path of travel corresponding to a path traversed by a predetermined point on the tow vehicle.
In addition to one or more of the features described herein, the predetermined point on the tow vehicle may include a point on a front axle of the tow vehicle.
In addition to one or more of the features described herein, the point on the front axle of the tow vehicle may include a central point on the front axle of the tow vehicle.
In addition to one or more of the features described herein, the predetermined point on the tow vehicle may include a point on a longitudinal centerline of the tow vehicle.
In addition to one or more of the features described herein, the predetermined path of travel may include a path of travel relative to a reference frame corresponding to the tow vehicle.
In addition to one or more of the features described herein, the control of the active rear steering system may be such that a predetermined point on the trailer follows the predetermined path of travel.
In addition to one or more of the features described herein, the predetermined point on the trailer may include a point on an axle of the trailer.
In addition to one or more of the features described herein, the point on the axle of the trailer may include a central point on the axle of the trailer.
In addition to one or more of the features described herein, the predetermined point on the trailer may include a point on a longitudinal centerline of the trailer.
In another exemplary embodiment, a method for controlling a path of travel of a trailer towed by a tow vehicle may include controlling an active rear steering system on the tow vehicle such that the trailer follows a predetermined path of travel.
In addition to one or more of the features described herein, the predetermined path of travel may include a path of travel corresponding to a path traversed by a predetermined point on the tow vehicle.
In addition to one or more of the features described herein, the predetermined point on the tow vehicle may include a central point on a front axle of the tow vehicle.
In addition to one or more of the features described herein, the predetermined path of travel may include a path of travel relative to a reference frame corresponding to the tow vehicle.
In addition to one or more of the features described herein, controlling an active rear steering system on the tow vehicle such that the trailer follows a predetermined path of travel may include controlling the active rear steering system such that a predetermined point on the trailer follows the predetermined path of travel.
In addition to one or more of the features described herein, the predetermined point on the trailer may include a central point on an axle of the trailer.
In yet another exemplary embodiment, a method for controlling a path of travel of a trailer towed by a tow vehicle may include determining a trailer location point on the trailer, determining a path of travel for the trailer relative to a reference frame corresponding to the tow vehicle, and controlling with an automatic rear steering system on the tow vehicle the trailer location point to the path of travel.
In addition to one or more of the features described herein, determining the trailer location point on the trailer may be based upon a trailer dimension and a hitch angle.
In addition to one or more of the features described herein, the reference frame corresponding to the tow vehicle may include a coordinate system, wherein determining the path of travel for the trailer relative to the reference frame may include updating the path of travel including transforming the path relative to position and orientation changes of the tow vehicle.
In addition to one or more of the features described herein, the trailer location point may include a point on at least one of a trailer axle and a centerline of the trailer, wherein the path of travel for the trailer may include a path traversed by a point on at least one of a front axle of the tow vehicle and the centerline of the tow vehicle.
The above features and advantages, and other features and advantages of the disclosure are readily apparent from the following detailed description when taken in connection with the accompanying drawings.
Other features, advantages and details appear, by way of example only, in the following detailed description, the detailed description referring to the drawings in which:
The following description is merely exemplary in nature and is not intended to limit the present disclosure, its application or uses. Throughout the drawings, corresponding reference numerals indicate like or corresponding parts and features. As used herein, control module, module, control, controller, control unit, processor and similar terms mean any one or various combinations of one or more of Application Specific Integrated Circuit(s) (ASIC), electronic circuit(s), central processing unit(s) (preferably microprocessor(s)) and associated memory and storage (read only memory (ROM), random access memory (RAM), electrically programmable read only memory (EPROM), hard drive, etc.) or microcontrollers executing one or more software or firmware programs or routines, combinational logic circuit(s), input/output circuitry and devices (I/O) and appropriate signal conditioning and buffer circuitry, high speed clock, analog to digital (A/D) and digital to analog (D/A) circuitry and other components to provide the described functionality. A control module may include a variety of communication interfaces including point-to-point or discrete lines and wired or wireless interfaces to networks including wide and local area networks, on vehicle networks (e.g. Controller Area Network (CAN), Local Interconnect Network (LIN) and in-plant and service-related networks. Control module functions as set forth in this disclosure may be performed in a distributed control architecture among several networked control modules. Software, firmware, programs, instructions, routines, code, algorithms and similar terms mean any controller executable instruction sets including calibrations, data structures, and look-up tables. A control module has a set of control routines executed to provide described functions. Routines are executed, such as by a central processing unit, and are operable to monitor inputs from sensing devices and other networked control modules and execute control and diagnostic routines to control operation of actuators. Routines may be executed at regular intervals during ongoing engine and vehicle operation. Alternatively, routines may be executed in response to occurrence of an event, software calls, or on demand via user interface inputs or requests.
In accordance with the present disclosure, an apparatus and method for ARS control of trailer tracking a vehicle in a towing configuration is set forth herein and in the various drawings.
Vehicle 101 may include a control system architecture 135 including a plurality of electronic control units (ECU) 137 which may be communicatively coupled via a bus structure 139 to perform control functions and information sharing, including executing control routines locally and in distributed fashion. Bus structure 139 may include a Controller Area Network (CAN), as well known to those having ordinary skill in the art. ECUs 137 may include such non-limiting examples as a powertrain control module (PCM), an engine control module (ECM), a transmission control module (TCM), a body control module (BCM), a traction control or stability control module, a cruise control module, a steering control module, a brake control module, etc. One exemplary ECU may be an ARS control module (ARSCM) 141 primarily tasked with functions related to ARS system monitoring, control and diagnostics. ECUs 137, including ARSCM 141 may be indirectly or directly connected to a variety of sensors and actuators, as well as any combination of the other ECUs (e.g., via bus structure 139).
ARSCM 141 receives a variety of information from sensors and from other ECUs for use in control of rear wheel steering of vehicle 101. Information received by ARSCM 141 may include such non limiting examples as vehicle dynamic and kinematic information such as speed, heading, steering angle, multi-axis accelerations and jerks, yaw, pitch, roll and their derivative quantities, etc. Many such quantities may be generally available over vehicle bus structure 139 originating from known vehicle sensors such as wheel speed sensors 171 at each corner of the vehicle 101, steering angle sensor 181, and yaw rate sensor 188, for example. As shown in
Vehicle 101 includes a front axle 116 corresponding to front wheels 105F. Front wheel steering is effected by a front steering mechanism 180 which may include a steering gear and steering linkages as well known in the art. Steering input (i.e. operator interface) may be by way of a mechanical steering shaft interacting with the steering gear. Mechanical steering effort may be assisted by hydraulic or electrical devices. Steer-by-wire systems are known wherein operator steering intent is determined and, together with other information such as vehicle speed (V) and yaw rate (ω), actuates the steering rack without the need for the mechanical steering shaft interacting with the steering gear.
Vehicle 101 includes a rear axle 114 corresponding to rear wheels 105R and an ARS system. In one embodiment the ARS system may include the ARSCM 141 including control routines, various sensors and/or sensor information and rear steering mechanism 106, among other related components. Rear wheel steering is effected by rear steering mechanism 106 which may include a steering gear and steering linkages as well known in the art. Rear steering mechanism 106 may include an actuator 110 which causes the steering gear to steer the rear wheels 105R in the desired direction. In one embodiment actuator 110 may be a rotary or linear electric motor or a hydraulic actuator or combination such as an electric-over-hydraulic actuator, for example. Other actuators may be apparent to those having ordinary skill in the art. In another embodiment, the rear steering mechanism 106 may include individual actuator-at-wheel mechanisms such as independent electric actuators. Actuator 110 is communicatively coupled to ARSCM 141 either directly or via the bus structure 139 as illustrated which may provide steering angle commands to the actuator 110. Rear steering mechanism feedback, such as rear steering angle, may similarly be provided to the ARSCM 141. Among the sensor information of the ARS system is hitch angle which is defined as the angle of deviation of the centerline of the trailer 103 from alignment with the centerline of the vehicle 101. Hitch angle sensing is known to those skilled in the art and may be provided by a rotation sensor 102 such as an encoder or potentiometer or a vision system 104 including camera as non-limiting examples. Rotation sensor 102, vision system 104, or alternative hitch angle sensor may provide hitch angle information to ARSCM 141 via bus structure 139 for example.
Additional reference is made to
In accordance with one embodiment,
A trailer location point is next determined at (407). The trailer location point may provide a reference for control of the trailer tracking. In the present exemplary embodiment, the trailer location point corresponds to center point D of the trailer axle 108, relative to the vehicle 101 reference frame with the origin at center point B of the rear axle 114 as described herein. Alternative trailer location points may be determined and utilized including, for example other points along the trailer axle 108 or along the trailer centerline 203. One skilled in the art will recognize that any trailer location point may be determined and utilized for the present purposes. Thus, in the present embodiment, the coordinates (xD, yD) of center point D of the trailer axle 108 may be determined in accordance with the following relationships:
x
D
=L2+L3 cos(α) [1]
y
D
=L3 sin(α) [2]
wherein
Next, at (409), the desired path 150 for traversal by trailer 103 may be updated. In the present embodiment the desired path 150 is determined with respect to the path traversed by center point A of the front axle 116. Alternative vehicle points may be determined and utilized for determination of the desired path 150 including, for example other points along the front axle 116 or along the vehicle centerline 201. One skilled in the art will recognize that any vehicle point may be determined and utilized for the present purposes. Thus, in accordance with the present embodiment, the desired path may be represented by points traversed by center point A of the front axle 116, and more particularly represented by those points having yet to be traversed by the trailer 103. In the present embodiment the desired path 150 is relative to the vehicle 101 reference frame preferably established in a two-dimensional cartesian coordinate system with the vehicle centerline 201 as one axis (x-axis) and the rear axle 114 as a second axis (y-axis) and the origin at the intersecting center point B as described herein. Therefore, as the vehicle 101 progresses and changes its position and orientation in space, previously determined points along the desired path 150 are transformed or mapped to the reference frame at the current position and orientation of the vehicle 101. Additionally, as the vehicle 101 progresses and new points in the desired path 150 added, historical points along the desired path 150 that have already been traversed by the trailer 103 are removed. Thus, for example, the desired path may be stored in a coordinate matrix or other such data structure and updated substantially in accordance with a first-in first-out (FIFO) approach whereby the desired path is dynamically updated. In this respect, dynamic updating of the desired path 150 includes updating points in the path and transformation of the path relative to position and orientation changes of the vehicle 101. Initially, the desired path may be populated with points exclusively along the longitudinal x-axis of the vehicle reference frame and particularly with points extending from center point A of the front axle 116 through and including center point D of the trailer axle 108. In one embodiment, a procedure for determining and dynamically updating the desired path may include calculation of the movement of the vehicle 101 reference frame in accordance with a kinematic model. Movement of the reference frame may include both angular and positional displacements or shifts. In one embodiment, the kinematic model may be a simple unicycle kinematic model as represented by the following relationships:
{dot over (θ)}=ω [3]
{dot over (x)}=V cos(θ) [4]
{dot over (y)}=V sin(θ) [5]
wherein
Thus, the angular change (Δθ) in the reference frame, that is the difference between the angular orientation at current control time step (t) and the angular orientation at the previous control time step (t−1), is determined from the yaw rate (ω), which is equivalent to the rate of change in the vehicle yaw angle (θ), and the interval from the previous time step (t−1) to the current time step (t). Similarly, the positional shift (Δx, Δy) in the reference frame, that is the difference between the position at current time step (t) and the position at the previous time step (t−1), is determined from the position rates of change {dot over (x)} and {dot over (y)} and the interval from the previous time step (t−1) to the current time step (t). Movement of the vehicle 101 reference frame may be alternatively quantified, for example by dead-reckoning, relative to roadway or infrastructure features, including visible lane markers or radio frequency lane markers, or through global positioning system (GPS) and geographic information system (GIS) data.
A transformation relationship may next be used to map the historical points of the desired path 150 as follows:
is a rotational transformation matrix;
is a prior time step point on the desired path 150 adjusted by the positional shift (Δx, Δy) in the reference frame; and
is the current time step point on the desired path 150 transformed to the current position and orientation of the vehicle reference frame.
One having ordinary skill in the art will recognize that the exemplary rotational transformation matrix corresponds to a clockwise rotation, whereas an alternative rotational transformation matrix of the form
corresponds to a counterclockwise rotation. It is understood that the transformation relationship [6] may be applied to all points in the desired path 150 at each new time step whereby all prior time step positions are continually mapped to the vehicle 101 current reference frame. Thus, the entire desired path is continually updated and mapped to the vehicle reference frame at its current position and orientation. Under a FIFO approach, the oldest point in the desired path 150 may be removed from the coordinate matrix or other such data structure and the most current point added thereto. The new point may be represented by the following relationship:
ARS control calculations are made to track the trailer 103 to the desired path 150 at (411). Essentially, it is desirable that the center point D of the trailer axle 108 tracks the desired path 150 with minimal error. Thus, in one embodiment, the rear steering mechanism 106 actuator 110 may be controlled to minimize this error. One exemplary feedback controller may command actuator 110 to a steering angle setpoint δ(t) using a conventional PID controller responsive to the error e(t) between the desired path and point D to provide the steering angle setpoint δ(t). Alternatively, any appropriate controller may be employed. For example, one skilled in the art will recognize that the desired path includes a substantial set of future points along the desired path and may advantageously be used in a controller including feedforward control or compensation, or in a model predictive controller (MPC). The control setpoint, for example δ(t), is provided to the rear steering mechanism 106 actuator 110 at (413). Control time may be incremented and other controller maintenance tasks performed at (413) consistent with completion of the current control time step. Where continued rear steering mechanism 106 control for trailer tracking is desired, the process returns from (413) to (405) to repeat the control functions set forth herein. Where continued rear steering mechanism 106 control for trailer tracking is not desired, the process ends at (415).
Unless explicitly described as being “direct,” when a relationship between first and second elements is described in the above disclosure, that relationship can be a direct relationship where no other intervening elements are present between the first and second elements, but can also be an indirect relationship where one or more intervening elements are present (either spatially or functionally) between the first and second elements.
Or more steps within a method may be executed in different order (or concurrently) without altering the principles of the present disclosure. Further, although each of the embodiments is described above as having certain features, any one or more of those features described with respect to any embodiment of the disclosure can be implemented in and/or combined with features of any of the other embodiments, even if that combination is not explicitly described. In other words, the described embodiments are not mutually exclusive, and permutations of one or more embodiments with one another remain within the scope of this disclosure.
While the above disclosure has been described with reference to exemplary embodiments, it will be understood by those skilled in the art that various changes may be made and equivalents may be substituted for elements thereof without departing from its scope. In addition, many modifications may be made to adapt a particular situation or material to the teachings of the disclosure without departing from the essential scope thereof. Therefore, it is intended that the present disclosure not be limited to the particular embodiments disclosed, but will include all embodiments falling within the scope thereof