Exploiting sparsity in robot trajectory optimization with direct collocation and geometric algorithms. - Daniel Cardona-Ortiz; Alvaro Paz; Gustavo Arechavaleta (ICRA, 2020)