add parameter to choose keeping pointcloud organized