The Mixed-Observable Constrained Linear Quadratic Regulator Problem: the Exact Solution and Practical Algorithms

This paper studies the problem of steering a linear time-invariant system subject to state and input constraints towards a goal location that may be inferred only through partial observations. We assume mixed-observable settings, where the system’s state is fully observable and the environment’s state defining the goal location is only partially observed. In these settings, the planning problem is an infinite-dimensional optimization problem where the objective is to minimize the expected cost. We show how to reformulate the control problem as a finite-dimensional deterministic problem by optimizing over a trajectory tree. Leveraging this result, we demonstrate that when the environment is static, the observation model piecewise, and cost function convex, the original control problem can be reformulated as a Mixed-Integer Convex Program (MICP) that can be solved to global optimality using a branchand-bound algorithm. The effectiveness of the proposed approach is demonstrated on navigation tasks, where the system has to reach a goal location identified from partial observations.

[1]  Mario Zanon,et al.  A Robust Scenario MPC Approach for Uncertain Multi-Modal Obstacles , 2021, IEEE Control Systems Letters.

[2]  Lorenz T. Biegler,et al.  Fast nonlinear model predictive control: Formulation and industrial process applications , 2013, Comput. Chem. Eng..

[3]  Jay H. Lee,et al.  Model predictive control: past, present and future , 1999 .

[4]  Lei Feng,et al.  Safe Stop Trajectory Planning for Highly Automated Vehicles: An Optimal Control Problem Formulation , 2018, 2018 IEEE Intelligent Vehicles Symposium (IV).

[5]  Alberto Bemporad,et al.  From linear to nonlinear MPC: bridging the gap via the real-time iteration , 2020, Int. J. Control.

[6]  Stephen P. Boyd,et al.  CVXPY: A Python-Embedded Modeling Language for Convex Optimization , 2016, J. Mach. Learn. Res..

[7]  Colin N. Jones,et al.  Data-driven methods for building control — A review and promising future directions , 2020 .

[8]  Luigi Chisci,et al.  Systems with persistent disturbances: predictive control with restricted constraints , 2001, Autom..

[9]  Paulo Tabuada,et al.  Control Barrier Function Based Quadratic Programs for Safety Critical Systems , 2016, IEEE Transactions on Automatic Control.

[10]  Alberto Bemporad,et al.  Model Predictive Control (MPC) for Enhancing Building and HVAC System Energy Efficiency: Problem Formulation, Applications and Opportunities , 2018 .

[11]  Eric C. Kerrigan,et al.  Optimization over state feedback policies for robust control with constraints , 2006, Autom..

[12]  Frank Allgöwer,et al.  Tube MPC scheme based on robust control invariant set with application to Lipschitz nonlinear systems , 2011, CDC/ECC.

[13]  Manfred Morari,et al.  Model predictive control: Theory and practice - A survey , 1989, Autom..

[14]  Stephen P. Boyd,et al.  Fast Model Predictive Control Using Online Optimization , 2010, IEEE Transactions on Control Systems Technology.

[15]  Francesco Borrelli,et al.  Predictive Active Steering Control for Autonomous Vehicle Systems , 2007, IEEE Transactions on Control Systems Technology.

[16]  Alberto Bemporad,et al.  An Algorithm for Approximate Multiparametric Convex Programming , 2006, Comput. Optim. Appl..

[17]  J. Christian Gerdes,et al.  Contingency Model Predictive Control for Linear Time-Varying Systems , 2021, ArXiv.

[18]  David Hsu,et al.  POMDPs for robotic tasks with mixed observability , 2009, Robotics: Science and Systems.

[19]  David Q. Mayne,et al.  Robust output feedback model predictive control of constrained linear systems , 2006, Autom..

[20]  Manfred Morari,et al.  Embedded Online Optimization for Model Predictive Control at Megahertz Rates , 2013, IEEE Transactions on Automatic Control.

[21]  Eduardo F. Camacho,et al.  Output feedback Robust tube based MPC for tracking of piece-wise constant references , 2007, 2007 46th IEEE Conference on Decision and Control.

[22]  Basil Kouvaritakis,et al.  Robust Tube MPC for Linear Systems With Multiplicative Uncertainty , 2015, IEEE Transactions on Automatic Control.

[23]  Stefano Di Cairano,et al.  The development of Model Predictive Control in automotive industry: A survey , 2012, 2012 IEEE International Conference on Control Applications.

[24]  J. Christian Gerdes,et al.  Contingency Model Predictive Control for Automated Vehicles , 2019, 2019 American Control Conference (ACC).

[25]  F. Allgöwer,et al.  Nonlinear Model Predictive Control: From Theory to Application , 2004 .

[26]  Basil Kouvaritakis,et al.  Stochastic tube MPC with state estimation , 2012, Autom..

[27]  Nikolai Matni,et al.  A System-Level Approach to Controller Synthesis , 2016, IEEE Transactions on Automatic Control.

[28]  John Lygeros,et al.  Racing miniature cars: Enhancing performance using Stochastic MPC and disturbance feedback , 2017, 2017 American Control Conference (ACC).

[29]  Alberto Bemporad,et al.  Control of systems integrating logic, dynamics, and constraints , 1999, Autom..

[30]  David Q. Mayne,et al.  Constrained model predictive control: Stability and optimality , 2000, Autom..

[31]  D. Mayne,et al.  Min-max feedback model predictive control for constrained linear systems , 1998, IEEE Trans. Autom. Control..

[32]  David Q. Mayne,et al.  Robust model predictive control of constrained linear systems with bounded disturbances , 2005, Autom..

[33]  A. Ben-Tal,et al.  Adjustable robust solutions of uncertain linear programs , 2004, Math. Program..

[34]  Alberto Bemporad,et al.  Predictive Control for Linear and Hybrid Systems , 2017 .

[35]  Alberto Bemporad,et al.  Risk-averse model predictive control , 2017, Autom..

[36]  Moritz Diehl,et al.  Recent Advances in Quadratic Programming Algorithms for Nonlinear Model Predictive Control , 2018, Vietnam Journal of Mathematics.

[37]  Paulo Tabuada,et al.  Control Barrier Functions: Theory and Applications , 2019, 2019 18th European Control Conference (ECC).

[38]  Alberto Bemporad,et al.  A Numerically Robust Mixed-Integer Quadratic Programming Solver for Embedded Hybrid Model Predictive Control , 2018 .

[39]  Bo Wahlberg,et al.  Experimental validation of model predictive control stability for autonomous driving , 2018 .

[40]  Yang Wang,et al.  Fast Model Predictive Control Using Online Optimization , 2008 .