Drastic Change

Added default subsystem command function and removed calls to command
driveCMD