Controls

[ejbunnell]

Main points:

• Control structure now all in Control class
• Different autos are now in place, along with the shooter and intake commands
• Fixed issues with loop overrun, make sure to not try to do too much every cycle, especially setting PIDFs of motors
• Changed field oriented control to use the odometry rot instead of the raw gyro angle