20190723_CVPR2019_[优化SLAM]VITAMIN-E

文章:VITAMIN-E: VIsual Tracking And MappINgwith Extremely Dense Feature Points
链接https://arxiv.org/abs/1904.10324
视频https://www.youtube.com/watch?v=yfKccCmmMsM
作者:Masashi Yokozuka,……,Atsuhiko Banno
机构:National Institute of Advanced Industrial Science and Technology (AIST),JSPS KAKENHI
摘要的摘要:基于经典优化SLAM框架下,改进或提升两点:
(1)Tracking的特征点数量大幅增加;
(2)BA使用Jacobi迭代法缩减求解时间和复杂度。

1. Dense Feature Point Tracking

1.1 Feature Point Tracking

VITAMIN-E tracks the local extrema of curvature (\kappa) in incoming images (f(x,y))。
\kappa=f_y^{2}f_{xx}-2f_xf_yf_{xy}+f_x^{2}f_{yy} \tag{1}

1.2 Dominant Flow Estimation

使用光流法+匹配提供匹配点对的位置初始值,设前后帧的点匹配2D点对为\boldsymbol{x}\boldsymbol{y},然后最小化仿射变换的cost function:
E=\sum_i^N{\rho \left( \lVert \boldsymbol{y}_i-\left( A\boldsymbol{x}_i+\boldsymbol{b} \right) \rVert _2 \right)} \tag{2}
得到一个稳定的A\boldsymbol{b}

1.3 Curvature Extrema Tracking

经过1.2,可以计算特定追踪点\boldsymbol{x}_{t_0}的预测值\boldsymbol{\hat{x}}_{t_1}
\boldsymbol{\hat{x}}_{t_1}=A \boldsymbol{x}_{t_0} + \boldsymbol{b} \tag{4}
再最大化evaluation function:
F=\kappa \left( \boldsymbol{x}_{t_1},t_1 \right) +\lambda \omega \left( \lVert \boldsymbol{x}_{t_1}-\boldsymbol{\hat{x}}_{t_1} \rVert _2 \right) \tag{5}
得到校正后的点\boldsymbol{x}_{t_1}

2. Bundle Adjustment for Dense Tracking

2.1 Bundle Adjustment

BA原理就不说了,Model一下求解方程:
H\delta \boldsymbol{x}=-\boldsymbol{g},\,\,\,\, \boldsymbol{x}=\boldsymbol{x}+\delta\boldsymbol{x} \tag{7}
经典方法是基于稀疏矩阵的Schur消元将问题分解:
H=\left[ \begin{matrix} H_{cc}& H_{cp}\\ H_{pc}& H_{pp}\\ \end{matrix} \right] ,\,\,\,\,\boldsymbol{g}=\left[ \begin{array}{c} \boldsymbol{g}_{\boldsymbol{c}}\\ \boldsymbol{g}_{\boldsymbol{p}}\\ \end{array} \right] \tag{8}
其中,下标为c的为camera相关,camera相关变量为M个,下标为p的为point相关,point相关变量为N个,然后进行Schur消元求解,具体不表了。但是文章的H的size是100,000 \times 100,000甚至更大,这样求解的复杂度和代价很大。

2.2 Subspace Gauss–Newton Method

我理解其实就是雅克比迭代法,并不是什么子空间方法。关于这类方法之后再整理一篇笔记出来。
此时方程(8)的求解可分解为如下形式:
H_{c_ic_i}\delta \boldsymbol{x}_{c_i}=-\left( \boldsymbol{g}_{c_i}+\sum_{l=1}^{i-1}{H_{c_lc_i}\delta \boldsymbol{x}_{c_l}}+\sum_{r=i+1}^M{H_{c_ic_r}\delta \boldsymbol{x}_{c_r}}+\sum_{j=1}^N{H_{c_ip_j}\delta \boldsymbol{x}_{p_j}} \right) \tag{11}
H_{p_jp_j}\delta \boldsymbol{x}_{p_j}=-\left( \boldsymbol{g}_{p_j}+\sum_{l=1}^{j-1}{H_{p_lp_j}\delta \boldsymbol{x}_{p_l}}+\sum_{r=j+1}^N{H_{p_ip_r}\delta \boldsymbol{x}_{p_r}}+\sum_{i=1}^M{H_{p_jc_i}\delta \boldsymbol{x}_{c_i}} \right) \tag{12}

3. Experimental Results

ATE详见paper,看起来比DSO、ORB、LSD好不少。
时间上,在论文的CPU上:
-- Feature tracking:36 msec/frame
-- Localization & mapping :25 msec/frame
建图方面就没有细看了。

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

推荐阅读更多精彩内容