四元组和旋转矩阵

二维旋转矩阵(2D Rotation Matrix)

在欧几里得坐标系下,二维的旋转矩阵可以用一个旋转角 $\theta$ 来表达出来。具体地,
$$ R = \begin{bmatrix} \cos \theta & -\sin \theta \ \sin \theta & \cos \theta \ \end{bmatrix} $$

二维点坐标表示为列向量乘以旋转矩阵,得到的列向量就是在欧几里得坐标系下的旋转后的坐标。

三维旋转矩阵(3D Rotation Matrix)

一般地,欧几里得理论下,三维旋转矩阵可以表达为绕着某个方向向量以及绕着这个方向向量的旋转角(默认采用右手原则)。也就是说,确定一个三维旋转矩阵有 4 个变量,方向向量 $x, y, z$ 以及旋转角 $\theta$ 。欧拉旋转指出,三维旋转矩阵的自由度是 3 。

三维旋转矩阵有多种表示方法,主要有 2 种方法:欧拉旋转、四元组。

1. 欧拉旋转(Euler Rotation)

欧拉旋转的想法和旋转向量相似。但是不是给定一个旋转向量,而是分别给出观测对象沿$x, y, z$ 三个坐标轴旋转(转化为了一个二维的旋转问题)。其中,沿着给定三个方向的旋转矩阵是这个样子的:

$$ \nonumber \begin{alignat}{1} R_x(\theta) &= \begin{bmatrix} 1 & 0 & 0 \ 0 & \cos \theta & -\sin \theta \[3pt] 0 & \sin \theta & \cos \theta \[3pt] \end{bmatrix} , R_y(\theta) &= \begin{bmatrix} \cos \theta & 0 & \sin \theta \[3pt] 0 & 1 & 0 \[3pt] -\sin \theta & 0 & \cos \theta \ \end{bmatrix} , R_z(\theta) &= \begin{bmatrix} \cos \theta & -\sin \theta & 0 \[3pt] \sin \theta & \cos \theta & 0\[3pt] 0 & 0 & 1\ \end{bmatrix} \end{alignat} $$

然后,旋转矩阵表示为:

$$ R=R_z R_y R_x $$

这种方法的缺点之一就是复杂,且由于欧拉万向角问题而表示不唯一。

2. 四元组(Quaternions)

四元组是扩展自复数的一个概念,延伸自欧拉旋转。定义三个复变量 $i2=j2=k^2=-1$ ,然后把向量的各个分量表示为 $i, j, k$ 的系数,即 (2, 3, 4) 表示为 $2i+3j+4k$ 。一个围绕单位向量 $\overrightarrow{u}=(u_x, u_y, u_z)=u_x i + u_y j + u_z k$的旋转$\theta$角度的旋转,可以利用欧拉公式的扩展来表达:

$$ q = e^{\frac{\theta}{2}(u_x i + u_y j + u_z k)} = \cos \frac{\theta}{2} + (u_x i + u_y j + u_z k) \sin \frac{\theta}{2} $$

然后,利用四元组乘法(注意,此处不是矩阵乘法!),上式可以应用于计算一个普通的三维点 $p=(p_x, p_y, p_z) = p_x i + p_y j + p_z k $ 的旋转:

$$ p' = q p q^{-1} $$

而 $p'=({p_x}', {p_y}', {p_z}')$ 是旋转后的坐标。如果 $ \overrightarrow{u} $ 和 点 $p$ 是沿原点同方向的,那么该旋转将绕 $\overrightarrow{u}$ 顺时针旋转 $\theta$。

2.1 四元组的矩阵表示

四元组表达的旋转也可以通过旋转矩阵来表示,即简化上述 $$ p' = q p q^{-1} $$ 的操作。其得到的旋转矩阵为:

$$ \begin{bmatrix} c + a_x^2 (1-c) & a_x a_y (1-c) - a_z s & a_x a_z (1-c) + a_y s \ a_y a_x (1-c) + a_z s & c + a_y^2 (1-c) & a_y a_z (1-c) - a_x s \ a_z a_x (1-c) - a_y s & a_z a_y (1-c) + a_x s & c + a_z^2 (1-c) \end{bmatrix} $$

其中,$s=\sin \theta, c = \cos \theta$ 。对于一个旋转四元组 $q=q_r+q_i i + q_j j + q_k k$,以上变量可以通过

$$ \begin{align} \theta & =2 \arccos q_r=2 \arcsin \sqrt{{q_i}2+{q_j}2+{q_k}^2} \nonumber \ (a_x, a_y, a_z) & =\frac{1}{\sin \frac{1}{2}\theta} (q_i, q_j, q_k) \nonumber \end{align}$$

得到。

如果直接从四元组中的变量出发,也可以把矩阵表达为:

$$ \begin{bmatrix} 1 - 2 q_j^2 - 2 q_k^2 & 2 (q_i q_j - q_k q_r) & 2 (q_i q_k + q_j q_r) \ 2 (q_i q_j + q_k q_r) & 1 - 2 q_i^2 - 2 q_k^2 & 2 (q_j q_k - q_i q_r) \ 2 (q_i q_k - q_j q_r) & 2 (q_j q_k + q_i q_r) & 1 - 2 q_i^2 - 2 q_j^2 \end{bmatrix} $$

或(已知 $q_r$,可以通过变换式代换主轴线上的量)

$$ \begin{bmatrix} q_r^2 + q_i^2 - q_j^2 - q_k^2 & 2 (q_i q_j - q_k q_r) & 2 (q_i q_k + q_j q_r) \ 2 (q_i q_j + q_k q_r) & q_r^2 + q_j^2 - q_i^2 - q_k^2 & 2 (q_j q_k - q_i q_r) \ 2 (q_i q_k - q_j q_r) & 2 (q_j q_k + q_i q_r) & q_r^2 + q_k^2 - q_i^2 - q_j^2 \end{bmatrix} $$

上述两个矩阵是等价的。

以上旋转默认物体绕着原点的旋转,其他形式的旋转,可以把物体平移到相对坐标系,再做四元组旋转,然后再把坐标系变换回去。

2.2 四元组的矩阵恢复

从旋转矩阵恢复四元组可以通过构造矩阵求特征值为 1 的 特征向量(即四元组)。设 $Q$ 是一个 $3\times 3$ 的旋转矩阵,构造矩阵:

$$ K = \frac13 \begin{bmatrix} Q_{xx}-Q_{yy}-Q_{zz} & Q_{yx}+Q_{xy} & Q_{zx}+Q_{xz} & Q_{yz}-Q_{zy} \ Q_{yx}+Q_{xy} & Q_{yy}-Q_{xx}-Q_{zz} & Q_{zy}+Q_{yz} & Q_{zx}-Q_{xz} \ Q_{zx}+Q_{xz} & Q_{zy}+Q_{yz} & Q_{zz}-Q_{xx}-Q_{yy} & Q_{xy}-Q_{yx} \ Q_{yz}-Q_{zy} & Q_{zx}-Q_{xz} & Q_{xy}-Q_{yx} & Q_{xx}+Q_{yy}+Q_{zz} \end{bmatrix} $$

如果 $Q$ 是一个纯旋转矩阵,那么$ K $ 将会有一个特征值为 1 的特征向量,该向量即四元组。如果 $Q$ 不是一个纯旋转矩阵,那么我们求出最大的特征值所对应的向量为四元组,该四元组求得的旋转矩阵将接近$Q$。

最后编辑于
©著作权归作者所有,转载或内容合作请联系作者
  • 序言:七十年代末,一起剥皮案震惊了整个滨河市,随后出现的几起案子,更是在滨河造成了极大的恐慌,老刑警刘岩,带你破解...
    沈念sama阅读 159,219评论 4 362
  • 序言:滨河连续发生了三起死亡事件,死亡现场离奇诡异,居然都是意外死亡,警方通过查阅死者的电脑和手机,发现死者居然都...
    沈念sama阅读 67,363评论 1 293
  • 文/潘晓璐 我一进店门,熙熙楼的掌柜王于贵愁眉苦脸地迎上来,“玉大人,你说我怎么就摊上这事。” “怎么了?”我有些...
    开封第一讲书人阅读 108,933评论 0 243
  • 文/不坏的土叔 我叫张陵,是天一观的道长。 经常有香客问我,道长,这世上最难降的妖魔是什么? 我笑而不...
    开封第一讲书人阅读 44,020评论 0 206
  • 正文 为了忘掉前任,我火速办了婚礼,结果婚礼上,老公的妹妹穿的比我还像新娘。我一直安慰自己,他们只是感情好,可当我...
    茶点故事阅读 52,400评论 3 287
  • 文/花漫 我一把揭开白布。 她就那样静静地躺着,像睡着了一般。 火红的嫁衣衬着肌肤如雪。 梳的纹丝不乱的头发上,一...
    开封第一讲书人阅读 40,640评论 1 219
  • 那天,我揣着相机与录音,去河边找鬼。 笑死,一个胖子当着我的面吹牛,可吹牛的内容都是我干的。 我是一名探鬼主播,决...
    沈念sama阅读 31,896评论 2 313
  • 文/苍兰香墨 我猛地睁开眼,长吁一口气:“原来是场噩梦啊……” “哼!你这毒妇竟也来了?” 一声冷哼从身侧响起,我...
    开封第一讲书人阅读 30,597评论 0 199
  • 序言:老挝万荣一对情侣失踪,失踪者是张志新(化名)和其女友刘颖,没想到半个月后,有当地人在树林里发现了一具尸体,经...
    沈念sama阅读 34,327评论 1 244
  • 正文 独居荒郊野岭守林人离奇死亡,尸身上长有42处带血的脓包…… 初始之章·张勋 以下内容为张勋视角 年9月15日...
    茶点故事阅读 30,581评论 2 246
  • 正文 我和宋清朗相恋三年,在试婚纱的时候发现自己被绿了。 大学时的朋友给我发了我未婚夫和他白月光在一起吃饭的照片。...
    茶点故事阅读 32,072评论 1 261
  • 序言:一个原本活蹦乱跳的男人离奇死亡,死状恐怖,灵堂内的尸体忽然破棺而出,到底是诈尸还是另有隐情,我是刑警宁泽,带...
    沈念sama阅读 28,399评论 2 253
  • 正文 年R本政府宣布,位于F岛的核电站,受9级特大地震影响,放射性物质发生泄漏。R本人自食恶果不足惜,却给世界环境...
    茶点故事阅读 33,054评论 3 236
  • 文/蒙蒙 一、第九天 我趴在偏房一处隐蔽的房顶上张望。 院中可真热闹,春花似锦、人声如沸。这庄子的主人今日做“春日...
    开封第一讲书人阅读 26,083评论 0 8
  • 文/苍兰香墨 我抬头看了看天上的太阳。三九已至,却和暖如春,着一层夹袄步出监牢的瞬间,已是汗流浃背。 一阵脚步声响...
    开封第一讲书人阅读 26,849评论 0 195
  • 我被黑心中介骗来泰国打工, 没想到刚下飞机就差点儿被人妖公主榨干…… 1. 我叫王不留,地道东北人。 一个月前我还...
    沈念sama阅读 35,672评论 2 274
  • 正文 我出身青楼,却偏偏与公主长得像,于是被迫代替她去往敌国和亲。 传闻我的和亲对象是个残疾皇子,可洞房花烛夜当晚...
    茶点故事阅读 35,585评论 2 270

推荐阅读更多精彩内容