add servo control