added servo rotate code