Merge pull request #14 from Auv5/dev

Fixed bug: Robot will drive forever in autonomous.