Finished SetGear commands. Modified DriveTrain to work with SetGear.
Merge pull request #5 from Team997Coders/SetGear

Finished SetGear commands. Modified DriveTrain to work with SetGear.