Most of the code for VEX team 2713