Avevo già fatto, nel setup, esattamente come hai suggerito.
Per quanto riguarda il controllo ho usato una variabile che inizialmente vale 0 e quindi con una "if" vado dove voglio, solo la prima volta, poi nel loop la variabile diventa 1 e quindi non esce più dal loop.
L'unica "pecca" e che l'avevo dichiarata byte, ma siccome assume solo due valori 0/1 meglio risparmiare e farla diventare booleana 