added servo functionality