add servo code