1. Institut für Technische Informatik (ZITI), Heidelberg University, Heidelberg, Germany
2. Division of Robotics, ABB AG, Gilching, Germany
3. Department of Informatics, Bioengineering, Robotics, and System Engineering, University of Genoa, Genoa, Italy