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
posted @ 2016-05-21 22:03  rEINforCE  阅读(531)  评论(0编辑  收藏  举报