Natürlich gibt es switch, aber ich habe gehört, dass es zumindest in C/C++ langsamer ist als if-else-if.
Ausserdem habe ich schon darauf hingewiesen, dass du nicht jedesmal waitingStartTime auf die aktuelle "Zeit" setzen darfst, wie sollte dann auch die > waitingStartTime + 500 wahr werden?
Man hat ein schönes Problem zu lösen, falls das sleep wirklich ausgeführt bevor alles mit Schwarz gefüllt wird, obwohl es wirklich danach im Code ist.