Added voxel_grid variant that doesn't add voxel if too few points are in there