1. Simulation, Systems Optimization and Robotics Group CS Dept. Technische Universität Darmstadt Hochschulstrasse 10, 64289 Darmstadt Hesse Germany
2. Verifiable Robotics Research Group School of Mechanical and Aerospace Engineering, Cornell University Ithaca NY 14853 USA
3. Robert Bosch GmbH Corporate Research, Department for Cognitive Systems 70442 Stuttgart Germany
4. Capable Humanitarian Robotics & Intelligent Systems Lab Department of Physics, Computer Science and Engineering, Christopher Newport University Newport News VA 23606 USA