Adding octomap_mapping to indigo