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.

Continuous-time optimal control for trajectory planning under uncertainty

Robust Hierarchical Model Predictive Control for Trajectory Tracking with Obstacle Avoidance

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

A Real-Time Optimization-Based Trajectory Planning Method in Dynamic and Uncertain Environments

Safe planning and control under uncertainty for self-driving

An Incremental Strategy for Tractor-Trailer Vehicle Global Trajectory Optimization in the Presence of Obstacles.

Non-Gaussian Chance-Constrained Trajectory Planning for Autonomous Vehicles under Agent Uncertainty

Planning in the continuous domain: A generalized belief space approach for autonomous navigation in unknown environments

Stochastic Time-Optimal Trajectory Planning for Connected and Automated Vehicles in Mixed-Traffic Merging Scenarios

Stochastic trajectory optimization for mechanical systems with parametric uncertainties

Continuous Decision Making for On-road Autonomous Driving under Uncertain and Interactive Environments.

Trajectory Optimization under Contact Timing Uncertainties

Optimality and robustness in path-planning under initial uncertainty

Stochastic optimal control for autonomous driving applications via polynomial chaos expansions

Enable Faster and Smoother Spatio-Temporal Trajectory Planning for Autonomous Vehicles in Constrained Dynamic Environment

Real-Time Spatial Trajectory Planning for Urban Environments Using Dynamic Optimization

An Efficient Spatial-Temporal Trajectory Planner for Autonomous Vehicles in Unstructured Environments

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

Spatio-Temporal Trajectory Planning Using Search And Optimizing Method for Autonomous Driving

An Adaptive Horizon Predictive Control Method for Autonomous Vehicles

Time-Dependent Hybrid-State A* and Optimal Control for Autonomous Vehicles in Arbitrary and Dynamic Environment