【C++游戏引擎开发】《线性代数》（5）：四元数的3D旋转原理与实现（含新增Vector3、修改Matrix为非SIMD版本）

一、四元数基础理论

四元数（Quaternions）是一种扩展了复数系统的数学工具，由威廉·哈密顿（William Rowan Hamilton）于1843年提出。它在三维空间旋转表示和计算中具有重要应用，尤其在计算机图形学、机器人学和航空航天等领域中因其高效性和无万向节锁的特性而被广泛使用。

​1.1 四元数的定义

四元数是一个四维超复数，形式为：
$$q=a+b\mathbf{i}+c\mathbf{j}+d\mathbf{k}$$
其中：

• $a,b,c,d\in \mathbb{R}$ 是实部（标量部分）和三个虚部（矢量部分）。
• $\mathbf{i},\mathbf{j},\mathbf{k}$ 是虚数单位，满足以下乘法规则：
  $${\mathbf{i}}^2={\mathbf{j}}^2={\mathbf{k}}^2=\mathbf{ijk}=-1,\mathbf{ij}=\mathbf{k},\mathbf{jk}=\mathbf{i},\mathbf{ki}=\mathbf{j},$$
  且乘法是不可交换的，例如 $\mathbf{ji}=-\mathbf{k}$。

1.2 四元数的运算

• ​加减法：对应分量相加减。
  $$q_1\pm q_2=(a_1\pm a_2)+(b_1\pm b_2)\mathbf{i}+(c_1\pm c_2)\mathbf{j}+(d_1\pm d_2)\mathbf{k}$$

• ​乘法：使用分配律和虚数单位规则展开。
  $$q_1{q}_2=(a_1{a}_2-b_1{b}_2-c_1{c}_2-d_1{d}_2)+\cdots$$
  乘法满足结合律但不满足交换律（$q_1{q}_2\ne q_2{q}_1$）。

• ​标量乘法：标量 $k$ 乘以四元数，即各分量乘以 $k$。

​1.3 共轭与模长

• ​共轭四元数：将虚部取反。
  $$q^{\ast }=a-b\mathbf{i}-c\mathbf{j}-d\mathbf{k}$$

• ​模长（范数）​：
  $$\Vert q\Vert =\sqrt{a^2+b^2+c^2+d^2}$$
  若 $\Vert q\Vert =1$，则称 $q$ 为单位四元数。

• ​逆四元数：
  $$q^{-1}=\frac{q^{\ast }}{\Vert q{\Vert }^2}$$
  对于单位四元数，$q^{-1}=q^{\ast }$。

1.​4 四元数与三维旋转

四元数的核心应用之一是表示三维旋转，其优势在于避免了欧拉角的万向节锁问题，且计算效率高。

​1.4.1 旋转的表示

• ​旋转轴：单位向量 $\mathbf{u}=(u_x,u_y,u_z)$。
• ​旋转角度：$\theta$（绕轴 $\mathbf{u}$ 旋转的角度）。

对应的单位四元数为：
$$q=\cos \left(\frac{\theta }{2}\right)+\sin \left(\frac{\theta }{2}\right)(u_x\mathbf{i}+u_y\mathbf{j}+u_z$$