es hängt garantiert mit meiner Servofunktion zusammen. Hier habe ich vermutlich ein Timerproblem oder so was.
Das kann ich mir nicht vorstellen. Dein Programm nutzt die Timer der Lib ohne sie zu beeinflussen. BP0 ist die StatusLED und hat auch keinen Einfluss auf die Motoransteuerung, zumal dein asuro auch bei auskommentierter Servofunktion nicht vorwärts fährt.

Bist du sicher das die Programmvarianten mit den Änderungen auch geflash wurden? Was passiert wenn du das Programm mit nicht angeschlossenem Servo startest?

Teste mal mit einem anderen Programm ob dein asuro überhaupt noch vorwärts fahren kann. Vielleicht ist die H-Brücke oder deren Ansteuerung defekt.