Library that puts creates a TSDF from a depth image and inserts it into an Octree (Octomap)