Implemented a more recent function from octomap for incredible speed up#47

half-potato wants to merge 2 commits intoOctoMap:kinetic-develOctoMap/octomap_mapping:kinetic-develfrom

Yonder-Dynamics:kinetic-develYonder-Dynamics/octomap-mapping:kinetic-develCopy head branch name to clipboard