Some of the code for FRC Team 3081 Roboeagles