Vehicular trailering assist system with trailer beam length estimation

Information

  • Patent Grant
  • 11989902
  • Patent Number
    11,989,902
  • Date Filed
    Friday, December 10, 2021
    3 years ago
  • Date Issued
    Tuesday, May 21, 2024
    7 months ago
Abstract
A vehicular trailer beam estimation system includes a camera disposed at a rear portion of a vehicle equipped with a trailer hitch. With a trailer hitched at the trailer hitch of the vehicle, the camera views at least a portion of the trailer hitched to the vehicle. The system, responsive at least in part to processing by an image processor of image data captured by the camera, determines a trailer angle of the trailer relative to the vehicle. During a driving maneuver, the system tracks trailering parameters, which include (i) the trailer angle, (ii) steering angle of the vehicle and (iii) speed of the vehicle. The system determines beam length of the trailer based at least in part on (i) the trailering parameters, (ii) the vehicle's wheelbase and (iii) hitch length of the trailer hitch of the vehicle.
Description
FIELD OF THE INVENTION

The present invention relates generally to a vehicle and trailer guidance system for guiding a vehicle and trailer during a driving maneuver.


BACKGROUND OF THE INVENTION

Use of imaging sensors to help a driver when backing up a trailer is common and known. Examples of such known systems are described in U.S. Pat. Nos. 9,446,713 and 9,085,261, which are hereby incorporated herein by reference in their entireties.


SUMMARY OF THE INVENTION

Implementations herein provide vehicular trailer beam estimation system that includes a camera disposed at a rear portion of a vehicle equipped with the vehicular trailer beam estimation system. The camera includes a CMOS imaging array. The CMOS imaging array includes at least one million photosensors arranged in rows and columns. The camera views at least rearward of the vehicle and captures image data. The vehicle is equipped with a trailer hitch and, with a trailer hitched at the trailer hitch of the vehicle, the camera views at least a portion of the trailer hitched at the trailer hitch of the vehicle. The system includes an electronic control unit (ECU) that includes electronic circuitry and associated software. The electronic circuitry includes an image processor operable to process image data captured by the camera. The vehicular trailer beam estimation system, responsive at least in part to processing by the image processor of image data captured by the camera, determines a trailer angle that includes an angle between a longitudinal axis of the trailer and a longitudinal axis of the vehicle. During a driving maneuver of the vehicle, the vehicular trailer beam estimation system tracks trailering parameters including at least (i) the determined trailer angle, (ii) steering angle of the vehicle and (iii) speed of the vehicle. The vehicular trailer beam estimation system determines beam length of the trailer based at least in part on (i) the trailering parameters tracked during the driving maneuver, (ii) the vehicle's wheelbase and (iii) hitch length of the trailer hitch of the vehicle. The hitch length includes distance along the longitudinal axis of the vehicle from a rear axle of the vehicle to a hitch ball of the trailer hitch of the vehicle.


These and other objects, advantages, purposes and features of the present invention will become apparent upon review of the following specification in conjunction with the drawings.





BRIEF DESCRIPTION OF THE DRAWINGS


FIG. 1 is a plan view of a vehicle and a trailer, the vehicle equipped with a trailer guidance system that is operable to maneuver the vehicle and steer the trailer along a trailer direction;



FIG. 2 is a schematic view of a trailer and the trailer beam length;



FIG. 3 is a schematic view of a vehicle and trailer with kinematic variables;



FIG. 4 is a block diagram for an online trailer beam length estimation system; and



FIG. 5 is a schematic view of a calibration maneuver for the online trailer beam length estimation system.





DESCRIPTION OF THE PREFERRED EMBODIMENTS

Referring now to the drawings and the illustrative embodiments depicted therein, a vehicle 10 includes a trailering assist system or trailer maneuvering or guidance system 12 that is operable to guide the vehicle during backing up or reversing of the vehicle with a hitched trailer 16. The trailer 16 is hitched at the vehicle via, for example, a hitch 14 (such as via a trailer coupler at the end of the trailer tongue hitching to the hitch ball of the hitch of the vehicle to establish a pivoting joint connection of the trailer to the vehicle). The trailer guidance system 12 may guide and maneuver the vehicle 10 and trailer 16 toward a desired or selected location.


In the illustrated embodiment, the trailer guidance system 12 includes at least one exterior viewing vehicle-based imaging sensor or camera, such as a rearward viewing imaging sensor or camera or rear backup camera 18 (and the system may optionally include multiple exterior viewing imaging sensors or cameras, such as a sideward/rearward viewing camera at respective sides of the vehicle and/or trailer), which captures image data representative of the scene exterior and rearward of the vehicle 10 (FIG. 1). The field of view of the rear backup camera 18 includes the hitch 14 and/or trailer 16. The rear backup camera 18 includes a lens for focusing images at or onto an imaging array or imaging plane or imager of the camera. The trailer maneuver guidance system 12 includes a control or electronic control unit (ECU) or processor 19 that includes electronic circuitry, such as an image and/or data processor, and associated software. The ECU 19 is operable to process image data captured by the camera or cameras and the system 12 may, based on processing of the captured image data at the processor of the ECU 19, detect objects or the like and/or provide displayed images at a display device 24 for viewing by the driver of the vehicle 10. The control 19 and/or display device 24 may be part of or incorporated in or at an interior rearview mirror assembly of the vehicle 10, or the control 19 and/or the display device 24 may be disposed elsewhere at or in the vehicle 10. The trailer guidance system 12 may determine a current angle between a centerline axis 20 of the vehicle and a centerline axis 22 of the trailer 16 such as by processing the image data captured by the rearward viewing camera 18 and/or a bed camera and/or one or more side cameras (i.e., the trailer angle). The data transfer or signal communication from the camera to the ECU 19 may comprise any suitable data or communication link, such as a vehicle network bus or the like of the equipped vehicle.


Referring now to FIG. 2, the system 12 includes aspects for estimating a beam length 26 of the trailer 16 (i.e., a trailer beam length or length/distance between the hitch or coupler 14 and the axle or the center between two or three axles of the trailer) during a driving maneuver or a towing maneuver of the vehicle. In other words, a towing vehicle (i.e., a vehicle with a trailer hitched to the towing vehicle) may be equipped with the trailer guidance system 12 and the system 12 may determine the beam length 26 of the trailer 16 hitched to the vehicle 10 while the vehicle 10 performs a forward (or rearward) driving maneuver while towing the trailer 16. The trailer beam length 26 may be measured as the length longitudinally along the trailer 16 from the coupler 14 to a rear axle 28 of the trailer 16. The system may use the estimated trailer beam length 26 for various trailering advanced driver-assistance systems (ADAS).


For example, the trailer beam length 26 is involved in many computations related to ADAS trailering features such as auto-straight-reverse and auto-park features. However, because a vehicle may be used to tow different trailers at different times and each of the different trailers may have different characteristics such as different trailer beam lengths, a trailer beam length for a particular trailer cannot always be predetermined. Asking the operator to measure and input the trailer beam length is not convenient or even always possible, as the driver may be unaware of the beam length of the trailer. Thus, the trailer maneuvering guidance system 12 estimates trailer beam length 26 for the trailer 16 being towed by the vehicle 10 using kinematic vehicle data and by employing the proper vehicle-trailer kinematic equations. Optionally, the system 12 may, whenever a new trailer is detected, perform a calibration process. For example, the system 12 may prompt the vehicle driver to begin the calibration process or, responsive to detecting the new or differently oriented trailer, begin the calibration process. The calibration process includes gathering sufficient kinematic data (e.g., while the vehicle and trailer are driven along a road) in order to perform the required computations to estimate the trailer beam length.


Referring now to FIG. 3, vehicle and trailer kinematic equations used to determine or estimate the trailer beam length 26 may be established with parameters or calibration parameters or signal values, such as γ representing the relative angle between the vehicle centerline 20 and the trailer centerline 22. As shown in FIG. 3, α represents an angle between the vehicle centerline 20 and a common axis 30 and β represents an angle between the trailer centerline 22 and the common axis 30 and γ represents the angle between the vehicle centerline 20 and the trailer centerline 22 (i.e., γ=α−β). The vehicle wheelbase (i.e., the length between the front and rear axles of the vehicle) is represented as 1, the hitch length (i.e., the length from the rear axle of the vehicle to the hitch 14 or hitch ball) is represented as a, and the trailer beam length is b. The vehicle speed is represented by u. With these parameters, the trailer relative angle rate of change γ(t) may be determined with the following Equation (1):











γ
.



(
t
)


=


u


(
t
)




(



1
L


tan


ϕ


(
t
)



+


1
b



a
L


tan


ϕ


(
t
)



cos


γ


(
t
)



-


1
b


sin


γ


(
t
)




)






(
1
)







Referring now to FIG. 4, an online trailer beam length estimation (OTBLE) system is illustrated in block diagram 400. The OBTLE system captures and/or receives the required signal values and determines or estimates the trailer beam length for use by one or more driving assist systems of the vehicle. The OBTLE system may comprise a processor and/or software at the ECU 19 of the vehicle 10, or the system may be remote from the vehicle and in communication with the ECU 19 of the vehicle, such as via wireless communication networks. The OBTLE system receives the required signal values during vehicle operation, such as while the vehicle is performing a driving maneuver with the trailer attached at the trailer hitch. For example, the OBTLE may receive signal values during normal operation of the vehicle or the driving maneuver may comprise a calibration maneuver. Through the driving or calibration maneuver, the OTBLE system receives the required signals values in real-time and the OTBLE system performs the computations to estimate the beam length. The OBTLE system may perform the computations to determine or estimate the beam length during the driving maneuver or may perform the computations at the end of the maneuver. The system may evaluate the estimate and reiterate the estimation process through the use of recorded data to achieve the required accuracy of estimation. In other words, the OBTLE system may record the signal values during the driving or calibration maneuver and perform a plurality of iterations of the computations to improve the accuracy of the determination of beam length. The system may determine the relative angle between the vehicle centerline 20 and the trailer centerline 22 in any suitable fashion, such as by utilizing aspects of the trailer angle detection system described in U.S. patent application Ser. No. 17/443,258, filed Jul. 23, 2021, now U.S. Pat. No. 11,861,878, which is hereby incorporated herein by reference in its entirety.


Referring now to FIG. 5, the OTBLE system performs a calibration maneuver 500 to gather sufficient kinematic information to accurately estimate the trailer beam length. In other words, the system may prompt the driver of the vehicle to perform the calibration maneuver and/or the system may autonomously or semi-autonomously guide the vehicle in performing the calibration maneuver. The OTBLE system, during the calibration maneuver (such as a forward driving maneuver that includes a turn, such as approximately a 90 degree turn, as shown in FIG. 5), collects information related to the relative angle between the vehicle and the trailer (i.e., γ=α−β) and the steering angle or front wheel angle of the towing vehicle. The OTBLE system may also track the vehicle speed as the vehicle (towing the trailer) performs the calibration maneuver. The OTBLE system obtains the towing vehicle's wheelbase (i.e., l) from, for example, vehicle configuration data stored in memory at the vehicle. The OTBLE system may also obtain a hitch length (i.e., a) from, for example, a trailer angle detection (TAD) system. The OBTLE system may obtain the values for the wheelbase of the vehicle and the hitch length before, after, or during the calibration maneuver.


An exemplary calibration maneuver (e.g., as illustrated in FIG. 5) begins with the vehicle (towing the trailer) driving forward in a straight line. The vehicle then begins a turn to the left or the right. The OTBLE system may begin collecting data when γ (i.e., the trailer angle relative to the vehicle) is greater than, for example, ten degrees. The towing vehicle may complete the turn (e.g., a 90 degree turn) by again driving in a straight line. The OTBLE system completes data collection for the calibration maneuver when the trailer is re-aligned with the towing vehicle (e.g., |γ|<1 degree or less than 2 degrees or less than 5 degrees). While the vehicle completes the calibration maneuver, the OTBLE system begins computation after the TAD system completes hitch ball detection. The TAD system may utilize aspects of the trailer angle detection system described in U.S. patent application Ser. No. 17/443,257, filed Jul. 23, 2021, now U.S. Pat. No. 11,702,017 which is hereby incorporated herein by reference in its entirety.


To determine or estimate the trailer beam length, the OTBLE completes a series of computations. By rearranging the kinematic equation (i.e., Equation (1)) to move the unknown parameter (b) to the right provides Equation (2):










(


u


a
L


tan

ϕ

cos

γ

-

u

sin

γ


)

=

b


(


γ
.

-


u
L


tan

ϕ


)






(
2
)







Integrating both sides of Equation (2) provides Equation (3):










(




u


a
L


tan





ϕcosγ


-



u





sin





γ



)

=

b


(

γ
-

γ
0

-




u
L


tan

ϕ



)






(
3
)







Equation (3) may be provided in the alternate and more compact form of Equation (4):

z(t)=bΦ(t)  (4)


Equation (4) may be expanded by Equations (5) and (6):










z


(
t
)


=

u


(





a
L


tan

ϕ

cos

γ


-



sin





γ



)






(
5
)







Φ


(
t
)


=

(

γ
-

γ
0

-




u
L


tan

ϕ



)





(
6
)







Equation (4) defines the parametric model of the system. Thus, z(t) is the parametric model and is computed based on the vehicle speed, steering angle, and trailer angle relative to the vehicle. An estimation model may be the same as the parametric model, but instead of computing z based on the vehicle speed, steering angle, and trailer angle relative to the vehicle, z is computed based on the estimated value of beam length (b) and Φ as shown in Equation (7):

{circumflex over (z)}={circumflex over (b)}(t)Φ  (7)


The difference between the output of the parametric model z and the output of the estimation model {circumflex over (z)} is the estimation error, shown in Equation (8):

∈==z(t)−{circumflex over (z)}(t)  (8)


The OTBLE system uses the adaptive law to update the beam length estimate based on the estimation error, shown in Equation (9):

{dot over (b)}(t)=Γ∈(t)  (9)


In Equation (9), Γ is the adaptive gain. By iterating through the above computation in each sample time, the trailer beam length is updated continuously until the estimation error converges at zero. At that time, the estimated trailer beam length converges at its actual ground-truth value.


Thus, the system includes aspects for an online estimation of a trailer beam length. The system, when a new trailer is hitched to the towing vehicle, performs a calibration maneuver. During the calibration maneuver, the system collects kinematic data regarding the vehicle and the trailer, such as based on captured image data processed by a processor of the system. Based on the collected kinematic data, the system estimates the beam length of the trailer.


The system may utilize aspects of the trailering systems or trailer angle detection systems or trailer hitch systems described in U.S. Pat. Nos. 10,755,110; 10,638,025; 10,160,382; 10,086,870; 9,558,409; 9,446,713; 9,085,261 and/or 6,690,268, and/or U.S. Publication Nos. US-2021-0170947; US-2021-0170820; US-2021-0078634; US-2020-0406967; US-2020-0361397; US-2020-0356788; US-2020-0334475; US-2020-0017143; US-2019-0347825; US-2019-0118860; US-2019-0064831; US-2019-0042864; US-2019-0039649; US-2019-0143895; US-2019-0016264; US-2018-0276839; US-2018-0276838; US-2018-0253608; US-2018-0215382; US-2017-0254873 and/or US-2017-0217372, and/or U.S. patent application Ser. No. 17/443,258, filed Jul. 23, 2021, now U.S. Pat. No. 11,861,878, Ser. No. 17/443,257, filed Jul. 23, 2021, now U.S. Pat. No. 11,702,017, and/or Ser. No. 17/443,256, filed Jul. 23, 2021, now U.S. Pat. No. 11,875,575, and/or International Publication No. WO 2021/0127693, which are all hereby incorporated herein by reference in their entireties.


The system includes an image processor operable to process image data captured by the camera or cameras, such as for detecting objects or other vehicles or pedestrians or the like in the field of view of one or more of the cameras. For example, the image processor may comprise an image processing chip selected from the EYEQ family of image processing chips available from Mobileye Vision Technologies Ltd. of Jerusalem, Israel, and may include object detection software (such as the types described in U.S. Pat. Nos. 7,855,755; 7,720,580 and/or 7,038,577, which are hereby incorporated herein by reference in their entireties), and may analyze image data to detect vehicles and/or other objects. Responsive to such image processing, and when an object or other vehicle is detected, the system may generate an alert to the driver of the vehicle and/or may generate an overlay at the displayed image to highlight or enhance display of the detected object or vehicle, in order to enhance the driver's awareness of the detected object or vehicle or hazardous condition during a driving maneuver of the equipped vehicle.


The vehicle may include any type of sensor or sensors, such as imaging sensors or radar sensors or lidar sensors or ultrasonic sensors or the like. The imaging sensor or camera may capture image data for image processing and may comprise any suitable camera or sensing device, such as, for example, a two dimensional array of a plurality of photosensor elements arranged in at least 640 columns and 480 rows (at least a 640×480 imaging array, such as a megapixel imaging array or the like), with a respective lens focusing images onto respective portions of the array. The photosensor array may comprise a plurality of photosensor elements arranged in a photosensor array having rows and columns. The imaging array may comprise a CMOS imaging array having at least 300,000 photosensor elements or pixels, preferably at least 500,000 photosensor elements or pixels and more preferably at least 1 million photosensor elements or pixels. The imaging array may capture color image data, such as via spectral filtering at the array, such as via an RGB (red, green and blue) filter or via a red/red complement filter or such as via an RCC (red, clear, clear) filter or the like. The logic and control circuit of the imaging sensor may function in any known manner, and the image processing and algorithmic processing may comprise any suitable means for processing the images and/or image data.


Optionally, the vision system may include a display for displaying images captured by one or more of the imaging sensors for viewing by the driver of the vehicle while the driver is normally operating the vehicle. Optionally, for example, the vision system may include a video display device, such as by utilizing aspects of the video display systems described in U.S. Pat. Nos. 5,530,240; 6,329,925; 7,855,755; 7,626,749; 7,581,859; 7,446,650; 7,338,177; 7,274,501; 7,255,451; 7,195,381; 7,184,190; 5,668,663; 5,724,187; 6,690,268; 7,370,983; 7,329,013; 7,308,341; 7,289,037; 7,249,860; 7,004,593; 4,546,551; 5,699,044; 4,953,305; 5,576,687; 5,632,092; 5,708,410; 5,737,226; 5,802,727; 5,878,370; 6,087,953; 6,173,501; 6,222,460; 6,513,252 and/or 6,642,851, and/or U.S. Publication Nos. US-2014-0022390; US-2012-0162427; US-2006-0050018 and/or US-2006-0061008, which are all hereby incorporated herein by reference in their entireties.


Changes and modifications in the specifically described embodiments can be carried out without departing from the principles of the invention, which is intended to be limited only by the scope of the appended claims, as interpreted according to the principles of patent law including the doctrine of equivalents.

Claims
  • 1. A vehicular trailer beam estimation system, the vehicular trailer beam estimation system comprising: a camera disposed at a rear portion of a vehicle equipped with the vehicular trailer beam estimation system;wherein the camera comprises a CMOS imaging array, and wherein the CMOS imaging array comprises at least one million photosensors arranged in rows and columns;wherein the camera views at least rearward of the vehicle, the camera capturing image data;wherein the vehicle is equipped with a trailer hitch and, with a trailer hitched at the trailer hitch of the vehicle, the camera views at least a portion of the trailer hitched at the trailer hitch of the vehicle;an electronic control unit (ECU) comprising electronic circuitry and associated software, the electronic circuitry comprising an image processor operable to process image data captured by the camera;wherein the vehicular trailer beam estimation system, responsive at least in part to processing by the image processor of image data captured by the camera, determines a trailer angle, the trailer angle comprising an angle between a longitudinal axis of the trailer and a longitudinal axis of the vehicle;wherein, during a driving maneuver of the vehicle, the vehicular trailer beam estimation system tracks trailering parameters comprising at least (i) the determined trailer angle, (ii) steering angle of the vehicle and (iii) speed of the vehicle; andwherein the vehicular trailer beam estimation system determines beam length of the trailer based at least in part on (i) the trailering parameters tracked during the driving maneuver, (ii) the vehicle's wheelbase and (iii) hitch length of the trailer hitch of the vehicle, the hitch length comprising distance along the longitudinal axis of the vehicle from a rear axle of the vehicle to a hitch ball of the trailer hitch of the vehicle.
  • 2. The vehicular trailer beam estimation system of claim 1, wherein the driving maneuver comprises (i) a first portion where the vehicle drives in a first straight line, (ii) a second portion following the first portion where the vehicle performs a turn and (iii) a third portion following the second portion where the vehicle drives in a second straight line.
  • 3. The vehicular trailer beam estimation system of claim 2, wherein, during the second portion of the driving maneuver, the vehicle performs a 90 degree turn.
  • 4. The vehicular trailer beam estimation system of claim 1, wherein the vehicular trailer beam estimation system determines the beam length of the trailer based on one or more vehicle-trailer kinematic equations.
  • 5. The vehicular trailer beam estimation system of claim 4, wherein the vehicular trailer beam estimation system determines the beam length of the trailer by iterating the one or more vehicle-trailer kinematic equations until an error estimate converges to zero.
  • 6. The vehicular trailer beam estimation system of claim 1, wherein the vehicular trailer beam estimation system determines the beam length of the trailer based on an estimation error and an adaptive gain.
  • 7. The vehicular trailer beam estimation system of claim 1, wherein, during the driving maneuver, the vehicular trailer beam estimation system begins tracking the trailering parameters responsive to determination that the determined trailer angle is greater than a threshold angle.
  • 8. The vehicular trailer beam estimation system of claim 7, wherein the threshold angle is at least 10 degrees.
  • 9. The vehicular trailer beam estimation system of claim 7, wherein, during the driving maneuver, the vehicular trailer beam estimation system stops tracking the trailering parameters responsive to determination that the determined trailer angle is below a second threshold angle.
  • 10. The vehicular trailer beam estimation system of claim 9, wherein the second threshold angle is less than 2 degrees.
  • 11. The vehicular trailer beam estimation system of claim 1, wherein the vehicular trailer beam estimation system, during the driving maneuver, records the trailering parameters to refine the determined beam length of the trailer after the driving maneuver is complete.
  • 12. The vehicular trailer beam estimation system of claim 1, wherein the driving maneuver comprises a calibration maneuver, and wherein the vehicular trailer beam estimation system prompts a driver of the vehicle to perform the calibration maneuver.
  • 13. The vehicular trailer beam estimation system of claim 1, wherein the vehicular trailer beam estimation system determines the beam length of the trailer after the driving maneuver is complete.
  • 14. The vehicular trailer beam estimation system of claim 1, wherein the vehicular trailer beam estimation system provides the determined beam length of the trailer to a trailering assist system of the vehicle.
  • 15. The vehicular trailer beam estimation system of claim 1, wherein the camera comprises a rear backup camera of the vehicle.
  • 16. A vehicular trailer beam estimation system, the vehicular trailer beam estimation system comprising: a camera disposed at a rear portion of a vehicle equipped with the vehicular trailer beam estimation system;wherein the camera comprises a CMOS imaging array, and wherein the CMOS imaging array comprises at least one million photosensors arranged in rows and columns;wherein the camera views at least rearward of the vehicle, the camera capturing image data;wherein the vehicle is equipped with a trailer hitch and, with a trailer hitched at the trailer hitch of the vehicle, the camera views at least a portion of the trailer hitched at the trailer hitch of the vehicle;an electronic control unit (ECU) comprising electronic circuitry and associated software, the electronic circuitry comprising an image processor operable to process image data captured by the camera;wherein the vehicular trailer beam estimation system, responsive at least in part to processing by the image processor of image data captured by the camera, determines a trailer angle, the trailer angle comprising an angle between a longitudinal axis of the trailer and a longitudinal axis of the vehicle;wherein, during a forward driving maneuver of the vehicle that includes a turning maneuver of the vehicle, and responsive to determining that the determined trailer angle is greater than a threshold angle, the vehicular trailer beam estimation system tracks trailering parameters comprising at least (i) the determined trailer angle, (ii) steering angle of the vehicle and (iii) speed of the vehicle; andwherein the vehicular trailer beam estimation system determines beam length of the trailer based at least in part on (i) the trailering parameters tracked during the forward driving maneuver, (ii) the vehicle's wheelbase and (iii) hitch length of the trailer hitch of the vehicle, the hitch length comprising distance along the longitudinal axis of the vehicle from a rear axle of the vehicle to a hitch ball of the trailer hitch of the vehicle.
  • 17. The vehicular trailer beam estimation system of claim 16, wherein the turn comprises a 90 degree turn.
  • 18. The vehicular trailer beam estimation system of claim 17, wherein the vehicular trailer beam estimation system determines the beam length of the trailer based on one or more vehicle-trailer kinematic equations.
  • 19. The vehicular trailer beam estimation system of claim 16, wherein the vehicular trailer beam estimation system determines the beam length of the trailer by iterating the one or more vehicle-trailer kinematic equations until an error estimate converges to zero.
  • 20. A vehicular trailer beam estimation system, the vehicular trailer beam estimation system comprising: a rear backup camera disposed at a rear portion of a vehicle equipped with the vehicular trailer beam estimation system;wherein the rear backup camera comprises a CMOS imaging array, and wherein the CMOS imaging array comprises at least one million photosensors arranged in rows and columns;wherein the rear backup camera views at least rearward of the vehicle, the rear backup camera capturing image data;wherein the vehicle is equipped with a trailer hitch and, with a trailer hitched at the trailer hitch of the vehicle, the rear backup camera views at least a portion of the trailer hitched at the trailer hitch of the vehicle;an electronic control unit (ECU) comprising electronic circuitry and associated software, the electronic circuitry comprising an image processor operable to process image data captured by the rear backup camera;wherein the vehicular trailer beam estimation system, responsive at least in part to processing by the image processor of image data captured by the rear backup camera, determines a trailer angle, the trailer angle comprising an angle between a longitudinal axis of the trailer and a longitudinal axis of the vehicle;wherein, during a forward driving maneuver of the vehicle, the vehicular trailer beam estimation system tracks trailering parameters comprising at least (i) the determined trailer angle, (ii) steering angle of the vehicle and (iii) speed of the vehicle; andwherein the vehicular trailer beam estimation system determines beam length of the trailer based at least in part on (i) the trailering parameters tracked during the forward driving maneuver, (ii) the vehicle's wheelbase, (iii) hitch length of the trailer hitch of the vehicle and (iv) one or more vehicle-trailer kinematic equations, the hitch length comprising distance along the longitudinal axis of the vehicle from a rear axle of the vehicle to a hitch ball of the trailer hitch of the vehicle.
  • 21. The vehicular trailer beam estimation system of claim 20, wherein the forward driving maneuver comprises (i) a first portion where the vehicle drives in a first straight line, (ii) a second portion following the first portion where the vehicle performs a turn and (iii) a third portion following the second portion where the vehicle drives in a second straight line.
  • 22. The vehicular trailer beam estimation system of claim 20, wherein the vehicular trailer beam estimation system determines the beam length of the trailer by iterating the one or more vehicle-trailer kinematic equations until an error estimate converges to zero.
CROSS REFERENCE TO RELATED APPLICATION

The present application claims the filing benefits of U.S. provisional application Ser. No. 63/199,155, filed Dec. 10, 2020, which is hereby incorporated herein by reference in its entirety.

US Referenced Citations (94)
Number Name Date Kind
4546551 Franks Oct 1985 A
4953305 Van Lente et al. Sep 1990 A
5530240 Larson et al. Jun 1996 A
5576687 Blank et al. Nov 1996 A
5632092 Blank et al. May 1997 A
5668663 Varaprasad et al. Sep 1997 A
5699044 Van Lente et al. Dec 1997 A
5708410 Blank et al. Jan 1998 A
5724187 Varaprasad et al. Mar 1998 A
5737226 Olson et al. Apr 1998 A
5802727 Blank et al. Sep 1998 A
5878370 Olson Mar 1999 A
6087953 DeLine et al. Jul 2000 A
6173501 Blank et al. Jan 2001 B1
6222460 DeLine et al. Apr 2001 B1
6329925 Skiver et al. Dec 2001 B1
6513252 Schierbeek et al. Feb 2003 B1
6642851 Deline et al. Nov 2003 B2
6690268 Schofield et al. Feb 2004 B2
7004593 Weller et al. Feb 2006 B2
7038577 Pawlicki et al. May 2006 B2
7184190 McCabe et al. Feb 2007 B2
7195381 Lynam et al. Mar 2007 B2
7249860 Kulas et al. Jul 2007 B2
7255451 McCabe et al. Aug 2007 B2
7274501 McCabe et al. Sep 2007 B2
7289037 Uken et al. Oct 2007 B2
7308341 Schofield et al. Dec 2007 B2
7329013 Blank et al. Feb 2008 B2
7338177 Lynam Mar 2008 B2
7370983 DeWind et al. May 2008 B2
7446650 Scholfield et al. Nov 2008 B2
7581859 Lynam Sep 2009 B2
7626749 Baur et al. Dec 2009 B2
7720580 Higgins-Luthman May 2010 B2
7855755 Weller et al. Dec 2010 B2
9085261 Lu et al. Jul 2015 B2
9446713 Lu et al. Sep 2016 B2
9558409 Pliefke et al. Jan 2017 B2
9937953 Lavoie et al. Apr 2018 B2
10071687 Ihlenburg et al. Sep 2018 B2
10086870 Gieseke et al. Oct 2018 B2
10099614 Diessner Oct 2018 B2
10160382 Pliefke et al. Dec 2018 B2
10532698 Potnis et al. Jan 2020 B2
10552976 Diessner et al. Feb 2020 B2
10586119 Pliefke et al. Mar 2020 B2
10638025 Gali et al. Apr 2020 B2
10706291 Diessner et al. Jul 2020 B2
10733757 Gupta et al. Aug 2020 B2
10755110 Bajpai Aug 2020 B2
10780752 Niewiadomski et al. Sep 2020 B1
20060050018 Hutzel et al. Mar 2006 A1
20060061008 Karner et al. Mar 2006 A1
20080231701 Greenwood Sep 2008 A1
20120162427 Lynam Jun 2012 A1
20140022390 Blank et al. Jan 2014 A1
20140085472 Lu et al. Mar 2014 A1
20140160276 Pliefke et al. Jun 2014 A1
20150002670 Bajpai Jan 2015 A1
20150217693 Pliefke et al. Aug 2015 A1
20170050672 Gieseke et al. Feb 2017 A1
20170174128 Hu et al. Jun 2017 A1
20170217372 Lu et al. Aug 2017 A1
20170254873 Koravadi Sep 2017 A1
20170341583 Zhang et al. Nov 2017 A1
20180215382 Gupta et al. Aug 2018 A1
20180253608 Diessner et al. Sep 2018 A1
20180276838 Gupta et al. Sep 2018 A1
20180276839 Diessner et al. Sep 2018 A1
20190016264 Potnis et al. Jan 2019 A1
20190039649 Gieseke et al. Feb 2019 A1
20190042864 Pliefke et al. Feb 2019 A1
20190064831 Gali et al. Feb 2019 A1
20190092388 Raad Mar 2019 A1
20190118860 Gali et al. Apr 2019 A1
20190143895 Pliefke et al. May 2019 A1
20190297233 Gali et al. Sep 2019 A1
20190347825 Gupta et al. Nov 2019 A1
20190359134 Yamamoto et al. Nov 2019 A1
20200017143 Gali Jan 2020 A1
20200282910 Nagasamy Sep 2020 A1
20200334475 Joseph et al. Oct 2020 A1
20200356788 Joseph et al. Nov 2020 A1
20200361397 Joseph et al. Nov 2020 A1
20200406967 Yunus et al. Dec 2020 A1
20210027490 Taiana et al. Jan 2021 A1
20210078634 Jalalmaab et al. Mar 2021 A1
20210127693 Tomita et al. May 2021 A1
20210170820 Zhang Jun 2021 A1
20210170947 Yunus et al. Jun 2021 A1
20220024391 Gali et al. Jan 2022 A1
20220027644 Gali et al. Jan 2022 A1
20220028111 Gali et al. Jan 2022 A1
Related Publications (1)
Number Date Country
20220189052 A1 Jun 2022 US
Provisional Applications (1)
Number Date Country
63199155 Dec 2020 US