Abstract-This work presents our results on 3D robot localization, mapping and path planning for the latest joint exercise of the European project "Long-Term Human-Robot Teaming for Robots Assisted Disaster Response" (TRADR)1 . The full system is operated and evaluated by firemen end-users in realworld search and rescue experiments. We demonstrate that the system is able to plan a path to a goal position desired by the fireman operator in the TRADR Operational Control Unit (OCU), using a persistent 3D map created by the robot during previous sorties.
I. INTRODUCTIONTeams of autonomous mobile robots have the potential to reduce human risks during disaster response as well as the associated costs [1]. Different levels of robot autonomy are required in order to effectively support a rescue squad performing high-level tasks such as exploring the disaster area, detecting victims and taking chemical samples. Moreover, long-term operation of robotic platforms is desired for humans and robots to collaborate over several days of disaster intervention. To this end, building and maintaining a persistent representation of the environment, accurate localization, and efficient path planning are fundamental prerequisites.Prior to this work, a SLAM strategy based on Iterative Closest Point (ICP) for the robotic platform considered in this work was proposed in [2]. While providing precise local reconstruction of an environment, this technique can not improve the map in the event of place recognition. The localization algorithm presented in this paper is therefore based on the pose-graph SLAM strategy as described in [3].The 3D path planning and navigation methods presented in this paper are based on the works [4,5,6]. The underlying modules provide functionalities such as real-time point cloud segmentation and traversability analysis. A randomized A* approach is applied on the current terrain structure interpretation.In the remainder of this report, we concisely describe the localization, mapping and path planning systems and present the results of experiments with firemen end-users, at the latest TRADR Joint Exercise (TJEx).II. SYSTEM DESCRIPTION While the TRADR system comprises an integrated framework spanning from low-level perception functionalities to high-level reasoning, in this work we focus on presenting the latest advances in the integrated SLAM and path planning.