Adding octomap_mapping (hydro)