Added Catapult/ Jordan

- Added Catapult subsystem, which is very similar to the Jordan
subsystem if we need to change it
- Added LaunchBall command, as well as a button to launch the ball
- Cleaned up some of the code for the drivetrain stuff