Modern MAP inference methods for accurate and fast occupancy grid mapping on higher order factor graphs

Using the inverse sensor model has been popular in occupancy grid mapping. However, it is widely known that applying the inverse sensor model to mapping requires certain assumptions that are not necessarily true. Even the works that use forward sensor models have relied on methods like expectation maximization or Gibbs sampling which have been succeeded by more effective methods of maximum a posteriori (MAP) inference over graphical models. In this paper, we propose the use of modern MAP inference methods along with the forward sensor model. Our implementation and experimental results demonstrate that these modern inference methods deliver more accurate maps more efficiently than previously used methods.

[1]  Alberto Elfes,et al.  Using occupancy grids for mobile robot perception and navigation , 1989, Computer.

[2]  Martin J. Wainwright,et al.  MAP estimation via agreement on trees: message-passing and linear programming , 2005, IEEE Transactions on Information Theory.

[3]  Margrit Betke,et al.  Mobile robot localization using landmarks , 1997, IEEE Trans. Robotics Autom..

[4]  Tom Heskes,et al.  Fractional Belief Propagation , 2002, NIPS.

[5]  Sebastian Thrun,et al.  Robotic mapping: a survey , 2003 .

[6]  Tim D. Barfoot,et al.  Occupancy grid mapping with Markov Chain Monte Carlo Gibbs sampling , 2013, 2013 IEEE International Conference on Robotics and Automation.

[7]  Sebastian Thrun,et al.  Learning Occupancy Grid Maps with Forward Sensor Models , 2003, Auton. Robots.

[8]  Hans P. Moravec,et al.  High resolution maps from wide angle sonar , 1985, Proceedings. 1985 IEEE International Conference on Robotics and Automation.

[9]  David J. C. Mackay,et al.  Introduction to Monte Carlo Methods , 1998, Learning in Graphical Models.

[10]  Judea Pearl,et al.  Fusion, Propagation, and Structuring in Belief Networks , 1986, Artif. Intell..

[11]  Richard T. Vaughan,et al.  The Player/Stage Project: Tools for Multi-Robot and Distributed Sensor Systems , 2003 .

[12]  D. Sontag.  1 Introduction to Dual Decomposition for Inference , 2010 .

[13]  Wolfram Burgard,et al.  Occupancy Grid Models for Robot Mapping in Changing Environments , 2012, AAAI.

[14]  Tommi S. Jaakkola,et al.  Introduction to dual composition for inference , 2011 .

[15]  Kokichi Sugihara,et al.  Some location problems for robot navigation using a single camera , 1988, Computer Vision Graphics and Image Processing.

[16]  Tim Hesterberg,et al.  Monte Carlo Strategies in Scientific Computing , 2002, Technometrics.

[17]  Michael J. Black,et al.  Efficient Belief Propagation with Learned Higher-Order Markov Random Fields , 2006, ECCV.

[18]  X. Jin.  Factor graphs and the Sum-Product Algorithm , 2002 .

[19]  Dilbag Singh,et al.  Improved occupancy grid mapping in specular environment , 2012, Robotics Auton. Syst..

[20]  Wolfram Burgard,et al.  Highly accurate maximum likelihood laser mapping by jointly optimizing laser points and robot poses , 2011, 2011 IEEE International Conference on Robotics and Automation.

[21]  Sebastian Nowozin,et al.  A Comparative Study of Modern Inference Techniques for Discrete Energy Minimization Problems , 2013, 2013 IEEE Conference on Computer Vision and Pattern Recognition.

[22]  Stephen Gould,et al.  Accelerated dual decomposition for MAP inference , 2010, ICML.

[23]  Olivier Stasse,et al.  MonoSLAM: Real-Time Single Camera SLAM , 2007, IEEE Transactions on Pattern Analysis and Machine Intelligence.

[24]  W. Freeman,et al.  Generalized Belief Propagation , 2000, NIPS.

[25]  Nikos Komodakis,et al.  Beyond pairwise energies: Efficient optimization for higher-order MRFs , 2009, 2009 IEEE Conference on Computer Vision and Pattern Recognition.

[26]  Brendan J. Frey,et al.  Factor graphs and the sum-product algorithm , 2001, IEEE Trans. Inf. Theory.

[27]  Andrew W. Fitzgibbon,et al.  KinectFusion: Real-time dense surface mapping and tracking , 2011, 2011 10th IEEE International Symposium on Mixed and Augmented Reality.

[28]  K. Madhava Krishna,et al.  Realtime multibody visual SLAM with a smoothly moving monocular camera , 2011, 2011 International Conference on Computer Vision.

[29]  Vladimir Kolmogorov,et al.  Convergent Tree-Reweighted Message Passing for Energy Minimization , 2006, IEEE Transactions on Pattern Analysis and Machine Intelligence.

[30]  Frank Wolter,et al.  Exploring Artificial Intelligence in the New Millenium , 2002 .

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

[32]  Brian Potetz,et al.  Efficient Belief Propagation for Vision Using Linear Constraint Nodes , 2007, 2007 IEEE Conference on Computer Vision and Pattern Recognition.

[33]  Robert Platt,et al.  Voxel planes: Rapid visualization and meshification of point cloud ensembles , 2013, 2013 IEEE/RSJ International Conference on Intelligent Robots and Systems.