Add a setWait function
Reorder to make RobotC happy