Fixed Stuff

- Got Drivetrain sorted out and some logic cleaned up
- Added some buttons for drive commands
- Got catapult code working
- Created intake subsystem (no code yet)