Added octomap generation from a point cloud