Fixed drivetrain issues

* Moved joystick to _OI_
+ Plugged in subsystem into main robot program