Nonlinear Model Predictive Control of Robotic Systems with Control Lyapunov Functions

The theoretical unification of Nonlinear Model Predictive Control (NMPC) with Control Lyapunov Functions (CLFs) provides a framework for achieving optimal control performance while ensuring stability guarantees. In this paper we present the first real-time realization of a unified NMPC and CLF controller on a robotic system with limited computational resources. These limitations motivate a set of approaches for efficiently incorporating CLF stability constraints into a general NMPC formulation. We evaluate the performance of the proposed methods compared to baseline CLF and NMPC controllers with a robotic Segway platform both in simulation and on hardware. The addition of a prediction horizon provides a performance advantage over CLF based controllers, which operate optimally point-wise in time. Moreover, the explicitly imposed stability constraints remove the need for difficult cost function and parameter tuning required by NMPC. Therefore the unified controller improves the performance of each isolated controller and simplifies the overall design process.

[1]  S. Sastry.  Nonlinear Systems: Analysis, Stability, and Control , 1999 .

[2]  Aaron D. Ames,et al.  Continuity and smoothness properties of nonlinear optimization-based feedback controllers , 2015, 2015 54th IEEE Conference on Decision and Control (CDC).

[3]  Dragan Nesic,et al.  Model Predictive Control for Nonlinear Sampled-Data Systems , 2007 .

[4]  Dragan Nesic,et al.  A framework for stabilization of nonlinear sampled-data systems based on their approximate discrete-time models , 2004, IEEE Transactions on Automatic Control.

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

[6]  Moritz Diehl,et al.  CasADi: a software framework for nonlinear optimization and optimal control , 2018, Mathematical Programming Computation.

[7]  Éva Gyurkovics,et al.  Stabilization of sampled-data nonlinear systems by receding horizon control via discrete-time approximations , 2003, Autom..

[8]  M. Diehl,et al.  Real-time optimization and nonlinear model predictive control of processes governed by differential-algebraic equations , 2000 .

[9]  Jie Yu,et al.  Unconstrained receding-horizon control of nonlinear systems , 2001, IEEE Trans. Autom. Control..

[10]  Z. Artstein.  Stabilization with relaxed controls , 1983 .

[11]  Shishir Kolathaya,et al.  PD based Robust Quadratic Programs for Robotic Systems , 2019, 2019 IEEE/RSJ International Conference on Intelligent Robots and Systems (IROS).

[12]  J. Rawlings,et al.  Feasibility issues in linear model predictive control , 1999 .

[13]  Stephen P. Boyd,et al.  OSQP: an operator splitting solver for quadratic programs , 2017, 2018 UKACC 12th International Conference on Control (CONTROL).

[14]  Aaron D. Ames,et al.  Bipedal Robotic Running with DURUS-2D: Bridging the Gap between Theory and Experiment , 2017, HSCC.

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

[16]  John Doyle,et al.  A receding horizon generalization of pointwise min-norm controllers , 2000, IEEE Trans. Autom. Control..

[17]  L. Biegler,et al.  A Multistep, Newton-Type Control Strategy for Constrained, Nonlinear Processes , 1989, 1989 American Control Conference.

[18]  Mrdjan Jankovic,et al.  Robust control barrier functions for constrained stabilization of nonlinear systems , 2018, Autom..

[19]  Panagiotis D. Christofides,et al.  Stabilization of nonlinear systems with state and control constraints using Lyapunov-based predictive control , 2005, Proceedings of the 2005, American Control Conference, 2005..

[20]  Koushil Sreenath,et al.  Rapidly Exponentially Stabilizing Control Lyapunov Functions and Hybrid Zero Dynamics , 2014, IEEE Transactions on Automatic Control.

[21]  Koushil Sreenath,et al.  Optimal Robust Control for Bipedal Robots through Control Lyapunov Function based Quadratic Programs , 2015, Robotics: Science and Systems.

[22]  C. A. Desoer,et al.  Nonlinear Systems Analysis , 1978 .

[23]  Panagiotis D. Christofides,et al.  Predictive control of switched nonlinear systems with scheduled mode transitions , 2005, IEEE Transactions on Automatic Control.

[24]  Prashant Mhaskar,et al.  Constrained control Lyapunov function based model predictive control design , 2014 .

[25]  Moritz Diehl,et al.  An auto-generated real-time iteration algorithm for nonlinear MPC in the microsecond range , 2011, Autom..

[26]  H. Bock,et al.  Recent Advances in Parameteridentification Techniques for O.D.E. , 1983 .

[27]  A. R. Teelb,et al.  Formulas relating KL stability estimates of discrete-time and sampled-data nonlinear systems , 1999 .

[28]  H. ChenT,et al.  A Quasi-Infinite Horizon Nonlinear Model Predictive Control Scheme with Guaranteed Stability * , 1998 .

[29]  G. Martin,et al.  Nonlinear model predictive control , 1999, Proceedings of the 1999 American Control Conference (Cat. No. 99CH36251).

[30]  S. Joe Qin,et al.  A survey of industrial model predictive control technology , 2003 .

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

[32]  Jie Yu,et al.  Comparison of nonlinear control design techniques on a model of the Caltech ducted fan , 2001, at - Automatisierungstechnik.

[33]  Eduardo Sontag,et al.  Formulas relating KL stability estimates of discrete-time and sampled-data nonlinear systems , 1999 .

[34]  D K Smith,et al.  Numerical Optimization , 2001, J. Oper. Res. Soc..

[35]  Panagiotis D. Christofides,et al.  Economic model predictive control of nonlinear process systems using Lyapunov techniques , 2012 .

[36]  Yuandan Lin,et al.  A universal formula for stabilization with bounded controls , 1991 .

[37]  Eduardo Sontag.  A universal construction of Artstein's theorem on nonlinear stabilization , 1989 .

[38]  John Hauser,et al.  On the stability of receding horizon control with a general terminal cost , 2005, IEEE Transactions on Automatic Control.

[39]  Koushil Sreenath,et al.  Torque Saturation in Bipedal Robotic Walking Through Control Lyapunov Function-Based Quadratic Programs , 2013, IEEE Access.

[40]  Eduardo Sontag.  Smooth stabilization implies coprime factorization , 1989, IEEE Transactions on Automatic Control.

[41]  Zhe Wu,et al.  Control Lyapunov-Barrier Function-Based Model Predictive Control of Nonlinear Systems , 2018, 2018 Annual American Control Conference (ACC).

[42]  Aaron D. Ames,et al.  Towards the Unification of Locomotion and Manipulation through Control Lyapunov Functions and Quadratic Programs , 2013, CPSW@CISS.

[43]  Manfred Morari,et al.  Contractive model predictive control for constrained nonlinear systems , 2000, IEEE Trans. Autom. Control..

[44]  Aaron D. Ames,et al.  Episodic Learning with Control Lyapunov Functions for Uncertain Robotic Systems* , 2019, 2019 IEEE/RSJ International Conference on Intelligent Robots and Systems (IROS).

[45]  H. Bock,et al.  A Multiple Shooting Algorithm for Direct Solution of Optimal Control Problems , 1984 .

[46]  P. Kokotovic,et al.  Inverse Optimality in Robust Stabilization , 1996 .

[47]  O. Mangasarian,et al.  The Fritz John Necessary Optimality Conditions in the Presence of Equality and Inequality Constraints , 1967 .