Changing LED color and intensity based on servo command