Getting two servos and RGB LED working together