works with octomap