{"status":"ok","message-type":"work","message-version":"1.0.0","message":{"indexed":{"date-parts":[[2025,10,12]],"date-time":"2025-10-12T00:46:17Z","timestamp":1760229977994,"version":"build-2065373602"},"reference-count":56,"publisher":"MDPI AG","issue":"4","license":[{"start":{"date-parts":[[2022,7,6]],"date-time":"2022-07-06T00:00:00Z","timestamp":1657065600000},"content-version":"vor","delay-in-days":0,"URL":"https:\/\/creativecommons.org\/licenses\/by\/4.0\/"}],"content-domain":{"domain":[],"crossmark-restriction":false},"short-container-title":["Robotics"],"abstract":"<jats:p>This paper presents a new approach for the optimal trajectory planning of nonlinear systems in a dynamic environment. Given the start and end goals with an objective function, the problem is to find an optimal trajectory from start to end that minimizes the objective while taking into account the changes in the environment. One of the main challenges here is that the optimal control sequence needs to be computed in a limited amount of time and needs to be adapted on-the-fly. The control method presented in this work has two stages: the first-order gradient algorithm is used at the beginning to compute an initial guess of the control sequence that satisfies the constraints but is not yet optimal; then, sequential action control is used to optimize only the portion of the control sequence that will be applied on the system in the next iteration. This helps to reduce the computational effort while still being optimal with regard to the objective; thus, the proposed approach is more applicable for online computation as well as dealing with dynamic environments. We also show that under mild conditions, the proposed controller is asymptotically stable. Different simulated results demonstrate the capability of the controller in terms of solving various tracking problems for different systems under the existence of dynamic obstacles. The proposed method is also compared to the related indirect optimal control approach and sequential action control in terms of cost and computation time to evaluate the improvement of the proposed method.<\/jats:p>","DOI":"10.3390\/robotics11040072","type":"journal-article","created":{"date-parts":[[2022,7,6]],"date-time":"2022-07-06T21:15:52Z","timestamp":1657142152000},"page":"72","update-policy":"https:\/\/doi.org\/10.3390\/mdpi_crossmark_policy","source":"Crossref","is-referenced-by-count":3,"title":["A Fast and Close-to-Optimal Receding Horizon Control for Trajectory Generation in Dynamic Environments"],"prefix":"10.3390","volume":"11","author":[{"ORCID":"https:\/\/orcid.org\/0000-0002-3738-9959","authenticated-orcid":false,"given":"Khoi","family":"Hoang-Dinh","sequence":"first","affiliation":[{"name":"Faculty of Electrical Engineering Technology, Industrial University of Ho Chi Minh City, No. 12 Nguyen Van Bao, Ward 4, Go Vap District, Ho Chi Minh City 70000, Vietnam"}]},{"ORCID":"https:\/\/orcid.org\/0000-0002-2802-5600","authenticated-orcid":false,"given":"Marion","family":"Leibold","sequence":"additional","affiliation":[{"name":"Automatic Control Engineering, Technische Universit\u00e4t M\u00fcnchen, 80333 M\u00fcnchen, Germany"}]},{"ORCID":"https:\/\/orcid.org\/0000-0003-2810-6790","authenticated-orcid":false,"given":"Dirk","family":"Wollherr","sequence":"additional","affiliation":[{"name":"Automatic Control Engineering, Technische Universit\u00e4t M\u00fcnchen, 80333 M\u00fcnchen, Germany"}]}],"member":"1968","published-online":{"date-parts":[[2022,7,6]]},"reference":[{"key":"ref_1","doi-asserted-by":"crossref","first-page":"1135","DOI":"10.1109\/TITS.2015.2498841","article-title":"A Review of Motion Planning Techniques for Automated Vehicles","volume":"17","author":"Nashashibi","year":"2016","journal-title":"IEEE Trans. Intell. Transp. Syst."},{"key":"ref_2","doi-asserted-by":"crossref","first-page":"33","DOI":"10.1109\/TIV.2016.2578706","article-title":"A Survey of Motion Planning and Control Techniques for Self-Driving Urban Vehicles","volume":"1","author":"Paden","year":"2016","journal-title":"IEEE Trans. Intell. Veh."},{"key":"ref_3","doi-asserted-by":"crossref","first-page":"416","DOI":"10.1016\/j.trc.2015.09.011","article-title":"Real-time motion planning methods for autonomous on-road driving: State-of-the-art and future research directions","volume":"60","author":"Katrakazas","year":"2015","journal-title":"Transp. Res. Part Emerg. Technol."},{"key":"ref_4","doi-asserted-by":"crossref","first-page":"810","DOI":"10.1109\/70.720356","article-title":"Autonomous road vehicle guidance from autobahnen to narrow curves","volume":"14","author":"Behringer","year":"1998","journal-title":"IEEE Trans. Robot. Autom."},{"key":"ref_5","doi-asserted-by":"crossref","first-page":"27","DOI":"10.1109\/6979.994793","article-title":"Quintic G2-splines for the iterative steering of vision-based autonomous vehicles","volume":"3","author":"Piazzi","year":"2002","journal-title":"IEEE Trans. Intell. Transp. Syst."},{"key":"ref_6","doi-asserted-by":"crossref","first-page":"449","DOI":"10.1177\/0278364906065543","article-title":"Toward reliable off road autonomous vehicles operating in challenging environments","volume":"25","author":"Kelly","year":"2006","journal-title":"Int. J. Robot. Res."},{"key":"ref_7","doi-asserted-by":"crossref","first-page":"19","DOI":"10.1007\/s10514-006-9000-0","article-title":"The DARPA PerceptOR evaluation experiments","volume":"22","author":"Krotkov","year":"2007","journal-title":"Auton. Robot."},{"key":"ref_8","unstructured":"Kuffner, J.J., and LaValle, S.M. (2000, January 24\u201328). RRT-connect: An efficient approach to single-query path planning. Proceedings of the 2000 ICRA. Millennium Conference. IEEE International Conference on Robotics and Automation. Symposia Proceedings (Cat. No.00CH37065), San Francisco, CA, USA."},{"key":"ref_9","doi-asserted-by":"crossref","first-page":"1105","DOI":"10.1109\/TCST.2008.2012116","article-title":"Real-Time Motion Planning With Applications to Autonomous Urban Driving","volume":"17","author":"Kuwata","year":"2009","journal-title":"IEEE Trans. Control. Syst. Technol."},{"key":"ref_10","doi-asserted-by":"crossref","first-page":"114","DOI":"10.3182\/20130626-3-AU-2035.00052","article-title":"Overall reviews of autonomous vehicle a1-system architecture and algorithms","volume":"46","author":"Jo","year":"2013","journal-title":"IFAC Proc. Vol."},{"key":"ref_11","doi-asserted-by":"crossref","first-page":"105","DOI":"10.1023\/A:1013219111657","article-title":"Dynamically-Stable Motion Planning for Humanoid Robots","volume":"12","author":"Kuffner","year":"2002","journal-title":"Auton. Robot."},{"key":"ref_12","doi-asserted-by":"crossref","first-page":"576","DOI":"10.1109\/TRO.2010.2044949","article-title":"Global Manipulation Planning in Robot Joint Space With Task Constraints","volume":"26","author":"Stilman","year":"2010","journal-title":"IEEE Trans. Robot."},{"key":"ref_13","doi-asserted-by":"crossref","unstructured":"Tsymbal, O., Mercorelli, P., and Sergiyenko, O. (2021). Predicate-Based Model of Problem-Solving for Robotic Actions Planning. Mathematics, 9.","DOI":"10.3390\/math9233044"},{"key":"ref_14","doi-asserted-by":"crossref","first-page":"575","DOI":"10.1017\/S0263574718001182","article-title":"A general framework for task-constrained motion planning with moving obstacles","volume":"37","author":"Cefalo","year":"2019","journal-title":"Robotica"},{"key":"ref_15","doi-asserted-by":"crossref","unstructured":"Xiong, C., Zhou, H., Lu, D., Zeng, Z., Lian, L., and Yu, C. (2020). Rapidly-Exploring Adaptive Sampling Tree*: A Sample-Based Path-Planning Algorithm for Unmanned Marine Vehicles Information Gathering in Variable Ocean Environments. Sensors, 20.","DOI":"10.3390\/s20092515"},{"key":"ref_16","doi-asserted-by":"crossref","first-page":"397","DOI":"10.1109\/LCSYS.2020.3002852","article-title":"Self-Configuring Robot Path Planning With Obstacle Avoidance via Deep Reinforcement Learning","volume":"5","author":"Sangiovanni","year":"2021","journal-title":"IEEE Control Syst. Lett."},{"key":"ref_17","doi-asserted-by":"crossref","first-page":"8","DOI":"10.1109\/MITS.2014.2306552","article-title":"Making Bertha Drive\u2014An Autonomous Journey on a Historic Route","volume":"6","author":"Ziegler","year":"2014","journal-title":"IEEE Intell. Transp. Syst. Mag."},{"key":"ref_18","doi-asserted-by":"crossref","first-page":"357","DOI":"10.1007\/BF02071065","article-title":"Direct and indirect methods for trajectory optimization","volume":"37","author":"Bulirsch","year":"1992","journal-title":"Ann. Oper. Res."},{"key":"ref_19","doi-asserted-by":"crossref","unstructured":"Diehl, M., Bock, H.G., Diedam, H., and Wieber, P.B. (2006). Fast direct multiple shooting algorithms for optimal robot control. Fast Motions in Biomechanics and Robotics, Springer.","DOI":"10.1007\/978-3-540-36119-0_4"},{"key":"ref_20","first-page":"497","article-title":"A Survey of Numerical Methods for Optimal Control","volume":"135","author":"Rao","year":"2010","journal-title":"Adv. Astronaut. Sci."},{"key":"ref_21","doi-asserted-by":"crossref","unstructured":"Lampariello, R., Nguyen-Tuong, D., Castellini, C., Hirzinger, G., and Peters, J. (2011, January 9\u201313). Trajectory planning for optimal robot catching in real-time. Proceedings of the 2011 IEEE International Conference on Robotics and Automation, Shanghai, China.","DOI":"10.1109\/ICRA.2011.5980114"},{"key":"ref_22","doi-asserted-by":"crossref","unstructured":"Werner, A., Trautmann, D., Lee, D., and Lampariello, R. (October, January 28). Generalization of optimal motion trajectories for bipedal walking. Proceedings of the 2015 IEEE\/RSJ International Conference on Intelligent Robots and Systems (IROS), Hamburg, Germany.","DOI":"10.1109\/IROS.2015.7353577"},{"key":"ref_23","doi-asserted-by":"crossref","unstructured":"Apostolopoulos, S., Leibold, M., and Buss, M. (2016, January 16\u201321). Online motion planning over uneven terrain with walking primitives and regression. Proceedings of the 2016 IEEE International Conference on Robotics and Automation (ICRA), Stockholm, Sweden.","DOI":"10.1109\/ICRA.2016.7487568"},{"key":"ref_24","doi-asserted-by":"crossref","unstructured":"Weitschat, R., Haddadin, S., Huber, F., and Albu-Sch\u00e4ffer, A. (2013, January 3\u20137). Dynamic optimality in real-time: A learning framework for near-optimal robot motions. Proceedings of the 2013 IEEE\/RSJ International Conference on Intelligent Robots and Systems, Tokyo, Japan.","DOI":"10.1109\/IROS.2013.6697173"},{"key":"ref_25","unstructured":"Rawlings, J.B., Mayne, D.Q., and Diehl, M.M. (2017). Model Predictive Control: Theory, Computation and Design, Nob Hill Publishing, LLC."},{"key":"ref_26","unstructured":"Allg\u00f6wer, F., and Zheng, A. (2012). Nonlinear Model Predictive Control, Birkh\u00e4user."},{"key":"ref_27","doi-asserted-by":"crossref","unstructured":"Allg\u00f6wer, F., and Zheng, A. (2000). An Overview of Nonlinear Model Predictive Control Applications. Nonlinear Model Predictive Control, Birkh\u00e4user.","DOI":"10.1007\/978-3-0348-8407-5"},{"key":"ref_28","doi-asserted-by":"crossref","unstructured":"Verschueren, R., Zanon, M., Quirynen, R., and Diehl, M. (July, January 29). Time-optimal race car driving using an online exact hessian based nonlinear MPC algorithm. Proceedings of the Control Conference (ECC), 2016 European, Aalborg, Denmark.","DOI":"10.1109\/ECC.2016.7810277"},{"key":"ref_29","doi-asserted-by":"crossref","unstructured":"Obayashi, M., Uto, K., and Takano, G. (2016, January 12\u201314). Appropriate overtaking motion generating method using predictive control with suitable car dynamics. Proceedings of the Decision and Control (CDC), 2016 IEEE 55th Conference, Las Vegas, NV, USA.","DOI":"10.1109\/CDC.2016.7799032"},{"key":"ref_30","doi-asserted-by":"crossref","unstructured":"Mad\u00e5s, D., Nosratinia, M., Keshavarz, M., Sundstr\u00f6m, P., Philippsen, R., Eidehall, A., and Dahl\u00e9n, K.M. (2013, January 23\u201326). On path planning methods for automotive collision avoidance. Proceedings of the 2013 IEEE Intelligent Vehicles Symposium (IV), Gold Coast, QLD, Australia.","DOI":"10.1109\/IVS.2013.6629586"},{"key":"ref_31","doi-asserted-by":"crossref","unstructured":"Li, X., Sun, Z., Zhu, Q., and Liu, D. (2014, January 3\u20136). A unified approach to local trajectory planning and control for autonomous driving along a reference path. Proceedings of the 2014 IEEE International Conference on Mechatronics and Automation, Tianjin, China.","DOI":"10.1109\/ICMA.2014.6885959"},{"key":"ref_32","unstructured":"Kim, D., Carlo, J.D., Katz, B., Bledt, G., and Kim, S. (2019). Highly Dynamic Quadruped Locomotion via Whole-Body Impulse Control and Model Predictive Control. arXiv."},{"key":"ref_33","doi-asserted-by":"crossref","first-page":"563","DOI":"10.1016\/j.automatica.2003.11.005","article-title":"A continuation\/GMRES method for fast computation of nonlinear receding horizon control","volume":"40","author":"Ohtsuka","year":"2004","journal-title":"Automatica"},{"key":"ref_34","doi-asserted-by":"crossref","first-page":"328","DOI":"10.1016\/j.automatica.2017.02.001","article-title":"A stabilizing iteration scheme for model predictive control based on relaxed barrier functions","volume":"80","author":"Feller","year":"2016","journal-title":"Automatica"},{"key":"ref_35","doi-asserted-by":"crossref","unstructured":"Soloperto, R., K\u00f6hler, J., Allg\u00f6wer, F., and M\u00fcller, M.A. (2019, January 25\u201328). Collision avoidance for uncertain nonlinear systems with moving obstacles using robust Model Predictive Control. Proceedings of the 2019 18th European Control Conference (ECC), Naples, Italy.","DOI":"10.23919\/ECC.2019.8796049"},{"key":"ref_36","doi-asserted-by":"crossref","first-page":"776","DOI":"10.1109\/LRA.2019.2893494","article-title":"Chance-Constrained Collision Avoidance for MAVs in Dynamic Environments","volume":"4","author":"Zhu","year":"2019","journal-title":"IEEE Robot. Autom. Lett."},{"key":"ref_37","doi-asserted-by":"crossref","first-page":"132074","DOI":"10.1109\/ACCESS.2019.2940758","article-title":"Dynamic Trajectory Planning and Tracking for Autonomous Vehicle With Obstacle Avoidance Based on Model Predictive Control","volume":"7","author":"Li","year":"2019","journal-title":"IEEE Access"},{"key":"ref_38","doi-asserted-by":"crossref","first-page":"88301","DOI":"10.1109\/ACCESS.2019.2925428","article-title":"Dynamical Obstacle Avoidance of Task- Constrained Mobile Manipulation Using Model Predictive Control","volume":"7","author":"Li","year":"2019","journal-title":"IEEE Access"},{"key":"ref_39","doi-asserted-by":"crossref","first-page":"298","DOI":"10.1002\/oca.939","article-title":"ACADO Toolkit\u2014An Open Source Framework for Automatic Control and Dynamic Optimization","volume":"32","author":"Houska","year":"2011","journal-title":"Optim. Control. Appl. Methods"},{"key":"ref_40","doi-asserted-by":"crossref","unstructured":"Kamel, M., Alexis, K., Achtelik, M., and Siegwart, R. (2015, January 21\u201323). Fast nonlinear model predictive control for multicopter attitude tracking on SO(3). Proceedings of the 2015 IEEE Conference on Control Applications (CCA), Sydney, NSW, Australia.","DOI":"10.1109\/CCA.2015.7320769"},{"key":"ref_41","doi-asserted-by":"crossref","unstructured":"Zanelli, A., Horn, G., Frison, G., and Diehl, M. (2018, January 12\u201315). Nonlinear Model Predictive Control of a Human-sized Quadrotor. Proceedings of the 2018 European Control Conference (ECC), Limassol, Cyprus.","DOI":"10.23919\/ECC.2018.8550530"},{"key":"ref_42","doi-asserted-by":"crossref","first-page":"1196","DOI":"10.1109\/TRO.2016.2596768","article-title":"Sequential Action Control: Closed-Form Optimal Control for Nonlinear Systems","volume":"32","author":"Ansari","year":"2016","journal-title":"IEEE Trans. Robot."},{"key":"ref_43","doi-asserted-by":"crossref","first-page":"110","DOI":"10.1109\/TAC.2005.861711","article-title":"Transition-time optimization for switched-mode dynamical systems","volume":"51","author":"Egerstedt","year":"2006","journal-title":"IEEE Trans. Autom. Control"},{"key":"ref_44","unstructured":"Dinh, K.H., Weiler, P., Leibold, M., and Wollherr, D. (2017, January 3\u20137). Fast and close to optimal trajectory generation for articulated robots in reaching motions. Proceedings of the 2017 IEEE International Conference on Advanced Intelligent Mechatronics (AIM), Munich, Germany."},{"key":"ref_45","unstructured":"Bryson, A.E., and Ho, Y.C. (1975). Applied Optimal Control Optimization, Estimation and Control, Wiley."},{"key":"ref_46","unstructured":"Pontryagin, L. (1987). Mathematical Theory of Optimal Processes, English ed., CRC Press. Classics of Soviet Mathematics."},{"key":"ref_47","doi-asserted-by":"crossref","unstructured":"Mahil, S.M., and Al-Durra, A. (2016, January 16\u201319). Modeling analysis and simulation of 2-DOF robotic manipulator. Proceedings of the 2016 IEEE 59th International Midwest Symposium on Circuits and Systems (MWSCAS), Abu Dhabi, United Arab Emirates.","DOI":"10.1109\/MWSCAS.2016.7870099"},{"key":"ref_48","doi-asserted-by":"crossref","unstructured":"Rucco, A., Notarstefano, G., and Hauser, J. (2010, January 15\u201317). Dynamics exploration of a single-track rigid car model with load transfer. Proceedings of the Decision and Control (CDC), 2010 49th IEEE Conference, Atlanta, GA, USA.","DOI":"10.1109\/CDC.2010.5718133"},{"key":"ref_49","doi-asserted-by":"crossref","unstructured":"Rubin, D., and Arogeti, S. (2013, January 25\u201328). Vehicle yaw stability control using rear active differential via sliding mode control methods. Proceedings of the Control & Automation (MED), 2013 21st Mediterranean Conference, Chania, Crete, Greece.","DOI":"10.1109\/MED.2013.6608740"},{"key":"ref_50","doi-asserted-by":"crossref","first-page":"3388","DOI":"10.1109\/TITS.2017.2687047","article-title":"Parking Like a Human: A Direct Trajectory Planning Solution","volume":"18","author":"Liu","year":"2017","journal-title":"IEEE Trans. Intell. Transp. Syst."},{"key":"ref_51","doi-asserted-by":"crossref","first-page":"789","DOI":"10.1016\/S0005-1098(99)00214-9","article-title":"Constrained model predictive control: Stability and optimality","volume":"36","author":"Mayne","year":"2000","journal-title":"Automatica"},{"key":"ref_52","doi-asserted-by":"crossref","first-page":"349","DOI":"10.1016\/0005-1098(82)90096-6","article-title":"On receding horizon feedback control","volume":"18","author":"Chen","year":"1982","journal-title":"Automatica"},{"key":"ref_53","doi-asserted-by":"crossref","first-page":"1623","DOI":"10.1109\/9.262032","article-title":"Robust receding horizon control of constrained nonlinear systems","volume":"38","author":"Michalska","year":"1993","journal-title":"IEEE Trans. Autom. Control"},{"key":"ref_54","doi-asserted-by":"crossref","unstructured":"Althoff, M., Koschi, M., and Manzinger, S. (2017, January 11\u201314). CommonRoad: Composable benchmarks for motion planning on roads. Proceedings of the 2017 IEEE Intelligent Vehicles Symposium (IV), Los Angeles, CA, USA.","DOI":"10.1109\/IVS.2017.7995802"},{"key":"ref_55","doi-asserted-by":"crossref","unstructured":"de Souza Mendes, A., Meneghetti, D.D.R., Ackermann, M., and de Toledo Fleury, A. (2016). Vehicle Dynamics-Lateral: Open Source Simulation Package for MATLAB, SAE. Technical report; SAE Technical Paper.","DOI":"10.4271\/2016-36-0115"},{"key":"ref_56","doi-asserted-by":"crossref","first-page":"814","DOI":"10.1109\/9.57020","article-title":"Receding horizon control of nonlinear systems","volume":"35","author":"Mayne","year":"1990","journal-title":"IEEE Trans. Autom. Control"}],"container-title":["Robotics"],"original-title":[],"language":"en","link":[{"URL":"https:\/\/www.mdpi.com\/2218-6581\/11\/4\/72\/pdf","content-type":"unspecified","content-version":"vor","intended-application":"similarity-checking"}],"deposited":{"date-parts":[[2025,10,10]],"date-time":"2025-10-10T23:43:32Z","timestamp":1760139812000},"score":1,"resource":{"primary":{"URL":"https:\/\/www.mdpi.com\/2218-6581\/11\/4\/72"}},"subtitle":[],"short-title":[],"issued":{"date-parts":[[2022,7,6]]},"references-count":56,"journal-issue":{"issue":"4","published-online":{"date-parts":[[2022,8]]}},"alternative-id":["robotics11040072"],"URL":"https:\/\/doi.org\/10.3390\/robotics11040072","relation":{},"ISSN":["2218-6581"],"issn-type":[{"type":"electronic","value":"2218-6581"}],"subject":[],"published":{"date-parts":[[2022,7,6]]}}}