COOPERATIVE DRIVING AND COLLISION AVOIDANCE BY DISTRIBUTED RECEDING HORIZON CONTROL
First Claim
1. A controller for a first coordinating vehicle, the controller comprising:
- a communication terminal configured to receive trajectory messages from a plurality of second coordinating vehicles in a communication range, the trajectory messages including vehicle trajectory information for a predetermined update interval; and
a computer processor configured to execute instructions stored on a non-transitory memory, the instructions includingcalculating an assumed trajectory for the first coordinating vehicle by solving an optimal control problem,detecting a conflict based on the received trajectory information and the calculated assumed trajectory, andwhen a conflict is detected, adjusting terminal state constraints in the optimal control problem and calculating, with the adjusted constraints in the optimal control problem, an optimized trajectory for the first coordinating vehicle such that the detected conflict is resolved.
2 Assignments
0 Petitions
Accused Products
Abstract
Distributed control of vehicles with coordinating cars that implement a cooperative control method, and non-coordinating cars that are presumed to follow predictable dynamics. A cooperative control method can combine distributed receding horizon control, for optimization-based path planning and feedback, with higher level logic, to ensure that implemented plans are collision free. The cooperative method can be completely distributed with partially synchronous execution, and can afford dedicated time for communication and computation, features that are prerequisites for implementation on real freeways. The method can test for conflicts and can calculate optimized trajectories by adjusting parameters in terminal state constraints of an optimal control problem.
-
Citations
17 Claims
-
1. A controller for a first coordinating vehicle, the controller comprising:
-
a communication terminal configured to receive trajectory messages from a plurality of second coordinating vehicles in a communication range, the trajectory messages including vehicle trajectory information for a predetermined update interval; and a computer processor configured to execute instructions stored on a non-transitory memory, the instructions including calculating an assumed trajectory for the first coordinating vehicle by solving an optimal control problem, detecting a conflict based on the received trajectory information and the calculated assumed trajectory, and when a conflict is detected, adjusting terminal state constraints in the optimal control problem and calculating, with the adjusted constraints in the optimal control problem, an optimized trajectory for the first coordinating vehicle such that the detected conflict is resolved. - View Dependent Claims (2, 3, 4, 5, 6, 7, 8, 9, 10, 11, 12, 13, 14, 15)
-
-
16. A method for controlling a first coordinating vehicle, the method comprising:
-
receiving trajectory messages from a plurality of second coordinating vehicles in a communication range, the trajectory messages including vehicle trajectory information for a predetermined update interval; calculating an assumed trajectory for the first coordinating vehicle by solving an optimal control problem; detecting a conflict based on the received trajectory information and the calculated assumed trajectory; and when a conflict is detected, adjusting terminal state constraints in the optimal control problem and calculating, with the adjusted constraints in the optimal control problem, an optimized trajectory for the first coordinating vehicle such that the detected conflict is resolved.
-
-
17. A vehicle coordination system comprising a plurality of coordinating vehicles, each vehicle (i=1, 2, 3, . . . , N) having a controller including:
-
a communication terminal configured to receive trajectory messages from each vehicle, of the plurality of coordinating vehicles, in a communication range, the trajectory messages including vehicle trajectory information for a predetermined update interval; and a computer processor configured to execute instructions stored on a non-transitory memory, the instructions including; calculating an assumed trajectory by solving an optimal control problem, for each received trajectory message, detecting a conflict with a corresponding vehicle based on the received trajectory information and the calculated assumed trajectory, and when a conflict is detected, adjusting terminal state constraints in the optimal control problem and calculating, with the adjusted constraints in the optimal control problem, an optimized trajectory for the first coordinating vehicle such that the detected conflict is resolved.
-
Specification