Zunächst die Servo Libary aufrufen.

Wir legen wir eine Variable mit dem Namen "Tor1" an.  Damit speichern wir die aktuelle Position des Servos Tor1.

Außerdem müssen wir einem Servo noch einen Namen geben.

Im Setup brauchen hier eigentlich nichts machen.

Dann Programieren wir eine Funktion außerhalb unseres Loop. Dadurch können wir wiederkehrende Abläufe einmal programmieren und aus dem Loop aufrufen und mit ein paar Parametern versorgen. Da wir einen Wert vom Typ int zurück erwarten, ist diese Funktion auch vom Typ int.

Übergeben werden folgende Werte:

an welchem Pin ist dieser angeschlossen, auf welche Grad-Zahl soll gefahren werden, auf welcher Grad-Zahl steht der Servo aktuell, wie lange soll zwischen den einzelenen Schritten gewartet werden.

In dieser Funktion aktivieren wir den PIN.

Dann müssen wir wissen in welche Richtung sich der Servo drehen muss. Daher Prüfen wir ob "soll" größer oder kleiner ist als "ist".

Beidesmal starten wir eine for-Schleife. Als Bedingungsvariable benutzten wir den "ist"-Wert. Diesen ändern wir solange schrittweise bis er dem soll entspricht.

Dann schicken wir dem Servo das Signal auf diesen "ist"-Wert zu fahren.

Anschließend warten wir kurz. Die dauer haben wir ja mit in die Funktion übergeben.

Nach den beiden for-Schleifen deaktivieren wir unseren Pin wieder. Außerdem senden wir den Wert "soll" aus der Funktion zurück.

Im loop brauchen wir dann nur die Funktion aufrufen und die Werte in der richtigen Reihenfolge mit übergeben. Der Wert der zurück kommt schreiben wir auf die Variable Tor1. Dies können wir dann wieder als "ist"-Wert in den nächsten Funktionsaufruf schicken