Ich hab das RN-Meag8 Board,
da hab ichs auf PortB.4 angeschlossen, mit 7.32Mhz
Bei meinem Servo geht der Bereich von 40 bis 140,
ich hab nur die Werte geändert, aber ansonsten macht der das so wie von Dir gewünscht, bei 1 die eine, und bei 2 die andre Position, und auch hin und her usw.

Bau mal einen Print ein (irgendein Text ausgeben), um zu sehen, ob die Zeichen richtig ankommen im Terminal, dort hab ich auch gemerkt, das ich noch Deine MHz drin stehen hatte.