2019-07-30_ICRA2019_[SLAM]Why BA?

文章:Visual SLAM: Why Bundle Adjust?
链接https://arxiv.org/abs/1902.03747
作者:Alvaro Parra Bustos,……,Ian Reid
机构:The University of Adelaide
摘要的摘要:BA的替代优化方法,解决纯旋转和弱平移下的位姿估计。简化SLAM算法,只估计orientations,然后基于已知R计算tX(mappoint)。


1. L-INFINITY SLAM

给定有重叠区域的图像集\{Z_j,Z_k\}的相对旋转\{R_{j,k}\},估计出每帧的平均旋转(详见后文):
\min_{\{R_j\}}\,\,\sum_{j,k \in N} \lVert R_{j,k} - R_kR_j^{-1} \rVert _F^2 \tag{3} \\
其中,N为共视图。然后基于给定的R_j,计算相机位置\{t_j\}和3D点\{X_i\}
\min_{\left\{X_i\right\}\left\{t_j\right\}} \,\, \max_{i,j} \lVert z_{i,j} - f(X_i|R_j,t_j) \rVert _2 \tag{4} \\
因为上述为最小化重投影误差的最大值,所以可看作为重投影误差的\ell_{\infty}-norm(BA里为\ell_2-norm)。

01: for each keyframe step t=1,2,\cdots do
02:  s \gets t - (\text{window size}) + 1
03:  \{R_{j,k}\}_{j,k \in N_{win}} \gets \text{relative_rotation} (Z_{(s-1):t})
04:  R_{s:t} \gets \text{rotation_averageing} (\left\{R_{j,k}\right\}_{j,k \in N_{win}})
05:  t_{s:t},X \gets \text{known_rotation_prob} (R_{s:t},Z_{0:t})
06:  if loop is detected in Z_t then
07:   \left\{ R_{j,k} \right\}_{j,k \in N_{sys}} \gets \text{relative_rotation}(Z_{0:t})
08:   R_{1:t} \gets \text{rotation_averageing} (\left\{R_{j,k}\right\}_{j,k \in N_{sys}})
09:   t_{1:t},X \gets \text{known_rotation_prob} (R_{1:t},Z_{0:t})
10:  end if
11: end for


2. ALGORITHMIC DETAILS

K \in \mathbb{R}^{3 \times 3}为相机内参,P_j = K[R_j \,\, t_j]为第j帧图像的投影矩阵。

2.1 Estimating relative motions

从essential matrix中分解出R_{j,k}。对于弱平移,使用Trimmed ICP。

2.2 Rotation averaging

使用文献[1]中的方法求解方程(3),不需要线性化等操作。

Rotation averaging

2.3 Known rotation problem

R_j^{(1:2)}R_j的前两行,R_j^{(3)}R_j的第三行,X_i投影到j图像:
f(X_i|R_j,t_j) := \cfrac{R_j^{(1:2)}X_i + t_j^{(1:2)}}{R_j^{(3)}X_i + t_j^{(3)}} \tag{6} \\
方程(4)可写为:

1.PNG

(7c)保证了深度值为正,点在相机前。因此问题可继续改写为:
2.PNG

很多方法解该问题,paper使用基于Res-Int改进的方法。

2.4 Known rotation problem with translation direction constraints

用的也是阿德莱德大学的一个老师的算法[2]
分别单独求解\min_{X_i}\min_{t_j}

4.PNG


3. RESULTS

  • BA: implemented in C++ using the Ceres solver
  • rotation averaging: code provided in [1]
  • known rotation prob: code provided in [2]
  • 闭环问题:(暂时没有看)krot tdc: (P3) implemented in MATLAB using SeDuMi


    5.JPG
6.PNG

  1. [33]A. Chatterjee and V. Madhav Govindu, “Efficient and robust largescale rotation averaging,” in ICCV, 2013.

  2. [39]Q. Zhang, T.-J. Chin, and H. M. Le, “A fast resection-intersection method for the known rotation problem,” in CVPR, 2018.

最后编辑于
©著作权归作者所有,转载或内容合作请联系作者
  • 序言:七十年代末,一起剥皮案震惊了整个滨河市,随后出现的几起案子,更是在滨河造成了极大的恐慌,老刑警刘岩,带你破解...
    沈念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

推荐阅读更多精彩内容