add servo to main program