Have a personal or library account? Click to login
Trajectory Optimization for Highly Articulated Robots based on Sparsity–Free Local Direct Collocation Cover

Trajectory Optimization for Highly Articulated Robots based on Sparsity–Free Local Direct Collocation

Open Access
|Dec 2025

References

  1. Agamawi, Y.M. and Rao, A.V. (2020). CGPOPS: A C++ software for solving multiple-phase optimal control problems using adaptive Gaussian quadrature collocation and sparse nonlinear programming, ACM Transactions on Mathematical Software 46(3): 1–38.
  2. Andersson, J.A., Gillis, J., Horn, G., Rawlings, J.B. and Diehl, M. (2019). CASADI: A software framework for nonlinear optimization and optimal control, Mathematical Programming Computation 11(1): 1–36.
  3. Becerra, V.M. (2010). Solving complex optimal control problems at no cost with PSOPT, 2010 IEEE International Symposium on Computer-Aided Control System Design, Yokohama, Japan, pp. 1391–1396.
  4. Betts, J.T. (2010). Practical Methods for Optimal Control and Estimation Using Nonlinear Programming, SIAM, Philadelphia.
  5. Betts, J.T. and Erb, S.O. (2003). Optimal low thrust trajectories to the moon, SIAM Journal on Applied Dynamical Systems 2(2): 144–170.
  6. Biegler, L.T. and Zavala, V.M. (2009). Large-scale nonlinear programming using IPOPT: An integrating framework for enterprise-wide dynamic optimization, Computers & Chemical Engineering 33(3): 575–582.
  7. Budhiraja, R., Carpentier, J., Mastalli, C. and Mansard, N. (2018). Differential dynamic programming for multi-phase rigid contact dynamics, 2018 IEEE-RAS 18th International Conference on Humanoid Robots (Humanoids), Beijing, China, pp. 1–9.
  8. Byrd, R.H., Nocedal, J. and Waltz, R.A. (2006). KNITRO: An integrated package for nonlinear optimization, in G. Di Pillo and M. Roma (Eds), Large-Scale Nonlinear Optimization, Springer, Boston, pp. 35–59.
  9. Cardona-Ortiz, D., Paz, A. and Arechavaleta, G. (2020). Exploiting sparsity in robot trajectory optimization with direct collocation and geometric algorithms, 2020 IEEE International Conference on Robotics and Automation (ICRA), pp. 469–475, (Virtual Event).
  10. Carpentier, J. and Mansard, N. (2018). Analytical derivatives of rigid body dynamics algorithms, Robotics: Science and Systems (RSS 2018), Pittsburgh, USA.
  11. Carpentier, J., Saurel, G., Buondonno, G., Mirabel, J., Lamiraux, F., Stasse, O. and Mansard, N. (2019). The Pinocchio C++ library: A fast and flexible implementation of rigid body dynamics algorithms and their analytical derivatives, 2019 IEEE/SICE International Symposium on System Integration (SII), Paris, France, pp. 614–619.
  12. Curtis, A.R., Powell, M.J. and Reid, J.K. (1974). On the estimation of sparse Jacobian matrices, IMA Journal of Applied Mathematics 13(1): 117–120.
  13. Felis, M.L. (2017). RBDL: An efficient rigid-body dynamics library using recursive algorithms, Autonomous Robots 41(2): 495–511.
  14. Gill, P.E., Murray, W. and Saunders, M.A. (2005). SNOPT: An SQP algorithm for large-scale constrained optimization, SIAM Review 47(1): 99–131.
  15. Guennebaud, G. and Benoît, J. (2023). Eigen v3.3.4, https://gitlab.com/libeigen/eigen/$-$/tree/3.3.
  16. Hereid, A., Hubicki, C.M., Cousineau, E.A. and Ames, A.D. (2018). Dynamic humanoid locomotion: A scalable formulation for HZD gait optimization, IEEE Transactions on Robotics 34(2): 370–387.
  17. Herman, A.L. and Conway, B.A. (1996). Direct optimization using collocation based on high-order Gauss–Lobatto quadrature rules, Journal of Guidance, Control, and Dynamics 19(3): 592–599.
  18. Houska, B., Ferreau, H.J. and Diehl, M. (2011). ACADO Toolkit—An open-source framework for automatic control and dynamic optimization, Optimal Control Applications and Methods 32(3): 298–312.
  19. Howell, T.A., Jackson, B.E. andManchester, Z. (2019). ALTRO: A fast solver for constrained trajectory optimization, 2019 IEEE/RSJ International Conference on Intelligent Robots and Systems (IROS), Macau, China, pp. 7674–7679.
  20. Kelly, M. (2017). An introduction to trajectory optimization: How to do your own direct collocation, SIAM Review 59(4): 849–904.
  21. Kelly, M.P. (2019). DIRCOL5I: Trajectory optimization for problems with high-order derivatives, Journal of Dynamic Systems, Measurement, and Control 141(3): 034502.
  22. Leineweber, D.B., Schäfer, A., Bock, H.G. and Schlöder, J.P. (2003). An efficient multiple shooting based reduced sqp strategy for large-scale dynamic process optimization. Part II: Software aspects and applications, Computers & Chemical Engineering 27(2): 167–174.
  23. Liu, G., Wu, S., Zhu, L., Wang, J. and Lv, Q. (2022). Fast and smooth trajectory planning for a class of linear systems based on parameter and constraint reduction, International Journal of Applied Mathematics and Computer Science 32(1): 11–21, DOI: 10.34768/amcs-2022-0002.
  24. Mastalli, C., Budhiraja, R., Merkt, W., Saurel, G., Hammoud, B., Naveau, M., Carpentier, J., Righetti, L., Vijayakumar, S. and Mansard, N. (2020). Crocoddyl: An efficient and versatile framework for multi-contact optimal control, 2020 IEEE International Conference on Robotics and Automation (ICRA), Paris, France, pp. 2536–2542.
  25. Mayne, D. (1966). A second-order gradient method for determining optimal trajectories of non-linear discrete-time systems, International Journal of Control 3(1): 85–95.
  26. Patterson, M.A., Hager, W.W. and Rao, A.V. (2015). A PH mesh refinement method for optimal control, Optimal Control Applications and Methods 36(4): 398–421.
  27. Paz, A. and Arechavaleta, G. (2023). Analytical differentiation of the articulated-body algorithm: A geometric multilinear approach, Multibody System Dynamics 60: 347–373.
  28. Paz, A. and Arechavaleta, G. (2024). Humanoid trajectory optimization with b-splines and analytical centroidal momentum derivatives, International Journal of Humanoid Robotics 21(02): 2350020.
  29. Posa, M., Cantu, C. and Tedrake, R. (2014). A direct method for trajectory optimization of rigid bodies through contact, International Journal of Robotics Research 33(1): 69–81.
  30. Rao, A.V. (2009). A survey of numerical methods for optimal control, Advances in the Astronautical Sciences 135(1): 497–528.
  31. Singh, S., Russell, R.P. and Wensing, P.M. (2024). On second-order derivatives of rigid-body dynamics: Theory & implementation, IEEE Transactions on Robotics 40: 2233–2253.
  32. Tassa, Y., Mansard, N. and Todorov, E. (2014). Control-limited differential dynamic programming, 2014 IEEE International Conference on Robotics and Automation (ICRA), Hong-Kong, China, pp. 1168–1175.
  33. Villanueva-Piñon, C. and Arechavaleta, G. (2025). DMOC-based robot trajectory optimization with analytical first-order information, International Journal of Applied Mathematics and Computer Science 35(1): 83–96, DOI: 10.61822/amcs-2025-0007.
  34. Walther, A., Griewank, A. and Vogel, O. (2003). ADOL-C: Automatic differentiation using operator overloading in C++, Proceedings in Applied Mathematics and Mechanics, 2: 41–44.
  35. Weinstein, M.J. and Rao, A.V. (2017). Algorithm 984: ADiGator, a toolbox for the algorithmic differentiation of mathematical functions in Matlab using source transformation via operator overloading, ACM Transactions on Mathematical Software 44(2): 1–25.
DOI: https://doi.org/10.61822/amcs-2025-0041 | Journal eISSN: 2083-8492 | Journal ISSN: 1641-876X
Language: English
Page range: 577 - 589
Submitted on: Feb 6, 2025
|
Accepted on: Jul 15, 2025
|
Published on: Dec 15, 2025
In partnership with: Paradigm Publishing Services
Publication frequency: 4 issues per year

© 2025 Daniel Cardona-Ortiz, Gustavo Arechavaleta, published by University of Zielona Góra
This work is licensed under the Creative Commons Attribution-NonCommercial-NoDerivatives 4.0 License.