Model Predictive Control Planner