Strategic decision making for automated driving on two-lane, one way roads using model predictive control
stanley : the robot that won the darpa grand challenge .