Octomap coordinate shift