Collision detection and pointcloud merging implemented in CloudSegmenter