added servo initialization