Patent Application
20180068566
This disclosure generally relates to a trailer-detection system, and more particularly relates to a trailer-detection system that detects when a trailer towed by a host-vehicle is departing a lane.
Typical trailer lane-departure-warning (LDW) systems include sensors mounted to the host-vehicle and/or the trailer and use the change in the trailer-angle to determine whether the trailer has departed from the travel-lane. Undesirably, these trailer LDW systems typically rely on an operator of the host-vehicle to manually input the trailer dimension information through a user interface.
In accordance with one embodiment, a trailer-detection system configured to determine a position of a trailer towed by a host-vehicle is provided. The trailer-detection system includes a radar-sensor, an angle-detector, a camera, and a controller. The radar-sensor is used to determine a range and an azimuth-angle of a radar-signal reflected by a trailer towed by a host-vehicle. The angle-detector is used to determine a trailer-angle relative to the host-vehicle of the trailer towed by the host-vehicle. The camera is used to detect a lane-marking of a roadway traveled by the host-vehicle and trailer. The controller is in communication with the radar-sensor, the angle-detector, and the camera, and is used to determine when the trailer is departing from a travel-lane of the roadway based on the radar-signal, the trailer-angle, and the lane-marking.
Further features and advantages will appear more clearly on a reading of the following detailed description of the preferred embodiment, which is given by way of non-limiting example only and with reference to the accompanying drawings.
The present invention will now be described, by way of example with reference to the accompanying drawings, in which:
The system 10 includes the radar-sensor 20 used to detect the radar-signal 26 that is reflected by features 28 of the trailer 14 towed by the host-vehicle 12. Typically, radar-systems on vehicles are capable of only determining a distance or range 22 and azimuth-angle 24 to a target so may be referred to as a two-dimensional (2D) radar-system. Other radar-systems are capable of determining an elevation-angle to a target so may be referred to as a three-dimensional (3D) radar-system. In the non-limiting example illustrated in
By way of example and not limitation, the radar-sensor 20 may be configured to output a continuous or periodic data stream that includes a variety of signal characteristics associated with each target detected. The signal characteristics may include or be indicative of, but are not limited to, the range 22 to the detected-target 46 from the host-vehicle 12, the azimuth-angle 24 to the detected-target 46 relative to a host-vehicle-longitudinal-axis 50, an amplitude (not shown) of the radar-signal 26, and a relative-velocity (not shown) of closure relative to the detected-target 46. A target is generally detected because the radar-signal 26 from the detected-target 46 has sufficient signal strength to meet some predetermined threshold. That is, there may be targets that reflect the radar-signal 26, but the strength of the radar-signal 26 is insufficient to be characterized as one of the detected-targets 46. Data that corresponds to a strong-target 46A will generally be from consistent, non-intermittent signals. However, data that corresponds to a weak-target 46B may be intermittent or have some substantial variability due to a low signal-to-noise ratio.
The system 10 includes the angle-detector 30 used to determine the trailer-angle 32 relative to the host-vehicle 12 of the trailer 14 towed by the host-vehicle 12. The trailer-angle 32 is defined as the angle between a host-vehicle-longitudinal-axis 50 and a trailer-longitudinal-axis 52, and is shown to be zero degrees (0°) in
The system 10 includes the camera 34 configured to detect the lane-marking 36 of the roadway 18 traveled by the host-vehicle 12 and the trailer 14. Examples of the camera 34 suitable for use on the host-vehicle 12 are commercially available as will be recognized by those in the art, one such being the ASX340AT from ON Semiconductor® of Phoenix, Ariz., USA.
The camera 34 may be mounted on the rear of the host-vehicle 12 and detect the lane-marking 36 of the roadway 18 behind the host-vehicle 12, or may be a mounted on the front of the host-vehicle 12 and detect the lane-marking 36 of the roadway 18 ahead of the host-vehicle 12, or may be a mounted in the interior of the host-vehicle 12 at a location suitable for the camera 34 to view the area around the host-vehicle 12 through the windows of the host-vehicle 12. Detecting the lane-marking 36 ahead of the vehicle is advantageous because the camera 34 may have a less restricted view of the roadway 18 that enables the system 10 to determine an upcoming change to a width of the travel-lane 16. The camera 34 is typically a rear-facing video-type camera 34 or camera 34 that can capture an image 58 (
The image 58 may include, but is not limited to, the lane-marking 36 on the left side and on the right side of the travel-lane 16 of the roadway 18. The lane-marking 36 may include a solid-line, as is typically used to indicate a boundary of the travel-lane 16 of the roadway 18. The lane-marking 36 may also include a dashed-line, as is also typically used to indicate the boundary of the travel-lane 16 of the roadway 18. The image 58 may also include objects proximate to the host-vehicle 12, such as the trailer 14 and other vehicles (not shown).
The system 10 includes the controller 48 in electrical communication with the radar-sensor 20, the angle-detector 30, and the camera 34. The controller 48 is used to determine when the trailer 14 is departing from the travel-lane 16 of the roadway 18 and to activate an alert-device 60 to warn an operator 62 of the host-vehicle 12 that the trailer 14 is making an unintentional departure from the travel-lane 16. The controller 48 may consider the departure of the trailer 14 from the travel-lane 16 unintentional when a turn-signal of the host-vehicle 12 is not activated prior to the departure of the trailer 14 from the travel-lane 16, for example.
The controller 48 is configured (e.g. programmed or hardwired) to receive the radar-signal 26 from the radar-sensor 20, to receive the yaw-rate 56 from the yaw-sensor 54, and to receive an image-signal 64 from the camera 34. The controller 48 may include a processor (not shown) such as a microprocessor or other control circuitry such as analog and/or digital control circuitry including an application specific integrated circuit (ASIC) for processing data as should be evident to those skilled in the art. The controller 48 may include a memory (not shown), including non-volatile memory, such as electrically erasable programmable read-only memory (EEPROM) for storing one or more routines, thresholds and captured data. The one or more routines may be executed by the processor to perform steps for determining if signals received by the controller 48 indicate the presence of objects as described herein.
The controller 48 is generally configured to determine if the radar-signal 26 arising from the detected-targets 46 corresponds to (i.e. is associated with) the trailer 14 being towed by the host-vehicle 12. That is, the controller 48 determines if the trailer 14 is present, so is actually being towed by the host-vehicle 12. The controller 48 is also generally configured to define a two-dimensional (2D) component of a trailer-boundary 66 characterized as occupied by the trailer 14 and thereby excluded from the zone proximate to the host-vehicle 12 where objects can be detected. By defining the portion of the zone proximate to the host-vehicle 12 that is the trailer-boundary 66, the controller 48 can more readily determine if what seems to be a new target indicated by the radar-signal 26 is likely from the trailer 14, or is likely from something other than the trailer 14, such as the other-vehicle (not shown).
The radar-signal 26 may be analyzed by the controller 48 to categorize the data from each detected-target 46 with respect to a list of previously detected-targets 46 having established tracks. As used herein, a track refers to one or more data sets that have been associated with a particular one of the detected-targets 46. By way of example and not limitation, if the amplitude of the radar-signal 26 is greater than a predetermined amplitude threshold, then the controller 48 determines if the data corresponds to a previously detected-target 46 or if a new-target has been detected. If the data corresponds to a previously detected-target 46, the data is added to or combined with prior data to update the track of the previously detected-target 46. If the data does not correspond to any previously detected-target 46 because, for example, it is located too far away from any previously detected-target 46, then it may be characterized as a new-target and assigned a unique track identification number. The identification number may be assigned according to the order that data for a new detected-target 46 is received, or may be assigned an identification number according to a grid location in the zone proximate to the host-vehicle 12.
The expectation is that the detected-target 46 or the track that corresponds to (i.e. is associated with) the trailer 14 would have a relative-velocity near zero, and that this condition would persist for an extended period of time. That is, the detected-target 46 corresponds to the trailer 14 if the range 22 to the detected-target 46 varies less than a variation threshold (e.g. less than 0.25 meters/second) for greater than a time threshold (e.g. greater than 5 seconds). It is noted that characterizing a target as having a relative-velocity near zero and having a variation in range 22 less than a variation threshold are effectively the same characterization. As such, references to the term ‘range-rate’ in the discussion that follows are directly comparable to the terms ‘relative-velocity’, ‘relative-rate’ and ‘variation-in-range’.
Given the track data described above, each track is compared to a defined bounded area behind the host-vehicle 12 and only tracks that are within those bounds are used. The boundary is set by calibrations, and suitable values for the boundary are 2.4 meters wide, 16.2 meters long, and 4.3 meters high. Additional constraints such as minimum amplitudes or detections sources may be applied to qualify a track prior to using it to determine the trailer-length 38 and the trailer-width 40. After the final track set is determined, the trailer-length 38 and the trailer-width 40 are determined in two steps: Determine the unfiltered (raw) value, and Filter the raw value to the final value. The unfiltered trailer-length 38 is determined by taking the maximum longitudinal-distance back from the rear bumper of the host-vehicle 12, and the raw trailer-width 40 is determined by taking the maximum lateral-distance between any two points within the bounded area. The unfiltered measures are then filtered. One way of filtering is to use a low pass filter with a long time constant such as five seconds. The second way of filtering is to create a histogram of the unfiltered measures where one count is added to the bin that corresponds to the current unfiltered measure and then the bin with the highest counts is selected as the filtered measure. This histogram filter approach appears to create a more stable estimation than the low pass filtered measure. By executing the processes described above, the trailer-length 38 of the trailer-boundary 66 can be determined by the controller 48 based on the longitudinal-distance to a most-distant-target 68 (
The controller 48 is further configured to determine the trailer-angle 32 by using the yaw-sensor 54 to adjust the sensing-area (not shown) behind the host-vehicle 12, in conjunction with the radar-sensor 20 to determine the relative-velocity of the tracked-target associated with the trailer 14, and determine the trailer-angle 32 based on a longitudinal-velocity (not shown) and a lateral-velocity (not shown) of the detected-target 46.
The controller 48 is further configured to determine a centerline 74 on the roadway 18 for the trailer 14 based on the lane-marking 36 of the roadway 18 detected by the camera 34. That is, the image 58 (
The controller 48 is further configured to determine when the feature 28 of the trailer 14 tracked by the radar-sensor 20 is departing from the travel-lane 16 based on the radar-signal 26, the trailer-angle 32 and the lane-marking 36. The feature 28 may be a corner of the trailer 14, as illustrated in
The controller 48 is further configured to determine the trailer-sway-rate 42 based on the trailer-angle 32. The trailer-sway-rate 42 is indicative of an oscillation or sudden change of the trailer-angle 32. The controller 48 is further configured to activate the alert-device 60 if the trailer-sway-rate 42 exceeds a predetermined sway-threshold 43 to warn the operator 62 of the host-vehicle 12 of the condition. That is, if the trailer-angle 32 oscillates greater than ten degrees (10°) within a period of time of less than five seconds (5 seconds), the controller 48 may activate the alert-device 60 to warn the operator 62 that the trailer 14 may be unstable. The predetermined sway-threshold 43 may be a single number, or may be a table of numbers that may be calibrated based on the speed (not shown) of the host-vehicle 12. The magnitude of the trailer-sway-rate 42 may also be used by the stability-control-systems (not shown) of the host-vehicle 12 to mitigate any instability of the trailer 14.
Accordingly, a trailer-detection system 10, and a controller 48 for the trailer-detection system 10 is provided. The system 10 is an improvement over prior trailer-detection systems because the system 10 is configured to more accurately determine when a trailer 14 towed by the host-vehicle 12 is departing a travel-lane 16 of a roadway 18 using sensors that exist on most vehicles, thereby eliminating additional components and reducing cost. This improvement also enables the system 10 to more accurately determine a trailer-length 38, a trailer-width 40, and a trailer-sway-rate 42 of the trailer 14.
While this invention has been described in terms of the preferred embodiments thereof, it is not intended to be so limited, but rather only to the extent set forth in the claims that follow.
