added servo functions