Topological Information-Theoretic Belief Space Planning with Optimality Guarantees

Determining a globally optimal solution of belief space planning (BSP) in high-dimensional state spaces is computationally expensive, as it involves belief propagation and objective function evaluation for each candidate action. Our recently introduced topological belief space planning t-bsp instead performs decision making considering only topologies of factor graphs that correspond to posterior future beliefs. In this paper we contribute to this body of work a novel method for efficiently determining error bounds of t-bsp, thereby providing global optimality guarantees or uncertainty margin of its solution. The bounds are given with respect to an optimal solution of information theoretic BSP considering the previously introduced topological metric which is based on the number of spanning trees. In realistic and synthetic simulations, we analyze tightness of these bounds and show empirically how this metric is closely related to another computationally more efficient t-bsp metric, an approximation of the von Neumann entropy of a graph, which can achieve online performance.

[1]  George J. Pappas,et al.  Decentralized active information acquisition: Theory and application to multi-robot SLAM , 2015, 2015 IEEE International Conference on Robotics and Automation (ICRA).

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

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

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

[5]  F. Dellaert Factor Graphs and GTSAM: A Hands-on Introduction , 2012 .

[6]  M. Yannakakis Computing the Minimum Fill-in is NP^Complete , 1981 .

[7]  Nancy M. Amato,et al.  FIRM: Sampling-based feedback motion-planning under motion uncertainty and imperfect measurements , 2014, Int. J. Robotics Res..

[8]  R. Bajcsy Active perception , 1988 .

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

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

[11]  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).

[12]  Ramesh Govindan,et al.  Utility based sensor selection , 2006, IPSN.

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

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

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

[16]  Harold W. Sorenson,et al.  Parameter estimation: Principles and problems , 1980 .

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

[18]  Vadim Indelman,et al.  Multi-robot decentralized belief space planning in unknown environments via efficient re-evaluation of impacted paths , 2016, 2016 IEEE/RSJ International Conference on Intelligent Robots and Systems (IROS).

[19]  B. Faverjon,et al.  Probabilistic Roadmaps for Path Planning in High-Dimensional Con(cid:12)guration Spaces , 1996 .

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

[21]  Joelle Pineau,et al.  Anytime Point-Based Approximations for Large POMDPs , 2006, J. Artif. Intell. Res..

[22]  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).

[23]  Ian D. Reid,et al.  On the comparison of uncertainty criteria for active SLAM , 2012, 2012 IEEE International Conference on Robotics and Automation.

[24]  Lydia E. Kavraki,et al.  A heuristic approach to finding diverse short paths , 2015, 2015 IEEE International Conference on Robotics and Automation (ICRA).

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

[26]  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..

[27]  David Hsu,et al.  SARSOP: Efficient Point-Based POMDP Planning by Approximating Optimally Reachable Belief Spaces , 2008, Robotics: Science and Systems.

[28]  Gamini Dissanayake,et al.  Multi-Step Look-Ahead Trajectory Planning in SLAM: Possibility and Necessity , 2005, Proceedings of the 2005 IEEE International Conference on Robotics and Automation.

[29]  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).

[30]  Geir Hovland,et al.  Dynamic sensor selection for robotic systems , 1997, Proceedings of International Conference on Robotics and Automation.

[31]  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..

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

[33]  Jaime Valls Miró,et al.  Active Pose SLAM , 2012, 2012 IEEE/RSJ International Conference on Intelligent Robots and Systems.

[34]  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).

[35]  Vadim Indelman,et al.  Topological Multi-Robot Belief Space Planning in Unknown Environments , 2018, 2018 IEEE International Conference on Robotics and Automation (ICRA).

[36]  G. Dissanayake,et al.  Good , Bad and Ugly Graphs for SLAM , 2015 .

[37]  Stephen P. Boyd,et al.  Sensor Selection via Convex Optimization , 2009, IEEE Transactions on Signal Processing.

[38]  Vadim Indelman,et al.  Decentralized multi-robot belief space planning in unknown environments via identification and efficient re-evaluation of impacted paths , 2017, Autonomous Robots.