Abstract:We address the problem of optimizing the performance of a dynamic system while satisfying hard safety constraints at all times. Implementing an optimal control solution is limited by the computational cost required to derive it in real time, especially when constraints become active, as well as the need to rely on simple linear dynamics, simple objective functions, and ignoring noise. The recently proposed Control Barrier Function (CBF) method may be used for safety-critical control at the expense of sub-optimal performance. In this paper, we develop a real-time control framework that combines optimal trajectories generated through optimal control with the computationally efficient CBF method providing safety guarantees. We use <a href="/topics/engineering/hamiltonian">Hamiltonian</a> analysis to obtain a tractable optimal solution for a linear or <a href="/topics/engineering/linearized-system">linearized system</a>, then employ High Order CBFs (HOCBFs) and Control <a href="/topics/engineering/lyapunov-function">Lyapunov Functions</a> (CLFs) to account for constraints with arbitrary relative degrees and to track the optimal state, respectively. We further show how to deal with noise in arbitrary relative degree systems. The proposed framework is then applied to the optimal traffic merging problem for Connected and Automated Vehicles (CAVs) where the objective is to jointly minimize the travel time and energy consumption of each CAV subject to speed, acceleration, and speed-dependent safety constraints. In addition, when considering more complex objective functions, nonlinear dynamics and passenger comfort requirements for which analytical optimal control solutions are unavailable, we adapt the HOCBF method to such problems. Simulation examples are included to compare the performance of the proposed framework to optimal solutions (when available) and to a baseline provided by human-driven vehicles with results showing significant improvements in all metrics.

A Framework for Approximating Perturbed Optimal Control Problems

Efficient Optimization-Based Trajectory Planning for Unmanned Systems in Confined Environments

A Rapid Trajectory Optimization and Control Framework for Resource-Constrained Applications

Stochastic trajectory optimization for mechanical systems with parametric uncertainties

Near Optimal Control for a Class of Stochastic Hybrid Systems.

Robust relatively optimal trajectory tracking control for a class of uncertain nonlinear control affine systems with state and input constraints

Continuous-time optimal control for trajectory planning under uncertainty

Bridging the gap between optimal trajectory planning and safety-critical control with applications to autonomous vehicles

Tracking optimal feedback control under uncertain parameters

Regret Optimal Control for Uncertain Stochastic Systems

Dynamic Programming-based Approximate Optimal Control for Model-Based Reinforcement Learning

Robust Optimal Control for Nonlinear Systems with Parametric Uncertainties via System Level Synthesis

Trajectory Optimization under Contact Timing Uncertainties

Optimality and robustness in path-planning under initial uncertainty

Reduced Desensitization Formulation for Optimal Control Problems

Deterministic Trajectory Optimization through Probabilistic Optimal Control

Expected Time-Optimal Control: a Particle Model Predictive Control-based Approach via Sequential Convex Programming

Safe Trajectory Tracking in Uncertain Environments

Almost Optimal Agnostic Control of Unknown Linear Dynamics

Trajectory tracking control for underactuated autonomous vehicles via adaptive dynamic programming

An Approximate Optimal Control Approach for Robust Stabilization of a Class of Discrete-Time Nonlinear Systems with Uncertainties