fix a compile error from octomap package