单位四元数与SO(3)中的旋转表示
1. 四元数基础
四元数在旋转表示中有着重要的应用。早在1840年,Olinde Rodrigues就独立发现了相关公式,比Hamilton还要早几年。不过,Rodrigues使用的是不同的形式体系——齐次变换,且并未发现四元数。
对于矩阵 (X = \begin{pmatrix} a + ib & c + id \ -(c - id) & a - ib \end{pmatrix}),其中 (a, b, c, d \in R),可以立即验证 (XX^ = X^ X = (a^2 + b^2 + c^2 + d^2)I),并且 (X^ = \begin{pmatrix} a - ib & -(c + id) \ c - id & a + ib \end{pmatrix} = a1 - bi - cj - dk)。这意味着如果 (X \neq 0),那么 (X) 是可逆的,其逆为 (X^{-1} = (a^2 + b^2 + c^2 + d^2)^{-1}X^ )。由此可以验证,四元数集合 (H) 是一个斜域(非交换域),同时它也是一个四维实向量空间,基为 ((1, i, j, k)),所以作为向量空间,(H) 与 (R^4) 同构。
四元数 (X) 可以简洁地表示为 (X = [a, (b, c, d)]),其中 (a) 称为 (X) 的标量部分,((b, c, d)) 称为向量部分。(X) 的共轭四元数 (X^* = [a, -(b, c, d)]),通常记为 (\overline{X})。如果 (q) 是单位四元数,那么 (q) 是 (q) 的乘法逆元。
2. SU(2) 中单位四元数对 SO(3) 旋转的表示
单位四元数表示 (SO(3)) 中旋转的关键在于 (SU(2)) 的伴随表示,这是一种群同态。
首先定义 (2\times2) 零迹斜Hermitian矩阵的实向量空间 (su(2)):
(su(2) = \left{ \begin{pmatrix} ix & y + iz \ -y + iz & -ix \end{pmatrix} \mid (x, y, z) \in R^3 \right})
对于任意矩阵 (A \in su(2)),有 (A^* = -A)(即 (A) 是斜Hermitian矩阵)且 (tr(A) = 0)。
(SU(2)) 的伴随表示定义为群同态 (Ad: SU(2) \to GL(su(2))),对于任意 (q = \begin{pmatrix} \alpha & \beta \ -\beta & \alpha \end{pmatrix} \in SU(2)),(Ad_q(A) = qAq^ ),其中 (A \in su(2)),(q^ ) 是 (q) 的逆(因为 (SU(2)) 是酉群),(q^* = \begin{pmatrix} \alpha & -\beta \ \beta & \alpha \end{pmatrix})。可以验证 (Ad_q) 是从 (su(2)) 到自身的可逆线性映射,且 (Ad) 是群同态。
为了将 (q) 与 (SO(3)) 中的旋转 (\rho_q) 关联起来,需要将 (R^3) 作为纯四元数嵌入到 (H) 中,通过 (\psi(x, y, z) = \begin{pmatrix} ix & y + iz \ -y + iz & -ix \end{pmatrix}),((x, y, z) \in R^3)。则 (q) 定义了 (R^3) 上的映射 (\rho_q(x, y, z) = \psi^{-1}(q\psi(x, y, z)q^*))。在同构 (\psi) 下,线性映射 (\rho_q) 就是线性同构 (Ad_q),并且可以证明 (\rho_q) 是一个旋转。
技术上,将 (R^3) 嵌入到零迹Hermitian矩阵的实向量空间中会更简单:
(\left{ \begin{pmatrix} x & z - iy \ z + iy & -x \end{pmatrix} \mid x, y, z \in R \right})
因为矩阵 (\psi(x, y, z)) 是斜Hermitian的,所以 (-i\psi(x, y, z)) 是Hermitian的,且 (-i\psi(x, y, z) = \begin{pmatrix} x & z - iy \ z + iy & -x \end{pmatrix} = x\sigma_3 + y\sigma_2 + z\sigma_1),其中 (\sigma_1 = \begin{pmatrix} 0 & 1 \ 1 & 0 \end{pmatrix}),(\sigma_2 = \begin{pmatrix} 0 & -i \ i & 0 \end{pmatrix}),(\sigma_3 = \begin{pmatrix} 1 & 0 \ 0 & -1 \end{pmatrix}) 是Pauli自旋矩阵。
单位四元数 (q \in SU(2)) 诱导了 (R^3) 上的映射 (r_q):
(r_q(x, y, z) = \phi^{-1}(q\phi(x, y, z)q^
) = \phi^{-1}(q(x\sigma_3 + y\sigma_2 + z\sigma_1)q^
)),其中 (\phi(x, y, z) = x\sigma_3 + y\sigma_2 + z\sigma_1),且 (\phi = -i\psi),(\phi^{-1} = i\psi^{-1})。
可以证明对于任意单位四元数 (q \in SU(2)),线性映射 (r_q) 是正交的,即 (r_q \in O(3))。进一步通过寻找 (r_q) 的不动点,可以证明 (r_q) 是一个旋转。具体来说,设 (q = \begin{pmatrix} \alpha & \beta \ -\beta & \alpha \end{pmatrix}),(\alpha = a + ib),(\beta = c + id),且 (a^2 + b^2 + c^2 + d^2 = 1)。如果 ((b, c, d) \neq (0, 0, 0)),则 (r_q) 的不动点是线性系统 (\begin{cases} -dy + cz = 0 \ cx - by = 0 \ dx - bz = 0 \end{cases}) 的解,该线性系统有非平凡解 ((b, c, d)) 且秩为2,所以 (r_q) 有特征值1,重数为1,其旋转轴由 ((b, c, d)) 确定。
映射 (r: SU(2) \to SO(3)),(q \mapsto r_q) 是一个群同态,其核为 ({I, -I})。虽然 (r) 是满射,但这并不明显,后续将在明确表示 (r_q) 的矩阵后再进行讨论。
3. 旋转 (r_q) 的矩阵表示
给定单位四元数 (q = \begin{pmatrix} \alpha & \beta \ -\beta & \alpha \end{pmatrix}),(\alpha = a + ib),(\beta = c + id),且 (a^2 + b^2 + c^2 + d^2 = 1),为了找到表示旋转 (r_q) 的矩阵,需要计算 (q(x\sigma_3 + y\sigma_2 + z\sigma_1)q^*)。
经过一系列计算可得:
(x’ = (a^2 + b^2 - c^2 - d^2)x + 2(bc - ad)y + 2(ac + bd)z)
(y’ = 2(ad + bc)x + (a^2 - b^2 + c^2 - d^2)y + 2(-ab + cd)z)
(z’ = 2(-ac + bd)x + 2(ab + cd)y + (a^2 - b^2 - c^2 + d^2)z)
表示 (r_q) 的矩阵为:
(R_q = \begin{pmatrix} a^2 + b^2 - c^2 - d^2 & 2bc - 2ad & 2ac + 2bd \ 2bc + 2ad & a^2 - b^2 + c^2 - d^2 & -2ab + 2cd \ -2ac + 2bd & 2ab + 2cd & a^2 - b^2 - c^2 + d^2 \end{pmatrix})
由于 (a^2 + b^2 + c^2 + d^2 = 1),该矩阵也可写为:
(R_q = \begin{pmatrix} 2a^2 + 2b^2 - 1 & 2bc - 2ad & 2ac + 2bd \ 2bc + 2ad & 2a^2 + 2c^2 - 1 & -2ab + 2cd \ -2ac + 2bd & 2ab + 2cd & 2a^2 + 2d^2 - 1 \end{pmatrix})
这就是由四元数 (q) 诱导的Euler形式的旋转矩阵,对应于 (\rho_q),因为 (r_q = \rho_q)。
下面用表格总结一些关键信息:
| 概念 | 定义或表达式 |
| ---- | ---- |
| 四元数 (X) | (X = [a, (b, c, d)]) |
| (su(2)) | (su(2) = \left{ \begin{pmatrix} ix & y + iz \ -y + iz & -ix \end{pmatrix} \mid (x, y, z) \in R^3 \right}) |
| 伴随表示 (Ad_q(A)) | (Ad_q(A) = qAq^*),(q \in SU(2)),(A \in su(2)) |
| 旋转 (r_q) 的矩阵 (R_q) | (R_q = \begin{pmatrix} a^2 + b^2 - c^2 - d^2 & 2bc - 2ad & 2ac + 2bd \ 2bc + 2ad & a^2 - b^2 + c^2 - d^2 & -2ab + 2cd \ -2ac + 2bd & 2ab + 2cd & a^2 - b^2 - c^2 + d^2 \end{pmatrix}) |
mermaid流程图如下:
graph TD;
A[单位四元数 \(q\)] --> B[伴随表示 \(Ad_q\)];
B --> C[旋转 \(\rho_q\) 或 \(r_q\)];
C --> D[旋转矩阵 \(R_q\)];
4. 寻找表示旋转的四元数的算法
已知同态 (r: SU(2) \to SO(3)) 是满射,下面给出寻找表示旋转矩阵 (R) 的单位四元数 (q) 的算法。
设 (q = \begin{pmatrix} a + ib & c + id \ -(c - id) & a - ib \end{pmatrix}),(a^2 + b^2 + c^2 + d^2 = 1)。
首先,(R_q) 的迹 (tr(R_q) = 3a^2 - b^2 - c^2 - d^2 = 4a^2 - 1),所以 (a^2 = \frac{tr(R_q) + 1}{4})。对于任意旋转矩阵 (R \in SO(3)),若 (R = \begin{pmatrix} r_{11} & r_{12} & r_{13} \ r_{21} & r_{22} & r_{23} \ r_{31} & r_{32} & r_{33} \end{pmatrix}),要找到 (q \in SU(2)) 使得 (R_q = R),则 (a^2 = \frac{tr(R) + 1}{4})。又因为 (tr(R) = 1 + 2\cos\theta),(\theta \in [0, \pi]) 是旋转 (R) 的角度,所以 (a^2 = \frac{\cos\theta + 1}{2} = \cos^2(\frac{\theta}{2})),即 (|a| = \cos(\frac{\theta}{2}))。
分两种情况讨论:
-
情况1:(tr(R) \neq -1)(即 (\theta \neq \pi))
:此时 (a \neq 0),取 (a = \sqrt{\frac{tr(R) + 1}{2}})。通过比较 (R - R^T) 和 (R_q - R_q^T),可得 (4ab = r_{32} - r_{23}),(4ac = r_{13} - r_{31}),(4ad = r_{21} - r_{12}),从而 (b = \frac{r_{32} - r_{23}}{4a}),(c = \frac{r_{13} - r_{31}}{4a}),(d = \frac{r_{21} - r_{12}}{4a})。
-
情况2:(tr(R) = -1)(即 (\theta = \pi))
:此时 (a = 0)。通过比较 (R + R^T) 和 (R_q + R_q^T),可得 (4bc = r_{21} + r_{12}),(4bd = r_{13} + r_{31}),(4cd = r_{32} + r_{23})。再比较 (R) 和 (R_q) 的对角项,可得 (b^2 = \frac{1 + r_{11}}{2}),(c^2 = \frac{1 + r_{22}}{2}),(d^2 = \frac{1 + r_{33}}{2})。因为 (q \neq 0) 且 (a = 0),至少有一个 (b, c, d) 不为零。
- 若 (b \neq 0),取 (b = \sqrt{\frac{1 + r_{11}}{2}}),并根据 (4bc = r_{21} + r_{12}) 和 (4bd = r_{13} + r_{31}) 确定 (c) 和 (d)。
- 若 (c \neq 0),取 (c = \sqrt{\frac{1 + r_{22}}{2}}),并根据 (4bc = r_{21} + r_{12}) 和 (4cd = r_{32} + r_{23}) 确定 (b) 和 (d)。
- 若 (d \neq 0),取 (d = \sqrt{\frac{1 + r_{33}}{2}}),并根据 (4bd = r_{13} + r_{31}) 和 (4cd = r_{32} + r_{23}) 确定 (b) 和 (c)。
需要注意的是,在计算平方根时,若取负号会得到四元数 (-q),但 (q) 和 (-q) 确定相同的旋转 (r_q)。
这种根据 (tr(R)) 的不同情况进行讨论的方法与使用Rodrigues公式寻找旋转矩阵的对数的过程类似。若 (B = \begin{pmatrix} 0 & -u_3 & u_2 \ u_3 & 0 & -u_1 \ -u_2 & u_1 & 0 \end{pmatrix}),(\theta = \sqrt{u_1^2 + u_2^2 + u_3^2})((0 \leq \theta \leq \pi)),Rodrigues公式为 (e^B = I + \frac{\sin\theta}{\theta}B + \frac{1 - \cos\theta}{\theta^2}B^2)((\theta \neq 0)),(e^0 = I),且 (tr(e^B) = 1 + 2\cos\theta)。对应于旋转 (R = e^B)((B \neq 0))的四元数 (q = \left[ \cos(\frac{\theta}{2}), \sin(\frac{\theta}{2}) \left(\frac{u_1}{\theta}, \frac{u_2}{\theta}, \frac{u_3}{\theta}\right) \right])。
从几何角度看,群 (SU(2)) 同胚于 (R^4) 中的三维球面 (S^3 = {(x, y, z, t) \in R^4 \mid x^2 + y^2 + z^2 + t^2 = 1})。由于满同态 (r: SU(2) \to SO(3)) 的核为 ({I, -I}),作为拓扑空间,(SO(3)) 同胚于通过将 (S^3) 中对径点 ((x, y, z, t)) 和 (-(x, y, z, t)) 等同得到的商空间,即实射影空间 (RP^3),它比 (S^3) 更复杂,(S^3) 是单连通的,而 (RP^3) 不是。
5. 指数映射 (\exp: su(2) \to SU(2))
对于任意矩阵 (A \in su(2)),(A = \begin{pmatrix} iu_1 & u_2 + iu_3 \ -u_2 + iu_3 & -iu_1 \end{pmatrix}),有 (A^2 = -\theta^2 \begin{pmatrix} 1 & 0 \ 0 & 1 \end{pmatrix}),其中 (\theta = \sqrt{u_1^2 + u_2^2 + u_3^2})。则有公式 (e^A = \cos\theta I + \frac{\sin\theta}{\theta}A)((\theta \neq 0)),(e^0 = I)。这表明指数映射 (\exp: su(2) \to SU(2)) 是存在的,它类似于指数映射 (\exp: so(3) \to SO(3))。
若假设 (u = (u_1, u_2, u_3)) 是单位向量,即 (det(A) = 1),则 (A^2 = -I),公式变为 (e^{\theta A} = \cos\theta I + \sin\theta A),用四元数表示为 (e^{\theta A} = [\cos\theta, \sin\theta u])。
指数映射 (\exp: su(2) \to SU(2)) 是满射,下面给出寻找单位四元数 (q = \begin{pmatrix} \alpha & \beta \ -\beta & \alpha \end{pmatrix})((\alpha = a + bi),(\beta = c + id))的对数 (A \in su(2)) 的算法:
- 若 (q = I)(即 (a = 1)),则 (A = 0)。
- 若 (q = -I)(即 (a = -1)),则 (A = \pm\pi \begin{pmatrix} i & 0 \ 0 & -i \end{pmatrix})。
- 否则,(a \neq \pm 1) 且 ((b, c, d) \neq (0, 0, 0)),寻找 (A = \theta B \in su(2)),(det(B) = 1),(0 < \theta < \pi),使得 (q = e^{\theta B} = \cos\theta I + \sin\theta B)。设 (B = \begin{pmatrix} iu_1 & u_2 + iu_3 \ -u_2 + iu_3 & -iu_1 \end{pmatrix}),(u = (u_1, u_2, u_3)) 是单位向量,则有 (a = \cos\theta),(e^{\theta B} - (e^{\theta B})^
= q - q^
)。因为 (0 < \theta < \pi),(\sin\theta \neq 0),可得 (u_1 = \frac{1}{\sin\theta}b),(u_2 + iu_3 = \frac{1}{\sin\theta}(c + id)),即 (\cos\theta = a),((u_1, u_2, u_3) = \frac{1}{\sin\theta}(b, c, d))。由于 (a^2 + b^2 + c^2 + d^2 = 1) 且 (a = \cos\theta),向量 (\frac{(b, c, d)}{\sin\theta}) 是单位向量。若四元数 (q = [\cos\theta, \sin\theta u]),则 (A = \theta \begin{pmatrix} iu_1 & u_2 + iu_3 \ -u_2 + iu_3 & -iu_1 \end{pmatrix}) 是 (q) 的对数。
表格总结指数映射相关信息:
| 情况 | 四元数 (q) | 对数 (A) |
| ---- | ---- | ---- |
| (q = I) | (a = 1) | (A = 0) |
| (q = -I) | (a = -1) | (A = \pm\pi \begin{pmatrix} i & 0 \ 0 & -i \end{pmatrix}) |
| 其他 | (a \neq \pm 1) 且 ((b, c, d) \neq (0, 0, 0)) | (A = \theta B),(det(B) = 1),(0 < \theta < \pi),(u_1 = \frac{1}{\sin\theta}b),(u_2 + iu_3 = \frac{1}{\sin\theta}(c + id)) |
mermaid流程图如下:
graph TD;
E[单位四元数 \(q\)] --> F{特殊情况};
F -- \(q = I\) --> G[\(A = 0\)];
F -- \(q = -I\) --> H[\(A = \pm\pi \begin{pmatrix} i & 0 \\ 0 & -i \end{pmatrix}\)];
F -- 其他 --> I[计算 \(A = \theta B\)];
通过以上内容,我们详细介绍了单位四元数在表示 (SO(3)) 中旋转的相关理论、矩阵表示、寻找表示旋转的四元数的算法以及指数映射等内容,这些知识在计算机图形学、机器人学等领域有着重要的应用。
单位四元数与SO(3)中的旋转表示
6. 算法总结与实际应用
前面介绍了寻找表示旋转矩阵的四元数的算法以及指数映射相关内容,下面对这些算法进行总结,并探讨其在实际中的应用。
寻找表示旋转矩阵的四元数算法总结
:
1. 计算旋转矩阵 (R) 的迹 (tr(R))。
2. 根据 (tr(R)) 的值分情况讨论:
- 若 (tr(R) \neq -1):
- 计算 (a = \sqrt{\frac{tr(R) + 1}{2}})。
- 通过比较 (R - R^T) 和 (R_q - R_q^T) 计算 (b = \frac{r_{32} - r_{23}}{4a}),(c = \frac{r_{13} - r_{31}}{4a}),(d = \frac{r_{21} - r_{12}}{4a})。
- 若 (tr(R) = -1):
- 确定至少一个非零的 (b, c, d)。
- 若 (b \neq 0),取 (b = \sqrt{\frac{1 + r_{11}}{2}}),根据 (4bc = r_{21} + r_{12}) 和 (4bd = r_{13} + r_{31}) 确定 (c) 和 (d)。
- 若 (c \neq 0),取 (c = \sqrt{\frac{1 + r_{22}}{2}}),根据 (4bc = r_{21} + r_{12}) 和 (4cd = r_{32} + r_{23}) 确定 (b) 和 (d)。
- 若 (d \neq 0),取 (d = \sqrt{\frac{1 + r_{33}}{2}}),根据 (4bd = r_{13} + r_{31}) 和 (4cd = r_{32} + r_{23}) 确定 (b) 和 (c)。
指数映射求对数算法总结
:
1. 对于单位四元数 (q = \begin{pmatrix} \alpha & \beta \ -\beta & \alpha \end{pmatrix}),判断 (q) 的值:
- 若 (q = I),则 (A = 0)。
- 若 (q = -I),则 (A = \pm\pi \begin{pmatrix} i & 0 \ 0 & -i \end{pmatrix})。
- 若 (a \neq \pm 1) 且 ((b, c, d) \neq (0, 0, 0)):
- 寻找 (A = \theta B \in su(2)),(det(B) = 1),(0 < \theta < \pi)。
- 由 (a = \cos\theta) 确定 (\theta)。
- 根据 (e^{\theta B} - (e^{\theta B})^
= q - q^
) 计算 (u_1 = \frac{1}{\sin\theta}b),(u_2 + iu_3 = \frac{1}{\sin\theta}(c + id))。
实际应用
:
-
计算机图形学
:在三维图形的旋转操作中,单位四元数可以避免欧拉角表示法中出现的万向锁问题,提供更平滑和稳定的旋转效果。通过将旋转矩阵转换为四元数,可以方便地进行旋转的插值和组合操作。
-
机器人学
:机器人的关节运动通常涉及到三维空间中的旋转。使用四元数表示旋转可以更高效地进行运动规划和控制,减少计算量和误差积累。
7. 四元数与其他旋转表示方法的比较
除了四元数表示法,常见的旋转表示方法还有欧拉角和旋转矩阵。下面对它们进行比较。
| 表示方法 | 优点 | 缺点 |
|---|---|---|
| 四元数 | 避免万向锁问题,插值计算简单,计算效率高 | 物理意义不如欧拉角直观,需要额外的归一化操作 |
| 欧拉角 | 物理意义直观,易于理解和解释 | 存在万向锁问题,插值计算复杂 |
| 旋转矩阵 | 可以直接应用于向量的旋转计算,易于与其他线性变换组合 | 存储和计算量较大,不便于进行插值操作 |
从表格中可以看出,四元数在旋转表示方面具有独特的优势,尤其在需要进行平滑插值和避免万向锁的场景中表现出色。
8. 进一步的研究方向
虽然单位四元数在旋转表示中已经有了广泛的应用,但仍有一些值得进一步研究的方向。
- 高效算法优化 :目前的算法在处理大规模数据或实时应用时可能存在性能瓶颈。可以研究更高效的算法,减少计算量和内存占用。
- 多旋转组合问题 :在实际应用中,可能需要对多个旋转进行组合。如何更高效地进行多旋转的组合和插值是一个有待解决的问题。
- 与其他数学工具的结合 :可以探索将四元数与其他数学工具,如李群、李代数等相结合,以获得更深入的理论理解和更强大的应用能力。
9. 总结
本文详细介绍了单位四元数在表示 (SO(3)) 中旋转的相关理论和方法。从四元数的基础定义出发,阐述了 (SU(2)) 中单位四元数对 (SO(3)) 旋转的表示,包括伴随表示、旋转矩阵的推导以及寻找表示旋转的四元数的算法。同时,还介绍了指数映射和四元数与其他旋转表示方法的比较。
单位四元数作为一种强大的旋转表示工具,在计算机图形学、机器人学等领域有着重要的应用。通过深入理解和掌握四元数的相关知识,可以更好地解决实际中的旋转问题,提高算法的性能和稳定性。
mermaid流程图总结整个流程:
graph LR;
A[旋转矩阵 \(R\)] --> B{计算 \(tr(R)\)};
B -- \(tr(R) \neq -1\) --> C[计算 \(a, b, c, d\)];
B -- \(tr(R) = -1\) --> D[确定 \(b, c, d\)];
C --> E[得到四元数 \(q\)];
D --> E;
E --> F{判断 \(q\) 的值};
F -- \(q = I\) --> G[\(A = 0\)];
F -- \(q = -I\) --> H[\(A = \pm\pi \begin{pmatrix} i & 0 \\ 0 & -i \end{pmatrix}\)];
F -- 其他 --> I[计算 \(A = \theta B\)];
G --> J[应用于实际场景];
H --> J;
I --> J;
通过以上内容,我们对单位四元数在旋转表示中的应用有了全面的了解,希望这些知识能为相关领域的研究和应用提供有益的参考。
286



被折叠的 条评论
为什么被折叠?



