旋转的描述【2】——等效旋转矢量与四元数

最新推荐文章于 2023-05-13 23:24:51 发布

清风微升至

最新推荐文章于 2023-05-13 23:24:51 发布

阅读量7.8k

点赞数 8

分类专栏：惯性导航文章标签：图形学计算机视觉

本文链接：https://blog.csdn.net/m0_38095099/article/details/105603523

版权

惯性导航专栏收录该内容

15 篇文章 17 订阅

订阅专栏

1. 定义

欧拉旋转定理（Euler’s rotation theorem）表明，刚体（可视为直角坐标系）从一个角位置到另一个角位置的任意转动总能够等效于绕一固定轴的一次转动，当这一固定轴方向用单位矢量 $u$ 表示时，转角 $\phi$ 与 $u$ 的乘机 $\Phi=\phi u$ 即为等效旋转矢量，并且有 $\phi=\left |\Phi \right |$ 和 $u=\Phi /\phi$ 。
四元数就是由四个元素构成的一种数，一般形式为
$Q=q_{0}+\bm{q_{v}}=q_{0}+q_{1}\bm{i}+q_{2}\bm{j}+q_{3}\bm{k}$
其中， $q_{0},q_{1},q_{2},q_{3}$ 都是实数， $q_{0}$ 称为实部， $\bm{q_{v}}=q_{1}\bm{i}+q_{2}\bm{j}+q_{3}\bm{k}$ 称为虚部。可以观察到，当 $q_{2},q_{3}$ 为0时，四元数退化为我们熟悉的复数，因此四元数也可视为复数的扩展，可称之为超复数。因四元数的虚部单位矢量满足叉乘运算特点，例如 $\bm{i} \circ \bm{j}=\bm{k}（$ 其中 $\circ$ 表示四元数乘法），故可将四元数的叙述部分看成在三维空间的映像，反之，一个三维矢量可以看作是零标量的四元数（此处的转化很关键）。

2. 推导

推导部分需要介绍等效旋转矢量如何用来表示旋转，还会介绍罗德里格公式中的转化矩阵与方向余弦矩阵的关系，最后会介绍等效旋转矢量和四元数的关系。

2.1. 等效旋转矢量表示旋转——罗德里格公式

在这里插入图片描述
虽然严老师和秦老师推导罗德里格公式时都用了相似的图，过程也比较简洁，但不太好理解。于是我找来网上的图，看起来更直观些。
如图所示，矢量 $V$ 绕着单位矢量 $k$ 旋转了 $\theta$ 角，得到新的矢量 $V_{rot}$ 。容易知道，旋转后矢量 $v$ 的模值保持不变，即 $\left \| V_{rot}\right\|=\left \| V\right\|$ 。并且平行于矢量 $k$ 的分量不变 $V_{\parallel rot}=V_{\parallel}$ ，只是垂直于矢量 $k$ 的分量 $V_{\perp}$ 发生了旋转。
(1) 图中的三个公式比较容易得到，看图即可得到。值得一提的是，矢量 $k$ ， $V$ 和 $V_{\perp}$ 都在同一平面内。并且根据矢量叉乘的定义以及 $k$ 为单位矢量，容易证明有 $\left\| V_{\perp} \right\|=\left\| V_{\perp rot} \right \|=\left\| k\times V\right \|=\left\| k\times (k\times V) \right \|$ ，即下面的圈是个圆。
(2) 将 $V_{\perp rot}$ 投影到 $V_{\perp}$ 和 $k\times v$ 两个方向，结合前面几个模值相等的矢量，有 $V_{\perp rot}=V_{\perp}cos\theta+(k\times v) sin\theta\tag{1}$
(3) 因此有
$\begin{aligned} V_{rot}&=V_{\parallel rot}+V_{\perp rot}\\ &=V_{\parallel}+V_{\perp}cos\theta+(k\times V) sin\theta\\ &=k(k\cdot V)+(V-k(k\cdot V))cos\theta +k \times V sin\theta\\ &=Vcos\theta+(1-cos\theta)k(k\cdot V)+k \times V sin\theta\\ &=(cos\theta \cdot I+sin\theta \cdot k\times)V+(1-cos\theta)k(k\cdot V) \end{aligned}\tag{2}$
(4) 根据三重矢量叉积公式 $V_{1}\times(V_{2}\times V_{3})=V_{2}(V_{1}\cdot V_{3})-V_{3}(V_{1}\cdot V_{2})$ ，
令 $V_{1}=V_{2}=k$ ， $V_{3}=V$ ，将其代入叉积公式有
$\cdot V)=[I+(k\times )^2]V\tag{3}$
其中， $k\times$ 表示矢量k构造的反对称阵。
(5) 将式 $(3)$ 代入式 $(2)$ 得
$\begin{aligned} V_{rot}&=V_{\parallel rot}+V_{\perp rot}\\ &=(cos\theta \cdot I+sin\theta \cdot k\times)V+(1-cos\theta)k(k\cdot V)\\ &=(cos\theta \cdot I+sin\theta \cdot k\times)V+(1-cos\theta)[I+(k\times )^2]V\\ &=[I+sin\theta( k\times) +(1-cos\theta)(k\times )^2]V \end{aligned}\tag{4}$
将上式中 $[I+sin\theta( k\times) +(1-cos\theta)(k\times )^2]$ 记为 $D$ ，则式 $(4)$ 可写为
$\begin{aligned} V_{rot}&=DV \end{aligned}\tag{5}$
如此便证明了罗德里格公式，通过此公式可以利用一个单位矢量表示旋转方向，加上旋转角度就能描述空间中的刚体（直角坐标系）旋转。
等效旋转矢量与方向余弦矩阵有什么关系呢？

2.2. 等效旋转矢量与方向余弦矩阵的关系

方向余弦矩阵的定义中对旋转的描述是静态描述，描述的是旋转后的结果吗，即旋转后两个坐标系的相对角位置。而等效旋转矢量对旋转的描述是动态描述，即绕着什么方向转，转了多少度，可以描述过程。
下面来证明两种方法的相通性，其桥梁为罗德里格公式。
假设旋转前，有一参考坐标系R在空间中保持不动，而动坐标系b与矢量 $V$ 固联，随之转动。将式(5)投影到R系下有，
$\begin{aligned} V_{rot}^{R}&=DV^{R} \end{aligned}\tag{6}$
旋转之初，参考坐标系与动坐标系重合，记此时动坐标系为 $b_{0}$ ，则有
$V^{b_{0}}=V^{R}\tag{7}$
在旋转过程中，动坐标系b与矢量 $V_{rot}$ 固联，因此有
$V^{b}_{rot}=V^{b_{0}}\tag{8}$
将式（7）、（8）代入式（6），有
$\begin{aligned} V_{rot}^{R}&=DV^{b}_{rot} \end{aligned}\tag{9}$
由此可知，矩阵D即为矢量在坐标系旋转前后的坐标变换阵，即为方向余弦矩阵，有
$D=C_{b}^{n}\tag{10}$
从此可见，方向余弦矩阵也包含旋转的过程信息，由于旋转的周期性，当转角在区间 $[0,2\pi)$ 时，等效旋转矢量与方向余弦矩阵存在一一对应关系。从这点来看，又可将方向余弦矩阵称为转动矩阵。后面在定义欧拉角时我们再推导初等转动矩阵。

2.3. 等效旋转矢量与规范四元数的关系

模值为1的四元数称为规范四元数，规范四元数的三角表达式为
$Q=cos\frac {\phi}2 +\bm{u}sin\frac {\phi}2\tag{11}$
所代表的几何含义可以用等效旋转矢量来解释，其中的 $\theta$ 即为等效旋转矢量的旋转角度， $u$ 即为其旋转轴的单位矢量。由此可见，规范四元数包含了等效旋转矢量的所有信息。

2.4. 规范四元数与方向余弦矩阵的关系

为了避免与四元数的表示冲突，将公式（4）作稍稍改写，将旋转轴单位矢量 $k$ 改写为 $u$ ，旋转角度 $\theta$ 改为 $\phi$ ，则式（4）中的方向余弦阵变为
$\begin{aligned} C_{b}^n &=I+sin\phi( u\times) +(1-cos\phi)(u\times )^2 \end{aligned}\tag{12}$
根据三角函数关系，有
$\begin{aligned} C_{b}^n &=I+2sin\frac {\phi}2cos\frac {\phi}2( u\times) +2sin^2\frac {\phi}2(u\times )^2 \end{aligned}\tag{13}$
结合式（11）定义的规范四元数三角表达式，将 $cos\frac {\phi}2=q_{0}$ ， $\bm{u}sin\frac {\phi}2=\bm{q_{v}}$ 带入式（13），有
$\begin{aligned} C_{b}^n &=I+2q_{0}( \bm{q_{v} }\times) +2( \bm{q_{v} }\times )^2 \end{aligned}\tag{14}$
将 $\bm{q_{v}}=q_{1}\bm{i}+q_{2}\bm{j}+q_{3}\bm{k}$ 带入上式进一步展开可以得到四元数表示的方向余弦矩阵，在此不再展开，仅给出最后结果：
在这里插入图片描述