The present invention relates generally to a vehicle and trailer guidance system for guiding a vehicle and trailer during a driving maneuver.
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.
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.
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 (
Referring now to
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
Referring now to
Referring now to
An exemplary calibration maneuver (e.g., as illustrated in
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):
Integrating both sides of Equation (2) provides Equation (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):
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.
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.
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 |
Number | Date | Country | |
---|---|---|---|
20220189052 A1 | Jun 2022 | US |
Number | Date | Country | |
---|---|---|---|
63199155 | Dec 2020 | US |