Ich würde Dir noch empfehlen vor dem Richtungswechsel die Enable's kurz auf LOW zu ziehen und nach dem Wechsel wieder auf High. Spart manchmal den einen oder anderen Motortreiber