Source-linked AI summary
Enhancing Feasibility and Safety of Nonlinear Model Predictive Control with Discrete-Time Control Barrier Functions
Jun Zeng, Zhongyu Li, Koushil Sreenath
TL;DR
Existing discrete-time CBF optimal-control approaches face a feasibility–safety tradeoff. This paper proposes NMPC formulations that relax CBF decay rates, and reports theoretical and numerical improvements in feasibility and safety over existing approaches.
Problem
Existing discrete-time CBF formulations cannot theoretically enhance optimization feasibility and system safety at the same time.
Source: A. Motivation · p. 1, 2) Feasibility & Safety · p. 1Method
The proposed formulations relax discrete-time CBF decay rates within NMPC to enhance feasibility and safety for one-step and multi-step input optimization.
Source: C. Contributions · p. 2Results
The proposed formulations are reported to outperform state-of-the-art approaches in feasibility and safety, with theoretical analysis and numerical validation.
Source: §VI · p. 8, A. Numerical Results for Feasibility · p. 8Takeaways & Limitations
The decay-rate relaxation is presented for both one-step and multi-step input optimization, rather than requiring only one-step constraints.
Source: C. Contributions · p. 2
Abstract
from arXiv · showhide
Safety is one of the fundamental problems in robotics. Recently, one-step or multi-step optimal control problems for discrete-time nonlinear dynamical system were formulated to offer tracking stability using control Lyapunov functions (CLFs) while subject to input constraints as well as safety-critical constraints using control barrier functions (CBFs). The limitations of these existing approaches are mainly about feasibility and safety. In the existing approaches, the feasibility of the optimization and the system safety cannot be enhanced at the same time theoretically. In this paper, we propose two formulations that unifies CLFs and CBFs under the framework of nonlinear model predictive control (NMPC). In the proposed formulations, safety criteria is commonly formulated as CBF constraints and stability performance is ensured with either a terminal cost function or CLF constraints. Slack variables with relaxing technique are introduced on the CBF constraints to resolve the tradeoff between feasibility and safety so that they can be enhanced at the same. The advantages about feasibility and safety of proposed formulations compared with existing methods are analyzed theoretically and validated with numerical results.
I. INTRODUCTION
Discrete-time CBF optimal control combines safety constraints with CLF-based performance, but existing formulations face a tradeoff between feasibility and safety. The paper proposes NMPC formulations that relax CBF decay rates to address both concerns.
A. Motivation
- The paper situates its work in robotic safety-critical control, where performance objectives and safety criteria may conflict.CLFs and CBFs are used to address stability and safety, respectively.Source: A. Motivation · p. 1
B. Related Work
- Earlier discrete-time work includes current-input optimization with DCLF-DCBF and predictive safety constraints with MPC-DCBF.NMPC-DCLF instead uses discrete-time CLF constraints under NMPC.Source: 1) Optimal Control with Discrete-time… · p. 1
2) Feasibility & Safety:
- Existing discrete-time CBF methods face feasibility challenges when reachable states and the CBF-defined safe region do not intersect.One-step constraints can improve feasibility, but do not remove the safety–feasibility tradeoff; the intersection can still be empty.Source: 2) Feasibility & Safety · pp. 1–2
- The paper relaxes discrete-time CBF decay rates and supports both one-step and multi-step constraints, rather than requiring only the one-step approach of MPC-GCBF.The authors state that this can enhance feasibility and safety together.Source: 2) Feasibility & Safety · p. 2, C. Contributions · p. 2
C. Contributions
- The proposed frameworks combine discrete-time CBF safety constraints with CLF stability criteria, represented by either a terminal cost or CLF constraints.The paper reports theoretical and numerical comparisons with existing approaches.Source: C. Contributions · p. 2
D. Paper Structure
The paper first introduces discrete-time CLF and CBF background, then presents its proposed NMPC formulations, analysis, and numerical simulations. The background defines the safe set and describes how discrete-time barrier and Lyapunov functions constrain safety and stability.
D. Paper Structure
- The paper structure proceeds from discrete-time CLF and CBF background to proposed NMPC formulations, theoretical analysis, numerical simulations, and concluding remarks.Source: D. Paper Structure · p. 2
A. CLFs and CBFs
- The background treats the safe set C as the superlevel set of h and describes it as the set satisfying distance constraints.Source: A. CLFs and CBFs · p. 2
- The discrete-time CBF condition bounds h(x_k+1) below by (1−γ_k)h(x_k), while the CLF condition makes the upper bound of V decrease at rate 1−α_k.Source: A. CLFs and CBFs · p. 2
B. Existing Approaches Revisited
The section revisits discrete-time optimal-control formulations that combine CLFs and CBFs or impose predictive CBF constraints. It highlights their safety and stability mechanisms as well as feasibility limitations of predictive constraints.
B. Existing Approaches Revisited
- The section revisits existing discrete-time CLF- and CBF-based optimal-control formulations.Source: B. Existing Approaches Revisited · p. 2
1) DCLF-DCBF [3]:
- DCLF-DCBF unifies discrete-time CLF and CBF constraints in one optimization, with a slack variable and cost that permit Lyapunov growth when the constraints conflict.The safe set is invariant when h(x0) ≥ 0 and 0 < γ_k ≤ 1.Source: 1) DCLF-DCBF [3] · p. 2, DCLF-DCBF · p. 3
2) MPC-DCBF [4]:
- MPC-DCBF imposes CBF constraints across a prediction horizon and applies the first input of the optimized sequence in a receding-horizon strategy.Its larger number of constraints can reduce its feasibility region relative to DCLF-DCBF.Source: MPC-DCBF · p. 3, 2) MPC-DCBF [4] · p. 3
3) MPC-GCBF [18]:
MPC-GCBF reduces predictive CBF constraints to one step to improve feasibility and computational time. A generalization for high-relative-degree safety constraints poses constraints on two nonadjacent steps.
3) MPC-GCBF [18]:
- A one-step CBF constraint can reduce computational complexity and improve feasibility by imposing fewer constraints.The approach was first presented in MPC-GCBF.Source: 3) MPC-GCBF [18] · p. 3
- For a high-relative-degree safety constraint, the generalized formulation places constraints on two nonadjacent steps, with m denoting the relative degree.Source: 3) MPC-GCBF [18] · p. 3
4) CLF-NMPC [15]:
This section contrasts prior CLF-NMPC, which does not include safety criteria, with two proposed NMPC formulations that combine discrete-time CLFs and CBFs. The formulations relax CBF decay rates to improve feasibility, while using either a terminal CLF cost or CLF constraints for stability.
4) CLF-NMPC [15]:
- CLF-NMPC incorporates stability constraints but does not consider safety criteria.Its CLF constraint may be imposed over one or multiple steps.Source: 4) CLF-NMPC [15] · p. 3
III. CLFS AND CBFS UNIFIED WITH NMPC
- The proposed NMPC-DCBF and NMPC-DCLF-DCBF formulations unify discrete-time CLFs and CBFs within NMPC.Safety is expressed through CBF constraints, while stability is handled by a terminal cost or CLF constraints.Source: §III · p. 3
A. Formulations
- One formulation uses the terminal CLF V(x_t+N|t) as a cost alongside cumulative stage cost.The passage notes that stability can usually be achieved without a terminal-state constraint if β is sufficiently large.Source: A. Formulations · p. 4
- NMPC-DCBF optimizes relaxed CBF decay rates and guarantees safety for the first M_CBF open-loop steps, not the full horizon N.A separate CBF-constraint horizon M_CBF ≤ N allows its length to be chosen to reduce computational complexity.Source: A. Formulations · p. 4
- Unlike one-step MPC-GCBF, NMPC-DCBF retains multi-step constraints, providing stronger set invariance with fewer assumptions for high-relative-degree systems.The stated requirement is M_CBF ≥ m, where m is the relative degree.Source: A. Formulations · p. 4
- NMPC-DCLF-DCBF instead imposes CLF constraints, with slack variables and penalties to avoid infeasibility between CLF and CBF constraints.The CLF and CBF constraint horizons may be shorter than prediction horizon N; NMPC-DCBF also makes fixed CBF decay rates optimization variables, increasing feasibility.Source: A. Formulations · p. 4
- Complexity depends on system dynamics and CBF nonlinearity; with nonlinear CBFs, shorter constraint horizons can outweigh added ω_k variables.The added optimization variables increase complexity, while shorter constraint horizons can reduce it.Source: A. Formulations · pp. 4–5
IV. THEORETICAL ANALYSIS
The section presents a theoretical comparison of the proposed approaches with state-of-the-art methods, summarized in Table I.
IV. THEORETICAL ANALYSIS
- The section states that theoretical advantages in feasibility and safety are compared with state-of-the-art methods and summarized in Table I.Source: §IV · p. 5
A. Theoretical Analysis of Feasibility
The feasibility analysis compares reachable and safe regions for MPC-DCBF and NMPC-DCBF. It concludes that decay-rate relaxation makes the proposed formulations’ feasible regions larger and independent of the CBF decay-rate hyperparameters.
A. Theoretical Analysis of Feasibility
- The analysis compares MPC-DCBF and NMPC-DCBF by examining intersections of reachable sets and CBF-confined safe regions at each time step.Source: A. Theoretical Analysis of Feasibility · p. 5
- NMPC-DCBF’s safe region equals C and is independent of γ_k, so changing γ_k does not affect feasibility.C is the set of states satisfying h(x) ≥ 0.Source: A. Theoretical Analysis of Feasibility · p. 5
- The feasible regions for NMPC-DCBF are larger than those for MPC-DCBF because its safe set contains the corresponding MPC-DCBF safe set.Source: A. Theoretical Analysis of Feasibility · p. 5
- The analysis concludes that NMPC-DCBF and NMPC-DCLF-DCBF outperform MPC-DCBF, MPC-GCBF, and DCLF-DCBF in feasibility.The feasibility region at each step is the intersection of the reachable set and safe set.Source: A. Theoretical Analysis of Feasibility · p. 5
B. Theoretical Analysis of Safety
Reducing γ_k can improve safety while worsening feasibility in existing formulations, but the proposed NMPC-DCBF keeps its safety-constrained region independent of γ_k. An appropriate cost for the decay-rate slack variable can further support safety without harming feasibility.
B. Theoretical Analysis of Safety
- Reducing γ_k improves safety but can make existing formulations more likely to become infeasible; in NMPC-DCBF, the safety region is independent of γ_k, allowing safety to improve without harming feasibility.The authors summarize that reducing γ_k with an appropriate slack-variable cost can outperform existing formulations in safety while not harming feasibility.Source: B. Theoretical Analysis of Safety · pp. 5–6
- A larger P_ω tends to keep ω_k closer to 1, while a value that is too small may overrelax the CBF constraint.Keeping ω_k near 1 limits deviation from the nominal decay rate 1 − γ_k; the authors therefore do not recommend setting P_ω too small.Source: B. Theoretical Analysis of Safety · pp. 5–6
- With ω_k = 0, the relaxed CBF constraint becomes a distance constraint, and MPC-DC needs a longer horizon for expected obstacle avoidance.Source: B. Theoretical Analysis of Safety · p. 6
V. NUMERICAL EXAMPLES & RESULTS
The numerical examples use a discrete-time linear triple-integrator system with bounded jerk inputs. Simulations use a 0.1-second sampling time and MATLAB, with Yalmip and IPOPT for formulation and solution.
V. NUMERICAL EXAMPLES & RESULTS
- The numerical examples consider a discrete-time linear triple-integrator system.Source: §V · p. 6
- The state is position, velocity, and acceleration, and the input is jerk constrained between j_min and j_max.Source: §V · p. 6
- Simulations use Δt = 0.1 s and jerk bounds of −1 and 1 m/s^3; MATLAB, Yalmip, and IPOPT are used.Source: §V · p. 6
A. Numerical Results for Feasibility
In sampled feasibility comparisons, NMPC-DCBF outperforms MPC-DCBF and MPC-GCBF, while NMPC-DCLF-DCBF outperforms DCLF-DCBF. The proposed formulations’ feasible regions are independent of γk in the reported comparisons.
A. Numerical Results for Feasibility
- Feasibility was tested by solving each optimization problem at sampled states in a bounded state space.The stated bounds are x from −2 m to 0 m, and v and a from 0 to 2 in their respective units.Source: A. Numerical Results for Feasibility · p. 6
- NMPC-DCBF’s feasible region contains those of MPC-DCBF and MPC-GCBF and is independent of γk in the high-order CBF comparison.The comparison uses γk values of 0.05, 0.10, 0.15, and 0.20.Source: A. Numerical Results for Feasibility · p. 6, Figure 1 · p. 7, Figure 2 · p. 7
- NMPC-DCLF-DCBF outperforms DCLF-DCBF in feasibility, and its feasible region is independent of γk.Unsafe states inside the sphere defined by h(x) = x2 + v2 + a2 −1 were excluded from the sampling test.Source: A. Numerical Results for Feasibility · p. 6, Figure 3 · p. 7
- At γ = 0.05, NMPC-DCBF is the only compared approach that remains feasible along the trajectory.The reported feasibility comparison uses the same horizon and forms of stage and terminal costs across approaches.Source: A. Numerical Results for Feasibility · pp. 6–8
B. Safety
Reducing γk made NMPC-DCBF safer without adversely affecting feasibility in the reported comparison. The conclusion presents the formulations as outperforming the state of the art in feasibility and safety, while identifying deployment and theoretical analyses as future work.
B. Safety
- With γ = 0.05, NMPC-DCBF alone remained feasible from the initial condition; reducing γk slowed CBF decrease and improved safety without adversely affecting feasibility.MPC-DCBF and MPC-GCBF were infeasible initially at γ = 0.05, and MPC-GCBF became infeasible after around 5 seconds.Source: B. Safety · p. 8
VI. CONCLUSION & FUTURE WORK
- The proposed formulations unify CLFs and CBFs in NMPC and outperform the state of the art in feasibility and safety, according to theoretical and numerical results.They relax the decay rate of CBF constraints and use different horizon lengths for cost functions and constraints.Source: §VI · p. 8
- Real-time mobile-robot deployment still requires handling modelling uncertainty, disturbance, and noise, while formal recursive-feasibility and stability analysis remains future work.The authors identify implementation as either a mid-level planner or real-time controller as a future direction.Source: §VI · p. 8