Embedded nonlinear model predictive control for obstacle avoidance using PANOC

We employ the proximal averaged Newton-type method for optimal control (PANOC) to solve obstacle avoidance problems in real time. We introduce a novel modeling framework for obstacle avoidance which allows us to easily account for generic, possibly nonconvex, obstacles involving polytopes, ellipsoids, semialgebraic sets and generic sets described by a set of nonlinear inequalities. PANOC is particularly well-suited for embedded applications as it involves simple steps, its implementation comes with a low memory footprint and its fast convergence meets the tight runtime requirements of fast dynamical systems one encounters in modern mechatronics and robotics. The proposed obstacle avoidance scheme is tested on a lab-scale autonomous vehicle.

[1]  A. Bemporad,et al.  Forward-backward truncated Newton methods for convex composite optimization , 2014, 1402.6655.

[2]  Dimitri P. Bertsekas,et al.  Nonlinear Programming , 1997 .

[3]  Elmer G. Gilbert,et al.  Distance functions and their application to robot path planning in the presence of obstacles , 1985, IEEE J. Robotics Autom..

[4]  Gui-Hua Lin,et al.  Stationarity Conditions and Their Reformulations for Mathematical Programs with Vertical Complementarity Constraints , 2012, J. Optim. Theory Appl..

[5]  Panagiotis Patrinos,et al.  Forward-Backward Envelope for the Sum of Two Nonconvex Functions: Further Properties and Nonmonotone Linesearch Algorithms , 2016, SIAM J. Optim..

[6]  Osamu Takahashi,et al.  Motion planning in a plane using generalized Voronoi diagrams , 1989, IEEE Trans. Robotics Autom..

[7]  Dirk Abel,et al.  Centralized non-convex model predictive control for cooperative collision avoidance of networked vehicles , 2014, 2014 IEEE International Symposium on Intelligent Control (ISIC).

[8]  Jur P. van den Berg,et al.  Generalized reciprocal collision avoidance , 2015, Int. J. Robotics Res..

[9]  H. E. Tseng,et al.  Linear model predictive control for lane keeping and obstacle avoidance on low curvature roads , 2013, 16th International IEEE Conference on Intelligent Transportation Systems (ITSC 2013).

[10]  Stephen J. Wright,et al.  Numerical Optimization , 2018, Fundamental Statistical Inference.

[11]  Lorenz T. Biegler,et al.  On the implementation of an interior-point filter line-search algorithm for large-scale nonlinear programming , 2006, Math. Program..

[12]  Benar Fux Svaiter,et al.  Convergence of descent methods for semi-algebraic and tame problems: proximal algorithms, forward–backward splitting, and regularized Gauss–Seidel methods , 2013, Math. Program..

[13]  Francesco Borrelli,et al.  An auto-generated nonlinear MPC algorithm for real-time obstacle avoidance of ground vehicles , 2013, 2013 European Control Conference (ECC).

[14]  MORITZ DIEHL,et al.  A Real-Time Iteration Scheme for Nonlinear Optimization in Optimal Feedback Control , 2005, SIAM J. Control. Optim..

[15]  Florent Lamiraux,et al.  Motion Planning and Obstacle Avoidance , 2016, Springer Handbook of Robotics, 2nd Ed..

[16]  D. Bertsekas,et al.  Efficient dynamic programming implementations of Newton's method for unconstrained optimal control problems , 1989 .

[17]  Panagiotis Patrinos,et al.  Forward–backward quasi-Newton methods for nonsmooth optimization problems , 2016, Computational Optimization and Applications.

[18]  Alberto Bemporad,et al.  Proximal Newton methods for convex composite optimization , 2013, 52nd IEEE Conference on Decision and Control.

[19]  Joel Andersson,et al.  A General-Purpose Software Framework for Dynamic Optimization (Een algemene softwareomgeving voor dynamische optimalisatie) , 2013 .

[20]  Goele Pipeleers,et al.  Time-optimal path following for robots with object collision avoidance using lagrangian duality , 2013, 9th International Workshop on Robot Motion and Control.

[21]  Stefan Scholtes,et al.  Mathematical Programs with Complementarity Constraints: Stationarity, Optimality, and Sensitivity , 2000, Math. Oper. Res..

[22]  Goele Pipeleers,et al.  Spline-Based Motion Planning for Autonomous Guided Vehicles in a Dynamic Environment , 2018, IEEE Transactions on Control Systems Technology.

[23]  Baocang Ding,et al.  A synthesis approach of distributed model predictive control for homogeneous multi-agent system with collision avoidance , 2014, Int. J. Control.

[24]  Pantelis Sopasakis,et al.  A simple and efficient algorithm for nonlinear model predictive control , 2017, 2017 IEEE 56th Annual Conference on Decision and Control (CDC).