Added servos functions