On-Manifold Model Predictive Control for Trajectory Tracking on Robotic Systems