Team 2601's summer drivetrain project.
To do:
- Port to command-based model
- Fix shifting toggle (probably not an issue with the Spike) - should be easy to resolve with the above
- Convert to Singleton pattern
- Extend RobotDrive for 6CIMs (optional)
- Add inertia controls
- Add encoder feedback (PID control, moving in a straight line)
- Adapt buttons/joysticks for gamepad
- Try CheesyDrive