Refactored, added safety timeout,  string format

AuxDrive is now a top level object instead of being inside
RobotController
Added gyro test
Added string formatting
Added magic