LED and Servo Code Working in Opposite Way