Queued State Machine Zeitverzögerung

Ist ja klar, im Idle-State hast Du die Wartezeit drin, und von fast jedem Status aus, auch aus dem Idle-Status selbst, fütterst du immer die Queue, um den Idle-D status erneut auszuführen. Das hat zur Folge, dass in der while-Schleife nur höchstens all 100ms etwas "Vernüftiges" aus der Queue abgearbeitet werden kann - und das ist zu wenig, die Queue wird im Lauf der Zeit immer voller.
Wozu überhaup der Idle-Status? Die Funktion "Element aus Queue entfernen" wartet doch, wenn nichts mehr in der Queue ist, und das ist dann gewissermaßen der Idle-Zustand. Du kannst den Idle-Status von mir aus auch lassen, aber dann nicht von da aus erneut immer wieder die Queue mit "Idle" füttern - und natürlich ohne Wartezeit.
Die Waits in der oberen Schleife sind auch überflüssig: Weg mit dem 10ms Wait, und weg mit dem ganzen Timeout-Case.

Edit: Die Doppelbelastung, von Jens und von mir annähernd dasselbe lesen zu müssen, macht Dir doch hoffentlich nichts aus?