1. Department of Computer Science, Rice University, Houston, TX, USA
2. Jet Propulsion Laboratory, California Institute of Technology, Pasadena, CA, USA
3. Estimation, Search, and Planning (ESP) Group, Oxford Robotics Institute, University of Oxford, Oxford, U.K.