ASAP-MPC: An Asynchronous Update Scheme for Online Motion Planning with Nonlinear Model Predictive Control (2402.06263v2)
Abstract: This paper presents a Nonlinear Model Predictive Control (NMPC) scheme targeted at motion planning for mechatronic motion systems, such as drones and mobile platforms. NMPC-based motion planning typically requires low computation times to be able to provide control inputs at the required rate for system stability, disturbance rejection, and overall performance. Although there exist various ways in literature to reduce the solution times in NMPC, such times may not be low enough to allow real-time implementations. This paper presents ASAP-MPC, an approach to handle varying, sometimes restrictively large, solution times with an asynchronous update scheme, always allowing for full convergence and real-time execution. The NMPC algorithm is combined with a linear state feedback controller tracking the optimised trajectories for improved robustness against possible disturbances and plant-model mismatch. ASAP-MPC seamlessly merges trajectories, resulting from subsequent NMPC solutions, providing a smooth and continuous overall trajectory for the motion system. This frameworks applicability to embedded applications is shown on two different experiment setups where a state-of-the-art method fails: a quadcopter flying through a cluttered environment in hardware-in-the-loop simulation and a scale model truck-trailer manoeuvring in a structured lab environment.
- S. Karaman and E. Frazzoli, “Sampling-based algorithms for optimal motion planning,” The International journal of robotics research, vol. 30, no. 7, pp. 846–894, 2011.
- P. E. Hart, N. J. Nilsson, and B. Raphael, “A formal basis for the heuristic determination of minimum cost paths,” IEEE transactions on systems science and cybernetics, vol. 4, no. 2, pp. 100–107, 1968.
- S. Aradi, “Survey of deep reinforcement learning for motion planning of autonomous vehicles,” IEEE Transactions on Intelligent Transportation Systems, vol. 23, pp. 740–759, 2022.
- M. Obayashi and G. Takano, “Real-time autonomous car motion planning using nmpc with approximated problem considering traffic environment,” IFAC-PapersOnLine, vol. 51, no. 20, pp. 279–286, 2018, 6th IFAC Conference on Nonlinear Model Predictive Control NMPC 2018.
- T. Englert, A. Völz, F. Mesmer, S. Rhein, and K. Graichen, “A software framework for embedded nonlinear model predictive control using a gradient-based augmented lagrangian approach (GRAMPC),” Optimization and engineering, vol. 20, no. 3, 2019.
- B. Houska, H. J. Ferreau, and M. Diehl, “Acado toolkit—an open-source framework for automatic control and dynamic optimization,” Optimal Control Applications and Methods, vol. 32, no. 3, pp. 298–312, 2011.
- J. Kalmari, J. Backman, and A. Visala, “A toolkit for nonlinear model predictive control using gradient projection and code generation,” Control Engineering Practice, vol. 39, pp. 56–66, 2015.
- B. Kapernick and K. Graichen, “The gradient based nonlinear model predictive control software grampc,” 06 2014, pp. 1170–1175.
- L. Stella, A. Themelis, P. Sopasakis, and P. Patrinos, “A simple and efficient algorithm for nonlinear model predictive control,” in 2017 IEEE 56th Annual Conference on Decision and Control (CDC), 2017, pp. 1939–1944.
- A. Sathya, P. Sopasakis, R. Van Parys, A. Themelis, G. Pipeleers, and P. Patrinos, “Embedded nonlinear model predictive control for obstacle avoidance using PANOC,” in 2018 European Control Conference (ECC), 2018, pp. 1523–1528.
- V. M. Zavala, C. D. Laird, and L. T. Biegler, “Fast implementations and rigorous models: Can both be accommodated in NMPC?” International Journal of Robust and Nonlinear Control, vol. 18, no. 8, pp. 800–815, 2008.
- R. Findeisen and F. Allgöwer, “Computational delay in nonlinear model predictive control,” IFAC Proceedings Volumes, vol. 37, no. 1, pp. 427–432, 2004, 7th International Symposium on Advanced Control of Chemical Processes (ADCHEM 2003), Hong-Kong, 11-14 January 2004.
- M. Neunert, C. de Crousaz, F. Furrer, M. Kamel, F. Farshidian, R. Siegwart, and J. Buchli, “Fast nonlinear model predictive control for unified trajectory optimization and tracking,” in 2016 IEEE International Conference on Robotics and Automation (ICRA), 2016, pp. 1398–1404.
- R. Grandia, F. Farshidian, R. Ranftl, and M. Hutter, “Feedback mpc for torque-controlled legged robots,” in 2019 IEEE/RSJ International Conference on Intelligent Robots and Systems (IROS), 2019, pp. 4730–4737.
- D. Dirckx, M. Bos, W. Decré, and J. Swevers, “Optimal and reactive control for agile drone flight in cluttered environments,” IFAC-PapersOnLine, vol. 56, no. 2, pp. 6273–6278, 2023, 22nd IFAC World Congress.
- M. Bos, B. Vandewal, W. Decré, and J. Swevers, “MPC-based motion planning for autonomous truck-trailer maneuvering,” IFAC-PapersOnLine, vol. 56, no. 2, pp. 4877–4882, 2023, 22nd IFAC World Congress.
- Y. Song, S. Naji, E. Kaufmann, A. Loquercio, and D. Scaramuzza, “Flightmare: A flexible quadrotor simulator,” in Conference on Robot Learning, 2020.