Robot with simple autonomous mode running fine, just need to take care with the stepper/sonar routine