Playing with octomap functionality