System and method for adjusting trailer reverse assist parameters based upon estimated trailer position
A method and system for operating a vehicle's trailer reverse assist system is disclosed, including receiving vehicle sensor system data from one or more sensors supported by the vehicle. Based upon the received vehicle sensor data, a trailer pitch angle and a trailer roll angle of a coupled trailer are estimated relative to the vehicle. Surface unevenness of a surface traversed by the vehicle and the trailer is estimated, based upon the estimated trailer pitch angle and the estimated trailer roll angle. One or more parameters of the trailer reverse assist system or of the tow vehicle are adjusted based upon the estimated road surface variance. The trailer reverse assist system of the tow vehicle is subsequently operated using the adjusted one or more parameters.
1. A method for operating a trailer reverse assist system of a tow vehicle coupled to a trailer, the trailer reverse assist system including data processing hardware, the method comprising:
receiving, at the data processing hardware, vehicle sensor system data from one or more sensors supported by the vehicle;
estimating, based upon the received vehicle sensor data, a trailer pitch angle and a trailer roll angle, relative to the tow vehicle;
estimating, at the data processing hardware, surface unevenness of a surface traversed by the tow vehicle and the trailer, based upon the estimated trailer pitch angle and the estimated trailer roll angle;
adjusting, at the data processing hardware, one or more parameters of the trailer reverse assist system or of the tow vehicle based upon the estimated surface unevenness;
operating, by the data processing hardware, the trailer reverse assist system of the tow vehicle using the adjusted one or more parameters; and,
determining, at the data processing hardware, trailer pitch angle variance based upon the estimated trailer pitch angle, and determining, at the data processing hardware, trailer roll angle variance based upon the estimated trailer roll angle, wherein estimating the surface unevenness is based upon the trailer pitch angle variance and the trailer roll angle variance.
2. The method of claim 1 , further comprising determining, at the data processing hardware, a derivative of the trailer pitch angle variance and a derivative of the trailer roll angle variance, wherein estimating the surface unevenness is based upon the derivative of the trailer pitch angle variance and the derivative of the trailer roll angle variance.
3. The method of claim 1 , wherein the adjusted one or more parameters comprises a maximum yaw angle between the tow vehicle and the trailer during a reverse maneuver of the tow vehicle and the trailer.
4. The method of claim 1 , wherein the adjusted one or more parameters comprises at least one of a maximum speed or a maximum acceleration of the tow vehicle during a reverse maneuver of the tow vehicle and the trailer.
5. The method of claim 1 , wherein the adjusted one or more parameters comprises a dynamic response of the trailer reverse assist system or of the tow vehicle.
6. The method of claim 5 , wherein the dynamic response of the trailer reverse assist system comprises at least one of a degree of sensitivity of a steering system of the tow vehicle or a degree of an acceleration system of the tow vehicle.
7. The method of claim 1 , wherein estimating the surface unevenness is further based upon at least one of speed of the tow vehicle, acceleration of the tow vehicle or a wheel pulse counter value of the tow vehicle.
8. The method of claim 1 , wherein estimating the trailer pitch angle and estimating the trailer roll angle are performed when the tow vehicle is operating at least one of a reverse maneuver or a forward maneuver.
9. The method of claim 1 , wherein estimating the surface unevenness comprises estimating surface variance of the surface traversed by the tow vehicle and the trailer.
10. A trailer reverse assist system of a tow vehicle coupled to a trailer, the trailer reverse assist system comprising:
data processing hardware; and
non-transitory memory hardware in communication with the data processing hardware, the non-transitory memory hardware storing instructions that when executed on the data processing hardware cause the data processing hardware to perform operations comprising:
receiving vehicle sensor system data from one or more sensors supported by the vehicle;
estimating, based upon the received vehicle sensor data, a trailer pitch angle and a trailer roll angle, relative to the tow vehicle;
estimating surface unevenness of a surface traversed by the trailer based upon the estimated trailer pitch angle and the estimated trailer roll angle;
adjusting one or more parameters of the trailer reverse assist system or of the tow vehicle based upon the estimated surface unevenness;
operating the trailer reverse assist system and the tow vehicle using the adjusted one or more parameters; and
determining trailer pitch angle variance based upon the estimated trailer pitch angle, and determining, at the data processing hardware, trailer roll angle variance based upon the estimated trailer roll angle, wherein estimating the surface unevenness is based upon the trailer pitch angle variance and the trailer roll angle variance.
11. The trailer reverse assist system of claim 10 , the instructions, when executed on the data processing hardware, causes the data processing hardware to further perform operations comprising determining a derivative of the trailer pitch angle variance and a derivative of the trailer roll angle variance, wherein estimating the surface unevenness is based upon the derivative of the trailer pitch angle variance and the derivative of the trailer roll angle variance.
12. The trailer reverse assist system of claim 10 , wherein the adjusted one or more parameters comprises at least one of a maximum speed or a maximum acceleration of the tow vehicle during a reverse maneuver of the tow vehicle and the trailer.
13. The trailer reverse assist system of claim 10 , wherein the adjusted one or more parameters comprises a dynamic response of the trailer reverse assist system or of the tow vehicle.
14. The trailer reverse assist system of claim 13 , wherein the dynamic response of the trailer reverse assist system comprises at least one of a degree of sensitivity of a steering system or a degree of an acceleration system of the tow vehicle.
15. The trailer reverse assist system of claim 10 , wherein estimating the surface unevenness is further based upon at least one of speed of the tow vehicle, acceleration of the tow vehicle or a wheel pulse counter value of the tow vehicle.
16. The trailer reverse assist system of claim 10 , wherein estimating the trailer pitch angle and estimating the trailer roll angle are performed when the tow vehicle is operating at least one of a reverse maneuver or a forward maneuver.
17. The trailer reverse assist system of claim 10 , wherein estimating the surface unevenness comprises estimating surface variance of the surface traversed by the tow vehicle and the trailer.
18. A computer software product for a trailer reverse assist system comprising computer program instructions, stored on non-transitory memory hardware and which, when executed by data processing hardware, causes the data processing hardware to perform operations comprising:
receiving vehicle sensor system data from one or more sensors supported by a tow vehicle;
estimating, based upon the received vehicle sensor data, a trailer pitch angle and a trailer roll angle of a trailer coupled to the tow vehicle, relative to the tow vehicle;
estimating surface unevenness of a surface traversed by the trailer based upon the estimated trailer pitch angle and the estimated trailer roll angle;
adjusting one or more parameters of the trailer reverse assist system or of the tow vehicle based upon the estimated surface unevenness;
operating the trailer reverse assist system and the tow vehicle using the adjusted one or more parameters; and
determining at least one of trailer pitch angle variance based upon the estimated trailer pitch angle, or trailer roll angle variance based upon the estimated trailer roll angle, wherein estimating the surface unevenness is based upon the at least one of trailer pitch angle variance or the trailer roll angle variance.
19. The computer software product of claim 18 , wherein determining the at least one of trailer pitch angle variance or the trailer roll angle variance comprises determining the trailer pitch angle variance and the trailer roll angle variance, and wherein estimating the surface unevenness is based upon the trailer pitch angle variance and the trailer roll angle variance.
20. The computer software product of claim 18 , further comprising determining, at the data processing hardware, a derivative of the at least one of the trailer pitch angle variance or the trailer pitch roll angle variance, wherein estimating the surface unevenness is based upon the derivative of the at least one of the trailer pitch angle variance or the derivative of the trailer roll angle variance.
21. The computer software product of claim 20 , wherein determining the derivative of the at least one of the trailer pitch angle variance or the trailer pitch roll angle variance comprises determining the derivative of the trailer pitch angle variance and the trailer pitch roll angle variance, and wherein estimating the surface unevenness is based upon the derivative of the trailer pitch angle variance and the derivative of the trailer roll angle variance.
22. The computer software product of claim 18 , wherein determining the at least one of trailer pitch angle variance or trailer roll angle variance comprises determining the trailer roll angle variance, and wherein estimating the surface unevenness is based upon the trailer roll angle variance.