added servo control