Acknowledgements

The work was done during the authors' time at the Fraunhofer Institute for Autonomous intelligent Systems. We would like to thank Kai Pervölz and Matthias Hennig and the whole Kurt3D RoboCup Rescue team of Fraunhofer AIS.