Hi hannes
Ich werde Dir gerne helfen, daß Du Deinen Code angepasst bekommst.
Ein Forum hat aber nicht den Sinn, daß per PN fertige Codes überreicht werden - wenn mich Deine Anfrage auch ehrt, hier gibt Es eine ganze Menge Leute mit wesentlich mehr 'Skills' in Sachen Arduino.
Versuche meinen Pseudo-Code zu verstehen und packe Das in Deinen Sketch - wenn's nicht klappt, kannst Du damit gerne wieder hier vorbei kommen - so sehen wir, wie weit Du gekommen bist und Du verstehst, was Du Da geschrieben hast.
Die Nachwelt wird bei einem ähnlichem Problem dann auch Deinen Werdegang sehen und so das Problem aus der Welt schaffen können - so gibt es nur Gewinner.
MfG
PS: Das 'in Code-Tags setzen' kannst Du nachträglich tun - mit der Bitte, daß Du Deinen Anfangs-Post durch Code-Tags (Schaltfläche </> im Antwort-Fenster) ergänzt.