Advanced Model Predictive Path