旋转平移

二维旋转

二维

\left\{\begin{matrix} x=r\cos \phi \\ y=r\sin \phi \end{matrix}\right.

$\left\{\begin{matrix} x'=r\cos (\phi+\theta) \\ x'=r\sin (\phi+\theta) \end{matrix}\right.$

三角函数展开：

$\left\{\begin{matrix} x′=r\cos(\theta)\cos(\phi)−r\sin(\theta)\sin(\phi)\\ y′=r\sin(\theta)\cos(\phi)+y\cos(\theta)\sin(\phi) \end{matrix}\right.$

带入xy公式：

$\left\{\begin{matrix} x′=x\cos(\theta)−y\sin(\theta)\\ y′=x\sin(\theta)+y\cos(\theta) \end{matrix}\right.$

转为矩阵形式：

$\begin{bmatrix} x' \\ y' \end{bmatrix} = \begin{bmatrix} \cos(\theta) &-\sin(\theta) \\ \sin(\theta) &\cos(\theta) \end{bmatrix} \ast \begin{bmatrix} x\\ y \end{bmatrix}$

二维绕点旋转，旋转矩阵对角记忆

加入平移引入齐次坐标：

$\begin{bmatrix} x' \\ y' \\ 1 \end{bmatrix} = \begin{bmatrix} \cos(\theta) &-\sin(\theta) &t_x\\ \sin(\theta) &\cos(\theta) &t_y\\ 0& 0&1 \end{bmatrix} \ast \begin{bmatrix} x\\ y\\ 1 \end{bmatrix}$

三维旋转(齐次坐标下)

三维坐标系定义

绕X轴旋转

$\begin{bmatrix} x' \\ y' \\ z' \\ 1 \end{bmatrix} = \begin{bmatrix} 1 & 0 & 0& 0\\ 0 & \cos(\theta) &-\sin(\theta) &0 \\ 0 & \sin(\theta) &\cos(\theta)&0\\ 0 & 0& 0&1 \end{bmatrix} \ast \begin{bmatrix} x\\ y\\ z\\ 1 \end{bmatrix}$

绕Y轴旋转

$\begin{bmatrix} x' \\ y' \\ z' \\ 1 \end{bmatrix} = \begin{bmatrix} \sin(\theta) & 0 & \cos(\theta) &0\\ 0 &1 &0 &0\\ \cos(\theta) &0 &-\sin(\theta) &0\\ 0 & 0 & 0 &1 \end{bmatrix} \ast \begin{bmatrix} x\\ y\\ z\\ 1 \end{bmatrix}$

绕Z轴旋转

$\begin{bmatrix} x' \\ y' \\ z' \\ 1 \end{bmatrix} = \begin{bmatrix} \cos(\theta) &-\sin(\theta) &0 &0 \\ \sin(\theta) &\cos(\theta) &0 &0 \\ 0 &0 &1 &0\\ 0& 0& 0& 1 \end{bmatrix} \ast \begin{bmatrix} x\\ y\\ z\\ 1 \end{bmatrix}$

右手坐标系，拇指为旋转轴方向，四指弯曲方向由源轴指向目标轴
旋转矩阵中，源轴为cos -sin 目标轴为 sin cos
参考

如何求旋转矩阵

知道源坐标系及目标坐标系在原坐标系下的定义即可求得旋转矩阵

点乘叉乘的定义
注意：numpy中点乘结果为标量叉乘结果为矢量外积结果是矩阵

在刚体运动中，同一个向量在各个坐标系下的长度和夹角不发生变换，这种变换称为欧式变换，由旋转和平移组成

设两个单位正交基， $\begin{bmatrix} e_1,e_2,e_3\end{bmatrix}$ 和 $\begin{bmatrix} e_1^,,e_2^,,e_3^,\end{bmatrix}$ ， $e_i$ 为3x1列向量。

即已知源坐标系 $e_i$ 和目标坐标系 $e_i^,$ 及向量 $a$ 在源坐标系的定义

对于同一个向量 $a=[a_1,a_2,a_3]^T$ 有
$\begin{bmatrix}e_1,e_2,e_3\end{bmatrix} \begin{bmatrix} a_1\\ a_2\\ a_3 \end{bmatrix} = \begin{bmatrix}e_1^,,e_2^,,e_3^,\end{bmatrix} \begin{bmatrix} a_1^,\\ a_2^,\\ a_3^, \end{bmatrix}$
将坐标系 $e$ 旋转为坐标系 $e^,$ ，需将上式左边乘以 $\begin{bmatrix}e_1^,,e_2^,,e_3^,\end{bmatrix}^{-1}$ .

单位正交矩阵，单位正交矩阵的性质其逆矩阵等于其转置矩阵： $\begin{bmatrix}e_1^,,e_2^,,e_3^,\end{bmatrix}^{-1} = \begin{bmatrix}e_1^,,e_2^,,e_3^,\end{bmatrix}^{T}$

得到如下公式：
$\begin{bmatrix} a_1^,\\ a_2^,\\ a_3^, \end{bmatrix} = \begin{bmatrix}e_1^{,T}\\e_2^{,T}\\e_3^{,T}\end{bmatrix} \begin{bmatrix}e_1,e_2,e_3\end{bmatrix} \begin{bmatrix} a_1\\ a_2\\ a_3 \end{bmatrix}$
展开
$\begin{bmatrix} a_1^,\\ a_2^,\\ a_3^, \end{bmatrix} = \begin{bmatrix} e_1^{,T}e_1 & e_1^{,T}e_2 &e_1^{,T}e_2 \\ e_2^{,T}e_1 & e_2^{,T}e_2 &e_2^{,T}e_2 \\ e_3^{,T}e_1 & e_3^{,T}e_2 &e_3^{,T}e_2 \end{bmatrix} \begin{bmatrix} a_1\\ a_2\\ a_3 \end{bmatrix}$
$R= \begin{bmatrix} e_1^{,T}e_1 & e_1^{,T}e_2 &e_1^{,T}e_2 \\ e_2^{,T}e_1 & e_2^{,T}e_2 &e_2^{,T}e_2 \\ e_3^{,T}e_1 & e_3^{,T}e_2 &e_3^{,T}e_2 \end{bmatrix}$

其中R为旋转矩阵，加上平移向量 $t$ 改为齐次坐标
$\begin{bmatrix} a^,\\ 1 \end{bmatrix} = \begin{bmatrix} R & t\\ 0^T &1 \end{bmatrix} \begin{bmatrix} a\\ 1 \end{bmatrix}$

参考资料

当仅知道原坐标系和目标坐标系时

以相机坐标系旋转为例
相机坐标系a满足以下条件：
$a=\begin{bmatrix} 1&0&0\\ 0&1&0\\ 0&0&1 \end{bmatrix}$
可得：
$a^,=Ra\ a^,=R$
即若能求得目标坐标系在原坐标系下的定义矩阵，则旋转矩阵 $R$ 即为 $a^,$ 坐标系的描述，该矩阵每个列向量即为坐标轴 $x,y,z$ 的分量
$R_1^{T}$ $R_2^{T}$ $R_3^{T}$

旋转矩阵的性质及理解

最后编辑于：2020.11.27 14:05:59

人面猴
序言：七十年代末，一起剥皮案震惊了整个滨河市，随后出现的几起案子，更是在滨河造成了极大的恐慌，老刑警刘岩，带你破解...
沈念sama阅读 214,444评论 6赞 496
死咒
序言：滨河连续发生了三起死亡事件，死亡现场离奇诡异，居然都是意外死亡，警方通过查阅死者的电脑和手机，发现死者居然都...
沈念sama阅读 91,421评论 3赞 389
救了他两次的神仙让他今天三更去死
文/潘晓璐我一进店门，熙熙楼的掌柜王于贵愁眉苦脸地迎上来，“玉大人，你说我怎么就摊上这事。” “怎么了？”我有些...
开封第一讲书人阅读 160,036评论 0赞 349
道士缉凶录：失踪的卖姜人
文/不坏的土叔我叫张陵，是天一观的道长。经常有香客问我，道长，这世上最难降的妖魔是什么？我笑而不...
开封第一讲书人阅读 57,363评论 1赞 288
港岛之恋（遗憾婚礼）
正文为了忘掉前任，我火速办了婚礼，结果婚礼上，老公的妹妹穿的比我还像新娘。我一直安慰自己，他们只是感情好，可当我...
茶点故事阅读 66,460评论 6赞 386
恶毒庶女顶嫁案：这布局不是一般人想出来的
文/花漫我一把揭开白布。她就那样静静地躺着，像睡着了一般。火红的嫁衣衬着肌肤如雪。梳的纹丝不乱的头发上，一...
开封第一讲书人阅读 50,502评论 1赞 292
城市分裂传说
那天，我揣着相机与录音，去河边找鬼。笑死，一个胖子当着我的面吹牛，可吹牛的内容都是我干的。我是一名探鬼主播，决...
沈念sama阅读 39,511评论 3赞 412
双鸳鸯连环套：你想象不到人心有多黑
文/苍兰香墨我猛地睁开眼，长吁一口气：“原来是场噩梦啊……” “哼！你这毒妇竟也来了？” 一声冷哼从身侧响起，我...
开封第一讲书人阅读 38,280评论 0赞 270
万荣杀人案实录
序言：老挝万荣一对情侣失踪，失踪者是张志新（化名）和其女友刘颖，没想到半个月后，有当地人在树林里发现了一具尸体，经...
沈念sama阅读 44,736评论 1赞 307
护林员之死
正文独居荒郊野岭守林人离奇死亡，尸身上长有42处带血的脓包…… 初始之章·张勋以下内容为张勋视角年9月15日...
茶点故事阅读 37,014评论 2赞 328
白月光启示录
正文我和宋清朗相恋三年，在试婚纱的时候发现自己被绿了。大学时的朋友给我发了我未婚夫和他白月光在一起吃饭的照片。...
茶点故事阅读 39,190评论 1赞 342
活死人
序言：一个原本活蹦乱跳的男人离奇死亡，死状恐怖，灵堂内的尸体忽然破棺而出，到底是诈尸还是另有隐情，我是刑警宁泽，带...
沈念sama阅读 34,848评论 5赞 338
日本核电站爆炸内幕
正文年R本政府宣布，位于F岛的核电站，受9级特大地震影响，放射性物质发生泄漏。R本人自食恶果不足惜，却给世界环境...
茶点故事阅读 40,531评论 3赞 322
男人毒药：我在死后第九天来索命
文/蒙蒙一、第九天我趴在偏房一处隐蔽的房顶上张望。院中可真热闹，春花似锦、人声如沸。这庄子的主人今日做“春日...
开封第一讲书人阅读 31,159评论 0赞 21
一桩弑父案，背后竟有这般阴谋
文/苍兰香墨我抬头看了看天上的太阳。三九已至，却和暖如春，着一层夹袄步出监牢的瞬间，已是汗流浃背。一阵脚步声响...
开封第一讲书人阅读 32,411评论 1赞 268
情欲美人皮
我被黑心中介骗来泰国打工，没想到刚下飞机就差点儿被人妖公主榨干…… 1. 我叫王不留，地道东北人。一个月前我还...
沈念sama阅读 47,067评论 2赞 365
代替公主和亲
正文我出身青楼，却偏偏与公主长得像，于是被迫代替她去往敌国和亲。传闻我的和亲对象是个残疾皇子，可洞房花烛夜当晚...
茶点故事阅读 44,078评论 2赞 352