Optimized route network graph as map reference for autonomous cars operating on German autobahn
stanley : the robot that won the darpa grand challenge .