Hi BlaueLed,

es mag auf den ersten Blick klappen, allerdings hat dein Programm noch 2 kleine Schönheitsfehler:

- Servos erwarten alle 20ms einen Impuls. Die meisten Servos können sehr gut mit kürzeren Abständen umgehen, einige mögen aber längere Abstände absolut nicht.
Wenn du nun einen Puls von 2ms sendest und nach jedem Puls 20ms wartest, kommen die Pulse eben nicht alle 20ms, sondern alle 22ms. Deshalb hatte ich auch vorgeschlagen, eine Pause von nur 18ms zu nehmen.

- momentan stellt sich dein Servo auf eine Position ein, nach 2 Sekunden gehts in die andere Position u.s.w.
Problem ist, das dein Servo in der "wait 1" Zeit absolut kraftlos wird, da keine Stellimpulse mehr eintreffen. Sollte der Servo also so verwendet werden, das er in seiner jeweiligen Position unter mechanischer Last ist, wird er diese nicht halten können.

Das ist just auch der Grund, warum häufig Timer verwendet werden und Servos über einen Interrupt gesteuert werden.

Gruß MeckPommER