Veo que esa función es llamada mediante un temporizador. ¿No será que no le da tiempo a ejecutarse por completo y vuelve a ser rellamada por el temporizador? Prueba a ver utilizando en el monitor serial y el setup una velocidad más alta para que los serial.print de esa función se ejecuten más rápido.
Saludos.