Debugged Teleop/Drive, deleted PID

reversed velocity for left motors so the go in correct direction.
Activated main class to enable teleop