danke fuer die antwort, hab den fehler gefunden hatte einen vorzeichenfehler bei der jakobimatrix. Ich arbeite mit einer imu von rotomotion
Zwar ungenau aber es funktioniert
Spielst du dich auch mit solchem Zeugsrum?

Michael