Rotationsmatrix und Translationsvektor¶
Eine Pose kann mit einer Rotationsmatrix \(R\) und einem Translationsvektor \(T\) definiert werden.
Die Posentransformation für einen Punkt \(P\) ist
Umrechnung von Rotationsmatrizen in Quaternionen¶
Die Umrechnung von einer Rotationsmatrix (mit \(det(R)=1\)) in eine Quaternion \(q=(\begin{array}{cccc}x & y & z & w\end{array})\) kann wie folgt durchgeführt werden.
Der \(\text{sign}\) Operator gibt -1 zurück, falls sein Argument negativ ist. Sonst wird 1 zurück gegeben. Er wird zur Wiederherstellung das Vorzeichens der Wurzel benutzt. Die \(\text{max}\) Funktion stellt sicher, dass das Argument der Wurzel nicht negativ ist, was in der Praxis durch Rundungsfehler passieren kann.
Umrechnung von Quaternionen in Rotationsmatrizen¶
Die Umrechnung von einer Quaternion \(q=(\begin{array}{cccc}x & y & z & w\end{array})\) mit \(||q||=1\) in eine Rotationsmatrix kann wie folgt durchgeführt werden.