Model predictive planning