Fixed Drivetrain and Temporary Catapult code

- Added swag drive (completely working)
- Added a catapult button (probably will be switched out for Jordan code
eventually)