Removed debug output
Implemented DriveControl and added Joystick test