Optimization Based Planner–Tracker Design for Safety Guarantees

We present a safe-by-design approach to path planning and control for nonlinear systems. The planner uses a low fidelity model of the plant to compute reference trajectories by solving an MPC problem, while the plant being controlled utilizes a feedback control law that tracks those trajectories with an upper-bound on the tracking error. Our main goal is to allow for maximum permissiveness (that is, room for constraint feasibility) of the planner, while maintaining safety after accounting for the tracking error bound. We achieve this by parametrizing the state and input constraints imposed on the planner and deriving corresponding parametrized tracking control laws and tracking error bounds, which are computed offline through Sum-of-Squares programming. The parameters are then optimally chosen to maximize planner permissiveness, while guaranteeing safety.

[1]  David González,et al.  A Review of Motion Planning Techniques for Automated Vehicles , 2016, IEEE Transactions on Intelligent Transportation Systems.

[2]  Marco Pavone,et al.  Robust online motion planning via contraction theory and convex optimization , 2017, 2017 IEEE International Conference on Robotics and Automation (ICRA).

[3]  Murat Arcak,et al.  Continuous Abstraction of Nonlinear Systems using Sum-of-Squares Programming , 2019, 2019 IEEE 58th Conference on Decision and Control (CDC).

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

[5]  Ryan Feeley,et al.  Some controls applications of sum of squares programming , 2003, 42nd IEEE International Conference on Decision and Control (IEEE Cat. No.03CH37475).

[6]  Peter Seiler,et al.  SOSOPT: A Toolbox for Polynomial Optimization , 2013, ArXiv.

[7]  Stephen P. Boyd,et al.  Convex Optimization , 2004, Algorithms and Theory of Computation Handbook.

[8]  Ian R. Manchester,et al.  LQR-trees: Feedback Motion Planning via Sums-of-Squares Verification , 2010, Int. J. Robotics Res..

[9]  M. Kothare,et al.  Robust constrained model predictive control using linear matrix inequalities , 1994, Proceedings of 1994 American Control Conference - ACC '94.

[10]  Frank Allgöwer,et al.  A Computationally Efficient Robust Model Predictive Control Framework for Uncertain Nonlinear Systems , 2019, IEEE Transactions on Automatic Control.

[11]  Mo Chen,et al.  Robust Tracking with Model Mismatch for Fast and Safe Planning: an SOS Optimization Approach , 2018, WAFR.

[12]  Ravi N. Banavar,et al.  Discrete Optimal Control of Interconnected Mechanical Systems , 2018, ArXiv.

[13]  Rolf Findeisen,et al.  Homothetic tube model predictive control , 2012, Autom..

[14]  D. Mayne,et al.  Robust receding horizon control of constrained nonlinear systems , 1993, IEEE Trans. Autom. Control..

[15]  Matthew Johnson-Roberson,et al.  Bridging the gap between safety and real-time performance in receding-horizon trajectory design for mobile robots , 2018, Int. J. Robotics Res..

[16]  Nikolai Matni,et al.  On the Sample Complexity of the Linear Quadratic Regulator , 2017, Foundations of Computational Mathematics.

[17]  Torsten Koller,et al.  Learning-based Model Predictive Control for Safe Exploration and Reinforcement Learning , 2019, ArXiv.

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

[19]  Majid Zamani,et al.  Approximate abstractions of control systems with an application to aggregation , 2018, Autom..

[20]  Peter Seiler,et al.  Backward Reachability for Polynomial Systems on A Finite Horizon , 2019, ArXiv.

[21]  Mo Chen,et al.  FaSTrack: A modular framework for fast and guaranteed safe motion planning , 2017, 2017 IEEE 56th Annual Conference on Decision and Control (CDC).

[22]  P. Parrilo.  Structured semidefinite programs and semialgebraic geometry methods in robustness and optimization , 2000 .

[23]  Emilio Frazzoli,et al.  A Survey of Motion Planning and Control Techniques for Self-Driving Urban Vehicles , 2016, IEEE Transactions on Intelligent Vehicles.

[24]  Andrew Packard,et al.  Control Applications of Sum of Squares Programming , 2005 .

[25]  Colin Neil Jones,et al.  Convex Computation of the Maximum Controlled Invariant Set For Polynomial Control Systems , 2013, SIAM J. Control. Optim..

[26]  Stefano Di Cairano,et al.  Reference Tracking With Guaranteed Error Bound for Constrained Linear Systems , 2016, IEEE Transactions on Automatic Control.

[27]  Basil Kouvaritakis,et al.  Model Predictive Control: Classical, Robust and Stochastic , 2015 .

[28]  David Q. Mayne,et al.  Robust model predictive control using tubes , 2004, Autom..