Refactored tank turn state machine and other driving things in main into Drive.Compiles, but currently untested