Den Code im RN-Wissen solltest du dir noch mal genau ansehen!

Nur ein paar Sachen, die so nicht klappen:
1. Dein Timer läuft mit ca. 600Hz, d.h. die ISR wird alle ~1,7ms aufgerufen. Das wäre im Prinzip "fast" die Servo-Mittelstellung. Aber warum "disablest" du dann den Timer? Es müssen viele identische Impulse folgen, damit das Servo in eine Stellung fährt.
2. Alle 20ms muss der Impuls wiederholt werden. Das geht nicht mit einem Waitms in der ISR! Eine ISR muss so schnell wie möglich ablaufen. Warten darf man nicht in der ISR. Sieh dir das Beispiel aus dem RN-Wissen genau an!
3. Wenn das Servo "brummt" dann arbeitet es gegen einen Anschlag und verbraucht dabei extrem viel Strom. Der bringt dann dein Board zum Reset, weil dort die Versorgungs-Spannung einbricht. Das sieht dann so aus, dass das Board "neu startet".

Gruß Dirk