Sampling Strategies for Particle Filtering SLAM

We describe several new sampling strategies for Rao-Blackwellized particle filtering SLAM. Two of the strategies, called fixed-lag roughening and the block proposal distribution, attempt to exploit “future” information, when it becomes available, to improve the filter’s estimation for previous time steps. Fixed-lag roughening perturbs trajectory samples over a fixed lag time according to a Markov Chain Monte Carlo kernel. The block proposal distribution directly samples poses over a fixed lag from their fully joint distribution conditioned on all the available data. Our results indicate that the proposed strategies, especially the block proposal, yield significant improvements in filter consistency and a reduction in particle degeneracies compared to standard sampling techniques such as the improved proposal distribution of FastSLAM 2. In addition, we examine the effectiveness of two new resampling techniques, residual resampling and generalized resampling, as applied to RBPF SLAM. These drop-in-place techniques are simple to use and (in the case of residual resampling) computationally cheaper than the standard random resampling approach. However, our results show that they offer no real improvement in performance over random resampling in SLAM. This is an extended version of a paper (Beevers and Huang, 2007) previously submitted for publication.

[1]  Jun S. Liu,et al.  Monte Carlo strategies in scientific computing , 2001 .

[2]  Eduardo Mario Nebot,et al.  Consistency of the FastSLAM algorithm , 2006, Proceedings 2006 IEEE International Conference on Robotics and Automation, 2006. ICRA 2006..

[3]  W. Gilks,et al.  Following a moving target—Monte Carlo inference for dynamic Bayesian models , 2001 .

[4]  Jun S. Liu,et al.  Blind Deconvolution via Sequential Imputations , 1995 .

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

[6]  Timothy S. Bailey,et al.  Mobile Robot Localisation and Mapping in Extensive Outdoor Environments , 2002 .

[7]  Wesley H. Huang,et al.  Inferring and Enforcing Relative Constraints in SLAM , 2006, WAFR.

[8]  Wolfram Burgard,et al.  Recovering Particle Diversity in a Rao-Blackwellized Particle Filter for SLAM After Actively Closing Loops , 2005, Proceedings of the 2005 IEEE International Conference on Robotics and Automation.

[9]  A. Doucet,et al.  Efficient Block Sampling Strategies for Sequential Monte Carlo Methods , 2006 .

[10]  John M. Olin.  Calculating posterior distributions and modal estimates in Markov mixture models , 1996 .

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

[12]  Wolfram Burgard,et al.  Improving Grid-based SLAM with Rao-Blackwellized Particle Filters by Adaptive Proposals and Selective Resampling , 2005, Proceedings of the 2005 IEEE International Conference on Robotics and Automation.

[13]  Wesley H. Huang,et al.  Fixed-lag Sampling Strategies for Particle Filtering SLAM , 2007, Proceedings 2007 IEEE International Conference on Robotics and Automation.