Robot control code for the 2014 FRC season