pith. sign in

arxiv: 2604.04602 · v1 · submitted 2026-04-06 · 📡 eess.SY · cs.SY· math.OC

Stochastic Model Predictive Control with Online Risk Allocation and Feedback Gain Selection

Pith reviewed 2026-05-10 19:36 UTC · model grok-4.3

classification 📡 eess.SY cs.SYmath.OC
keywords stochastic model predictive controlchance constraintsrisk allocationfeedback gain selectionmixed-integer conic programmingprobit approximationpath planning
0
0 comments X

The pith

Stochastic model predictive control with joint optimization of risk allocation and feedback policies can be reformulated as a mixed-integer conic program.

A machine-rendered reading of the paper's core claim, the machinery that carries it, and where it could break.

The paper seeks to make stochastic model predictive control tractable when both risk allocation and feedback policies must be chosen online. Normally this produces nonconvex problems because chance constraints contain products of the feedback law with the risk variables and because they embed the nonconvex probit function. By deriving disjunctive convex chance constraints, restricting the feedback law to a finite precomputed set of candidates, and replacing probit compositions with power- and exponential-cone representable approximations, the authors obtain a mixed-integer conic program. This program can be solved with standard off-the-shelf solvers and extends to general chance constraints that mix exclusive disjunctions with Gaussian variables. The approach is illustrated on a path-planning task.

Core claim

The paper establishes that disjunctive convex chance constraints together with power- and exponential-cone approximations to the probit function allow the simultaneous optimization of risk allocation and feedback gains in stochastic MPC to be cast as a mixed-integer conic optimization problem that is solvable by existing software, while preserving the original probabilistic guarantees up to the accuracy of the chosen approximations.

What carries the argument

Disjunctive convex chance constraints that replace nonconvex products of feedback laws and risk allocations, combined with power- and exponential-cone representable approximations to the probit function, yielding a mixed-integer conic program.

If this is right

  • The stochastic MPC problem becomes solvable in real time with standard conic solvers rather than requiring custom nonconvex algorithms.
  • The same reformulation applies directly to any chance constraint that contains products of exclusive disjunctive variables and Gaussian random variables.
  • Feedback policies can be adapted online while risk is allocated at each step without sacrificing convexity.
  • Path-planning problems with probabilistic obstacle avoidance become practical instances of the new formulation.

Where Pith is reading between the lines

These are editorial extensions of the paper, not claims the author makes directly.

  • The method could support safety-critical applications where risk levels must be adjusted on the fly according to changing conditions or priorities.
  • If the candidate feedback set is generated by a learning procedure, the overall scheme could combine data-driven policy selection with formal probabilistic guarantees.
  • Similar cone approximations might be developed for other quantile functions, opening the approach to non-Gaussian uncertainties.
  • The computational scaling with the number of candidate feedback laws could be studied to determine how large the precomputed set can be before real-time feasibility is lost.

Load-bearing premise

The power- and exponential-cone approximations to the probit function are accurate enough that the resulting constraints still deliver the intended probabilistic guarantees, and that restricting the feedback law to a finite precomputed set does not materially degrade closed-loop performance.

What would settle it

Run the closed-loop system on the path-planning example, measure the empirical frequency of constraint violations, and check whether it stays at or below the prescribed risk levels; separately compare solution times and achieved cost against a two-stage nonconvex solver on identical instances.

Figures

Figures reproduced from arXiv: 2604.04602 by Filipe Marques Barbosa, Johan L\"ofberg.

Figure 1
Figure 1. Figure 1: The curves of the nonconvex function compositions resulting from the formulations in Sec. IV-A (solid) and their corresponding exponential cone-representable approximations (dashed). In this way, a lower power cone-representable approxima￾tion Ψ inv(γ) ≈ 1 Φ−1(1 − γ) (46) can be constructed using a fractional power function combined with compensation terms that preserve convexity and tractabil￾ity as Ψ inv… view at source ↗
Figure 2
Figure 2. Figure 2: A polyhedron representing a stay-in region I encoded as a conjunction of linear equality constraints. Finally, the nonconvex functions in (36), (39), and (43) can be removed from the constraints and their correspond￾ing power and exponential cone-representable approximations used instead. These approximations enable expressing the problems as mixed-integer cone optimization programs and solving them effici… view at source ↗
Figure 4
Figure 4. Figure 4: 1000 Monte Carlo simulations of the state predictions at the first sampling instant, obtained using the best and worst feasible integer solutions. The plots show the prediction envelopes of the best integer solution Xmin (gray) and the worst integer solution Xmax (magenta). The results in each subplot correspond to different parameter ranges used to construct M(δ). −1 −0.5 0 0.5 −0.4 −0.2 0 0.2 x(m) y(m) T… view at source ↗
Figure 5
Figure 5. Figure 5: 100 Monte Carlo simulations of the performed trajectories in Case 1 (without obstacles). The vehicle navigates inside I (light green), from the initial state x0 = [0, −1.18, 0, 0.16]⊤, to T (dark green). As the vehicle’s initial position is close to the boundaries of I, a safer trajectory toward T involves moving away from these limits. of keeping a safe distance from the boundaries of I and O, which conse… view at source ↗
Figure 6
Figure 6. Figure 6: 100 Monte Carlo simulations of the performed trajectories in Case 2 (with obstacles). The vehicle navigates within I (light green), from the initial state x0 = [0, −1, 0, 0]⊤, toward T (dark green), while avoiding O (red). Larger weights on the risk allocation (S = diag (10, 10)) produce the trajectories shown with dark lines. Lower weights on the risk allocation (S = diag (1, 1)) produce the trajecto￾ries… view at source ↗
Figure 7
Figure 7. Figure 7: The time to solve the optimization problem at every sampling time in both cases. The solution times of the Inverse (blue), Root (yellow), and Logarithm (orange) probit approaches are compared to the exhaustive search method (dashed gray). Note the logarithm scale for the solution times in Case 2. constraints involving mutually exclusive binary variables mul￾tiplying Gaussian stochastic variables, that is, … view at source ↗
read the original abstract

Stochastic Model Predictive Control addresses uncertainties by incorporating chance constraints that provide probabilistic guarantees of constraint satisfaction. However, simultaneously optimizing over the risk allocation and the feedback policies leads to intractable nonconvex problems. This is due to (i) products of functions involving the feedback law and risk allocation in the deterministic counterpart of the chance constraints, and (ii) the presence of the nonconvex Gaussian quantile (probit) function. Existing methods rely on two-stage optimization, which is nonconvex. To address this, we derive disjunctive convex chance constraints and select the feedback law from a set of precomputed candidates. The inherited compositions of the probit function are replaced with power- and exponential-cone representable approximations. The main advantage is that the problem can be formulated as a mixed-integer conic optimization problem and efficiently solved with off-the-shelf software. Moreover, the proposed formulations apply to general chance constraints with products of exclusive disjunctive and Gaussian variables. The proposed approaches are validated with a path-planning application.

Editorial analysis

A structured set of objections, weighed in public.

Desk editor's note, referee report, simulated authors' rebuttal, and a circularity audit. Tearing a paper down is the easy half of reading it; the pith above is the substance, this is the friction.

Referee Report

3 major / 2 minor

Summary. The paper claims that simultaneous optimization of risk allocation and feedback policies in stochastic MPC leads to intractable nonconvex problems due to products involving feedback laws and the nonconvex probit function in chance constraints. It addresses this by deriving disjunctive convex chance constraints, restricting feedback selection to a finite set of precomputed candidates, and replacing probit compositions with power- and exponential-cone representable approximations. The resulting problem is cast as a mixed-integer conic program solvable with off-the-shelf solvers, with extensions to general chance constraints involving exclusive disjunctions and Gaussian variables, and validation on a path-planning application.

Significance. If the cone approximations are shown to be conservative or equipped with explicit error bounds that can be absorbed into the risk allocation, and if the finite feedback candidate set does not materially degrade closed-loop performance, the approach would provide a tractable, software-friendly method for online risk allocation in SMPC. This could be significant for applications requiring probabilistic guarantees under uncertainty, as it avoids two-stage nonconvex optimization while extending to broader classes of disjunctive-Gaussian chance constraints.

major comments (3)
  1. [Reformulation of chance constraints and cone approximations] The central claim relies on the probit approximations preserving the original chance-constraint violation probabilities. However, the manuscript provides no derivation of error bounds, no proof of outer-approximation conservatism, and no quantitative assessment of how approximation errors propagate into the risk allocation (see the reformulation steps following the derivation of disjunctive convex constraints). Without this, the solved MICP policies may violate the allocated risk levels in closed loop.
  2. [Feedback gain selection from precomputed candidates] Restricting the feedback law to a finite precomputed candidate set is presented as enabling convexity, but the paper does not quantify the resulting suboptimality gap relative to the unrestricted case or demonstrate that the candidate set is rich enough to achieve near-optimal performance for the path-planning example (see the section on feedback gain selection).
  3. [Numerical validation] The validation on the path-planning application reports successful solution times but provides no Monte Carlo closed-loop violation probability estimates or comparison against the true (non-approximated) chance-constraint satisfaction rates. This leaves the probabilistic guarantees unverified numerically.
minor comments (2)
  1. [Notation and problem formulation] Notation for the disjunctive variables and the mapping from feedback candidates to the chance-constraint reformulation could be clarified with an explicit table or diagram.
  2. [Abstract and introduction] The abstract states that the formulations 'apply to general chance constraints with products of exclusive disjunctive and Gaussian variables,' but the manuscript should include a brief remark on whether this requires additional assumptions on the disjunction structure.

Simulated Author's Rebuttal

3 responses · 0 unresolved

We thank the referee for the thorough and constructive review of our manuscript. We address each major comment point by point below, indicating where revisions will be made to strengthen the presentation and analysis.

read point-by-point responses
  1. Referee: The central claim relies on the probit approximations preserving the original chance-constraint violation probabilities. However, the manuscript provides no derivation of error bounds, no proof of outer-approximation conservatism, and no quantitative assessment of how approximation errors propagate into the risk allocation (see the reformulation steps following the derivation of disjunctive convex constraints). Without this, the solved MICP policies may violate the allocated risk levels in closed loop.

    Authors: We agree that the manuscript would benefit from an explicit treatment of approximation errors. The power- and exponential-cone approximations are constructed as conservative outer approximations of the probit function, which ensures that satisfaction of the approximated constraints implies satisfaction of the original chance constraints at the allocated risk level. In the revised manuscript we will add a dedicated subsection deriving the approximation error bounds and demonstrating how these bounds can be absorbed into the risk allocation by a conservative adjustment of the risk parameters. This will provide a rigorous guarantee that the MICP solutions remain probabilistically safe. revision: yes

  2. Referee: Restricting the feedback law to a finite precomputed candidate set is presented as enabling convexity, but the paper does not quantify the resulting suboptimality gap relative to the unrestricted case or demonstrate that the candidate set is rich enough to achieve near-optimal performance for the path-planning example (see the section on feedback gain selection).

    Authors: The finite candidate set is introduced to restore convexity while retaining the ability to optimize over feedback policies online. The candidates are drawn from standard linear feedback structures commonly used in stochastic control. For the path-planning example the resulting closed-loop trajectories satisfy all constraints and exhibit good performance. To address the suboptimality concern we will augment the revised manuscript with a quantitative comparison of closed-loop cost and feasibility against an expanded candidate set, thereby illustrating that the chosen set is sufficiently rich for the considered application. revision: yes

  3. Referee: The validation on the path-planning application reports successful solution times but provides no Monte Carlo closed-loop violation probability estimates or comparison against the true (non-approximated) chance-constraint satisfaction rates. This leaves the probabilistic guarantees unverified numerically.

    Authors: We concur that empirical verification of the probabilistic guarantees is important. In the revised version we will add Monte Carlo closed-loop simulations that estimate empirical violation probabilities for the obtained policies and compare these rates to the allocated risk levels. Where tractable, we will also include comparisons against the non-approximated (non-conic) formulation to quantify the effect of the cone approximations on realized safety. revision: yes

Circularity Check

0 steps flagged

No significant circularity; derivation remains self-contained

full rationale

The paper derives disjunctive convex chance constraints by reformulating products involving feedback laws and risk allocations, then replaces probit compositions with power- and exponential-cone approximations to obtain a mixed-integer conic program. These steps rely on standard convex relaxation techniques and cone representability results external to the paper; the finite candidate set for feedback gains is precomputed independently and does not reduce the claimed probabilistic guarantees to a tautology or fitted parameter defined by the authors' own prior outputs. No load-bearing self-citations, self-definitional loops, or renaming of known results appear in the derivation chain. The formulation is presented as a general method validated on a path-planning example, confirming independent content.

Axiom & Free-Parameter Ledger

0 free parameters · 1 axioms · 0 invented entities

The approach rests on standard domain assumptions in stochastic control but introduces new reformulation techniques whose correctness depends on approximation quality.

axioms (1)
  • domain assumption Disturbances follow a Gaussian distribution.
    Implicit in the use of the probit function and chance constraints throughout the abstract.

pith-pipeline@v0.9.0 · 5475 in / 1353 out tokens · 40434 ms · 2026-05-10T19:36:26.254890+00:00 · methodology

discussion (0)

Sign in with ORCID, Apple, or X to comment. Anyone can read and Pith papers without signing in.

Lean theorems connected to this paper

Citations machine-checked in the Pith Canon. Every link opens the source theorem in the public Lean library.

What do these tags mean?
matches
The paper's claim is directly supported by a theorem in the formal canon.
supports
The theorem supports part of the paper's argument, but the paper may add assumptions or extra steps.
extends
The paper goes beyond the formal theorem; the theorem is a base layer rather than the whole result.
uses
The paper appears to rely on the theorem as machinery.
contradicts
The paper's claim conflicts with a theorem or certificate in the canon.
unclear
Pith found a possible connection, but the passage is too broad, indirect, or ambiguous to say the theorem truly supports the claim.

Reference graph

Works this paper leans on

42 extracted references · 42 canonical work pages

  1. [1]

    Bemporad and M

    A. Bemporad and M. Morari,Robust model predictive control: A survey. Springer London, p. 207–226

  2. [2]

    Approximations of closed-loop minimax MPC,

    J. L ¨ofberg, “Approximations of closed-loop minimax MPC,” in42nd IEEE International Conference on Decision and Control. Maui, Hawaii: IEEE, 2003, p. 1438–1442

  3. [3]

    Optimization over state feedback policies for robust control with constraints,

    P. J. Goulart, E. C. Kerrigan, and J. M. Maciejowski, “Optimization over state feedback policies for robust control with constraints,”Automatica, vol. 42, no. 4, p. 523–533, Apr. 2006

  4. [4]

    Robust model predictive control using tubes,

    W. Langson, I. Chryssochoos, S. Rakovi ´c, and D. Mayne, “Robust model predictive control using tubes,”Automatica, vol. 40, no. 1, p. 125–133, Jan. 2004

  5. [5]

    Stochastic linear model predictive control with chance constraints – a review,

    M. Farina, L. Giulioni, and R. Scattolini, “Stochastic linear model predictive control with chance constraints – a review,”Journal of Process Control, vol. 44, p. 53–67, Aug. 2016

  6. [6]

    Theory and applications of robust optimization,

    D. Bertsimas, D. B. Brown, and C. Caramanis, “Theory and applications of robust optimization,”SIAM Review, vol. 53, no. 3, p. 464–501, Jan. 2011

  7. [7]

    The scenario approach for systems and control design,

    M. C. Campi, S. Garatti, and M. Prandini, “The scenario approach for systems and control design,”Annual Reviews in Control, vol. 33, no. 2, p. 149–157, Dec. 2009

  8. [8]

    A proba- bilistic particle-control approximation of chance-constrained stochastic predictive control,

    L. Blackmore, M. Ono, A. Bektassov, and B. C. Williams, “A proba- bilistic particle-control approximation of chance-constrained stochastic predictive control,”IEEE Transactions on Robotics, vol. 26, no. 3, p. 502–517, Jun. 2010

  9. [9]

    Tractable approximations to robust conic optimization problems,

    D. Bertsimas and M. Sim, “Tractable approximations to robust conic optimization problems,”Mathematical Programming, vol. 107, no. 1–2, p. 5–36, Dec. 2005

  10. [10]

    On distributionally robust chance- constrained linear programs,

    G. C. Calafiore and L. E. Ghaoui, “On distributionally robust chance- constrained linear programs,”Journal of Optimization Theory and Ap- plications, vol. 130, no. 1, p. 1–22, Dec. 2006

  11. [11]

    A probabilistic approach to optimal robust path planning with obstacles,

    L. Blackmore, H. Li, and B. Williams, “A probabilistic approach to optimal robust path planning with obstacles,” in2006 American Control Conference. IEEE, 2006, p. 7 pp

  12. [12]

    Convex approximations of chance constrained programs,

    A. Nemirovski and A. Shapiro, “Convex approximations of chance constrained programs,”SIAM Journal on Optimization, vol. 17, no. 4, p. 969–996, Jan. 2007

  13. [13]

    Convex chance constrained predictive control without sampling,

    L. Blackmore and M. Ono, “Convex chance constrained predictive control without sampling,” inAIAA Guidance, Navigation, and Control Conference. American Institute of Aeronautics and Astronautics, Jun. 2009

  14. [14]

    A distributionally robust optimization based method for stochastic model predictive control,

    B. Li, Y . Tan, A.-G. Wu, and G.-R. Duan, “A distributionally robust optimization based method for stochastic model predictive control,” IEEE Transactions on Automatic Control, vol. 67, no. 11, p. 5762–5776, Nov. 2022

  15. [15]

    Chance-constrained optimal path planning with obstacles,

    L. Blackmore, M. Ono, and B. C. Williams, “Chance-constrained optimal path planning with obstacles,”IEEE Transactions on Robotics, vol. 27, no. 6, p. 1080–1094, Dec. 2011

  16. [16]

    Stochastic model predictive control using simplified affine disturbance feedback for chance-constrained systems,

    J. Zhang and T. Ohtsuka, “Stochastic model predictive control using simplified affine disturbance feedback for chance-constrained systems,” IEEE Control Systems Letters, vol. 5, no. 5, p. 1633–1638, Nov. 2021

  17. [17]

    Safe high-performance au- tonomous off-road driving using covariance steering stochastic model predictive control,

    J. Knaup, K. Okamoto, and P. Tsiotras, “Safe high-performance au- tonomous off-road driving using covariance steering stochastic model predictive control,”IEEE Transactions on Control Systems Technology, vol. 31, no. 5, p. 2066–2081, Sep. 2023

  18. [18]

    Stochastic model predictive control with minimal constraint violation probability for time-variant chance constraints,

    M. Fink, D. Wollherr, and M. Leibold, “Stochastic model predictive control with minimal constraint violation probability for time-variant chance constraints,”IEEE Control Systems Letters, vol. 8, p. 1385–1390, 2024

  19. [19]

    Stochastic model predictive control with joint chance constraints,

    J. A. Paulson, E. A. Buehler, R. D. Braatz, and A. Mesbah, “Stochastic model predictive control with joint chance constraints,”International Journal of Control, vol. 93, no. 1, p. 126–139, May 2017

  20. [20]

    A self-triggered stochastic model predictive control for uncertain networked control system,

    H. Wang, J. Wang, H. Xu, and S. Zhao, “A self-triggered stochastic model predictive control for uncertain networked control system,”Inter- national Journal of Control, vol. 96, no. 8, p. 2113–2123, Jun. 2022

  21. [21]

    Stochastic model predictive control — how does it work?

    T. A. N. Heirung, J. A. Paulson, J. O’Leary, and A. Mesbah, “Stochastic model predictive control — how does it work?”Computers & Chemical Engineering, vol. 114, p. 158–170, Jun. 2018

  22. [22]

    Exponential cone approach to joint chance constraints in stochastic model predictive control,

    F. M. Barbosa and J. L ¨ofberg, “Exponential cone approach to joint chance constraints in stochastic model predictive control,”International Journal of Control, vol. 98, no. 12, p. 3024–3034, Apr. 2025

  23. [23]

    A tractable approximation of chance constrained stochastic mpc based on affine disturbance feed- back,

    F. Oldewurtel, C. N. Jones, and M. Morari, “A tractable approximation of chance constrained stochastic mpc based on affine disturbance feed- back,” in2008 47th IEEE Conference on Decision and Control. IEEE, 2008, p. 4731–4736

  24. [24]

    Stochastic receding horizon control with output feedback and bounded controls,

    P. Hokayem, E. Cinquemani, D. Chatterjee, F. Ramponi, and J. Lygeros, “Stochastic receding horizon control with output feedback and bounded controls,”Automatica, vol. 48, no. 1, p. 77–88, Jan. 2012

  25. [25]

    Iterative risk allocation: A new approach to robust model predictive control with a joint chance constraint,

    M. Ono and B. C. Williams, “Iterative risk allocation: A new approach to robust model predictive control with a joint chance constraint,” in 2008 47th IEEE Conference on Decision and Control. IEEE, 2008

  26. [26]

    On feedback design and risk allocation in chance constrained control,

    M. P. Vitus and C. J. Tomlin, “On feedback design and risk allocation in chance constrained control,” inIEEE Conference on Decision and Control and European Control Conference. IEEE, Dec. 2011, p. 734–739

  27. [27]

    Covariance steering with optimal risk allocation,

    J. Pilipovsky and P. Tsiotras, “Covariance steering with optimal risk allocation,”IEEE Transactions on Aerospace and Electronic Systems, vol. 57, no. 6, p. 3719–3733, Dec. 2021

  28. [28]

    Cones and interior-point algorithms for structured convex optimization involving powers and exponentials,

    R. Chares, “Cones and interior-point algorithms for structured convex optimization involving powers and exponentials,”UCL- Universit´e Catholique de Louvain., 2009. [Online]. Available: http: //hdl.handle.net/2078.1/28538

  29. [29]

    Algorithms for unsymmetric cone optimization and an implementation for problems with the exponential cone,

    S. A. Serrano, “Algorithms for unsymmetric cone optimization and an implementation for problems with the exponential cone,” Stanford University, 2015. [Online]. Available: https://purl.stanford.edu/ sn367tt9726

  30. [30]

    Conic optimization via operator splitting and homogeneous self-dual embedding,

    B. O’Donoghue, E. Chu, N. Parikh, and S. Boyd, “Conic optimization via operator splitting and homogeneous self-dual embedding,”Journal of Optimization Theory and Applications, vol. 169, no. 3, p. 1042–1068, Feb. 2016. BARBOSA AND L ¨OFBERG: STOCHASTIC MODEL PREDICTIVE CONTROL WITH ONLINE RISK ALLOCATION AND FEEDBACK GAIN SELECTION 13

  31. [31]

    A primal-dual interior-point algorithm for nonsymmetric exponential-cone optimization,

    J. Dahl and E. D. Andersen, “A primal-dual interior-point algorithm for nonsymmetric exponential-cone optimization,”Mathematical Program- ming, vol. 194, no. 1–2, p. 341–370, Mar. 2021

  32. [32]

    Self-scaled barriers and interior- point methods for convex programming,

    Y . E. Nesterov and M. J. Todd, “Self-scaled barriers and interior- point methods for convex programming,”Mathematics of Operations Research, vol. 22, no. 1, p. 1–42, Feb. 1997

  33. [33]

    Primal-dual interior-point methods for self-scaled cones,

    ——, “Primal-dual interior-point methods for self-scaled cones,”SIAM Journal on Optimization, vol. 8, no. 2, p. 324–364, May 1998

  34. [34]

    Generalization of primal-dual interior-point methods to convex optimization problems in conic form,

    L. Tunc ¸el, “Generalization of primal-dual interior-point methods to convex optimization problems in conic form,”F oundations of Compu- tational Mathematics, vol. 1, no. 3, p. 229–254, Jul. 2001

  35. [35]

    Chance-constrained model predictive control,

    A. T. Schwarm and M. Nikolaou, “Chance-constrained model predictive control,”AIChE Journal, vol. 45, no. 8, p. 1743–1752, Aug. 1999

  36. [36]

    Branch- and-bound algorithms: A survey of recent advances in searching, branch- ing, and pruning,

    D. R. Morrison, S. H. Jacobson, J. J. Sauppe, and E. C. Sewell, “Branch- and-bound algorithms: A survey of recent advances in searching, branch- ing, and pruning,”Discrete Optimization, vol. 19, p. 79–102, Feb. 2016

  37. [37]

    MOSEK Modeling Cookbook,

    MOSEKApS, “MOSEK Modeling Cookbook,” 2025. [Online]. Available: https://docs.mosek.com/modeling-cookbook/index.html

  38. [38]

    Mezo,The Lambert W Function: Its Generalizations and Applications

    I. Mezo,The Lambert W Function: Its Generalizations and Applications. Chapman and Hall/CRC, Mar. 2022

  39. [39]

    Mixed- integer programming in motion planning,

    D. Ioan, I. Prodan, S. Olaru, F. Stoican, and S.-I. Niculescu, “Mixed- integer programming in motion planning,”Annual Reviews in Control, vol. 51, p. 65–87, 2021

  40. [40]

    Mixed integer programming for multi-vehicle path planning,

    T. Schouwenaars, B. De Moor, E. Feron, and J. How, “Mixed integer programming for multi-vehicle path planning,” in2001 European Con- trol Conference (ECC). IEEE, Sep. 2001

  41. [41]

    Yalmip : A toolbox for modeling and optimization in matlab,

    J. L ¨ofberg, “Yalmip : A toolbox for modeling and optimization in matlab,” inIn Proceedings of the CACSD Conference, Taipei, Taiwan, 2004

  42. [42]

    The matrix cookbook,

    K. B. Petersen, M. S. Pedersenet al., “The matrix cookbook,”Technical University of Denmark, Nov. 2012. Filipe Marques Barbosareceived the B.Sc. degree in electrical engineering from the Federal University of Uberl ˆandia, Brazil, in 2016, and the M.Sc. degree in dynamical systems from the University of S ˜ao Paulo, Brazil, in 2018. He is currently workin...