Moving led init to servo.cpp