erstmal.
Also wie das so aussieht mache ich eigentlich alles richtig, aber ich bekomme bei der berechnung der A,B,C winkeln kommische ergebnise.
Meine Vorgehnsweise:
Ich habe die 2 Frames, für diese 2 Frames erzeuge ich jeweils eine Rotationsmatrix
RNG=Rot(z,A)*Rot(y,B)*Rot(x,A).
dann wird jeweils eine Homogene 4X4 Matrix erzeugt, die Beiden so erhaltenen Matrizen werden mit einander Multipliziert, als ergebnis bekomme ich natürch wieder eine Homogene 4X4 Matrix. Nun kann ich die Werte X=(1,4) Y=(2,4) Z=(3,4) Ablesen, soweit so gut.
Um nun auf die Winkel zu kommen muss ich der Orthogonale 3X3 Matrix Transponieren.
und Anschließend über die arctan2 funktion die Winkel bestimmen. das kalppt aber nicht.
was mache ich falsch??