Entonces sube tu programa, en el que tienes ese único error; así podríamos verlo y decirte qué podrías hacer.
A menos claro, que quieras que alguien te haga el trabajo.
Y por cierto, si utilizas el BUSCADOR, encontrarás infinidad de información sobre control de servos.