Method and apparatus for determining a trailer hitch articulation angle in a motor vehicle
Methods and apparatus are provided for determining a hitch articulation angle including a camera for capturing a first image and a second image, a steering sensor configured to detect a steering angle, a velocity sensor configured to detect a vehicle velocity, a processor configured to for generating a bird's eye view of the first image and the second image through a perspective transform, generating a trailer hitch model from the first image in response to the steering angle and the vehicle velocity indicating a vehicle is traveling in a straight forward direction, generating a current hitch model from the second image, determining a hitch articulation angle in response to an angular difference between the trailer hitch model and the current hitch model, and a vehicle controller controlling the vehicle in response to the hitch articulation angle.
1. An apparatus comprising:
a camera for capturing a first image and a second image;
a steering sensor configured to detect a steering angle;
a velocity sensor configured to detect a vehicle velocity;
a processor configured to for generating a trailer hitch model from the first image in response to the steering angle and the vehicle velocity indicating a vehicle is traveling in a straight forward direction, generating a current hitch model from the second image in response to the vehicle velocity indicating a reverse vehicle motion, determining a hitch articulation angle in response to an angular difference between the trailer hitch model and the current hitch model; and
a vehicle controller controlling the vehicle in response to the hitch articulation angle.
2. The apparatus of claim 1 further including a trailer interface for generating a trailer connection indicator and wherein the trailer hitch model and the current hitch model are generated in response to the trailer connection indicator being indicative of an attached trailer.
3. The apparatus of claim 1 wherein the camera is a rear-view camera.
4. The apparatus of claim 1 wherein the trailer hitch model is generated in response to an edge detection algorithm and the first image.
5. The apparatus of claim 1 wherein the trailer hitch model includes a trailer centerline.
6. The apparatus of claim 1 wherein the trailer hitch model is generated in response to a Canny edge detection algorithm and the first image.
7. The apparatus of claim 1 further including a memory for storing the trailer hitch model.
8. The apparatus of claim 1 wherein the vehicle controller is configured to perform a reverse trailering operation in response to the hitch articulation angle.
9. A method comprising:
capturing, by a camera, a first image of a trailer hitch assembly in response to a vehicle traveling in a straight and forward direction;
generating, using a processor, a trailer hitch model in response to an image processing technique performed on the first image;
capturing, by the camera, a second image of the trailer hitch assembly in response to the vehicle traveling in a reverse vehicle direction;
generating, by the processor, a current hitch model in response to the image processing technique performed on the second image;
determining, by the processor, a hitch articulation angle in response to a difference between the trailer hitch model and the current hitch model;
controlling, using a vehicle controller, the vehicle in response to the hitch articulation angle.
10. The method of claim 9 wherein the first image is further captured in response to an indication of a trailer connection.
11. The method of claim 9 wherein the first image and the second image are generated by a lidar system.
12. The method of claim 9 wherein controlling the vehicle includes performing an automated driving assistance algorithm during a towing operation.
13. The method of claim 9 wherein the first image and the second image are captured by a rear-view camera.
14. The method of claim 9 wherein the hitch articulation angle is determined in response to a soft edge matching technique.
15. The method of claim 9 wherein the method is performed by a vehicle controller in response to an indication of a towing operation.
16. The method of claim 9 wherein the first image is captured in response to a trailer detection indicator generated by a trailer interface.
17. An advanced driver assistance system comprising;
an inertial measurement unit for detecting a vehicle acceleration;
a camera for capturing a first image of a trailer hitch assembly and a second image of the trailer hitch assembly;
a processor configured to generate a trailer hitch model in response to the first image and the vehicle acceleration being indicative of a forward vehicle motion, a current hitch model in response to the second image and the vehicle acceleration being indicative of a reverse vehicle motion and to determine a hitch articulation angle in response to a comparison of the current hitch model and the trailer hitch model; and
a vehicle controller configured to perform a reversing operation in response to the hitch articulation angle.
18. The advanced driver assistance system of claim 17 including a trailer interface configured to detect a trailer indicator in response to a connection of a trailer and wherein the trailer hitch model and current hitch model are generated in response to the trailer indicator.
19. The advanced driver assistance system of claim 17 wherein the forward vehicle motion and the reverse vehicle motion are determined in response to a transmission gear selection.
20. The advanced driver assistance system of claim 17 wherein the trailer hitch model further includes a perspective transformation to a top down view of the trailer hitch assembly.