Hallo djdune!
Ich freue mich für Dich, dass die Hardware schon OK ist. Damit hast Du schon die Hälfte geschafft. Dein Code ist nicht lang, deswegen ist es schneller ihn neu zu schreiben statt Fehler suchen. Ich würde Dir empfehlen in kleinen Stücken schreiben und jedes Stück gleich prüfen, nächstes Stück schreiben, prüfen usw. Obwohl ich schon bischen Erfahrung habe mache ich immer so. Wenn ich jetzt Dein Code auf Fehler prüfen sollte, dann wird die Beschreibung, wie die Motoren laufen sollen, länger als der Code, oder?
Viel Spass und Erfolg!
MfG