Super danke dir. 
Weist du ob das ganze von den Zeitschritten bzw. der Daten-Frequenz her funktionieren würde?
Sprich die Messdaten sind in einer Auflösung von 100Hz aufgenommen, aber ich würde die Datei hoffentlich auch in 10Hz Auflösung bekommen.
Und somit ist die Frage ob es klappt die Daten so schnell zu verarbeiten und an die Servos zu schicken, dass die Servowinkel auch in 10Hz "Abständen" an die Servos geschickt werden?
Hoffe du verstehst was ich versuche zu sagen.
Gruß Chris