Abstract: A global multi-vehicle decision making system is disclosed for providing real-time motion planning and coordination of one or multiple connected and automated and/or semi-automated vehicles (CAVs) in an interconnected traffic network that includes one or multiple non-controlled vehicles (NCVs), one or multiple conflict zones and one or multiple conflict-free road segments. The system includes a receiver configured to acquire infrastructure sensing signals, at least one memory configured to store map and programs, and at least one processor configured to perform steps of formulating a global mixed-integer programming (MIP) problem using the infrastructure sensing signals, computing a motion plan for each CAV and each NCV in the traffic network by solving the global MIP problem, computing an optimal sequence of entering/exiting times and a sequence of average velocities for each CAV and each NCV, and computing a velocity profile and/or one or multiple planned stops for each CAV.

Abstract: Connected and automated vehicles (CAVs) have shown the potential to improve safety, increase road throughput, and optimize energy efficiency and emissions in several complicated traffic scenarios. This invention describes a mixed-integer programming (MIP) optimization method for global multi-vehicle decision making and motion planning of CAVs in a highly dynamic environment that consists of multiple human-driven, i.e., conventional or manual, vehicles and multiple conflict zones, such as merging points and intersections. The proposed approach ensures safety, high throughput and energy efficiency by solving a global multi-vehicle constrained optimization problem. The solution provides a feasible and optimal time schedule through road segments and conflict zones for the automated vehicles, by using information from the position, velocity, and destination of the manual vehicles, which cannot be directly controlled.