A unified approach to local trajectory planning and control for autonomous driving along a reference path
stanley : the robot that won the darpa grand challenge .