已知两点坐标如何快速增加其他坐标_从零开始一起学习SLAM | 为什么要用齐次坐标?...

d1b4d56d3ecc2f4afa66fb7bd4c9dc2b.png

在涉及到计算机视觉的几何问题中,我们经常看到齐次坐标这个术语。本文介绍一下究竟为什么要用齐次坐标?使用齐次坐标到底有什么好处?

什么是齐次坐标?

简单的说:齐次坐标就是在原有坐标上加上一个维度:

416395ad7699ceeaea0fe68b3f1067f2.png

526a64da5e419e1bde33e538445f3c69.png

使用齐次坐标有什么优势?

齐次坐标的使用能够大大简化在三维空间中的点线面表达方式和旋转平移等操作,具体分如下几点进行说明。

1、能否非常方便的表达点在直线或平面上

在2D平面上,一条直线 l 可以用方程 ax + by + c = 0 来表示,该直线用向量表示的话一般记做

759a44c73f37d936d9781e934ae29456.png

我们知道点p = (x, y)在直线 l 上的充分必要条件是 ax + by + c = 0

如果使用齐次坐标的话,点p的齐次坐标就是

p'=(x, y, 1)

那么 ax + by + c = 0 就可以用两个向量的内积(点乘)来表示:

e1f7916475782c0b40a08460add0ba8f.png

因此,点p在直线l上的充分必要条件就是 直线l 与p的齐次坐标p'的内积:

046ebe371b2bf20afa2773de65a24b5d.png

是不是很方便呢!

同理,我们知道 三维空间的一个平面A可以用方程 ax + by + cz + d = 0 来表示,三维空间的一个点P=(x, y, z) 的齐次坐标 P'=(x, y, z, 1),类似的,点P在空间平面A上可以用两个向量的内积来表示,如下:

ebf71c6a8fb7572332251aba2b6f9918.png

因此,点P在平面A上的充分必要条件就是平面A 向量与P的齐次坐标P'的内积(点乘):

9cb7b8766cd674f7ca140145bf4c3a98.png

2、方便表达直线与直线,平面与平面的交点

先给出结论,后面再具体解释:

结论:在齐次坐标下,可以用两个点 p, q 的齐次坐标叉乘结果来表达一条直线 l,也就是

l = p x q

也可以使用两条直线 l, m 的叉乘表示他们的交点 x

x = l x m

见下面示例图。

582da25c7bca114f2fc8b51497c88872.png

之所以可以这么简洁的表示交点是因为采用了齐次坐标的表示方式。

那么这是为什么呢?

先介绍一下叉乘(也称叉积、外积)的概念:

两个向量 a和b 的叉乘仅在三维空间中有定义,写作 a x b

a x b 是与向量 a, b都垂直的向量,其方向通过右手定则(见下图)决定。

5aba21d6476d95ebc1c380c2223230d4.png

其模长等于以两个向量为边的平行四边形的面积(见下图)。

叉乘可以定义为:

00eb06758fae7dc8f4b36b5171b7592f.png

其中 θ表示a, b的夹角(0°到180°之间),||a||, ||b||是向量a, b的模长

n则是一个与向量a, b所构成的平面垂直的单位向量

4e8a641587e00dcc69f34d9ebf3e3342.png

根据叉乘定义:

向量自身叉乘结果为0,因为夹角为0。也就是说三维向量 a x a =0, b x b = 0而点乘(也称点积,内积)的定义是

a * b = ||a||* ||b|| *cos(θ)

根据定义:如果两个向量垂直,cos(θ) = 0,点积也为0。

好了,经过上面点乘和叉乘定义的铺垫。下面来推导一下上面的结论:

为什么两条直线 l, m 的叉乘 l x m 等于它们的交点 p,也就是 p = l x m?

原因如下:首先,根据前面叉乘的定义,l x m 的结果向量(记为 p = l x m) 与 l 和 m都垂直,根据点乘的定义,垂直的向量之间的点积为0,因此可以得到:

29d0df0a19029d95aed3ec6256f42990.png

因此,根据前面点在直线上的结论,可以看到p既在直线l 上又在直线m上,所以 p = l x m 是两条直线的交点。此处 p 是齐次坐标。

同样的,可以证明,两点p, q 的叉乘 可以表示 过两点的直线l,即 l = p x q。(留做作业)

3、能够区分一个向量和一个点

先给出结论:

(1)从普通坐标转换成齐次坐标时

如果(x,y,z)是个点,则变为(x,y,z,1);

如果(x,y,z)是个向量,则变为(x,y,z,0)

(2)从齐次坐标转换成普通坐标时

如果是(x,y,z,1),则知道它是个点,变成(x,y,z);

如果是(x,y,z,0),则知道它是个向量,仍然变成(x,y,z)

具体解释见:

齐次坐标的理解 - Bigcoder - 博客园​www.cnblogs.com

4、能够表达无穷远

比如 两条平行的直线 ax+by+c=0, ax+by+d=0,

可以分别用向量 l = (a, b, c), m = (a, b,d)表示

根据前面直线交点的计算方法,其交点为 l x m

根据叉乘计算法则

向量

b8eaa32431d8e5afae9b1ac4104aa5e6.png

的叉乘结果可以用如下方法计算得到

23b83ce35cacdab667c3ea1b16e79de6.png

最终:l x m = (d-c)(b,-a,0),忽略标量(d-c),我们得到交点为(b,-a,0),并且是齐次坐标,如果要转化为非齐次坐标,那么会得到 (b/0, a/0),坐标是无穷大,可以认为该点为无穷远点,这与我们通常理解的:平行线相交于无穷远的概念相吻合。

因此,如果一个点的齐次坐标中,最后一个元素为0,则表示为无穷远点。

5、更简洁的表达欧氏空间变换

这是齐次坐标最重要的一个优势之一。在以后的学习中你会更加深刻的理解。

使用齐次坐标,可以方便的将加法转化为乘法,方便的表达平移。

比如我们要完成将2D坐标点x=[u,v]' 平移t=[tu, tv],如果用非齐次方法的话,是用如下的加法

2316ff3c6c63a228e603a41bdb4071fe.png

如果用齐次坐标表示时可以将加法转换为乘法

1294161b2e112822848252d6fb2f4c2d.png

在欧氏变换中一般有两种操作:旋转和平移。

如果我们想要将向量a进行一个标准的欧氏变换,一般是先用旋转矩阵R进行旋转,然后再用向量t进行平移,其结果a' = R*a + t,这样看起来没什么问题。

但是,我们知道SLAM中一般都是连续的欧氏变换,所以会有多次连续的旋转和平移,假设我们将向量a进行了两次欧氏变换,分别为R1, t1 和 R2,t2,分别得到:

b = R1*a + t1, c = R2*b + t2

最终的结果 c = R2*(R1*a + t1) + t2

显然,这样的变换在经过多次后会变的越来越复杂。其根本原因是上述表达方式并不是一个线性的变换关系。

此时,齐次坐标就显示出它的魅力了,如果使用齐次坐标来表达 a' = R*a + t 的话可以写为:

852d435d6305d897f53596be5b63856e.png

旋转和平移可以用一个矩阵T来表示,该矩阵T称为变换矩阵(transform matrix),这样欧氏变换就变成了线性关系,进行多次欧氏变换只需要连乘变换矩阵就行了,比如前面的两次欧氏变换使用齐次坐标就可以表示为:

6fd60edfab5b93ca0f8c5bec5dbb0074.png

其中,波浪号代表齐次坐标。一般的,在SLAM中,b = Ta 的形式默认都是齐次坐标。

关于齐次坐标的优势还有哪些呢?欢迎留言补充。

作业

证明:两点p, q 的叉乘 可以表示 过两点的直线l,即 l = p x q

(提示:参考本文前面的证明)

更多学习视频、文档资料、参考答案等点击下面链接查看「从零开始学习SLAM」星球介绍,3天内无条件退款,有效期一年,每天0.3元,帮你少走弯路,快速入门SLAM!

http://mp.weixin.qq.com/s?__biz=MzIxOTczOTM4NA==&mid=100002356&idx=1&sn=1164bb5c8567cbe2672f4b513b48dce5&chksm=17d7efa320a066b50a0ab82e020bb9002df6947be7577cfb85adc01394b2c2c8a3c3045932b6#rd​mp.weixin.qq.com

相关阅读

从零开始一起学习SLAM | 为什么要学SLAM?​mp.weixin.qq.com 从零开始一起学习SLAM | 学习SLAM到底需要学什么?​mp.weixin.qq.com 从零开始一起学习SLAM | SLAM有什么用?​mp.weixin.qq.com 从零开始一起学习SLAM | C++新特性要不要学?​mp.weixin.qq.com 零基础小白,如何入门计算机视觉?​mp.weixin.qq.com
  • 0
    点赞
  • 3
    收藏
    觉得还不错? 一键收藏
  • 0
    评论

“相关推荐”对你有帮助么?

  • 非常没帮助
  • 没帮助
  • 一般
  • 有帮助
  • 非常有帮助
提交
评论
添加红包

请填写红包祝福语或标题

红包个数最小为10个

红包金额最低5元

当前余额3.43前往充值 >
需支付:10.00
成就一亿技术人!
领取后你会自动成为博主和红包主的粉丝 规则
hope_wisdom
发出的红包
实付
使用余额支付
点击重新获取
扫码支付
钱包余额 0

抵扣说明:

1.余额是钱包充值的虚拟货币,按照1:1的比例进行支付金额的抵扣。
2.余额无法直接购买下载,可以购买VIP、付费专栏及课程。

余额充值