Parallel Explicit Tube Model Predictive Control · Parallel Explicit Tube MPC Controller (Recursive...

46
Parallel Explicit Tube Model Predictive Control Kai Wang 1 , Yuning Jiang 1 , Juraj Oravec 2 , Mario E. Villanueva 1 , Boris Houska 1 1 ShanghaiTech University 2 Slovak University of Technology in Bratislava 1/19

Transcript of Parallel Explicit Tube Model Predictive Control · Parallel Explicit Tube MPC Controller (Recursive...

Page 1: Parallel Explicit Tube Model Predictive Control · Parallel Explicit Tube MPC Controller (Recursive Feasibility) Parallel Explicit Tube MPC Controller (Stability) 15/19 Theorem 1

Parallel ExplicitTube Model Predictive Control

Kai Wang1, Yuning Jiang1, Juraj Oravec2, Mario E. Villanueva1,

Boris Houska1

1ShanghaiTech University

2Slovak University of Technology in Bratislava

1/19

Page 2: Parallel Explicit Tube Model Predictive Control · Parallel Explicit Tube MPC Controller (Recursive Feasibility) Parallel Explicit Tube MPC Controller (Stability) 15/19 Theorem 1

Overview

Background on Tube MPC

2/19

Model Predictive Control (MPC)

Rigid Tube MPC

Contribution

Parallel Real-time Optimization Algorithm

Numerical Example

Robust MPC

Parallel Explicit Tube MPC Controller

Page 3: Parallel Explicit Tube Model Predictive Control · Parallel Explicit Tube MPC Controller (Recursive Feasibility) Parallel Explicit Tube MPC Controller (Stability) 15/19 Theorem 1

Model Predictive Control (MPC)

3/19

GoalObstacles

Uncertain Control System:

Page 4: Parallel Explicit Tube Model Predictive Control · Parallel Explicit Tube MPC Controller (Recursive Feasibility) Parallel Explicit Tube MPC Controller (Stability) 15/19 Theorem 1

Model Predictive Control (MPC)

3/19

Minimize distance to the dotted line

Subject to: System dynamics

State and input constraints

Uncertain Control System:

Certainty equivalent MPC:

Page 5: Parallel Explicit Tube Model Predictive Control · Parallel Explicit Tube MPC Controller (Recursive Feasibility) Parallel Explicit Tube MPC Controller (Stability) 15/19 Theorem 1

Model Predictive Control (MPC)

3/19

wait for new measurement

re-optimize the trajectory

Repeat:

apply optimal control law

Page 6: Parallel Explicit Tube Model Predictive Control · Parallel Explicit Tube MPC Controller (Recursive Feasibility) Parallel Explicit Tube MPC Controller (Stability) 15/19 Theorem 1

Model Predictive Control (MPC)

3/19

Problem:

certainty equivalent prediction is optimistic

infeasible (worst-case) scenarios possible

Page 7: Parallel Explicit Tube Model Predictive Control · Parallel Explicit Tube MPC Controller (Recursive Feasibility) Parallel Explicit Tube MPC Controller (Stability) 15/19 Theorem 1

4/19

What is Robust MPC?

Main idea:

take all possible uncertainty scenarios into account

design tailored feedback policies to react to uncertainties

Limitations:

exponential number of scenarios

much more expensive than certainty equivalent MPC

Page 8: Parallel Explicit Tube Model Predictive Control · Parallel Explicit Tube MPC Controller (Recursive Feasibility) Parallel Explicit Tube MPC Controller (Stability) 15/19 Theorem 1

4/19

Main idea:

take all possible uncertainty scenarios into account

design tailored feedback policies to react to uncertainties

What is Robust MPC?

Limitations:

exponential number of scenarios

much more expensive than certainty equivalent MPC

Page 9: Parallel Explicit Tube Model Predictive Control · Parallel Explicit Tube MPC Controller (Recursive Feasibility) Parallel Explicit Tube MPC Controller (Stability) 15/19 Theorem 1

5/19

Main idea:

enclose all trajectories by a tube of constant polytopic cross-sections

optimize the central path of the tube

Rigid Tube MPC

Page 10: Parallel Explicit Tube Model Predictive Control · Parallel Explicit Tube MPC Controller (Recursive Feasibility) Parallel Explicit Tube MPC Controller (Stability) 15/19 Theorem 1

5/19

Main idea:

enclose all trajectories by a tube of constant polytopic cross-sections

optimize the central path of the tube

Rigid Tube MPC

Page 11: Parallel Explicit Tube Model Predictive Control · Parallel Explicit Tube MPC Controller (Recursive Feasibility) Parallel Explicit Tube MPC Controller (Stability) 15/19 Theorem 1

5/19

Main idea:

enclose all trajectories by a tube of constant polytopic cross-sections

optimize the central path of the tube

Rigid Tube MPC

Page 12: Parallel Explicit Tube Model Predictive Control · Parallel Explicit Tube MPC Controller (Recursive Feasibility) Parallel Explicit Tube MPC Controller (Stability) 15/19 Theorem 1

5/19

Main idea:

enclose all trajectories by a tube of constant polytopic cross-sections

optimize the central path of the tube

Rigid Tube MPC

Page 13: Parallel Explicit Tube Model Predictive Control · Parallel Explicit Tube MPC Controller (Recursive Feasibility) Parallel Explicit Tube MPC Controller (Stability) 15/19 Theorem 1

6/19

Mathematical Formulation of Rigid Tube MPC

Uncertain control system:

Constraints:

Linear feedback law:

Nominal system: (disturbance-free)

and

denotes a precomputed robust invariant set, w.r.t.,

Page 14: Parallel Explicit Tube Model Predictive Control · Parallel Explicit Tube MPC Controller (Recursive Feasibility) Parallel Explicit Tube MPC Controller (Stability) 15/19 Theorem 1

6/19

Mathematical Formulation of Rigid Tube MPC

Uncertain control system:

Constraints:

Linear feedback law:

Nominal system: (disturbance-free)

and

denotes a precomputed robust invariant set, w.r.t.,

Page 15: Parallel Explicit Tube Model Predictive Control · Parallel Explicit Tube MPC Controller (Recursive Feasibility) Parallel Explicit Tube MPC Controller (Stability) 15/19 Theorem 1

7/19

Mathematical Formulation of Rigid Tube MPC

Optimal Control Problem (OCP):

stage cost:

terminal cost:

and are symmetric positivedefinite

Standard assumptions:

terminal constraint set

Page 16: Parallel Explicit Tube Model Predictive Control · Parallel Explicit Tube MPC Controller (Recursive Feasibility) Parallel Explicit Tube MPC Controller (Stability) 15/19 Theorem 1

7/19

Mathematical Formulation of Rigid Tube MPC

Optimal Control Problem (OCP):

stage cost:

terminal cost:

and are symmetric positivedefinite

Standard assumptions:

terminal constraint set

Page 17: Parallel Explicit Tube Model Predictive Control · Parallel Explicit Tube MPC Controller (Recursive Feasibility) Parallel Explicit Tube MPC Controller (Stability) 15/19 Theorem 1

7/19

Mathematical Formulation of Rigid Tube MPC

Optimal Control Problem (OCP):

stage cost:

terminal cost:

and are symmetric positivedefinite

Standard assumptions:

terminal constraint set

Page 18: Parallel Explicit Tube Model Predictive Control · Parallel Explicit Tube MPC Controller (Recursive Feasibility) Parallel Explicit Tube MPC Controller (Stability) 15/19 Theorem 1

Overview

Background on Tube MPC

8/19

Robust Model Predictive Control (MPC)

Rigid Tube MPC

Contribution

Parallel Real-time Optimization Algorithm

Numerical Example

Tube-Based Robust MPC

Parallel Explicit Tube MPC Scheme

Goal: develop a real-time Tube MPC algorithm with limited memory footprint

Page 19: Parallel Explicit Tube Model Predictive Control · Parallel Explicit Tube MPC Controller (Recursive Feasibility) Parallel Explicit Tube MPC Controller (Stability) 15/19 Theorem 1

Overview

Background on Tube MPC

8/19

Robust Model Predictive Control (MPC)

Rigid Tube MPC

Contribution

Parallel Real-time Optimization Algorithm

Numerical Example

Tube-Based Robust MPC

Parallel Explicit Tube MPC Scheme

Goal: develop a real-time Tube MPC algorithm with limited memory footprint

Page 20: Parallel Explicit Tube Model Predictive Control · Parallel Explicit Tube MPC Controller (Recursive Feasibility) Parallel Explicit Tube MPC Controller (Stability) 15/19 Theorem 1

9/19

Rewrite the OCP of the Rigid Tube MPC

Stacked vectors and matrices

Constraint sets

Cost function

Page 21: Parallel Explicit Tube Model Predictive Control · Parallel Explicit Tube MPC Controller (Recursive Feasibility) Parallel Explicit Tube MPC Controller (Stability) 15/19 Theorem 1

9/19

Rewrite the OCP of the Rigid Tube MPC

Stacked vectors and matrices

Constraint sets

Cost function

Page 22: Parallel Explicit Tube Model Predictive Control · Parallel Explicit Tube MPC Controller (Recursive Feasibility) Parallel Explicit Tube MPC Controller (Stability) 15/19 Theorem 1

9/19

Rewrite the OCP of the Rigid Tube MPC

Stacked vectors and matrices

Constraint sets

Cost function

Page 23: Parallel Explicit Tube Model Predictive Control · Parallel Explicit Tube MPC Controller (Recursive Feasibility) Parallel Explicit Tube MPC Controller (Stability) 15/19 Theorem 1

9/19

Rewrite the OCP of the Rigid Tube MPC

Stacked vectors and matrices

Constraint sets

Cost function

Page 24: Parallel Explicit Tube Model Predictive Control · Parallel Explicit Tube MPC Controller (Recursive Feasibility) Parallel Explicit Tube MPC Controller (Stability) 15/19 Theorem 1

9/19

Rewrite the OCP of the Rigid Tube MPC

Constraint sets

Cost function

Stacked vectors and matrices

equivalent

Page 25: Parallel Explicit Tube Model Predictive Control · Parallel Explicit Tube MPC Controller (Recursive Feasibility) Parallel Explicit Tube MPC Controller (Stability) 15/19 Theorem 1

10/19

Parallel Real-time Optimization Algorithm (Coupled QP)

Main idea:

problem approximates without needing inequality constraints

for problems and are equivalent

problem can be solved efficiently using a sparse linear algebra solver

Unconstrained auxiliary optimization problem:

Page 26: Parallel Explicit Tube Model Predictive Control · Parallel Explicit Tube MPC Controller (Recursive Feasibility) Parallel Explicit Tube MPC Controller (Stability) 15/19 Theorem 1

10/19

Parallel Real-time Optimization Algorithm (Coupled QP)

Main idea:

problem approximates without needing inequality constraints

for problems and are equivalent

problem can be solved efficiently using a sparse linear algebra solver

Unconstrained auxiliary optimization problem:

Page 27: Parallel Explicit Tube Model Predictive Control · Parallel Explicit Tube MPC Controller (Recursive Feasibility) Parallel Explicit Tube MPC Controller (Stability) 15/19 Theorem 1

11/19

Parallel Real-time Optimization Algorithm (Decoupled QPs)

Augmented Lagrangian optimization problem:

strictly convex quadraticprograms

current approximations, and

Notice that has a separable structure :

Page 28: Parallel Explicit Tube Model Predictive Control · Parallel Explicit Tube MPC Controller (Recursive Feasibility) Parallel Explicit Tube MPC Controller (Stability) 15/19 Theorem 1

11/19

Parallel Real-time Optimization Algorithm (Decoupled QPs)

Augmented Lagrangian optimization problem:

strictly convex quadraticprograms

current approximations, and

Notice that has a separable structure :

Page 29: Parallel Explicit Tube Model Predictive Control · Parallel Explicit Tube MPC Controller (Recursive Feasibility) Parallel Explicit Tube MPC Controller (Stability) 15/19 Theorem 1

Parallel Real-time Optimization Algorithm (Decoupled QPs)

12/19

Page 30: Parallel Explicit Tube Model Predictive Control · Parallel Explicit Tube MPC Controller (Recursive Feasibility) Parallel Explicit Tube MPC Controller (Stability) 15/19 Theorem 1

Parallel Real-time Optimization Algorithm (Decoupled QPs)

using multi-parametric quadratic programming

pre-compute threesolution maps

12/19

The memory requirements do not depend on the prediction horizon

Page 31: Parallel Explicit Tube Model Predictive Control · Parallel Explicit Tube MPC Controller (Recursive Feasibility) Parallel Explicit Tube MPC Controller (Stability) 15/19 Theorem 1

Parallel Real-time Optimization Algorithm (Decoupled QPs)

using multi-parametric quadratic programming

pre-compute threesolution maps

12/19

The memory requirements do not depend on the prediction horizon

Page 32: Parallel Explicit Tube Model Predictive Control · Parallel Explicit Tube MPC Controller (Recursive Feasibility) Parallel Explicit Tube MPC Controller (Stability) 15/19 Theorem 1

Parallel Real-time Optimization Algorithm

Step1: input

Step2: compute using decoupled QPs

Step3: set

Step4: update next iterate using coupled QP:

End

For

Optimization Algorithm:

13/19

Page 33: Parallel Explicit Tube Model Predictive Control · Parallel Explicit Tube MPC Controller (Recursive Feasibility) Parallel Explicit Tube MPC Controller (Stability) 15/19 Theorem 1

Parallel Real-time Optimization Algorithm

Step1: input

Step2: compute using decoupled QPs

Step3: set

Step4: update next iterate using coupled QP:

End

For

Optimization Algorithm:

13/19

Page 34: Parallel Explicit Tube Model Predictive Control · Parallel Explicit Tube MPC Controller (Recursive Feasibility) Parallel Explicit Tube MPC Controller (Stability) 15/19 Theorem 1

Parallel Real-time Optimization Algorithm

Step1: input

Step2: compute using decoupled QPs

Step3: set

Step4: update next iterate using coupled QP:

End

For

Optimization Algorithm:

13/19

Page 35: Parallel Explicit Tube Model Predictive Control · Parallel Explicit Tube MPC Controller (Recursive Feasibility) Parallel Explicit Tube MPC Controller (Stability) 15/19 Theorem 1

Parallel Real-time Optimization Algorithm

The algorithm converges linearly:

Step1: input

Step2: compute using decoupled QPs

Step3: set

Step4: update next iterate using coupled QP:

End

For

Optimization Algorithm:

13/19

Page 36: Parallel Explicit Tube Model Predictive Control · Parallel Explicit Tube MPC Controller (Recursive Feasibility) Parallel Explicit Tube MPC Controller (Stability) 15/19 Theorem 1

Parallel Explicit Tube MPC Controller

update the OCPcurrent state measurement

proposedoptimization algorithm

14/19

initial guess

re-scaling

Page 37: Parallel Explicit Tube Model Predictive Control · Parallel Explicit Tube MPC Controller (Recursive Feasibility) Parallel Explicit Tube MPC Controller (Stability) 15/19 Theorem 1

Parallel Explicit Tube MPC Controller

update the OCP

uncertain dynamic system

current state measurement

proposedoptimization algorithm

sub-optimal solution

14/19

initial guess

re-scaling

Page 38: Parallel Explicit Tube Model Predictive Control · Parallel Explicit Tube MPC Controller (Recursive Feasibility) Parallel Explicit Tube MPC Controller (Stability) 15/19 Theorem 1

Parallel Explicit Tube MPC Controller

update the OCP

uncertain dynamic system

current state measurement

proposedoptimization algorithm

shift horizon

update

sub-optimal solution

14/19

initial guess

re-scaling

Page 39: Parallel Explicit Tube Model Predictive Control · Parallel Explicit Tube MPC Controller (Recursive Feasibility) Parallel Explicit Tube MPC Controller (Stability) 15/19 Theorem 1

update the OCP

uncertain dynamic system

current state measurement

proposedoptimization algorithm

shift horizon

update

sub-optimal solution

14/19

initial guess

re-scaling

Recursive Feasibility

we assume that the state constant set to be robust control invariant, the subop-timal solution preserves the recursive feasibility

Parallel Explicit Tube MPC Controller (Recursive Feasibility)

Page 40: Parallel Explicit Tube Model Predictive Control · Parallel Explicit Tube MPC Controller (Recursive Feasibility) Parallel Explicit Tube MPC Controller (Stability) 15/19 Theorem 1

Parallel Explicit Tube MPC Controller (Stability)

15/19

Theorem 1

If the number of inner loops in the proposed optimization algorithm satisfies

the proposed scheme yields an asymptotically stable closed-loop controller.

linear convergence rate

satisfy the inequality

satisfies the inequality

Page 41: Parallel Explicit Tube Model Predictive Control · Parallel Explicit Tube MPC Controller (Recursive Feasibility) Parallel Explicit Tube MPC Controller (Stability) 15/19 Theorem 1

Numerical Example

16/19

Double integrator example:

Disturbance set:

State and input constraint:

Matrices:

Page 42: Parallel Explicit Tube Model Predictive Control · Parallel Explicit Tube MPC Controller (Recursive Feasibility) Parallel Explicit Tube MPC Controller (Stability) 15/19 Theorem 1

Numerical Example (Memory Requirements)

17/19

Explicit Tube MPCParallel Explicit Tube MPC

VS

Page 43: Parallel Explicit Tube Model Predictive Control · Parallel Explicit Tube MPC Controller (Recursive Feasibility) Parallel Explicit Tube MPC Controller (Stability) 15/19 Theorem 1

Numerical Example (Runtime Performance)

18/19

CPU Time [s]

On-line Centralized Tube MPC (qpOASES)

Parallel Explicit Tube MPC

Page 44: Parallel Explicit Tube Model Predictive Control · Parallel Explicit Tube MPC Controller (Recursive Feasibility) Parallel Explicit Tube MPC Controller (Stability) 15/19 Theorem 1

Summary

Derived a real-time and parallelizable Tube MPC scheme

Conclusions:

Maintained recursive feasibility and stability

Future work:

Implementation on the embedded applications

Extension to nonlinear systems

19/19

Reduced the storage of Explicit MPC by orders of magnitude

Page 45: Parallel Explicit Tube Model Predictive Control · Parallel Explicit Tube MPC Controller (Recursive Feasibility) Parallel Explicit Tube MPC Controller (Stability) 15/19 Theorem 1

Summary

Derived a real-time and parallelizable Tube MPC scheme

Conclusions:

Maintained recursive feasibility and stability

Future work:

Implementation on the embedded applications

Extension to nonlinear systems

19/19

Reduced the storage of Explicit MPC by orders of magnitude

Page 46: Parallel Explicit Tube Model Predictive Control · Parallel Explicit Tube MPC Controller (Recursive Feasibility) Parallel Explicit Tube MPC Controller (Stability) 15/19 Theorem 1

Summary

Derived a real-time and parallelizable Tube MPC scheme

Conclusions:

Maintained recursive feasibility and stability

Future work:

Implementation on the embedded applications

Extension to nonlinear systems

Contact: [email protected]

Thank you! Questions?

19/19

Reduced the storage of Explicit MPC by orders of magnitude