Ach so ist das mit dem Wait, vielen Dank.

Ja, Interrupts wären wirklich besser, aber das halte ich mir offen und verwende diese später dann bei den IR-Sensoren.