Correct motor direction code
Update teleop w/ vectors