L'ultimo IF, se creato per ogni motore, rallenta e incasina di molto la prima istanza di movimento dei motori, quindi non va bene.
Le condizioni che devo inserire, quindi, sono:
.muovi i motori CW finché non hanno raggiunto la posizione impostata;
.muovi i motori CCW finché il relativo finecorsa non chiama stop(); e disabilita l'Enable;
.nel caso il finecorsa sia attivo (quindi dopo CCW) e sia richiesto il movimento CW, fallo, fino alla posizione impostata;