RobotC code for competition