Paso 3: Mover los actuadores
Hay dos funciones que desplacen el servomotor. Uno es para ir hacia delante, el otro para atrás. Son esencialmente el mismo, sólo difieren por que las variables se cambian y que velocidades se ajustan. Ver la primera función a continuación. Hay unos Serial.prints() incluido que pueden haber los comentarios eliminados para propósitos de depuración.
La magia de sincronización ocurre en la subrutina FWDsync(). Cubriremos en el próximo paso. Adjunto está el código completo.