System for guiding trailer along target route during reversing maneuver
09902425 ยท 2018-02-27
Assignee
Inventors
Cpc classification
B60T2201/10
PERFORMING OPERATIONS; TRANSPORTING
B62D15/028
PERFORMING OPERATIONS; TRANSPORTING
B60T8/1708
PERFORMING OPERATIONS; TRANSPORTING
B62D13/06
PERFORMING OPERATIONS; TRANSPORTING
International classification
B62D13/06
PERFORMING OPERATIONS; TRANSPORTING
B62D15/02
PERFORMING OPERATIONS; TRANSPORTING
Abstract
The present invention relates to a vehicle control system (1) for controlling a vehicle (3) to facilitate reversing a trailer (5) coupled to the vehicle (3). The vehicle control system includes a processor (33) configured to receive a target trailer destination (D.sub.TAR). The current position of the trailer (5) is determined by the processor (33). A target route (R) is then modelled to guide the trailer (5) from its current position to the target trailer destination (D.sub.TAR). The processor (33) is configured to output a vehicle control signal to control the vehicle (3) to guide the trailer (5) along the target route (R). The invention also relates to a method of controlling a vehicle (3) to facilitate reversing a trailer (5).
Claims
1. A system for controlling a vehicle to facilitate reversing a trailer coupled to the vehicle, the system comprising a processor configured to: identify permissible target trailer destinations and impermissible target trailer destinations; receive a target trailer destination specified by a user; determine a current trailer position; model a target route from the current trailer position to the user-specified target trailer destination; and output a vehicle control signal for controlling the vehicle to guide the trailer along the target route; wherein the processor inhibits user selection of an impermissible target trailer destination.
2. The system of claim 1, wherein the target trailer destination comprises location data and/or orientation data.
3. The system of claim 1, wherein the target route comprises one or more curves joining the current trailer position to the target trailer destination.
4. The system of claim 3, wherein the vehicle control signal maps a center point of the trailer to the target route.
5. The system of claim 1, wherein the processor is configured to identify the permissible target trailer destinations based on a detected available space for the trailer.
6. The system of claim 1, wherein the processor is configured to receive image data from one or more video cameras disposed on the vehicle and/or the trailer.
7. The system of claim 6, wherein the processor is configured to identify one or more obstructions proximal to the trailer and/or the vehicle.
8. The system of claim 6, wherein the processor is configured to overlay the target trailer destination and/or a target route for the trailer on a video image from the one or more video cameras.
9. The system of claim 1, wherein the vehicle control signal comprises a steering control signal for controlling a steering angle of the vehicle.
10. A vehicle comprising the system of claim 1.
11. The system of claim 1, wherein the processor is configured to identify the permissible target trailer destinations based on at least one of a maximum permissible hitch angle, and a detected terrain parameter.
12. A method of controlling a vehicle to facilitate reversing a trailer to a specified target trailer destination, wherein the vehicle comprises a human machine interface (HMI) module, an electronic power assisted steering (EPAS) module, at least one camera, and a control unit having a guidance module and an image processing module, the method comprising: receiving at the control unit a user input via the HMI module that defines a user-specified target trailer destination, wherein the control unit is configured to identify permissible target trailer destinations for positioning the trailer and impermissible target trailer destinations unsuitable for positioning the trailer, the control unit being configured to inhibit user selection of an impermissible target trailer destination; processing image data from the at least one camera via the image processing module to determine a current orientation of the trailer relative to the vehicle; modeling a target route from a current trailer position to the user-specified target trailer destination via the guidance module; and outputting, via the guidance module, a vehicle control signal to the EPAS module for controlling the vehicle to guide the trailer along the target route.
Description
BRIEF DESCRIPTION OF THE DRAWINGS
(1) An embodiment of the present invention will now be described, by way of example only, with reference to the accompanying figures, in which:
(2)
(3)
(4)
(5)
(6)
(7)
(8)
(9)
(10)
DETAILED DESCRIPTION OF AN EMBODIMENT
(11) A vehicle control system 1 for assisting with the reversing of a vehicle 3 and a trailer 5 in accordance with an aspect of the present invention will now be described with reference to
(12) The vehicle control system is operable to facilitate reversing of the trailer 5 when it is coupled to the vehicle 3 (the combination of the vehicle 3 and the trailer 5 can be referred to as a rig). More specifically, the vehicle control system 1 is configured to control the steering of the vehicle 3 such that the trailer 5 is reversed to a target trailer destination D.sub.TAR specified by the user. In the present embodiment, the operation of the throttle and brakes of the vehicle 3 are controlled by the user, but these control functions could be automated.
(13) A plan view of the vehicle 3 and the trailer 5 is shown in
(14) As shown in
(15) A tow hitch 17 is mounted to the vehicle 3 for coupling to a trailer coupling 19 mounted to the trailer 5. The tow hitch 17 is an upwardly projecting tow ball in the present embodiment. The trailer coupling 19 is mounted to a hitch frame 21 disposed at the front of the trailer 5. In the present embodiment, the hitch frame 21 is an A-frame having a front apex 23 to which the trailer coupling 19 is mounted. A target 25 is mounted to a front face 27 of the trailer 5 to enable the position of the trailer 5 relative to the vehicle 3 to be determined, as described herein. The target 25 is a visible image comprising three circles arranged in a triangular formation. It will be appreciated that the present invention can be implemented with other targets 25, for example comprising different symbols/images or non-visible targets.
(16) The trailer 5 is provided with a trailer imaging system comprising a centrally mounted rear trailer camera 29; and left and right side trailer cameras 30, 31 mounted on respective sides of the trailer 5. The trailer cameras 29, 30, 31 are optical cameras arranged to provide video images of the area around the trailer 5 which may otherwise be obscured from view. The fields of view TV1, TV2, TV3 of the trailer cameras 29, 30, 31 are illustrated by dashed triangles in
(17) The vehicle control system 1 comprises an electronic control unit (ECU) having an electronic processor 33, as shown schematically in
(18) The image processing module 33A is configured to multiplex the images from the trailer cameras 29, 30, 31 to generate a composite image 35 showing a panoramic view to the rear of the trailer 5, as shown in
(19) The processor 33 further comprises vehicle/trailer guidance means in the form of a guidance module 33B. The guidance module 33B is provided to assist with guiding the trailer 5 when the vehicle 3 and the trailer 5 are being reversed together. In particular, the guidance module 33B is configured to output a control signal for controlling the steering angle of the front wheels W1, W2 of the vehicle 3 to guide the trailer 5 along a target route R. The target route R is generated by the guidance module 33B to guide the trailer 5 from its current position to a target destination D.sub.TAR specified by the user. The target route R is illustrated by a dashed line in
(20) The vehicle control system 1 comprises a human machine interface (HMI) module 39. The HMI module 39 is coupled to the display screen 37 and is configured to superimpose a graphical image 41, representing the target destination D.sub.TAR of the trailer 5, onto the composite image 35. In the present embodiment the graphical image 41 comprises a rectangle 43 which represents the footprint of the trailer 5. The graphical image 41 is sized to provide a scale representation of the trailer 5 within the composite image 35. To provide an accurate representation of the trailer 5, the trailer dimensions can be specified by the user and stored in a data file accessible to the HMI module 39. In the present embodiment a portion of the graphical image 41 is semi-transparent to reduce obfuscation of objects in the composite image 35. It will be appreciated that the present invention is not limited to the display of a rectangle 43 and other graphical images 39 can be used to represent the trailer 5.
(21) The HMI module 39 is coupled to input means 45 in the form of a touch screen and a rotary dial. The input means 45 can be operated by the user to position the graphical image 41 within the composite image 35. The user can thereby position the graphical image 41 to specify the target destination D.sub.TAR for the trailer 5, typically corresponding to a location where the trailer 5 is to be parked. The input means 45 can optionally also enable the user to define the orientation of the trailer 5 in relation to the vehicle 3, for example by adjusting the angular orientation of the rectangle 43.
(22) The HMI module 39 performs a scaling operation on the graphical image 41 to adjust its size based on its position within the composite image 35, for example to increase/decrease its size in dependence on its virtual position in relation to the camera generating the video image. The graphical image 41 can optionally also be modified to alter its perspective, for example to simulate foreshortening, as it is moved within the composite image 35. The graphical image 41 can thereby provide an accurate representation of the size of the trailer 5 within the composite image 35. The processor 33 could be configured to identify areas or regions which are unsuitable for positioning the trailer 5. The HMI module 39 can be configured to represent any such areas as an overlay on the composite image 35. Alternatively, or in addition, the HMI module 39 can be configured to prevent the graphical image 41 being moved to locations identified by the processor 33 as being unsuitable for positioning the trailer 5. For example, the processor 33 could determine that a region displayed in the composite image 35 is unsuitable due to the detection of one or more obstructions by the image processing module 33A. Alternatively, or in addition, the processor 33 could assess one or more terrain parameters, such as incline or gradient, to identify unsuitable regions for the trailer 5. The terrain parameters could be assessed from the image data derived from the vehicle cameras 9, 10, 11 and/or the trailer cameras 29, 30, 31. Alternatively, or in addition, one or more of the following types of sensor could be employed to monitor the terrain: ultrasonic sensors/cameras, laser scanners and radar. The resulting terrain data could be used to restrict selection of the target destination D.sub.TAR; and/or control vehicle operating parameters, for example to engage four wheel drive or to select a low transfer range; and/or request user confirmation of the selected target destination D.sub.TAR.
(23) The guidance module 33B is configured to generate the target route R to guide the trailer 5 from its current location to the target destination D.sub.TAR specified by the user. The target route R defines a target trailer travel direction T.sub.TAR for guiding the trailer 5 from its current position to the target destination D.sub.TAR. The target route R can comprise rectilinear and/or curved sections. The target route R is arranged coincident with a midpoint of the trailer 5 in its current position. The current position of the trailer 5 is monitored compared to the originally calculated target route R. Small deviations are managed within the vehicle control system 1. Larger deviations can trigger a recalculation of the target route R. If the target destination D.sub.TAR becomes unachievable from the current position, the user is alerted and a corrective manoeuvre is suggested (for example travel forward a short distance).
(24) The user positions the graphical image 41 within the composite image 35 to define the target destination D.sub.TAR of the trailer 5. The guidance module 33B determines the target route R between the current trailer position and the specified target destination D.sub.TAR. As illustrated in
(25) With reference to
(26) The S-shaped path 55 is positioned to link the actual longitudinal axis X2 of the trailer 5 to the target longitudinal axis X2.sub.TAR. A scaling function and/or a rotation function can be applied to the S-shaped path 55 depending on the position and/or orientation of the target destination D.sub.TAR in relation to the current trailer position. The S-shaped path 55 is then modified by adjusting the included angle of either the first curve A or the second curve B in dependence on the angular offset between the actual longitudinal axis X2 and the target longitudinal axis X2.sub.TAR.
(27) In the present embodiment, the guidance module 33B identifies which of the first and second curves A, B opens onto the side of the S-shaped path 55 to which the target longitudinal axis X2.sub.TAR is oriented. The guidance module 33B then modifies the included angle of the identified curve A, B corresponding to the angular offset between the actual longitudinal axis X2 and the target longitudinal axis X2.sub.TAR. This technique will now be described with reference to
(28) In the scenario illustrated in
(29) In the scenario illustrated in
(30) In the scenario illustrated in
(31) In the scenario illustrated in
(32) In a second process step, the vehicle control system 1 attempts to identify the presence of any obstructions (denoted generally by the reference numeral 46 in
(33) With reference to
(34) If the hitch angle can be achieved between the two calculation points, the guidance module 33B stores the values in memory and, during the manoeuvre, accesses the stored values after each interval to set the next interval value as the desired hitch angle . If the guidance module 33B detects a large deviation between the present hitch angle and the expected hitch angle it restarts the calculation to avoid failure.
(35) If the hitch angle between the two calculation points cannot be achieved (for example based on the maximum steering angle of the vehicle and the trailer geometry), the guidance module 33B compares the required hitch angle .sub.n, .sub.n+1 between first and second intervals x to establish if this hitch angle can be achieved while considering surrounding conditions. If the comparison of the hitch angle .sub.n, .sub.n+1 between the first and second intervals x is possible, the guidance module 33B stores the values in memory and, during the manoeuvre, accesses the stored values after each interval to set the next interval value as the desired hitch angle . If the guidance module 33B fails to achieve the required hitch angle for four (4) consecutive interval points (i.e. x to 4x), an alternative target route R is calculated while considering space requirement and the surrounding obstructions 46. If the guidance module 33B is unable to establish a viable alternative target route R, the guidance module 33B calculates an alternate position between failure points identified by means of driving forward in the available space to complete the manoeuvre. During the route calculation the guidance module 33B determines whether the hitch angle change between two intervals can be achieved. If the hitch angle cannot be achieved then the calculation needs to check if the hitch angle change calculated in alternative routes in two previous and two subsequent intervals can be achieved. If this fails then the calculation starts again or requests an initial drive forwards to reduce the rate of change of hitch angle. A forward shuffle could also be requested mid-manoeuvre.
(36) The angular change in the trailer angle at intervals along the target route R is illustrated in
(37) As described herein, the steering angle of the vehicle 3 is controlled to maintain the actual travel direction T.sub.ACT of the trailer 5 substantially coincident with the target trailer travel direction T.sub.TAR during the reversing manoeuvre along said target route R. The guidance module 33B can control the steering angle of the front wheels W1, W2 to guide the trailer 5 along the target travel direction T.sub.TAR.
(38) The control algorithm for generating a control signal to guide the vehicle 3 along the target route R will now be described with reference to
(39) The image processing module 33A calculates the hitch angle with reference to the target 25 and outputs a hitch angle signal to the guidance module 33B. When reversing, the guidance module 33B calculates the required steering angle based on the following equation:
.sub.t+1=.sub.t+min(max(k(.sub.req.sub.cur),),) Where: .sub.t+1 and .sub.t are the steering angles of the vehicle 3 at frame t+1 and t (auto steering command from the algorithm and current steering from the CAN respectively); .sub.req and .sub.cur are the requested and current hitch angles; is the maximum steering offset value; and k is a constant multiplier.
(40) The value of the gain k can be calculated based on the relationship between and , as shown in
(41)
(42) The gain k thereby compensates for the fact that longer trailers take longer to reach the requested hitch angle .
(43) The guidance module 33B is configured to calculate a maximum permissible hitch angle .sub.MAX. If the hitch angle exceeds the maximum permissible hitch angle .sub.MAX (which in the present embodiment is the jack-knife angle of the trailer 5), it is no longer possible to reduce the hitch angle by continuing to reverse (i.e. the trailer 5 has jack-knifed). If the detected hitch angle is equal to or exceeds the calculated jack-knife angle, the vehicle control system 1 will advise the user to drive forward until it determines that the trailer angle at the next interval is achievable while considering space and obstructions. With reference to
(44)
(45) The wheelbase d, the tow bar offset h and the maximum steering angle .sub.MAX of the vehicle 3 are defined for the vehicle 3. The hitch length L of the trailer 5 is entered during trailer setup by the user (or can be determined during a calibration exercise). The guidance module 33B outputs a maximum hitch angle signal to indicate the maximum permissible hitch angle .sub.MAX for the current steering angle . The guidance module 33B is configured to inhibit the trailer travel direction T.sub.ACT to values which are less than the maximum permissible hitch angle .sub.MAX. A minimum radius of curvature of the target route R can be defined to ensure that the trailer travel direction T.sub.ACT is less than or equal to the maximum permissible hitch angle .sub.MAX.
(46) The guidance module 33B calculates the initial required steering angle to achieve the desired hitch angle , then iteratively calculates the required steering angle and hitch angle . In use, the guidance module 33B is configured to output a steering control signal operative to control the steering angle of the front wheels W1, W2 to adjust the hitch angle , thereby modifying the actual trailer travel direction T.sub.ACT. Specifically, the guidance module 33B adjusts the steering angle (which can be positive or negative in relation to a reference point) to increase or decrease the hitch angle . The actual trailer travel direction T.sub.ACT can thereby be matched to the target trailer travel direction T.sub.TAR required to follow the target route R. The hitch angle signal is updated at least substantially in real time and the guidance module 33B makes corresponding real time adjustments to the steering control signal. The guidance module 33B controls the hitch angle so that the difference between the actual trailer travel direction T.sub.ACT and the target trailer travel direction T.sub.TAR is at least substantially zero. A tolerance of +/0.5 between the actual trailer travel direction T.sub.ACT and the target trailer travel direction T.sub.TAR provides a good result.
(47) The steering angle control signal is output to an electronic power assisted steering (EPAS) module 45 to control the angle of a steering wheel 47 to provide a required steering angle for the front wheels W1, W2. The EPAS module 45 automatically adjusts the angular orientation of the steering wheel 47 to provide the appropriate steering angle at the front wheels W1, W2 to control the vehicle 3 to match the actual trailer travel direction T.sub.ACT with the target trailer travel direction T.sub.TAR.
(48) In use, the user operates the HMI module 39 to position the graphical image 41 at the target destination D.sub.TAR for the trailer 5, as illustrated in
(49) The image processing module 33A analyses the image data from the vehicle cameras 9, 10, 11 to identify the target 25 on the trailer 5 and to determine the current position of the trailer 5 in relation to the vehicle 3. The guidance module 33B then models a target route R for the trailer 5 from its current position to the target trailer destination D.sub.TAR. A vehicle control signal is output by the guidance module 33B to the EPAS module 45 to adjust the steering angle to control the vehicle 3 to match the actual travel direction T.sub.ACT of the trailer 5 with the target travel direction T.sub.TAR. The HMI module 39 can optionally output instructions to prompt the user to select the appropriate drive gear and to operate the vehicle brakes and throttle. The EPAS module 45, in dependence on the vehicle control signal output from the guidance module 33B, then steers the vehicle 3 to guide the trailer 5 along the target route R. A notification can be output by the HMI module 39 to notify the user when the trailer 5 is in the target destination D.sub.TAR. The vehicle control system 1 can thereby facilitate reversing the trailer 5 to the target destination D.sub.TAR.
(50) The present invention is applicable to a range of different types of trailer 5. For example, the trailer 5 can be a caravan, a goods trailer, a flatbed trailer, a van trailer, a livestock trailer and so on. Similarly, the present invention is applicable to a range of different types of vehicles 3. For example, the vehicle 3 can be a motor vehicle, such as an off-road or sports utility vehicle; or a towing engine or tractor for a semi-trailer truck.
(51) The control techniques described herein are a development of those described in the Applicant's earlier UK patent applications GB1307524.7 (filed on 26 Apr. 2013) and GB1307525.4 (filed on 26 Apr. 2013), the contents of which are incorporated herein in their entirety by reference. Furthermore, the contents of the Applicant's related application entitled VEHICLE CONTROL SYSTEM filed on the same day as the present application at the UK Intellectual Property Office are hereby incorporated in their entirety into the present application by reference.
(52) It will be appreciated that various changes and modifications can be made to the vehicle control system 1 described herein without departing from the present invention. Rather than specify the target trailer destination D.sub.TAR by positioning the graphical image 41 on a video image, the graphical image 41 could be positioned on a static image such as a grid or mesh representing a predefined region around the vehicle 3.
(53) Furthermore, although the vehicle control system 1 has been described with reference to a set of vehicle cameras 9, 10, 11 and a set of trailer cameras 29, 30, 31, it will be appreciated that a single camera could be provided on the vehicle 3 and/or the trailer 5. In a further alternative, the trailer cameras 29, 30, 31 could be omitted. A set of parking sensors provided on the trailer 5 could, for example, provide notification to the driver of any obstructions. The hitch angle could be measured directly, for example by a rotary encoder.
(54) In a further alternative, a video image could be transmitted to the vehicle 3 from a remote camera (for example provided in a cellular telephone) over a wireless network such as Bluetooth.