Code for testing individual motors on an FRC Robot