第三讲 三维空间的刚体运动

三维刚体运动,由平移和旋转构成。平移简单,旋转就麻烦些了。这一章的重点就是描述旋转,设计核心概念为:旋转矩阵,变换矩阵,四元数以及欧拉角。

一、旋转矩阵

1、向量的内积、外积及其几何意义

(1)内积a.b = |a|*|b|*cos,结果是一个数值而非向量,几何上表示向量间的投影关系

(2)外积a x b = a^b,结果是一个垂直于a,b向量构成的平面的向量,大小为|a|*|b|*sin,很容易注意到,其大小是a与b围成的三角形的面积,所以我们也把这样的结果叫做有向面积。显然,根据外积的值能推断出a到b的旋转角度,所以我们也可以用外积表示向量的旋转。

2、坐标系间的欧式变换

欧拉变换公式:a' = Ra + t

a'----物体位姿相对新坐标系的位姿

R----旋转矩阵,它是欧拉变换的关键

a----物体相对原坐标系的位姿

t----物体的平移

3、旋转矩阵的性质:

(1)它是一个行列式为1的正交矩阵(与其转置矩阵相乘结果为单位矩阵),反之行列式为1的正交矩阵也一定是旋转矩阵

(2)特殊正交群:SO(n) = {R|R*R' = I,det(R) = 1},其中R为一个nxn矩阵,R'是其转置矩阵,det(R)为其行列式。SO(n)就是n维空间中旋转矩阵的集合,当然我们讨论最多的就是SO(3)。

(3)有了旋转矩阵,我们描述相机位姿时,可以直接聊矩阵了,而无需从基(坐标系)开始。体现在欧拉变换公式上,公式右边的R和t都是绝对量,只有输入值(向量a)是一个相对量。就是说,我们用R和t两个参数,就完整的描述了坐标变换关系。

4、变换矩阵:如果坐标系经过多次变换,那么对应的欧拉变换式就会变得越来越复杂,所以我们引入了变换矩阵。这是一个数学技巧,它将旋转和平移都放入同一个矩阵(变换矩阵)中,使得多次变换对应的欧拉变换式依然是齐次的:C=T2*B = T2*T1*A。

二、Eigen实践

本节讲eigen的用法。这里有一份代码比较注释比较详细,就不写那么多了。我就在这里留点简介吧

1、eigen是一个流行的矩阵工具库,有了它,我们在进行矩阵、向量的计算时,就方便得多

2、作为一个软件工具库,它有个特点就是,只有h文件而没有.a、.so等二进制文件,所以在CMakeLists.txt中,我们只需要引入eigen库的头文件目录(include_directories,但更好的方式还是find_package),而无须链接库文件。

3、在mac上的使用步骤:

(1)先执行locate eigen3查看是否安装,ubuntu也可执行此命令

(2)homebrew安装eigen

(3)CMakeLists.txt中添加include_directories("/usr/include/eigen3"),ubuntu中也是这个默认路径。不同人默认路径可能不同,用find_package最好。

三、旋转向量与欧拉角:

1、意义:利用向量外积的定义,方向表示旋转方向(右手定则),大小表示旋转角度大小。

2、旋转向量与旋转矩阵之间有一个换算关系,背下来。

3、欧拉角:偏航-俯仰-滚转,很容易理解

四、四元数:

1、意义:对照复数来理解,实际上乘以虚数部分,就是旋转;

2、四元数与旋转的对应关系,背下来;

3、四元数的运算法则,只能理解加记忆了;

4、四元数与旋转向量、旋转矩阵的对应关系;

五、实践:visualizeGeometry

这里遇到的麻烦主要是pangolin的导入

1、跟着github地址上的步骤编译

2、执行sudo make install指令,成功后在/usr/local/include中生成了pangolin目录,将该目录添加到header search paths中,要报错,没解决

3、果断将跟着github上的https://github.com/gaoxiang12/slambook/tree/master/ch3/visualizeGeometry方式,使用cmake编译,运行成功!!

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

推荐阅读更多精彩内容