Riemannian Direct Trajectory Optimization of Rigid Bodies on Matrix Lie GroupsShare on Twitter Facebook LinkedIn Previous Next