Der Code da oben von mir funktioniert.
Ich hatte nur die Motoren falsch angeschlossen, somit war alles irgendwie bißchen komisch.
Danke für die schnellen Antworten.