Optimal Decision Making for Automated Vehicles Using Homotopy Generation and Nonlinear Model Predictive Control | IEEE Conference Publication | IEEE Xplore