Das Programm sollte natürlich Fehler- und Warnungsfrei übersetzbar sein. Das würde ich mal als Grundlage vorraussetzen. Ebenso wie der richtige Anschluß der Servos und eine stabile Spannungsversorgung.

Wäre es nicht besser eine Liste mehrerer Beispiele zu erstellen als für jedes Beispiel einen Beitrag zu erstellen?

Nein mal im Ernst, würde es helfen den Rest zu posten? Ist halt nicht wenig...
Ja es würde helfen. Wenn es dir zuviel erscheint kannst du uns gerne eine Version deines Programms zeigen in der du dein Problem aufs nötigste reduziert hast. Denn genau das würden wir auch machen.

Gruß

mic