Now, the most time consuming operation is iteration over points in point cloud, which could be parallelized.