Abstract
This work proposes single-layer nonlinear model predictive control schemes to solve the autonomous navigation problem while providing obstacle avoidance feature in cluttered environments with previously unknown obstacles. Considering model predictive control frameworks for set-point stabilization and set-point tracking, the penalty method of nonlinear programming is taken into account to enforce avoidance constraints without losing stability and feasibility guarantees. The set-point tracking schemes are shown to be more suitable for motion systems due to their enlarged domain of attraction with respect to the regulation formulations, making it feasible for any changing targets. Further, for the set-point tracking problem, the proposed schemes avoid the use of terminal regions, which, for nonlinear systems, might be cumbersome to compute. Thus, simple design schemes based on a relaxed terminal equality constraint and on a weighted terminal cost are considered. Finally, two case studies considering a differential mobile robot and a quadrotor unmanned aerial vehicle are provided to evaluate the set-point tracking formulations.
Similar content being viewed by others
Data Availability
All data necessary to reproduce the results are given in the manuscript.
Notes
See documentation at https://www.mathworks.com/help/control/ref/dlqr.html.
References
Alessandretti, A., Aguiar, A. P., & Jones, C. N. (2017). An input-to-state-stability approach to economic optimization in model predictive control. IEEE Transactions on Automatic Control, 62(12), 6081–6093. https://doi.org/10.1109/tac.2017.2700388
Andersson, J. A. E., Gillis, J., Horn, G., et al. (2019). CasADi-A software framework for nonlinear optimization and optimal control. Mathematical Programming Computation, 11(1), 1–36. https://doi.org/10.1007/s12532-018-0139-4
Angeli, D., & Mosca, E. (1999). Command governors for constrained nonlinear systems. IEEE Transactions on Automatic Control, 44(4), 816–820. https://doi.org/10.1109/9.754825
Bemporad, A. (1998). Reference governor for constrained nonlinear systems. IEEE Transactions on Automatic Control, 43(3), 415–419. https://doi.org/10.1109/9.661611
Bock, H., & Plitt, K. (1984). A multiple shooting algorithm for direct solution of optimal control problems. IFAC Proceedings Volumes, 17(2), 1603–1608. https://doi.org/10.1016/s1474-6670(17)61205-9
Bonab, S. A., & Emadi, A. (2019). Optimization-based path planning for an autonomous vehicle in a racing track. In Proceedings of the industrial electronics society conferencehttps://doi.org/10.1109/iecon.2019.8926856
Bonatti, R., Zhang, Y., Choudhury, S., et al (2020). Autonomous drone cinematographer: Using artistic principles to create smooth, safe, occlusion-free trajectories for aerial filming. In Springer Proceedings in Advanced Robotics. Springer International Publishing (pp. 119–129), https://doi.org/10.1007/978-3-030-33950-0_11
Dixon, W., Dawson, D. M., Zergeroglu, E., et al. (2001). Nonlinear control of wheeled mobile robots. Springer.
Ferramosca, A., Limon, D., Alvarado, I., et al. (2009). MPC for tracking with optimal closed-loop performance. Automatica, 45(8), 1975–1978. https://doi.org/10.1016/j.automatica.2009.04.007
Ferramosca, A., Limon, D., Alvarado, I., et al. (2011). Optimal MPC for tracking of constrained linear systems. International Journal of Systems Science, 42(8), 1265–1276. https://doi.org/10.1080/00207721.2011.588895
Ferramosca, A., González, A. H., & Limon, D. (2017). Offset-free multi-model economic model predictive control for changing economic criterion. Journal of Process Control, 54, 1–13. https://doi.org/10.1016/j.jprocont.2017.02.014
Forrest, A., Laval, B., Lim, D., et al. (2010). Performance evaluation of underwater platforms in the context of space exploration. Planetary and Space Science, 58(4), 706–716. https://doi.org/10.1016/j.pss.2009.08.007
Gao, Y., & Chien, S. (2017). Review on space robotics: Toward top-level science through space exploration. Science Robotics, 2(7), 1–11. https://doi.org/10.1126/scirobotics.aan5074
Garone, E., Cairano, S., & Kolmanovsky, I. (2017). Reference and command governors for systems with constraints: A survey on theory and applications. Automatica, 75, 306–328. https://doi.org/10.1016/j.automatica.2016.08.013
Gohl, P., Burri, M., Omari, S., et al (2014). Towards autonomous mine inspection. In Proceedings of the international conference on applied robotics for the power industry (pp. 1–6), https://doi.org/10.1109/CARPI.2014.7030057
Hermans, B., Patrinos, P., & Pipeleers, G. (2018). A penalty method based approach for autonomous navigation using nonlinear model predictive control. IFAC-PapersOnLine, 51(20), 234–240. https://doi.org/10.1016/j.ifacol.2018.11.019
Hoy, M., Matveev, A. S., & Savkin, A. V. (2014). Algorithms for collision-free navigation of mobile robots in complex cluttered environments: A survey. Robotica, 33(3), 463–497. https://doi.org/10.1017/s0263574714000289
Kamel, M., Alonso-Mora, J., Siegwart, R., et al (2017). Robust collision avoidance for multiple micro aerial vehicles using nonlinear model predictive control. In Proceedings of the IEEE/RSJ international conference on intelligent robots and systems. https://doi.org/10.1109/iros.2017.8202163.
Kloeser, D., Schoels, T., Sartor, T., et al. (2020). NMPC for racing using a singularity-free path-parametric model with obstacle avoidance. IFAC-PapersOnLine, 53(2), 14.
Li, G., Huang, Y., Zhang, X., et al. (2020). Hybrid maps enhanced localization system for mobile manipulator in harsh manufacturing workshop. IEEE Access, 8, 10782–10795.
Li, X., Yu, W., Lin, X., et al. (2012). On optimizing autonomous pipeline inspection. IEEE Transactions on Robotics, 28(1), 223–233. https://doi.org/10.1109/tro.2011.2169619
Limon, D., Alamo, T., Salas, F., et al. (2006). On the stability of constrained MPC without terminal constraint. IEEE Transactions on Automatic Control, 51(5), 832–836. https://doi.org/10.1109/tac.2006.875014
Limon, D., Alvarado, I., Alamo, T., et al. (2008). MPC for tracking piecewise constant references for constrained linear systems. Automatica, 44(9), 2382–2387. https://doi.org/10.1016/j.automatica.2008.01.023
Limon, D., Ferramosca, A., Alvarado, I., et al. (2018). Nonlinear MPC for tracking piece-wise constant reference signals. IEEE Transactions on Automatic Control, 63(11), 3735–3750. https://doi.org/10.1109/tac.2018.2798803
Luenberger, D. G., & Ye, Y. (2008). Linear and nonlinear programming. Springer.
Magni, L., Nicolao, G., Magnani, L., et al. (2001). A stabilizing model-based predictive control algorithm for nonlinear systems. Automatica, 37(9), 1351–1362. https://doi.org/10.1016/s0005-1098(01)00083-8
Mayne, D., Rawlings, J., Rao, C., et al. (2000). Constrained model predictive control: Stability and optimality. Automatica, 36(6), 789–814. https://doi.org/10.1016/s0005-1098(99)00214-9
Morari, M., & Maeder, U. (2012). Nonlinear offset-free model predictive control. Automatica, 48(9), 2059–2067. https://doi.org/10.1016/j.automatica.2012.06.038
Nascimento, I. B. P., Ferramosca, A., Pimenta, L. C. A., et al (2019). NMPC strategy for a quadrotor UAV in a 3D unknown environment. In Proceedings of the international conference on advanced roboticshttps://doi.org/10.1109/icar46387.2019.8981556.
Nascimento, T. P., Conceicao, A. G., & Moreira, A. P. (2014). Multi-robot systems formation control with obstacle avoidance. IFAC Proceedings Volumes, 47(3), 5703–5708. https://doi.org/10.3182/20140824-6-za-1003.01848
Pannocchia, G., & Kerrigan, E. C. (2005). Offset-free receding horizon control of constrained linear systems. AIChE Journal, 51(12), 3134–3146. https://doi.org/10.1002/aic.10626
Pereira, J. C., Leite, V. J. S., & Raffo, G. V. (2021). An ellipsoidal-polytopic based approach for aggressive navigation using nonlinear model predictive control. In Proceedings of the international conference on unmanned aircraft systemshttps://doi.org/10.1109/icuas51884.2021.9476877.
Potdar, N. D., Croon, G. C. H. E., & Alonso-Mora, J. (2020). Online trajectory planning and control of a MAV payload system in dynamic environments. Autonomous Robots, 44(6), 1065–1089. https://doi.org/10.1007/s10514-020-09919-8
Raffo GV (2011) Robust control strategies for a quadrotor helicopter: An underactuated mechanical system. PhD thesis, Universidad de Sevilla, Depto. de Ingeniería de Sistemas y Automática,
Raffo, G. V., Ortega, M. G. & Rubio, F. R. (2011). Nonlinear \(\cal{H}_\infty \) controller for the quad-rotor helicopter with input coupling. IFAC Proceedings Volumes 44(1):13,834–13,839. https://doi.org/10.3182/20110828-6-it-1002.02453
Rao, C. V., & Rawlings, J. B. (1999). Steady states and constraints in model predictive control. AIChE Journal, 45(6), 1266–1278. https://doi.org/10.1002/aic.690450612
Sánchez, I., D’Jorge, A., Raffo, G. V., et al (2021). Nonlinear model predictive path following controller with obstacle avoidance. Journal of Intelligent & Robotic Systems. 102(1). https://doi.org/10.1007/s10846-021-01373-7
Santos, M. A., Ferramosca, A., & Raffo, G. V. (2021). Tracking nonlinear model predictive control for obstacle avoidance. In Proceedings of the Latin American Robotics Symposiumhttps://doi.org/10.1109/lars/sbr/wre54079.2021.9605408.
Siciliano, B., & Khatib, O. (2016). Handbook of robotics. Springer.
Tokekar, P., Hook, J. V., Mulla, D., et al (2013). Sensor planning for a symbiotic UAV and UGV system for precision agriculture. In Proceedings of the international conference on intelligent robots and systemshttps://doi.org/10.1109/iros.2013.6697126.
Wächter, A., & Biegler, L. T. (2005). Line search filter methods for nonlinear programming: Motivation and global convergence. SIAM Journal on Optimization, 16(1), 1–31. https://doi.org/10.1137/s1052623403426556
Zafar, M. N., & Mohanta, J. (2018). Methodology for path planning and optimization of mobile robots: A review. Procedia Computer Science, 133, 141–152. https://doi.org/10.1016/j.procs.2018.07.018
Acknowledgements
This work extends the results of Santos et al. (2021) in terms of the proposed control strategies and the analyzed case studies. Also, the feasibility and stability analyses are now provided. Besides, here we generalize how obstacles are handled by considering a penalty approach. However, this work presents a similar motivation and one of the case studies considers the same quadrotor UAV system. Considering a similar case study with different controllers allows explaining how the proposed controllers solve the issues of the formulation presented in Santos et al. (2021).
Funding
This work was partially supported by the Brazilian agencies Conselho Nacional de Desenvolvimento Científico (CNPq), under grants 465755/2014-3 (INCT project) and 315695/2020-0; Fundação de Aparo à Pesquisa do Estado de São Paulo (FAPESP), under grant 2014/50851-0; Cordenação de Aperfeiçoamento de Pessoal de Nível Superior (CAPES), under the grants 001 and 88887.136349/2017-00; and Fundação de Amparo à Pesquisa do Estado de Minas Gerais (FAPEMIG), under grant APQ-03090-17.
Author information
Authors and Affiliations
Contributions
All authors contributed to the study conception, control design, and analysis. Coding and numerical experiments were performed by Marcelo Alves dos Santos. The first draft of the manuscript was written by Marcelo Alves dos Santos, and all authors commented on previous versions of the manuscript. All authors read and approved the final manuscript.
Corresponding author
Ethics declarations
Competing interests
The authors have no relevant financial or nonfinancial interests to disclose.
Additional information
Publisher's Note
Springer Nature remains neutral with regard to jurisdictional claims in published maps and institutional affiliations.
Rights and permissions
Springer Nature or its licensor (e.g. a society or other partner) holds exclusive rights to this article under a publishing agreement with the author(s) or other rightsholder(s); author self-archiving of the accepted manuscript version of this article is solely governed by the terms of such publishing agreement and applicable law.
About this article
Cite this article
Santos, M.A., Ferramosca, A. & Raffo, G.V. Nonlinear Model Predictive Control Schemes for Obstacle Avoidance. J Control Autom Electr Syst 34, 891–906 (2023). https://doi.org/10.1007/s40313-023-01024-2
Received:
Revised:
Accepted:
Published:
Issue Date:
DOI: https://doi.org/10.1007/s40313-023-01024-2