working octomap