{"status":"ok","message-type":"work","message-version":"1.0.0","message":{"indexed":{"date-parts":[[2026,4,1]],"date-time":"2026-04-01T21:27:13Z","timestamp":1775078833325,"version":"3.50.1"},"reference-count":37,"publisher":"Springer Science and Business Media LLC","issue":"1","license":[{"start":{"date-parts":[[2024,1,28]],"date-time":"2024-01-28T00:00:00Z","timestamp":1706400000000},"content-version":"tdm","delay-in-days":0,"URL":"https:\/\/creativecommons.org\/licenses\/by\/4.0"},{"start":{"date-parts":[[2024,1,28]],"date-time":"2024-01-28T00:00:00Z","timestamp":1706400000000},"content-version":"vor","delay-in-days":0,"URL":"https:\/\/creativecommons.org\/licenses\/by\/4.0"}],"funder":[{"DOI":"10.13039\/501100011033","name":"Agencia Estatal de Investigaci\u00f3n","doi-asserted-by":"publisher","award":["PID2020-117509GB-I00 \/ AEI \/ 10.13039\/50110001103"],"award-info":[{"award-number":["PID2020-117509GB-I00 \/ AEI \/ 10.13039\/50110001103"]}],"id":[{"id":"10.13039\/501100011033","id-type":"DOI","asserted-by":"publisher"}]}],"content-domain":{"domain":["link.springer.com"],"crossmark-restriction":false},"short-container-title":["Auton Robot"],"published-print":{"date-parts":[[2024,2]]},"abstract":"<jats:title>Abstract<\/jats:title><jats:p>It is often unnoticed that the predominant way to use collocation methods is fundamentally flawed when applied to optimal control in robotics. Such methods assume that the system dynamics is given by a first order ODE, whereas robots are often governed by a second or higher order ODE involving configuration variables and their time derivatives. To apply a collocation method, therefore, the usual practice is to resort to the well known procedure of casting an <jats:italic>M<\/jats:italic>th order ODE into <jats:italic>M<\/jats:italic> first order ones. This manipulation, which in the continuous domain is perfectly valid, leads to inconsistencies when the problem is discretized. Since the configuration variables and their time derivatives are approximated with polynomials of the same degree, their differential dependencies cannot be fulfilled, and the actual dynamics is not satisfied, not even at the collocation points. This paper draws attention to this problem, and develops improved versions of the trapezoidal and Hermite\u2013Simpson collocation methods that do not present these inconsistencies. In many cases, the new methods reduce the dynamics transcription error in one order of magnitude, or even more, without noticeably increasing the cost of computing the solutions.<\/jats:p>","DOI":"10.1007\/s10514-023-10155-z","type":"journal-article","created":{"date-parts":[[2024,1,28]],"date-time":"2024-01-28T13:02:06Z","timestamp":1706446926000},"update-policy":"https:\/\/doi.org\/10.1007\/springer_crossmark_policy","source":"Crossref","is-referenced-by-count":3,"title":["Collocation methods for second and higher order systems"],"prefix":"10.1007","volume":"48","author":[{"given":"Siro","family":"Moreno-Mart\u00edn","sequence":"first","affiliation":[]},{"given":"Llu\u00eds","family":"Ros","sequence":"additional","affiliation":[]},{"given":"Enric","family":"Celaya","sequence":"additional","affiliation":[]}],"member":"297","published-online":{"date-parts":[[2024,1,28]]},"reference":[{"issue":"1","key":"10155_CR1","doi-asserted-by":"publisher","first-page":"15","DOI":"10.1137\/S0895479899358194","volume":"23","author":"PR Amestoy","year":"2001","unstructured":"Amestoy, P. R., Duff, I. S., L\u2019Excellent, J.-Y., & Koster, J. (2001). A fully asynchronous multifrontal solver using distributed dynamic scheduling. SIAM Journal on Matrix Analysis and Applications, 23(1), 15\u201341. https:\/\/doi.org\/10.1137\/S0895479899358194","journal-title":"SIAM Journal on Matrix Analysis and Applications"},{"issue":"1","key":"10155_CR2","doi-asserted-by":"publisher","first-page":"1","DOI":"10.1007\/s12532-018-0139-4","volume":"11","author":"JAE Andersson","year":"2019","unstructured":"Andersson, J. A. E., Gillis, J., Horn, G., Rawlings, J. B., & Diehl, M. (2019). CasADi: A software framework for nonlinear optimization and optimal control. Mathematical Programming Computation, 11(1), 1\u201336. https:\/\/doi.org\/10.1007\/s12532-018-0139-4","journal-title":"Mathematical Programming Computation"},{"key":"10155_CR3","doi-asserted-by":"publisher","unstructured":"Becerra, V.\u00a0M. (2010). Solving complex optimal control problems at no cost with PSOPT. In  2010 IEEE International Symposium on Computer-aided Control System Design (pp. 1391\u20131396). https:\/\/doi.org\/10.1109\/CACSD.2010.5612676.","DOI":"10.1109\/CACSD.2010.5612676"},{"key":"10155_CR4","doi-asserted-by":"publisher","unstructured":"Berscheid, L. & Kr\u00f6ger, T. (2021). Jerk-limited real-time trajectory generation with arbitrary target states. In  Robotics: Science and Systems. https:\/\/doi.org\/10.15607\/RSS.2021.XVII.015","DOI":"10.15607\/RSS.2021.XVII.015"},{"key":"10155_CR5","doi-asserted-by":"publisher","DOI":"10.1137\/1.9780898718577","volume-title":"Practical methods for optimal control and estimation using nonlinear programming","author":"JT Betts","year":"2010","unstructured":"Betts, J. T. (2010). Practical methods for optimal control and estimation using nonlinear programming. Philadelphia: SIAM. https:\/\/doi.org\/10.1137\/1.9780898718577"},{"issue":"1","key":"10155_CR6","doi-asserted-by":"publisher","first-page":"183","DOI":"10.1109\/TRO.2022.3193776","volume":"39","author":"R Bordalba","year":"2023","unstructured":"Bordalba, R., Schoels, T., Ros, L., Porta, J. M., & Diehl, M. (2023). Direct collocation methods for trajectory optimization in constrained robotic systems. IEEE Transactions on Robotics, 39(1), 183\u2013202. https:\/\/doi.org\/10.1109\/TRO.2022.3193776","journal-title":"IEEE Transactions on Robotics"},{"key":"10155_CR7","doi-asserted-by":"publisher","unstructured":"Carpentier, J., Saurel, G., Buondonno, G., Mirabel, J., Lamiraux, F., Stasse, O., & Mansard, N. (2019). The Pinocchio C++ library: A fast and flexible implementation of rigid body dynamics algorithms and their analytical derivatives. In  IEEE International Symposium on System Integrations (SII). https:\/\/doi.org\/10.1109\/SII.2019.8700380.","DOI":"10.1109\/SII.2019.8700380"},{"issue":"5","key":"10155_CR8","doi-asserted-by":"publisher","first-page":"57","DOI":"10.1109\/MCS.2003.1234651","volume":"23","author":"C Chevallereau","year":"2003","unstructured":"Chevallereau, C., Abba, G., Aoustin, Y., Plestan, F., Westervelt, E. R., De Wit, C. C., & Grizzle, J. (2003). RABBIT: A testbed for advanced control theory. IEEE Control Systems Magazine, 23(5), 57\u201379. https:\/\/doi.org\/10.1109\/MCS.2003.1234651","journal-title":"IEEE Control Systems Magazine"},{"issue":"5","key":"10155_CR9","doi-asserted-by":"publisher","first-page":"233","DOI":"10.1115\/IMECE1999-0065","volume":"17","author":"D Constantinescu","year":"2000","unstructured":"Constantinescu, D., & Croft, E. A. (2000). Smooth and time-optimal trajectory planning for industrial manipulators along specified paths. Journal of Robotic Systems, 17(5), 233\u2013249. https:\/\/doi.org\/10.1115\/IMECE1999-0065","journal-title":"Journal of Robotic Systems"},{"key":"10155_CR10","doi-asserted-by":"publisher","first-page":"37","DOI":"10.1017\/cbo9780511778025.004","volume-title":"Spacecraft trajectory optimization","author":"BA Conway","year":"2010","unstructured":"Conway, B. A., & Paris, S. W. (2010). Spacecraft trajectory optimization using direct transcription and nonlinear programming. In B. Conway (Ed.), Spacecraft trajectory optimization (pp. 37\u201378). Cambridge: Cambridge University Press. https:\/\/doi.org\/10.1017\/cbo9780511778025.004"},{"key":"10155_CR11","doi-asserted-by":"crossref","unstructured":"Dahlquist, G., & Bj\u00f6rck, A. (2008).  Numerical Methods in Scientific Computing, Volume I. Society for Industrial and Applied Mathematics.","DOI":"10.1137\/1.9780898717785"},{"key":"10155_CR12","doi-asserted-by":"publisher","unstructured":"De\u00a0Luca, A., & Book, W.\u00a0J. (2016). Robots with flexible elements. In Springer handbook of robotics (pp. 243\u2013282. Springer. https:\/\/doi.org\/10.1007\/978-3-319-32552-1_11.","DOI":"10.1007\/978-3-319-32552-1_11"},{"key":"10155_CR13","doi-asserted-by":"publisher","unstructured":"Della Santina, C. (2020). Flexible Manipulators. In Encyclopedia of robotics. Springer. https:\/\/doi.org\/10.1007\/978-3-642-41610-1_182-1.","DOI":"10.1007\/978-3-642-41610-1_182-1"},{"key":"10155_CR14","doi-asserted-by":"publisher","DOI":"10.1007\/978-1-4899-7560-7","volume-title":"Rigid body dynamics algorithms","author":"R Featherstone","year":"2008","unstructured":"Featherstone, R. (2008). Rigid body dynamics algorithms. Berlin: Springer. https:\/\/doi.org\/10.1007\/978-1-4899-7560-7"},{"key":"10155_CR15","doi-asserted-by":"publisher","DOI":"10.1007\/978-3-662-05018-7","volume-title":"Geometric numerical integration","author":"E Hairer","year":"2002","unstructured":"Hairer, E., Wanner, G., & Lubich, C. (2002). Geometric numerical integration. Berlin: Springer. https:\/\/doi.org\/10.1007\/978-3-662-05018-7"},{"key":"10155_CR16","doi-asserted-by":"publisher","DOI":"10.1007\/978-3-540-78862-1","volume-title":"Solving ordinary differential equations. I","author":"E Hairer","year":"1993","unstructured":"Hairer, E., Wanner, G., & N\u00f8rsett, S. P. (1993). Solving ordinary differential equations. I. Berlin: Springer. https:\/\/doi.org\/10.1007\/978-3-540-78862-1"},{"issue":"4","key":"10155_CR17","doi-asserted-by":"publisher","first-page":"338","DOI":"10.2514\/3.20223","volume":"10","author":"CR Hargraves","year":"1987","unstructured":"Hargraves, C. R., & Paris, S. W. (1987). Direct trajectory optimization using nonlinear programming and collocation. Journal of Guidance, Control, and Dynamics, 10(4), 338\u2013342. https:\/\/doi.org\/10.2514\/3.20223","journal-title":"Journal of Guidance, Control, and Dynamics"},{"issue":"2","key":"10155_CR18","doi-asserted-by":"publisher","first-page":"370","DOI":"10.1109\/TRO.2017.2783371","volume":"34","author":"A Hereid","year":"2018","unstructured":"Hereid, A., Hubicki, C. M., Cousineau, E. A., & Ames, A. D. (2018). Dynamic humanoid locomotion: A scalable formulation for HZD gait optimization. IEEE Transactions on Robotics, 34(2), 370\u2013387. https:\/\/doi.org\/10.1109\/TRO.2017.2783371","journal-title":"IEEE Transactions on Robotics"},{"issue":"4","key":"10155_CR19","doi-asserted-by":"publisher","first-page":"849","DOI":"10.1137\/16M1062569","volume":"59","author":"M Kelly","year":"2017","unstructured":"Kelly, M. (2017). An introduction to trajectory optimization: How to do your own direct collocation. SIAM Review, 59(4), 849\u2013904. https:\/\/doi.org\/10.1137\/16M1062569","journal-title":"SIAM Review"},{"issue":"1","key":"10155_CR20","doi-asserted-by":"publisher","first-page":"42","DOI":"10.1109\/TRA.2002.807548","volume":"19","author":"S Macfarlane","year":"2003","unstructured":"Macfarlane, S., & Croft, E. A. (2003). Jerk-bounded manipulator trajectory planning: Design for real-time applications. IEEE Transactions on Robotics Automation, 19(1), 42\u201352. https:\/\/doi.org\/10.1109\/TRA.2002.807548","journal-title":"IEEE Transactions on Robotics Automation"},{"key":"10155_CR21","doi-asserted-by":"publisher","first-page":"1223","DOI":"10.1007\/s11071-017-3722-8","volume":"90","author":"S Manara","year":"2017","unstructured":"Manara, S., Gabiccini, M., Artoni, A., & Diehl, M. (2017). On the integration of singularity-free representations of SO(3) for direct optimal control. Nonlinear Dynamics, 90, 1223\u20131241.","journal-title":"Nonlinear Dynamics"},{"key":"10155_CR22","unstructured":"Moreno-Mart\u00edn, S. (2023a). Online Jupyter notebook for cart-pole problem (with 3rd order ODE). https:\/\/mybinder.org\/v2\/gh\/AunSiro\/Second-Order-Schemes\/HEAD?labpath=Cartpole-3rd-order-demo.ipynb."},{"key":"10155_CR23","unstructured":"Moreno-Mart\u00edn, S. (2023b). Online Jupyter notebook for the cart-pole problem (standard version). https:\/\/mybinder.org\/v2\/gh\/AunSiro\/Second-Order-Schemes\/HEAD?labpath=Cartpole-demo.ipynb."},{"key":"10155_CR24","unstructured":"Moreno-Mart\u00edn, S. (2023c). Online Jupyter notebook for the bipedal walking problem. https:\/\/mybinder.org\/v2\/gh\/AunSiro\/Second-Order-Schemes\/HEAD?labpath=Five-Link-Biped-demo.ipynb."},{"key":"10155_CR25","doi-asserted-by":"publisher","unstructured":"Moreno-Mart\u00edn, S., Ros, L., & Celaya, E. (2022). A Legendre-Gauss pseudospectral collocation method for trajectory optimization in second order systems. In 2022 IEEE\/RSJ International Conference on Intelligent Robots and Systems (IROS) (pp. 13335\u201313340). https:\/\/doi.org\/10.1109\/IROS47612.2022.9981255.","DOI":"10.1109\/IROS47612.2022.9981255"},{"key":"10155_CR26","doi-asserted-by":"crossref","unstructured":"Moreno-Mart\u00edn, S., Ros, L., & Celaya, E. (2022). Collocation methods for second order systems. In Robotics: Science and Systems, New York. http:\/\/www.roboticsproceedings.org\/rss18\/p038.html.","DOI":"10.15607\/RSS.2022.XVIII.038"},{"issue":"2","key":"10155_CR27","doi-asserted-by":"publisher","first-page":"946","DOI":"10.1109\/LRA.2016.2527062","volume":"1","author":"D Pardo","year":"2016","unstructured":"Pardo, D., M\u00f6ller, L., Neunert, M., Winkler, A. W., & Buchli, J. (2016). Evaluating direct transcription and nonlinear optimization methods for robot motion planning. IEEE Robotics and Automation Letters, 1(2), 946\u2013953. https:\/\/doi.org\/10.1109\/LRA.2016.2527062","journal-title":"IEEE Robotics and Automation Letters"},{"key":"10155_CR28","doi-asserted-by":"publisher","unstructured":"Park, H.-W., Sreenath, K., Ramezani, A., & Grizzle, J.\u00a0W. (2012). Switching control design for accommodating large step-down disturbances in bipedal robot walking. In 2012 IEEE International Conference on Robotics and Automation (pp. 45\u201350). IEEE. https:\/\/doi.org\/10.1109\/ICRA.2012.6225056.","DOI":"10.1109\/ICRA.2012.6225056"},{"key":"10155_CR29","doi-asserted-by":"publisher","unstructured":"Posa, M., Kuindersma, S., & Tedrake, R. (2016). Optimization and stabilization of trajectories for constrained dynamical systems. In IEEE International Conference on Robotics and Automation (pp. 1366\u20131373). https:\/\/doi.org\/10.1109\/ICRA.2016.7487270.","DOI":"10.1109\/ICRA.2016.7487270"},{"key":"10155_CR30","doi-asserted-by":"publisher","unstructured":"Saglam, C.\u00a0O. & Byl, K. (2014). Robust policies via meshing for metastable rough terrain walking. In Robotics: Science and Systems. https:\/\/doi.org\/10.15607\/RSS.2014.X.049.","DOI":"10.15607\/RSS.2014.X.049"},{"key":"10155_CR31","unstructured":"Tedrake, R. (2023). Underactuated robotics: Algorithms for walking, running, swimming, flying, and manipulation (Course Notes for MIT 6.832). MIT. Accessed 16 June 2023 from http:\/\/underactuated.mit.edu\/."},{"key":"10155_CR32","unstructured":"The Drake Team (2023). Drake: Model-based design and verification for robotics. https:\/\/drake.mit.edu\/."},{"key":"10155_CR33","unstructured":"The IPOPT Team (2023). IPOPT Documentation. Accessed 16 June 2023 from https:\/\/coin-or.github.io\/Ipopt\/OPTIONS.html."},{"key":"10155_CR34","doi-asserted-by":"publisher","first-page":"1","DOI":"10.1155\/2014\/851720","volume":"2014","author":"F Topputo","year":"2014","unstructured":"Topputo, F., & Zhang, C. (2014). Survey of direct transcription for low-thrust space trajectory optimization with applications. Abstract and Applied Analysis, 2014, 1\u201315. https:\/\/doi.org\/10.1155\/2014\/851720","journal-title":"Abstract and Applied Analysis"},{"issue":"1","key":"10155_CR35","doi-asserted-by":"publisher","first-page":"25","DOI":"10.1007\/s10107-004-0559-y","volume":"106","author":"A W\u00e4chter","year":"2006","unstructured":"W\u00e4chter, A., & Biegler, L. T. (2006). On the implementation of an interior-point filter line-search algorithm for large-scale nonlinear programming. Mathematical Programming, 106(1), 25\u201357. https:\/\/doi.org\/10.1007\/s10107-004-0559-y","journal-title":"Mathematical Programming"},{"key":"10155_CR36","doi-asserted-by":"publisher","unstructured":"Westervelt, E. R., Grizzle, J. W., & Koditschek, D. E. (2003). Hybrid zero dynamics of planar biped walkers. IEEE Transactions on Automatic Control, 48(1), 42\u201356. https:\/\/doi.org\/10.1109\/TAC.2002.806653","DOI":"10.1109\/TAC.2002.806653"},{"issue":"3","key":"10155_CR37","doi-asserted-by":"publisher","first-page":"277","DOI":"10.1007\/s10514-009-9126-y","volume":"27","author":"T Yang","year":"2009","unstructured":"Yang, T., Westervelt, E. R., Serrani, A., & Schmiedeler, J. P. (2009). A framework for the control of stable aperiodic walking in underactuated planar bipeds. Autonomous Robots, 27(3), 277\u2013290. https:\/\/doi.org\/10.1007\/s10514-009-9126-y","journal-title":"Autonomous Robots"}],"container-title":["Autonomous Robots"],"original-title":[],"language":"en","link":[{"URL":"https:\/\/link.springer.com\/content\/pdf\/10.1007\/s10514-023-10155-z.pdf","content-type":"application\/pdf","content-version":"vor","intended-application":"text-mining"},{"URL":"https:\/\/link.springer.com\/article\/10.1007\/s10514-023-10155-z\/fulltext.html","content-type":"text\/html","content-version":"vor","intended-application":"text-mining"},{"URL":"https:\/\/link.springer.com\/content\/pdf\/10.1007\/s10514-023-10155-z.pdf","content-type":"application\/pdf","content-version":"vor","intended-application":"similarity-checking"}],"deposited":{"date-parts":[[2024,3,9]],"date-time":"2024-03-09T03:03:46Z","timestamp":1709953426000},"score":1,"resource":{"primary":{"URL":"https:\/\/link.springer.com\/10.1007\/s10514-023-10155-z"}},"subtitle":[],"short-title":[],"issued":{"date-parts":[[2024,1,28]]},"references-count":37,"journal-issue":{"issue":"1","published-print":{"date-parts":[[2024,2]]}},"alternative-id":["10155"],"URL":"https:\/\/doi.org\/10.1007\/s10514-023-10155-z","relation":{},"ISSN":["0929-5593","1573-7527"],"issn-type":[{"value":"0929-5593","type":"print"},{"value":"1573-7527","type":"electronic"}],"subject":[],"published":{"date-parts":[[2024,1,28]]},"assertion":[{"value":"15 February 2023","order":1,"name":"received","label":"Received","group":{"name":"ArticleHistory","label":"Article History"}},{"value":"17 December 2023","order":2,"name":"accepted","label":"Accepted","group":{"name":"ArticleHistory","label":"Article History"}},{"value":"28 January 2024","order":3,"name":"first_online","label":"First Online","group":{"name":"ArticleHistory","label":"Article History"}},{"order":1,"name":"Ethics","group":{"name":"EthicsHeading","label":"Declarations"}},{"value":"The authors declare no competing interests.","order":2,"name":"Ethics","group":{"name":"EthicsHeading","label":"Conflict of interest"}}],"article-number":"2"}}