Guaranteeing persistent feasibility of model predictive motion planning for autonomous vehicles