Por más que lo miro no veo donde está el error... Has probado con los ejemplos de la librería servo??