Sampling-based Motion Planning for Robotic Information Gathering

We propose an incremental sampling-based motion planning algorithm that generates maximally informative trajectories for guiding mobile robots to observe their environment. The goal is to find a trajectory that maximizes an information metric (e.g., variance reduction, information gain, or mutual information) and also falls within a pre-specified budget constraint (e.g., fuel, energy, or time). Prior algorithms have employed combinatorial optimization techniques to solve these problems, but existing techniques are typically restricted to discrete domains and often scale poorly in the size of the problem. Our proposed Rapidly-exploring Information Gathering (RIG) algorithm extends ideas from Rapidly-exploring Random Graphs (RRGs) and combines them with branch and bound techniques to achieve efficient optimization of information gathering while also allowing for operation in continuous space with motion constraints. We provide a rigorous analysis of the asymptotic optimality of our approach, and we present several conservative pruning strategies for modular, submodular, and time-varying information objectives. We demonstrate that our proposed approach finds optimal solutions more quickly than existing combinatorial solvers, and we provide a proof-ofconcept field implementation on an autonomous surface vehicle performing a wireless signal strength monitoring task in a lake.

[1]  R. Khan,et al.  Sequential Tests of Statistical Hypotheses. , 1972 .

[2]  John H. Reif,et al.  Complexity of the mover's problem and generalizations , 1979, 20th Annual Symposium on Foundations of Computer Science (sfcs 1979).

[3]  R. Bajcsy.  Active perception , 1988, Proc. IEEE.

[4]  Hugh F. Durrant-Whyte,et al.  A Bayesian Approach to Optimal Sensor Placement , 1990, Int. J. Robotics Res..

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

[6]  S. LaValle,et al.  Randomized Kinodynamic Planning , 2001 .

[7]  Hugh F. Durrant-Whyte,et al.  Coordinated decentralized search for a lost target in a Bayesian world , 2003, Proceedings 2003 IEEE/RSJ International Conference on Intelligent Robots and Systems (IROS 2003) (Cat. No.03CH37453).

[8]  Geoffrey A. Hollinger,et al.  Efficient Multi-robot Search for a Moving Target , 2009, Int. J. Robotics Res..

[9]  Andreas Krause,et al.  Efficient Informative Sensing using Multiple Robots , 2014, J. Artif. Intell. Res..

[10]  Carl E. Rasmussen,et al.  Gaussian processes for machine learning , 2005, Adaptive computation and machine learning.

[11]  Hugh F. Durrant-Whyte,et al.  Gaussian Process modeling of large scale terrain , 2009, ICRA.

[12]  J. How,et al.  Information-rich Path Planning with General Constraints using Rapidly-exploring Random Trees , 2010 .

[13]  Leslie Pack Kaelbling,et al.  Task-Driven Tactile Exploration , 2010, Robotics: Science and Systems.

[14]  J. Karl Hedrick,et al.  Particle filter based information-theoretic active sensing , 2010, Robotics Auton. Syst..

[15]  Shengyong Chen,et al.  Active vision in robotic systems: A survey of recent developments , 2011, Int. J. Robotics Res..

[16]  Gaurav S. Sukhatme,et al.  Persistent ocean monitoring with underwater gliders: Adapting sampling resolution , 2011, J. Field Robotics.

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

[18]  Emilio Frazzoli,et al.  Anytime Motion Planning using the RRT* , 2011, 2011 IEEE International Conference on Robotics and Automation.

[19]  Nicholas Roy,et al.  Rapidly-exploring Random Belief Trees for motion planning under uncertainty , 2011, 2011 IEEE International Conference on Robotics and Automation.

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

[21]  Gaurav S. Sukhatme,et al.  Branch and bound for informative path planning , 2012, 2012 IEEE International Conference on Robotics and Automation.

[22]  Lydia E. Kavraki,et al.  The Open Motion Planning Library , 2012, IEEE Robotics & Automation Magazine.

[23]  Geoffrey A. Hollinger,et al.  Active planning for underwater inspection and the benefit of adaptivity , 2012, Int. J. Robotics Res..