Ich kenne dir Motorfunktion zwar nicht. Aber wenn die mit Encodern und Interrupts arbeitet könnte dein simuliertes Multithreading da Probleme bereiten.