Model Predictive Control with Successive Linear Approximation on Robotic Systems