DV-SLAM (Dual-Sensor-Based Vector-Field SLAM) and Observability Analysis

In this paper, the observability of the conventional vector field simultaneous localization and mapping (SLAM) is examined by using the Fisher information matrix (FIM). If a mobile robot integrates sensor measurements while moving with a fixed heading, the measurements will be ambiguous because its measurement model is based on bilinear interpolation. To resolve the ambiguity, the authors proposed the novel dual-sensor-based vector-field SLAM (DV-SLAM), which is fully observable by using a mobile robot equipped with two sensors in a specific location to measure vector field signals. By examining its FIM, the condition is derived for the proposed DV-SLAM to be fully observable regardless of how the robot moves. The proposed DV-SLAM is implemented based on the Rao-Blackwellized particle filter with Earth's magnetic field sensors. Simulation and experimental results demonstrate that the proposed dual-sensor-based approach greatly improves the performance of the vector-field SLAM compared with the conventional approach.

[1]  Alok Aggarwal,et al.  Efficient, generalized indoor WiFi GraphSLAM , 2011, 2011 IEEE International Conference on Robotics and Automation.

[2]  Ren C. Luo,et al.  Multisensor Fusion-Based Concurrent Environment Mapping and Moving Object Detection for Intelligent Service Robotics , 2014, IEEE Transactions on Industrial Electronics.

[3]  Neil D. Lawrence,et al.  WiFi-SLAM Using Gaussian Process Latent Variable Models , 2007, IJCAI.

[4]  Cyrill Stachniss,et al.  Efficient information-theoretic graph pruning for graph-based SLAM with laser range finders , 2011, 2011 IEEE/RSJ International Conference on Intelligent Robots and Systems.

[5]  Nando de Freitas,et al.  Rao-Blackwellised Particle Filtering for Dynamic Bayesian Networks , 2000, UAI.

[6]  Kevin P. Murphy,et al.  Bayesian Map Learning in Dynamic Environments , 1999, NIPS.

[7]  Andrew W. Fitzgibbon,et al.  Bundle Adjustment - A Modern Synthesis , 1999, Workshop on Vision Algorithms.

[8]  Thia Kirubarajan,et al.  Estimation with Applications to Tracking and Navigation: Theory, Algorithms and Software , 2001 .

[9]  Wolfram Burgard,et al.  Improved Techniques for Grid Mapping With Rao-Blackwellized Particle Filters , 2007, IEEE Transactions on Robotics.

[10]  Y. Yamamoto,et al.  Optical sensing for robot perception and localization , 2005, IEEE Workshop on Advanced Robotics and its Social Impacts, 2005..

[11]  Ren C. Luo,et al.  Enriched Indoor Map Construction Based on Multisensor Fusion Approach for Intelligent Service Robot , 2012, IEEE Transactions on Industrial Electronics.

[12]  Mohammad Teshnehlab,et al.  A Square Root Unscented FastSLAM With Improved Proposal Distribution and Resampling , 2014, IEEE Transactions on Industrial Electronics.

[13]  Gamini Dissanayake,et al.  Convergence and Consistency Analysis for Extended Kalman Filter Based SLAM , 2007, IEEE Transactions on Robotics.

[14]  Jae-Bok Song,et al.  Monocular Vision-Based SLAM in Indoor Environment Using Corner, Lamp, and Door Features From Upward-Looking Camera , 2011, IEEE Transactions on Industrial Electronics.

[15]  Emanuele Menegatti,et al.  Range-only SLAM with a mobile robot and a Wireless Sensor Networks , 2009, 2009 IEEE International Conference on Robotics and Automation.

[16]  Sebastian Thrun,et al.  Simultaneous localization and mapping with unknown data association using FastSLAM , 2003, 2003 IEEE International Conference on Robotics and Automation (Cat. No.03CH37422).

[17]  Jens-Steffen Gutmann,et al.  Vector Field SLAM—Localization by Learning the Spatial Variation of Continuous Signals , 2012, IEEE Transactions on Robotics.

[18]  Wenyu Liu,et al.  Indoor Localization Based on Curve Fitting and Location Search Using Received Signal Strength , 2015, IEEE Transactions on Industrial Electronics.

[19]  Bhaskar Krishnamachari,et al.  Sequence-Based Localization in Wireless Sensor Networks , 2008 .

[20]  Hugh F. Durrant-Whyte,et al.  A solution to the simultaneous localization and map building (SLAM) problem , 2001, IEEE Trans. Robotics Autom..

[21]  Jiming Chen,et al.  Optimal Coordination of Mobile Sensors for Target Tracking Under Additive and Multiplicative Noises , 2014, IEEE Transactions on Industrial Electronics.

[22]  Euntai Kim,et al.  Simultaneous Global Localization and Mapping , 2014, IEEE/ASME Transactions on Mechatronics.

[23]  Gamini Dissanayake,et al.  Observability analysis of SLAM using fisher information matrix , 2008, 2008 10th International Conference on Control, Automation, Robotics and Vision.

[24]  Yanyan Chen,et al.  A novel loop closure detection method in monocular SLAM , 2013, Intell. Serv. Robotics.

[25]  C. Jauffret.  Observability and fisher information matrix in nonlinear regression , 2007, IEEE Transactions on Aerospace and Electronic Systems.

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

[27]  Nando de Freitas,et al.  Sequential Monte Carlo Methods in Practice , 2001, Statistics for Engineering and Information Science.

[28]  Kyoung Mu Lee,et al.  CV-SLAM: a new ceiling vision-based SLAM technique , 2005, 2005 IEEE/RSJ International Conference on Intelligent Robots and Systems.

[29]  Hans P. Moravec.  Sensor Fusion in Certainty Grids for Mobile Robots , 1988, AI Mag..

[30]  Sang Woo Kim,et al.  Observability-Based Selection Criterion for Anchor Nodes in Multiple-Cell Localization , 2013, IEEE Transactions on Industrial Electronics.

[31]  Robert H. Tolson,et al.  Maximizing the determinant of the information matrix with the effective independence method , 1992 .

[32]  John J. Leonard,et al.  Robust Mapping and Localization in Indoor Environments Using Sonar Data , 2002, Int. J. Robotics Res..

[33]  Matthew R. Walter,et al.  Exactly Sparse Extended Information Filters for Feature-based SLAM , 2007, Int. J. Robotics Res..