Pit test - Drivetrain

[danielbrownmsm]

The test command should:

• run the drivetrain motors forward for a time and check to see that the encoder velocity and distance match what they should be
• do the same thing in reverse
• check the gyro, wait a bit, then check it again to make sure it's not drifting more than normal
• make sure the status of isGood is good
  Post a progress bar for this test to Shuffleboard, and a pass/fail status