Siro Moreno-Martín, Lluís Ros, Enric Celaya: Collocation Methods for Second Order Systems. Robotics: Science and Systems 2022