Simultaneous Localization and Mapping Using a Novel Dual Quaternion Particle Filter

In this paper, we present a novel approach to perform simultaneous localization and mapping (SLAM) for planar motions based on stochastic filtering with dual quaternion particles using low-cost range and gyro sensor data. Here, SE(2) states are represented by unit dual quaternions and further get stochastically modeled by a distribution from directional statistics such that particles can be generated by random sampling. To build the full SLAM system, a novel dual quaternion particle filter based on Rao-Blackwellization is proposed for the tracking block, which is further integrated with an occupancy grid mapping block. Unlike previously proposed filtering approaches, our method can perform tracking in the presence of multi-modal noise in unknown environments while giving reasonable mapping results. The approach is further evaluated using a walking robot with on-board ultrasonic sensors and an IMU sensor navigating in an unknown environment in both simulated and real-world scenarios.

[1]  Gerhard Kurz,et al.  A stochastic filter for planar rigid-body motions , 2015, 2015 IEEE International Conference on Multisensor Fusion and Integration for Intelligent Systems (MFI).

[2]  Uwe D. Hanebeck,et al.  Progressive Gaussian filtering using explicit likelihoods , 2014, 17th International Conference on Information Fusion (FUSION).

[3]  Wolfram Burgard,et al.  Monte Carlo localization for mobile robots , 1999, Proceedings 1999 IEEE International Conference on Robotics and Automation (Cat. No.99CH36288C).

[4]  H. Temeltas,et al.  SLAM for robot navigation , 2008, IEEE Aerospace and Electronic Systems Magazine.

[5]  Branko Ristic,et al.  Beyond the Kalman Filter: Particle Filters for Tracking Applications , 2004 .

[6]  Sandra Hirche,et al.  Rigid motion estimation using mixtures of projected Gaussians , 2013, Proceedings of the 16th International Conference on Information Fusion.

[7]  Sebastian Thrun,et al.  FastSLAM: a factored solution to the simultaneous localization and mapping problem , 2002, AAAI/IAAI.

[8]  Clifford,et al.  Preliminary Sketch of Biquaternions , 1871 .

[9]  W. Hamilton.  II. On quaternions; or on a new system of imaginaries in algebra , 1844 .

[10]  Christian Lundquist,et al.  Extended Target Tracking using a Gaussian-Mixture PHD Filter , 2017, IEEE Transactions on Aerospace and Electronic Systems.

[11]  Christopher Bingham.  An Antipodally Symmetric Distribution on the Sphere , 1974 .

[12]  Mongi A. Abidi,et al.  Pose and motion estimation from vision using dual quaternion-based extended kalman filtering , 1997 .

[13]  Kyle J. DeMars,et al.  Uncertainty Propagation of correlated quaternion and Euclidean states using partially-conditioned Gaussian mixtures , 2016, 2016 19th International Conference on Information Fusion (FUSION).

[14]  Ben Kenwright,et al.  A Beginners Guide to Dual-Quaternions: What They Are, How They Work, and How to Use Them for 3D Character Hierarchies , 2012, WSCG 2012.

[15]  Gerhard Kurz,et al.  Unscented Orientation Estimation Based on the Bingham Distribution , 2013, IEEE Transactions on Automatic Control.

[16]  S. R. Jammalamadaka,et al.  Directional Statistics, I , 2011 .

[17]  Gerhard Kurz,et al.  A new probability distribution for simultaneous representation of uncertain position and orientation , 2014, 17th International Conference on Information Fusion (FUSION).

[18]  Gerhard Kurz,et al.  Nonlinear Progressive Filtering for SE(2) Estimation , 2018, 2018 21st International Conference on Information Fusion (FUSION).

[19]  Wendelin Feiten,et al.  MPG - Fast Forward Reasoning on 6 DOF Pose Uncertainty , 2012, ROBOTIK.

[20]  Jianke Zhu,et al.  Image Gradient-based Joint Direct Visual Odometry for Stereo Camera , 2017, IJCAI.

[21]  Jeffrey K. Uhlmann,et al.  Unscented filtering and nonlinear estimation , 2004, Proceedings of the IEEE.