Ayuda con mi servo

Tienes que usar millis() y olvidarte de delay() (al menos en aplicaciones de este tipo).

En la sección Documentación tienes excelentes tutoriales, por ej.