Vex Team 6089 RobotC code for October 2014 Tournament