Ich war gerade mit dem Fahrrad unterwegs und dabei ist mir eingefallen, dass du Reload vergessen hast. Also der Abstand zw. den Impulsen. (Siehe Servo Artikel)
Bild hier  
Versuche das mal noch einzubauen. Wenn das fehlt, kommt es zu dem Verhalten, das dein Servo zeigt.

jon