@Morpheus1997:

Die geposteten Funktionen zur Servoansteuerung können so funktionieren.