Du könntest die Motoren mal komplett durch jeweils zwei antiparallel geschaltete Dioden verschiedener Farbe (und passendem Vorwiderstand) ersetzen.
Also LEDs rein - Motoren raus.
Verschiedenfarbige LEDs, damit du auch die Drehrichtung des Motors sehen kannst.

Wenn jetzt alles korrekt funktioniert ist dein Programm soweit in Ordnung und dein Hardware-Aufbau versaut dir den Tag. Dann wird es interessant.