Wenn ich mir den Sketch ansehe mit den vielen ifs, kann ich dir nur raten, das ganze auf eine Statemaschine umzubauen.
Du findest hier im Forum massig Beispiele. Ein ganz einfaches Beispiel würde erst heute morgen von @noiasca gezeigt: Schrankensteuerung HO