Fixed bug: Robot will drive forever in autonomous.