Fast scene voxelization and applications