Abstract
This paper introduces a predictive closed-loop trajectory tracking algorithm for nonlinear control systems that combines the Model Predictive Control (MPC) approach with the task priority Lifted Newton method. The optimal control problem within MPC is replaced by the open-loop trajectory tracking problem formulated as a constrained motion planning problem. Constraints reflect the distance in the task space between the system current output and the desired trajectory. The original constrained motion planning problem is replaced by an unconstrained one addressed in an extended control system representation, and solved with the task priority version of the Lifted Newton method. All other steps of the MPC scheme remains unchanged. Performance of the closed-loop predictive Lifted Newton trajectory tracking algorithm has been demonstrated with series of computer simulations for the kinematic car type platform.
Article PDF
Similar content being viewed by others
Explore related subjects
Discover the latest articles, news and stories from top researchers in related subjects.Avoid common mistakes on your manuscript.
References
Albersmeyer, J., Diehl, M.: The lifted newton method and its application in optimization. SIAM J. on Optimization 20(3), 1655–1684 (2010)
Alexe, M., Sandu, A.: Forward and adjoint sensitivity analysis with continuous explicit Runge-Kutta schemes. Appl. Math. Comput. 208(2), 328–346 (2009)
Amrein, M., Wihler, T.P.: An adaptive newton-method based on a dynamical systems approach. Commun. Nonlinear Sci. Numer. Simul. 19(9), 2958–2973 (2014)
Biegler, L.T.: A survey on sensitivity-based nonlinear model predictive control. IFAC Proceedings 46(32), 499–510 (2013)
Cueli, J.R., Bordons, C.: Iterative nonlinear model predictive control. Stability, robustness and applications. Control. Eng. Pract. 16(9), 1023–1034 (2008)
Diehl, M., Bock, H.G., Schlöder, J.P.: A real-time iteration scheme for nonlinear optimization in optimal feedback control. SIAM J. Control. Optim. 43(5), 1714–1736 (2005)
Diehl, M., Findeisen, R., Allgower, F., Bock, H.G., Schloder, J.P.: Nominal stability of real-time iteration scheme for nonlinear model predictive control. IEE Proceedings - Control Theory Appl. 152(3), 296–308 (2005)
Divelbiss, A.W., Wen, J.T.: A path space approach to nonholonomic motion planning in the presence of obstacles. IEEE Trans. Robot. Autom. 13(3), 443–451 (1997)
van Duijkeren, N., Verschueren, R., Pipeleers, G., Diehl, M., Swevers, J.: Path-Following NMPC for Serial-Link Robot Manipulators Using a Path-Parametric System Reformulation. In: 2016 European Control Conference (ECC), pp. 477–482 (2016)
Findeisen, R., Imsland, L., Allgower, F., Foss, B.A.: State and output feedback nonlinear model predictive control: an overview. Eur. J. Control. 9(2), 190–206 (2003)
Grne, L., Pannek, J.: Nonlinear Model Predictive Control: Theory and Algorithms. Springer Publishing Company, Incorporated, New York (2013)
Grosan, C., Abraham, A.: A new approach for solving nonlinear equations systems. IEEE Trans. Syst., Man, Cybernetics - Part A: Syst. and Humans 38(3), 698–714 (2008)
Guerreiro, B.J., Silvestre, C., Cunha, R., Pascoal, A.: Trajectory Tracking Nonlinear Model Predictive Control for Autonomous Surface Craft. In: 2009 European Control Conference (ECC), pp. 1311–1316 (2009)
Guerreiro, B.J., Silvestre, C., Cunha, R., Pascoal, A.: Trajectory tracking nonlinear model predictive control for autonomous surface craft. IEEE Trans. Control Syst. Technol. 22(6), 2160–2175 (2014)
Houska, B., Ferreau, H. J., Diehl, M.: ACADO toolkit—An Open-source framework for automatic control and dynamic optimization. Optim. Control Appl. Meth. 32, 298–312 (2011)
Janiak, M.: Lifted Newton Motion Planning Algorithm. In: 2015 10th International Workshop on Robot Motion and Control (Romoco), pp. 223–228 (2015)
Janiak, M.: From Motion Planning through Waypoints to Open-Loop Trajectory Tracking Algorithm. In: 2017 11Th International Workshop on Robot Motion and Control (Romoco), pp. 142–147 (2017)
Janiak, M., Tchoń, K.: Motion Planning through Waypoints for a Skid-Steering Mobile Platform. In: 2015 10th International Workshop on Robot Motion and Control (Romoco), pp. 58–63 (2015)
Janiak, M., Tchon, K.: Constrained motion planning of nonholonomic systems. Syst. Control Lett. 60(8), 625–631 (2011)
Karpińska, J., Tchoń, K.: Continuation Method Approach to Trajectory Planning in Robotic Systems. In: 2011 16th International Conference on Methods and Models in Automation and Robotics (MMAR), pp. 51–56 (2011)
Kowalczyk, W., Michałek, M., Kozłowski, K.: Trajectory tracking control with obstacle avoidance capability for unicycle-like mobile robot. Bulletin of the Polish Academy of Sciences. Tech. Sci. 60(3), 537–546 (2012)
Maurović, I., Baotić, M., Petrović, I.: Explicit Model Predictive Control for Trajectory Tracking with Mobile Robots. In: 2011 IEEE/ASME International Conference on Advanced Intelligent Mechatronics (AIM), pp. 712–717 (2011)
Mazur, A., Cholewiński, M.: Implementation of factitious force method for control of 5R manipulator with skid-steering platform REX. Bulletin of the Polish Academy of Sciences. Tech. Sci. 64(1), 71–80 (2016)
Morin, P., Samson, C.: Stabilization of Trajectories for Systems on Lie Groups. Application to the Rolling Sphere. In: 17th IFAC World Congress, pp. 508–513 (2008)
Muszyniski, R., Jakubiak, J.: On Predictive Approach to Inverse Kinematics of Mobile Manipulators. In: 2007 IEEE International Conference on Control and Automation, pp. 2423–2428 (2007)
Qin, S., Badgwell, T.A.: A survey of industrial model predictive control technology. Control. Eng. Pract. 11(7), 733–764 (2003)
Qin, S.J., Badgwell, T.A.: An Overview of Nonlinear Model Predictive Control Applications, pp. 369–392. Basel, Birkhäuser Basel (2000)
Quarteroni, A., Sacco, R., Saleri, F.: Nonlinear Systems and Numerical Optimization, pp. 285–331. Springer, Berlin (2007)
Quirynen, R., Vukov, M., Zanon, M., Diehl, M.: Autogenerating microsecond solvers for nonlinear mpc: a tutorial using acado integrators. Optim. Control Appl. Method 36(5), 685–704 (2015)
Ratajczak, A.: Trajectory reproduction and trajectory tracking problem for the nonholonomic systems. Bull. Polish Academy of Sci. 64(1), 63–70 (2016)
Ratajczak, A., Tchoń, K.: Multiple-task motion planning of non-holonomic systems with dynamics. Mech. Sci. 4(1), 153–166 (2013)
Rawlings, J.B.: Tutorial overview of model predictive control. IEEE Control. Syst. 20(3), 38–52 (2000)
Sistu, P.B., Bequette, B.W.: Nonlinear model-predictive control: Closed-loop stability analysis. AIChE J 42(12), 3388–3402 (1996)
Tchoń, K., Jakubiak, J.: Endogenous configuration space approach to mobile manipulators: a derivation and performance assessment of Jacobian inverse kinematics algorithms. Int. J. Contr. 76(14), 1387–1419 (2003)
Łukasz, C.: Example of model predictive control simulation. https://bitbucket.org/lukych92/acado_mpc_simulation
Walsh, G., Tilbury, D., Sastry, S., Murray, R., Laumond, J.P.: Stabilization of trajectories for systems with nonholonomic constraints. IEEE Trans. Autom. Control 39(1), 216–222 (1994)
Acknowledgements
This research was supported by the Wrocław University of Science and Technology under a statutory research project. The authors are indebted to the anonymous referees whose comments unveiled advantages and limitation of the approach presented in this paper.
Author information
Authors and Affiliations
Corresponding author
Additional information
Publisher’s Note
Springer Nature remains neutral with regard to jurisdictional claims in published maps and institutional affiliations.
Rights and permissions
Open Access This article is distributed under the terms of the Creative Commons Attribution 4.0 International License (http://creativecommons.org/licenses/by/4.0/), which permits unrestricted use, distribution, and reproduction in any medium, provided you give appropriate credit to the original author(s) and the source, provide a link to the Creative Commons license, and indicate if changes were made.
About this article
Cite this article
Janiak, M., Chojnacki, Ł. Closing the Loop – Predictive Lifted Newton Trajectory Tracking Algorithm. J Intell Robot Syst 93, 669–686 (2019). https://doi.org/10.1007/s10846-018-0871-z
Received:
Accepted:
Published:
Issue Date:
DOI: https://doi.org/10.1007/s10846-018-0871-z