Fixed the while condition that keeps the robot moving forward. Seems to work.