Hallo Robotoni,

kleiner Tipp:
da Du das RP6-M32 Erweiterungsmodul hast, gäbe es neben den Möglichkeiten die mic und Dirk angegeben haben auch die Möglichkeit ein PWM Modul des MEGA32 auf dem RP6-M32 zu verwenden. Timer1 ist beim RP6-M32 komplett frei und PD5(OC1A) ist auf dem I/O Erweiterungsanschluss verfügbar. Das Hardware PWM Modul zu verwenden hätte den Vorteil, dass es keinerlei Rechenzeit kostet und immer nur einmal kurz die Position des Servos gesetzt werden muss.

Beispielcode habe ich gerade leider nicht parat, aber nähere Infos dazu findest Du z.B. im Datenblatt des MEGA32 im Abschnitt zum Timer1.

MfG,
SlyD