Wait blockiert dir bis auf die interrupts alles. Spätestens, wenn du den Watchdog nutzt stört es gewaltig. Du könntest eine Uhr mitlaufen lassen und im sectic sub eine Variable um eins erhöhen. Wenn diese 5 erreicht hat wieder auf null setzen und nen Schritt gehen lassen.