Achso, du hast praktisch nur die Anfangsstellung der Servos, berechnest dann die Endstellung und der Weg dazwischen "passiert".

Ich dachte du berechnest nicht nur die Servo-Endstellungen, sondern auch die optimalen Übergänge vom Ist- in den Sollzustand.

MfG
Daniel