getVoxelGridFromPointCloud has been improved an optimized.