Construction site navigation for the autonomous excavator Thor
stanley : the robot that won the darpa grand challenge .