Updating the CMakeList.txt to allow for the usage of octomap