Integrated nonlinear model predictive control for automated driving