zoukankan      html  css  js  c++  java
  • iSAM vs SPA vs HOG-Man

    原文:Why Use iSAM?  Michael Kaess (2012)

    Comparison

    • Fastest of the state-of-the-art SLAM algorithms
    • Provides the exact least-squares solution
    • Provides efficient access to marginal covariances
    • Also deals with landmarks, not just pose graphs
    • Easy to generalize to new cost functions

    Timing comparison for the Manhattan dataset.

    We compare iSAM [TRO 2008] against other state-of-the-art SLAM algorithms using the simulated Manhattan World by E. Olson. For each algorithm we recover a full solution in every step on a laptop with Intel Core 2 Duo 2.4GHz processor. Similar to the original square root SAM algorithm, iSAM also provides the exact least-square solution, but with the caveat that the most recently added variables might not be converged yet, as relinearization is postponed to the next periodic batch step.

    Sparse Pose Adjustment (SPA2d) by Konolige et al. [IROS 2010] provides a fast implementation of the original square root SAM algorithm [IJRR 2006], but batch methods in general have to solve a problem of continously growing size, while iSAM avoids unncessary repetition of calculations.

    HOG-Man by Grisetti et al. [ICRA 2010] focuses computation on affected regions using a hierarchical approach, which provides an approximate solution. Note that HOG-Man can provide the exact solution, but will then essentially perform square root SAM. While on the Manhattan dataset the HOG-Man implementation performs slower, on more dense data such as the w10000 dataset it is actually faster than iSAM, though it only provides an approximate solution:

    Timing comparison for the w10000 dataset.

    We have omitted other state-of-the-art algorithms such as TORO and Treemap, as they have already been shown to be inferior to SPA2d in Konolige et al. [IROS 2010]. In particular, TORO does not correctly deal with angular measurements, which is especially problematic when used in 3D. In contrast, Square Root SAM and iSAM have already been shown to work in 3D vision applications in IJRR 2006 and my thesis work.

    Note that iSAM can be slow on denser data, but our latest research has led us to an improved iSAM algorithm based on the Bayes tree [WAFR 2010] that avoids this problem. The slowdown is caused by local fill-in between periodic variable reordering steps. The fill-in on the other hand is caused by large numbers of loop closing constraints in certain simulated test datasets, such as the w10000 dataset. However, including such a large number of loop closing constraints creates an artificial problem while not improving the map quality - a smaller number is sufficient to obtain the same result. Standard datasets such as Intel, Killian Court and Victoria Park have sparse loop closing constraints, yielding good maps without any slowdown.

    Reference:

    • "Square Root SAM: Simultaneous Localization and Mapping via Square Root Information Smoothing" by F. Dellaert and M. Kaess, Intl. J. of Robotics Research, IJRR, vol. 25, no. 12, Dec 2006, pp. 1181-1204, PDF
    • "iSAM: Incremental Smoothing and Mapping" by M. Kaess, A. Ranganathan, and F. Dellaert, IEEE Trans. on Robotics, TRO, vol. 24, no. 6, Dec 2008, pp. 1365-1378, PDF
    • "iSAM2: Incremental Smoothing and Mapping Using the Bayes Tree" by M. Kaess, H. Johannsson, R. Roberts, V. Ila, J.J. Leonard, and F. Dellaert, Intl. J. of Robotics Research (IJRR), vol. 31, Feb. 2012, pp. 217-236, PDF
    • "Incremental Smoothing and Mapping" by M. Kaess, Ph.D. dissertation, Georgia Institute of Technology, Dec 2008, PDF
    • "Hierarchical Optimization on Manifolds for Online 2D and 3D Mapping" by G. Grisetti, R. Kuemmerle, C. Stachniss, U. Frese, and C. Hertzberg, IEEE Intl. Conf. on Robotics and Automation (ICRA), May 2010, PDF
    • "Sparse Pose Adjustment for 2D Mapping" by K. Konolige, G. Grisetti, R. Kuemmerle, W. Burgard, L. Benson, R. Vincent, IEEE/RSJ Intl. Conf. on Intelligent Robots and Systems (IROS), Oct 2010, PDF
  • 相关阅读:
    团队博客-十日冲刺6
    04构建之法阅读笔记之一
    Java基础-面向对象三大特性
    剑指 Offer 38. 字符串的排列
    Java基础:包装类 装箱/拆箱 Integer
    剑指 Offer 34. 二叉树中和为某一值的路径
    LeetCode 树:105. 从前序与中序遍历序列构造二叉树
    Java基础:类型
    Java基础:值传递和引用传递
    数据结构:图的基本知识
  • 原文地址:https://www.cnblogs.com/reinforce/p/5515699.html
Copyright © 2011-2022 走看看