Riemannian Direct Trajectory Optimization of Rigid Bodies on Matrix Lie Groups