In this paper, we provide a decentralized theoretical framework for coordination of connected and automated vehicles (CAVs) at different traffic scenarios. The framework includes: (1) an upper-level optimization that yields for each CAV its optimal time trajectory and lane to pass through a given traffic scenario while alleviating congestion; and (2) a low-level optimization that yields for each CAV its optimal control input (acceleration/deceleration). We provide a complete, analytical solution of the low-level optimization problem that includes the rear-end, speed-dependent safety constraint. Furthermore, we provide a problem formulation for the upper-level optimization in which there is no duality gap. The latter implies that the optimal time trajectory for each CAV does not activate any of the state, control, and safety constraints of the low-level optimization, thus allowing for online implementation. Finally, we present a geometric duality framework with hyperplanes to derive the condition under which the optimal solution of the upper-level optimization always exists. We validate the effectiveness of the proposed theoretical framework through simulation.
Connected and automated vehicles (CAVs) provide the most intriguing opportunity to reduce pollution, energy consumption, and travel delays. In earlier work, we addressed the optimal coordination of CAVs using Hamiltonian analysis. In this paper, we investigate the nature of the unconstrained problem and provide conditions under which the state and control constraints become active. We derive a closed-form analytical solution of the constrained optimization problem and evaluate the solution using numerical simulation.
In this paper we consider the problem of coordinating autonomous vehicles approaching an intersection. We cast the problem in the distributed optimisation framework and propose an algorithm to solve it in real time. We extend previous work on the topic by testing two alternative algorithmic solutions in simulations. Moreover, we test our algorithm in experiments using real cars on a test track. The experimental results demonstrate the applicability and real-time feasibility of the algorithm.
We address the problem of coordinating online a continuous flow of connected and automated vehicles (CAVs) crossing two adjacent intersections in an urban area. We present a decentralized optimal control framework whose solution yields for each vehicle the optimal acceleration/deceleration at any time in the sense of minimizing fuel consumption. The solu- tion, when it exists, allows the vehicles to cross the intersections without the use of traffic lights, without creating congestion on the connecting road, and under the hard safety constraint of collision avoidance. The effectiveness of the …
This article reviews some main results and progress in distributed multi-agent coordination, focusing on papers published in major control systems and robotics journals since 2006. Distributed coordination of multiple vehicles, including unmanned aerial vehicles, unmanned ground vehicles and unmanned underwater vehicles, has been a very active research subject studied extensively by the systems and control community. The recent results in this area are categorized into several directions, such as consensus, formation control, optimization, task assignment, and estimation. After the review, a s…
Connected and automated vehicles (CAVs) provide the most intriguing opportunity to improve energy efficiency, traffic flow, and safety. In earlier work, we addressed the constrained optimal coordination problem of CAVs at different traffic scenarios using Hamiltonian analysis. In this paper, we investigate the properties of the unconstrained problem and provide conditions under which different combination of the state and control constraints become active. We present a condition-based computational framework that improves on the standard iterative solution procedure of the constrained Hamilton…
In earlier work, a decentralized optimal control framework was established for coordinating online connected and automated vehicles (CAVs) in merging roadways, urban intersections, speed reduction zones, and roundabouts. The dynamics of each vehicle were represented by a double integrator and the Hamiltonian analysis was applied to derive an analytical solution that minimizes the L2-norm of the control input. However, the analytical solution did not consider the rear-end collision avoidance constraint. In this paper, we derive a complete, closed-form analytical solution that includes the rear-…
In this paper, we address the problem of coordinating platoons of connected and automated vehicles at signal-free intersections. We present a decentralized, two-level optimal framework to coordinate the platoons with the objective to minimize travel delay and fuel consumption of every platoon crossing the intersection. In the upper-level, each platoon derives an optimal schedule to enter the intersection. In the low-level, the platoons derive their optimal control input (acceleration/deceleration) for the optimal schedule derived in the upper-level. We validate the effectiveness of the propose…
Connected and automated vehicles (CAVs) provide the most intriguing opportunity to optimize energy consumption and travel time. Several approaches have been proposed in the literature that allow CAVs to coordinate in situations where there is a potential conflict, for example, in signalized intersections, merging at roadways and roundabouts, to reduce energy consumption and optimize traffic flow. In this paper, we consider the problem of coordinating CAVs in a corridor consisting of multiple traffic scenarios. We formulate a two-level optimization problem in which we maximize traffic throughpu…
Urban intersections, merging roadways, roundabouts, and speed reduction zones along with the driver responses to various disturbances are the primary sources of bottlenecks in corridors that contribute to traffic congestion. The implementation of connected and automated technologies can enable a novel computational framework for real-time control aimed at optimizing energy consumption and travel time. In this paper, we propose a decentralized energy-efficient optimal control framework for two adjacent intersections. We derive a closed-form analytical solution that includes interior boundary co…
This study presents a vehicle-level distributed coordination strategy to control a mixed traffic stream of connected automated vehicles (CAVs) and connected human-driven vehicles (CHVs) through signalized intersections. We use CAVs as mobile traffic controllers during a newly introduced white phase, during which CAVs will negotiate the right-of-way to lead a group of CHVs while CHVs must follow their immediate front vehicle. The white phase will not be activated under low CAV penetration rates, where vehicles must wait for green signals. We have formulated this problem as a distributed mixed-i…
Eindhoven University of Technology（埃因霍温理工大学）；Eindhoven Artificial Intelligence Systems Institute（埃因霍温人工智能系统研究所）；Lund University（隆德大学）；The Australian National University（澳大利亚国立大学）
We consider the problem of cooperative motion coordination for multiple heterogeneous mobile vehicles subject to various constraints. These include nonholonomic motion constraints, constant speed constraints, holonomic coordination constraints, and equality/inequality geometric constraints. We develop a general framework involving differential-algebraic equations and viability theory to determine coordination feasibility for a coordinated motion control under heterogeneous vehicle dynamics and different types of coordination task constraints. If a coordinated motion solution exists for the der…
This paper considers competitive mobility-on-demand systems where a group of vehicle sharing companies, on one hand, want to collectively regulate the traffic of the user queueing network, and on the other hand, maximize their own profits at each time instant. We formulate the strategic interconnection among the companies as a real-time game theoretic coordination problem. We propose an algorithm to achieve vehicle balance and practical regulation of the user queueing network. We quantify the relation between the regulation error and the system parameters (e.g., the maximum variation of the us…
Unmanned aerial vehicle (UAV) use continues to increase, including operating beyond line of sight in unknown environments where the vehicle must autonomously generate a trajectory to safely navigate. In this article, we develop a trajectory generation algorithm for vehicles with second-order dynamics in unknown environments with bounded wind disturbances where the vehicle only relies on its on-board distance sensors and communication with other vehicles to navigate. The proposed algorithm generates smooth trajectories and can be used with high-level planners and low-level motion controllers. T…
In this paper, we extend a framework that we developed earlier for coordination of connected and automated vehicles (CAVs) at a signal-free intersection by integrating a safety layer using control barrier functions. First, in our motion planning module, each CAV computes the optimal control trajectory using simple vehicle dynamics. The trajectory does not make any of the state, control, and safety constraints active. A vehicle-level tracking controller employs a combined feedforward-feedback control law to track the resulting optimal trajectory from the motion planning module. Then, a barrier-…
Motion trajectory planning is one crucial aspect for automated vehicles, as it governs the own future behavior in a dynamically changing environment. A good utilization of a vehicle's characteristics requires the consideration of the nonlinear system dynamics within the optimization problem to be solved. In particular, real-time feasibility is essential for automated driving, in order to account for the fast changing surrounding, e.g. for moving objects. The key contributions of this paper are the presentation of a fast optimization algorithm for trajectory planning including the nonlinear sys…
When connected and autonomous vehicles (CAVs) are widely used in the future, we can foresee many essential applications, such as platoon formation and autonomous police patrolling, which need two CAVs, originally separated in a mixed traffic flow involving CAVs and human-drive vehicles (HDVs), to quickly approach each other and then keep a stable car-following mode. The entire process should not jeopardize surrounding traffic safety and efficiency. The existing literature has not studied this CAV synchronization control well, and this study seeks to partially make up this gap.
Deriving optimal control strategies for coordination of connected and automated vehicles (CAVs) often requires re-evaluating the strategies in order to respond to unexpected changes in the presence of disturbances and uncertainties. In this paper, we first extend a decentralized framework that we developed earlier for coordination of CAVs at a signal-free intersection to incorporate replanning. Then, we further enhance the framework by introducing a priority-aware resequencing mechanism which designates the order of decision making of CAVs based on theory from the job-shop scheduling problem. …
Platooning of connected and autonomous vehicles (CAVs) has a significant potential for throughput improvement. However, the interaction between CAVs and non-CAVs may limit the practically attainable improvement due to platooning. To better understand and address this limitation, we introduce a new fluid model of mixed-autonomy traffic flow and use this model to analyze and design platoon coordination strategies. We propose tandem-link fluid model that considers randomly arriving platoons sharing highway capacity with non-CAVs. We derive verifiable conditions for stability of the fluid model by…
In this paper, we provide a decentralized optimal control framework for coordinating connected and automated vehicles (CAVs) in two interconnected intersections. We formulate a control problem and provide a solution that can be implemented in real time. The solution yields the optimal acceleration/deceleration of each CAV under the safety constraint at "conflict zones," where there is a chance of potential collision. Our objective is to minimize travel time for each CAV. If no such solution exists, then each CAV solves an energy-optimal control problem. We evaluate the effectiveness of the eff…
In this paper, we provide a hierarchical coordination framework for connected and automated vehicles (CAVs) at two adjacent intersections. This framework consists of an upper-level scheduling problem and a low-level optimal control problem. By partitioning the area around two adjacent intersections into different zones, we formulate a scheduling problem for each individual CAV aimed at minimizing its total travel time. For each CAV, the solution of the upper-level problem designates the arrival times at each zones on its path which becomes the inputs of the low-level problem. The solution of t…
University of California, Santa Barbara（加州大学圣塔芭芭拉分校）；Naval Air Warfare Center Weapons Division（海军空战中心武器分部）
We present a method for optimal coordination of multiple vehicle teams when multiple endpoint configurations are equally desirable, such as seen in the autonomous assembly of formation flight. The individual vehicles' positions in the formation are not assigned a priori and a key challenge is to find the optimal configuration assignment along with the optimal control and trajectory. Commonly, assignment and trajectory planning problems are solved separately. We introduce a new multi-vehicle coordination paradigm, where the optimal goal assignment and optimal vehicle trajectories are found simu…
In this paper, we consider the optimal coordination of automated vehicles at intersections under fixed crossing orders. We formulate the problem using direct optimal control and exploit the structure to construct a semi-distributed primal-dual interior-point algorithm to solve it by parallelizing most of the computations. Differently from standard distributed optimization algorithms, where the optimization problem is split, in our approach we split the linear algebra steps, such that the algorithm takes the same steps as a fully centralized one, while still performing computations in a distrib…
Platooning of vehicles with coordinated adaptive cruise control (CACC) capabilities is a promising technology with a strong potential for fuel savings and congestion mitigation. Although some researchers have studied the vehicle-level fuel savings of platooning, few have considered the system-level benefits. This paper evaluates vehicle platooning as a fuel-reduction method and propose a hierarchical control system. We particularly focus on the impact of platooning coordination algorithm on system-wide benefits. The main task of platooning coordination is to regulate the times at which multipl…
Autonomous trajectory generation for unmanned aerial vehicles (UAVs) in unknown environments continues to be an important research area as UAVs become more prolific. We define a trajectory generation algorithm for a vehicle in an unknown environment with wind disturbances, that relies only on the vehicle's on-board distance sensors and communication with other vehicles within a finite region to generate a smooth, collision-free trajectory up to the fourth derivative. The proposed trajectory generation algorithm can be used in conjunction with high-level planners and low-level motion controller…
We investigate the problem of coordinating multiple automated vehicles (AVs) in confined areas. This problem can be formulated as an optimal control problem (OCP) where the motion of the AVs is optimized such that collisions are avoided in cross-intersections, merge crossings, and narrow roads. The problem is combinatorial and solving it to optimality is prohibitively difficult for all but trivial instances. For this reason, we propose a heuristic method to obtain approximate solutions. The heuristic comprises two stages: In the first stage, a Mixed Integer Quadratic Program (MIQP), similar in…
We consider the charge scheduling coordination of a fleet of plug-in electric vehicles, developing a hybrid decision-making framework for efficient and profitable usage of the distribution grid. Each charging dynamics, affected by the aggregate behavior of the whole fleet, is modelled as an inter-dependent, mixed-logical-dynamical system. The coordination problem is formalized as a generalized mixed-integer aggregative potential game, and solved via semi-decentralized implementation of a sequential best-response algorithm that leads to an approximated equilibrium of the game.
