TRAILER LENGTH AND HITCH ANGLE BIAS ESTIMATION

• US 20170240204A1
• Filed: 02/18/2016
• Published: 08/24/2017
• Est. Priority Date: 02/18/2016
• Status: Active Grant

• Current Assignee: Ford Global Technologies, LLC (Ford Motor Company)
• Original Assignee: Ford Global Technologies, LLC (Ford Motor Company)
• Inventors: Raad, Joseph M., Kyrtsos, Christos, Daavettila, Tyler, Mattern, Donald Jacob, Lavoie, Erick Michael
• Granted Patent: US 10,005,492 B2
• Time in Patent Office: Days
• CPC Class Codes: B62D 13/06 for backing a normally drawn trailer
• CPC Class Codes: B62D 15/021 Determination of steering angle
• CPC Class Codes: B62D 15/025 Active steering aids, e.g. helping the driver by actively influencing the steering system after environment evaluation B62D1/28 takes precedence
• CPC Class Codes: B62D 15/0285 Parking performed automatically
• CPC Class Codes: G01B 21/22 for measuring angles or tapers; for testing the alignment of axes

Abstract

A backup assist system for a vehicle and trailer combination includes a steering system and a first sensor detecting a first dynamic condition of the combination. The system further includes a controller receiving a value for the first dynamic condition from the first sensor at a plurality of instances. The controller further solves for a corresponding plurality of parameters in a kinematic model of the combination and controls the steering system using the plurality of parameters in the kinematic model.

Claims

1. A backup assist system for a vehicle and trailer combination, comprising:

a steering system;

a first sensor detecting a first dynamic condition of the combination; and

a controller;

receiving a value for the first dynamic condition from the first sensor at a plurality of instances;

solving for a corresponding plurality of parameters in a kinematic model of the combination; and

controlling the steering system using the plurality of parameters in the kinematic model.

2. The backup assist system of claim 1, wherein:

the first sensor is a hitch angle sensor;

the first dynamic condition is a hitch angle between the vehicle and the trailer;

the system further includes a second sensor comprising a steering angle sensor determining a steering angle of the steering system; and

the controller further receives a plurality of values for the steering angle for each of the plurality of instances.

3. The backup assist system of claim 2, wherein:

the plurality of instances includes two instances; and

the plurality of parameters solved for include a trailer length and a hitch angle bias.

4. The backup assist system of claim 3, wherein the two instances indicate a steady state condition of the combination.

5. The backup assist system of claim 3, wherein the two instances each include a hitch angle of less than 10°

.

6. The backup assist system of claim 2, wherein:

the plurality of instances includes three instances; and

the plurality of parameters solved for include a trailer length, a drawbar length, and a hitch angle bias.

7. The backup assist system of claim 2, wherein:

the controller uses the values received for the hitch angle and the steering angle to fit a linear curve to the hitch angle values against the steering angle values, the linear curve correlating with a rate of change of the steering angle over a rate of change of the hitch angle; and

the controller solves for a trailer length using the a rate of change of the steering angle over a rate of change of the hitch angle in the kinematic model.

8. The backup assist system of claim 1, wherein:

the first sensor is a yaw rate sensor of the trailer;

the first dynamic condition is a yaw rate of the trailer;

the system further includes a second sensor comprising a vehicle yaw rate sensor determining a yaw rate of the vehicle; and

the controller further receives a plurality of values for the vehicle yaw rate for each of the plurality of instances.

9. The backup assist system of claim 8, wherein:

the plurality of instances includes two instances; and

the plurality of parameters solved for include a trailer length and a hitch angle bias.

10. The backup assist system of claim 1, wherein controlling the steering system using the plurality of parameters in the kinematic model includes determining a steering angle according to a curvature command.

11. A vehicle, comprising:

a steering system;

a first sensor detecting a first dynamic condition of at least one of the vehicle and the vehicle in a combination with a trailer; and

a trailer backup assist system, comprising a controller;

receiving a value for the first dynamic condition from the first sensor in at least one instance;

solving for at least one parameter corresponding in number to the at least one instance in a kinematic model of the combination; and

controlling the steering system using the at least one parameter in the kinematic model.

12. The vehicle of claim 11, further including a second sensor comprising a steering angle sensor determining a steering angle of the steering system, wherein:

the first sensor is a hitch angle sensor;

the first dynamic condition is a hitch angle between the vehicle and the trailer; and

the controller of the trailer backup assist system further receives at least one value for the steering angle for each of the at least one instance.

13. The vehicle of claim 12, wherein:

the at least one instance includes two instances; and

the at least one parameter solved for includes a trailer length and a hitch angle bias.

14. The vehicle of claim 12, wherein:

the controller uses the values received for the hitch angle and the steering angle to fit a linear curve to the hitch angle values against the steering angle values, the linear curve correlating with a rate of change of the steering angle over a rate of change of the hitch angle; and

the controller solves for a trailer length using the a rate of change of the steering angle over a rate of change of the hitch angle in the kinematic model.

15. The vehicle of claim 11, wherein:

the first sensor is a yaw rate sensor of the trailer;

the first dynamic condition is a yaw rate of the trailer;

the vehicle further includes a second sensor comprising a vehicle yaw rate sensor determining a yaw rate of the vehicle;

the controller further receives a plurality of values for the vehicle yaw rate for each of the at least one instance; and

the at least one parameter solved for includes a trailer length and a hitch angle.

16. A method for assisting a vehicle in reversing a trailer, comprising:

determining unknown values for a plurality of parameters in a combination of the vehicle and the trailer, including;

receiving a first measurement for a first dynamic condition of the combination at a plurality of instances; and

solving for the parameters in a kinematic model of the combination; and

implementing a reversing operation including controlling a vehicle steering system using the plurality of parameters.

17. The method of claim 16, wherein:

the first dynamic condition is a hitch angle between the vehicle and the trailer; and

determining the unknown values further includes receiving a second measurement for a steering angle of the steering system at the plurality of instances.

18. The method of claim 17, wherein:

the plurality of instances includes two instances; and

the plurality of parameters solved for include a trailer length and a hitch angle bias.

19. The method of claim 17, wherein solving for the parameters in the kinematic model of the combination includes:

using the values received for the hitch angle and the steering angle to fit a linear curve to the hitch angle values against the steering angle values, the linear curve correlating with a rate of change of the steering angle over a rate of change of the hitch angle; and

solving for a trailer length using the a rate of change of the steering angle over a rate of change of the hitch angle in the kinematic model.

20. The method of claim 16, wherein:

the first dynamic condition is a yaw rate of the trailer;

determining the unknown values further includes receiving a second measurement for a yaw rate of the vehicle for each of the plurality of instances; and

the plurality of parameters solved for include a trailer length and a hitch angle.