Trajectory planner for a trailer backup assist system
First Claim
Patent Images
1. A method for reversing a trailer with a trailer backup assist system, comprising:
- identifying a waypoint position;
determining a current position of the trailer relative to the waypoint position, wherein the current and waypoint positions each include a coordinate location and an angular orientation of the trailer;
generating with a trajectory planner first and second circular trajectories tangent to one another connecting between the current and waypoint positions such that the angular orientation of the trailer at the current and waypoint positions is substantially tangent to the respective first and second circular trajectories;
guiding with a controller the trailer on the first circular trajectory while continuously regenerating the first and second circular trajectories as the trailer reverses to account for the trailer deviating from the first circular trajectory; and
guiding with the controller the trailer on the second circular trajectory to the waypoint position.
1 Assignment
0 Petitions
Accused Products
Abstract
In one embodiment of the disclosed subject matter, a trailer backup assist system includes a state estimator that determines a current position of a trailer relative to a waypoint position. In addition, the trailer backup assist system includes a trajectory planner that generates first and second circular trajectories tangent to one another spanning between the current and waypoint positions. The trailer backup assist system also includes a controller that reverses the trailer to the waypoint position along the first and second circular trajectories, which are dynamically regenerated as the trailer reverses along the first circular trajectory.
180 Citations
18 Claims
-
1. A method for reversing a trailer with a trailer backup assist system, comprising:
-
identifying a waypoint position; determining a current position of the trailer relative to the waypoint position, wherein the current and waypoint positions each include a coordinate location and an angular orientation of the trailer; generating with a trajectory planner first and second circular trajectories tangent to one another connecting between the current and waypoint positions such that the angular orientation of the trailer at the current and waypoint positions is substantially tangent to the respective first and second circular trajectories; guiding with a controller the trailer on the first circular trajectory while continuously regenerating the first and second circular trajectories as the trailer reverses to account for the trailer deviating from the first circular trajectory; and guiding with the controller the trailer on the second circular trajectory to the waypoint position. - View Dependent Claims (2, 3, 4, 5, 6, 7)
-
-
8. A trailer backup assist system comprising:
-
a state estimator determining a current position of a trailer relative to a waypoint position; a trajectory planner generating first and second circular trajectories tangent to one another spanning between the current and waypoint positions; and a controller reversing the trailer to the waypoint position along the first and second circular trajectories, which are continuously regenerated as the trailer reverses along the first circular trajectory to account for deviations, wherein the current and waypoint positions each include a coordinate location and an angular orientation, such that the first and second circular trajectories are tangent to the angular orientation of the current and waypoint positions. - View Dependent Claims (9, 10, 11, 12, 13, 14, 15)
-
-
16. A trajectory planner for reversing a trailer with a trailer backup assist system, comprising:
-
a first operating mode continuously generating first and second circular trajectories tangent to one another connecting between a current position of the trailer and a waypoint position as the trailer reverses along the first circular trajectory to account for the trailer deviating from the first circular trajectory; and a second operating mode guiding the trailer along the second circular trajectory to the waypoint position as the trailer reverses and reaches the second circular trajectory, wherein the current and waypoint positions each include a coordinate location and an angular orientation, such that the first and second circular trajectories are tangent to the angular orientation of the current and wavpoint positions. - View Dependent Claims (17, 18)
-
Specification