Efficient Graph-SLAM optimization using unit dual-quaternions

This paper presents a new parameterization approach for the graph-based SLAM problem utilising unit dual-quaternion. The rigid-body transformation typically consists of the robot position and rotation, and due to the Lie-group nature of the rotation, a homogeneous transformation matrix has been widely used in pose-graph optimizations. In this paper, we investigate the use of unit dual-quaternion for SLAM problem, providing a unified representation of the robot poses with computational and storage benefits. Although unit dual-quaternion has been widely used in robot kinematics and navigation (known also as Michel Chasles' theorem), it has not been well utilised in the graph SLAM optimization. In this work, we re-parameterize the graph SLAM problem with dual-quaternions, investigating the optimization performance and the sensitivity to poor initial estimates. Experimental results on public synthetic and real-world datasets show that the proposed approach significantly reduces the computational complexity, whilst retaining the similar map accuracies compared to the homogeneous transform matrix-based one.

[1]  Wolfram Burgard,et al.  A Tutorial on Graph-Based SLAM , 2010, IEEE Intelligent Transportation Systems Magazine.

[2]  Frank Dellaert,et al.  Selecting good measurements via ℓ1 relaxation: A convex approach for robust estimation over graphs , 2014, 2014 IEEE/RSJ International Conference on Intelligent Robots and Systems.

[3]  Kostas Daniilidis,et al.  Hand-Eye Calibration Using Dual Quaternions , 1999, Int. J. Robotics Res..

[4]  Oliver Birbach,et al.  Rapid development of manifold-based graph optimization systems for multi-sensor calibration and SLAM , 2011, 2011 IEEE/RSJ International Conference on Intelligent Robots and Systems.

[6]  Evangelos E. Milios,et al.  Globally Consistent Range Scan Alignment for Environment Mapping , 1997, Auton. Robots.

[7]  Frank Dellaert,et al.  Square Root SAM: Simultaneous Localization and Mapping via Square Root Information Smoothing , 2006, Int. J. Robotics Res..

[8]  Wolfram Burgard,et al.  A benchmark for the evaluation of RGB-D SLAM systems , 2012, 2012 IEEE/RSJ International Conference on Intelligent Robots and Systems.

[9]  Tom Duckett,et al.  A multilevel relaxation algorithm for simultaneous localization and mapping , 2005, IEEE Transactions on Robotics.

[10]  Changbin Yu,et al.  A Dual Quaternion Solution to Attitude and Position Control for Rigid-Body Coordination , 2012, IEEE Transactions on Robotics.

[11]  Jonghyuk Kim,et al.  Robust linear pose graph-based SLAM , 2015, Robotics Auton. Syst..

[12]  Christoph Hertzberg,et al.  A Framework for Sparse, Non-Linear Least Squares Problems on Manifolds-Ein Rahmen für dünnbesetzte, nichtlineare quadratische Ausgleichsrechnung auf Mannigfaltigkeiten , 2008 .

[13]  F. Neuhaus.  A Full 2D/3D GraphSLAM System for Globally Consistent Mapping based on Manifolds , 2012 .

[14]  Huayong Zhu,et al.  On the Comparisons of Unit Dual Quaternion and Homogeneous Transformation Matrix , 2013, Advances in Applied Clifford Algebras.

[15]  Edwin Olson,et al.  Fast iterative alignment of pose graphs with poor initial estimates , 2006, Proceedings 2006 IEEE International Conference on Robotics and Automation, 2006. ICRA 2006..

[16]  Frank Dellaert,et al.  iSAM: Fast Incremental Smoothing and Mapping with Efficient Data Association , 2007, Proceedings 2007 IEEE International Conference on Robotics and Automation.

[17]  Cyrill Stachniss,et al.  On measuring the accuracy of SLAM algorithms , 2009, Auton. Robots.

[18]  Dewen Hu,et al.  Strapdown inertial navigation system algorithms based on dual quaternions , 2005, IEEE Transactions on Aerospace and Electronic Systems.

[19]  D. Hu,et al.  Strapdown inertial navigation system algorithms based on dual quaternions , 2005 .

[20]  Wolfram Burgard,et al.  G2o: A general framework for graph optimization , 2011, 2011 IEEE International Conference on Robotics and Automation.