Efficient Decision Making and Belief Space Planning using Sparse Approximations

In this work, we introduce a new approach for the efficient solution of autonomous decision and planning problems, with a special focus on decision making under uncertainty and belief space planning (BSP) in high-dimensional state spaces. Usually, to solve the decision problem, we identify the optimal action, according to some objective function. Instead, we claim that we can sometimes generate and solve an analogous yet simplified decision problem, which can be solved more efficiently. Furthermore, a wise simplification method can lead to the same action selection, or one for which the maximal loss can be guaranteed. This simplification is separated from the state inference, and does not compromise its accuracy, as the selected action would finally be applied on the original state. At first, we develop the concept for general decision problems, and provide a theoretical framework of definitions to allow a coherent discussion. We then practically apply these ideas to BSP problems, in which the problem is simplified by considering a sparse approximation of the initial belief. The scalable sparsification algorithm we provide is able to yield solutions which are guaranteed to be consistent with the original problem. We demonstrate the benefits of the approach in the solution of a highly realistic active-SLAM problem, and manage to significantly reduce computation time, with practically no loss in the quality of solution. This rigorous and fundamental work is conceptually novel, and holds numerous possible extensions.

[1]  Vadim Indelman,et al.  Scalable sparsification for efficient decision making under uncertainty in high dimensional state spaces , 2017, 2017 IEEE/RSJ International Conference on Intelligent Robots and Systems (IROS).

[2]  Pascal Poupart,et al.  Point-Based Value Iteration for Continuous POMDPs , 2006, J. Mach. Learn. Res..

[3]  Jonathan P. How,et al.  Complexity Analysis and Efficient Measurement Selection Primitives for High-Rate Graph SLAM , 2017, 2018 IEEE International Conference on Robotics and Automation (ICRA).

[4]  John J. Leonard,et al.  Consistent sparsification for graph optimization , 2013, 2013 European Conference on Mobile Robots.

[5]  Cyrill Stachniss,et al.  Information-theoretic compression of pose graphs for laser-based SLAM , 2012, Int. J. Robotics Res..

[6]  Lydia E. Kavraki,et al.  Probabilistic roadmaps for path planning in high-dimensional configuration spaces , 1996, IEEE Trans. Robotics Autom..

[7]  Frank Dellaert,et al.  iSAM2: Incremental smoothing and mapping using the Bayes tree , 2012, Int. J. Robotics Res..

[8]  Frank Dellaert,et al.  Planning in the continuous domain: A generalized belief space approach for autonomous navigation in unknown environments , 2015, Int. J. Robotics Res..

[9]  John N. Tsitsiklis,et al.  The Complexity of Markov Decision Processes , 1987, Math. Oper. Res..

[10]  Jur P. van den Berg,et al.  Robust belief space planning under intermittent sensing via a maximum eigenvalue-based bound , 2016, Int. J. Robotics Res..

[11]  Jonathan P. How,et al.  Two-Stage Focused Inference for Resource-Constrained Minimal Collision Navigation , 2017, IEEE Transactions on Robotics.

[12]  Leslie Pack Kaelbling,et al.  Belief space planning assuming maximum likelihood observations , 2010, Robotics: Science and Systems.

[13]  S. Sukkarieh,et al.  Observability analysis and active control for airborne SLAM , 2008, IEEE Transactions on Aerospace and Electronic Systems.

[14]  Jingjing Du,et al.  A comparative study on active SLAM and autonomous exploration with Particle Filters , 2011, 2011 IEEE/ASME International Conference on Advanced Intelligent Mechatronics (AIM).

[15]  Xavier Boyen,et al.  Tractable Inference for Complex Stochastic Processes , 1998, UAI.

[16]  Ron Alterovitz,et al.  Motion planning under uncertainty using iterative local optimization in belief space , 2012, Int. J. Robotics Res..

[17]  Geoffrey J. Gordon,et al.  Finding Approximate POMDP solutions Through Belief Compression , 2011, J. Artif. Intell. Res..

[18]  Ryan M. Eustice,et al.  Active visual SLAM for robotic area coverage: Theory and experiment , 2015, Int. J. Robotics Res..

[19]  Vadim Indelman No Correlations Involved: Decision Making Under Uncertainty in a Conservative Sparse Information Space , 2016, IEEE Robotics and Automation Letters.

[20]  Paul J. Besl,et al.  A Method for Registration of 3-D Shapes , 1992, IEEE Trans. Pattern Anal. Mach. Intell..

[21]  Vadim Indelman,et al.  Fast Action Elimination for Efficient Decision Making and Belief Space Planning Using Bounded Approximations , 2017, ISRR.

[22]  Emilio Frazzoli,et al.  Sampling-based algorithms for optimal motion planning , 2011, Int. J. Robotics Res..

[23]  David A. McAllester,et al.  Approximate Planning for Factored POMDPs using Belief State Simplification , 1999, UAI.

[24]  D. Harville Matrix Algebra From a Statistician's Perspective , 1998 .

[25]  Ryan M. Eustice,et al.  Efficient planning with the Bayes tree for active SLAM , 2016, 2016 IEEE/RSJ International Conference on Intelligent Robots and Systems (IROS).

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

[27]  Vadim Indelman,et al.  Towards information-theoretic decision making in a conservative information space , 2015, 2015 American Control Conference (ACC).

[28]  Andrew Howard,et al.  Design and use paradigms for Gazebo, an open-source multi-robot simulator , 2004, 2004 IEEE/RSJ International Conference on Intelligent Robots and Systems (IROS) (IEEE Cat. No.04CH37566).

[29]  Charles F. Manski,et al.  Ordinal utility models of decision making under uncertainty , 1988 .

[30]  Timothy A. Davis,et al.  A column approximate minimum degree ordering algorithm , 2000, TOMS.

[31]  N. Roy,et al.  The Belief Roadmap: Efficient Planning in Belief Space by Factoring the Covariance , 2009, Int. J. Robotics Res..

[32]  Wolfram Burgard,et al.  Exploration with active loop-closing for FastSLAM , 2004, 2004 IEEE/RSJ International Conference on Intelligent Robots and Systems (IROS) (IEEE Cat. No.04CH37566).

[33]  Vadim Indelman,et al.  Consistent sparsification for efficient decision making under uncertainty in high dimensional state spaces , 2017, 2017 IEEE International Conference on Robotics and Automation (ICRA).

[34]  Hugh F. Durrant-Whyte,et al.  Simultaneous Localization and Mapping with Sparse Extended Information Filters , 2004, Int. J. Robotics Res..

[35]  Vadim Indelman,et al.  No belief propagation required: Belief space planning in high-dimensional state spaces via factor graphs, the matrix determinant lemma, and re-use of calculation , 2017, Int. J. Robotics Res..

[36]  Michael Kaess,et al.  Generic Node Removal for Factor-Graph SLAM , 2014, IEEE Transactions on Robotics.