Iterative Convex Optimization for Model Predictive Control with Discrete-Time High-Order Control Barrier Functions

Shuo Liu,Jun Zeng,Koushil Sreenath,Calin A. Belta
2023-07-13
Abstract:Safety is one of the fundamental challenges in control theory. Recently, multi-step optimal control problems for discrete-time dynamical systems were formulated to enforce stability, while subject to input constraints as well as safety-critical requirements using discrete-time control barrier functions within a model predictive control (MPC) framework. Existing work usually focus on the feasibility or the safety for the optimization problem, and the majority of the existing work restrict the discussions to relative-degree one control barrier functions. Additionally, the real-time computation is challenging when a large horizon is considered in the MPC problem for relative-degree one or high-order control barrier functions. In this paper, we propose a framework that solves the safety-critical MPC problem in an iterative optimization, which is applicable for any relative-degree control barrier functions. In the proposed formulation, the nonlinear system dynamics as well as the safety constraints modeled as discrete-time high-order control barrier functions (DHOCBF) are linearized at each time step. Our formulation is generally valid for any control barrier function with an arbitrary relative-degree. The advantages of fast computational performance with safety guarantee are analyzed and validated with numerical results.
Optimization and Control,Robotics,Systems and Control,Dynamical Systems
What problem does this paper attempt to address?
This paper attempts to address the issue of efficiently handling high-order discrete-time control barrier functions (DHOCBF) in model predictive control (MPC) to ensure system safety. Specifically, existing methods typically focus on the feasibility and safety of the optimization problem, but most studies are limited to control barrier functions of relative degree 1, and real-time computation becomes very challenging when considering longer time horizons. This paper proposes an iterative optimization framework applicable to control barrier functions of any relative degree, significantly reducing computation time while ensuring system safety by iteratively optimizing based on the linearization of nonlinear system dynamics and safety constraints. ### Main Contributions: 1. **MPC Strategy for Safety-Critical Tasks**: An MPC strategy for safety-critical tasks is proposed, where safety constraints can be enforced through high-order discrete-time control barrier functions (DHOCBF). The decay rate in each constraint can be relaxed to enhance the feasibility of the optimization and ensure the forward invariance of a series of safe sets. 2. **Optimal Control Framework**: An optimal control framework that guarantees safety is proposed, where DHOCBF constraints and system dynamics are linearized at each iteration and solved as constraints of a convex optimization problem. 3. **Numerical Validation**: Numerical examples demonstrate that the proposed framework is significantly faster than existing methods without sacrificing safety and feasibility. ### Problems Addressed: - **Real-Time Computational Efficiency**: Existing methods take a long time to compute when handling high-order control barrier functions, especially when considering longer time horizons. This paper significantly reduces computation time through iterative optimization and linearization methods. - **Applicability of High-Order Control Barrier Functions**: Existing methods are mostly limited to control barrier functions of relative degree 1, while the method in this paper is applicable to control barrier functions of any relative degree. - **Feasibility of the Optimization Problem**: By introducing slack variables and iterative optimization, the feasibility of the optimization problem is improved, especially when dealing with long time horizon problems. ### Application Background: - **Robotic Control**: In tasks such as robot navigation and obstacle avoidance, efficient control needs to be achieved while ensuring safety. - **Autonomous Driving**: In autonomous vehicles, complex dynamic environments need to be processed in real-time to ensure the safe driving of the vehicle. Through these contributions, this paper provides new ideas and methods to address the issues of computational efficiency and feasibility in safety-critical control tasks.