|
|
@ -40,72 +40,146 @@ struct alignas(64) SwizzleTable {
|
|
|
|
constexpr auto legacy_swizzle_table = SwizzleTable<8, 64, 1>();
|
|
|
|
constexpr auto legacy_swizzle_table = SwizzleTable<8, 64, 1>();
|
|
|
|
constexpr auto fast_swizzle_table = SwizzleTable<8, 4, 16>();
|
|
|
|
constexpr auto fast_swizzle_table = SwizzleTable<8, 4, 16>();
|
|
|
|
|
|
|
|
|
|
|
|
static void LegacySwizzleData(u32 width, u32 height, u32 bytes_per_pixel, u32 out_bytes_per_pixel,
|
|
|
|
/**
|
|
|
|
u8* swizzled_data, u8* unswizzled_data, bool unswizzle,
|
|
|
|
* This function manages ALL the GOBs(Group of Bytes) Inside a single block.
|
|
|
|
u32 block_height) {
|
|
|
|
* Instead of going gob by gob, we map the coordinates inside a block and manage from
|
|
|
|
|
|
|
|
* those. Block_Width is assumed to be 1.
|
|
|
|
|
|
|
|
*/
|
|
|
|
|
|
|
|
void PreciseProcessBlock(u8* swizzled_data, u8* unswizzled_data, const bool unswizzle,
|
|
|
|
|
|
|
|
const u32 x_start, const u32 y_start, const u32 z_start, const u32 x_end,
|
|
|
|
|
|
|
|
const u32 y_end, const u32 z_end, const u32 tile_offset,
|
|
|
|
|
|
|
|
const u32 xy_block_size, const u32 layer_z, const u32 stride_x,
|
|
|
|
|
|
|
|
const u32 bytes_per_pixel, const u32 out_bytes_per_pixel) {
|
|
|
|
std::array<u8*, 2> data_ptrs;
|
|
|
|
std::array<u8*, 2> data_ptrs;
|
|
|
|
const std::size_t stride = width * bytes_per_pixel;
|
|
|
|
u32 z_address = tile_offset;
|
|
|
|
const std::size_t gobs_in_x = 64;
|
|
|
|
const u32 gob_size_x = 64;
|
|
|
|
const std::size_t gobs_in_y = 8;
|
|
|
|
const u32 gob_size_y = 8;
|
|
|
|
const std::size_t gobs_size = gobs_in_x * gobs_in_y;
|
|
|
|
const u32 gob_size_z = 1;
|
|
|
|
const std::size_t image_width_in_gobs{(stride + gobs_in_x - 1) / gobs_in_x};
|
|
|
|
const u32 gob_size = gob_size_x * gob_size_y * gob_size_z;
|
|
|
|
for (std::size_t y = 0; y < height; ++y) {
|
|
|
|
for (u32 z = z_start; z < z_end; z++) {
|
|
|
|
const std::size_t gob_y_address =
|
|
|
|
u32 y_address = z_address;
|
|
|
|
(y / (gobs_in_y * block_height)) * gobs_size * block_height * image_width_in_gobs +
|
|
|
|
u32 pixel_base = layer_z * z + y_start * stride_x;
|
|
|
|
(y % (gobs_in_y * block_height) / gobs_in_y) * gobs_size;
|
|
|
|
for (u32 y = y_start; y < y_end; y++) {
|
|
|
|
const auto& table = legacy_swizzle_table[y % gobs_in_y];
|
|
|
|
const auto& table = legacy_swizzle_table[y % gob_size_y];
|
|
|
|
for (std::size_t x = 0; x < width; ++x) {
|
|
|
|
for (u32 x = x_start; x < x_end; x++) {
|
|
|
|
const std::size_t gob_address =
|
|
|
|
const u32 swizzle_offset{y_address + table[x * bytes_per_pixel % gob_size_x]};
|
|
|
|
gob_y_address + (x * bytes_per_pixel / gobs_in_x) * gobs_size * block_height;
|
|
|
|
const u32 pixel_index{x * out_bytes_per_pixel + pixel_base};
|
|
|
|
const std::size_t x2 = x * bytes_per_pixel;
|
|
|
|
data_ptrs[unswizzle] = swizzled_data + swizzle_offset;
|
|
|
|
const std::size_t swizzle_offset = gob_address + table[x2 % gobs_in_x];
|
|
|
|
data_ptrs[!unswizzle] = unswizzled_data + pixel_index;
|
|
|
|
const std::size_t pixel_index = (x + y * width) * out_bytes_per_pixel;
|
|
|
|
std::memcpy(data_ptrs[0], data_ptrs[1], bytes_per_pixel);
|
|
|
|
|
|
|
|
}
|
|
|
|
|
|
|
|
pixel_base += stride_x;
|
|
|
|
|
|
|
|
if ((y + 1) % gob_size_y == 0)
|
|
|
|
|
|
|
|
y_address += gob_size;
|
|
|
|
|
|
|
|
}
|
|
|
|
|
|
|
|
z_address += xy_block_size;
|
|
|
|
|
|
|
|
}
|
|
|
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
|
|
data_ptrs[unswizzle] = swizzled_data + swizzle_offset;
|
|
|
|
/**
|
|
|
|
data_ptrs[!unswizzle] = unswizzled_data + pixel_index;
|
|
|
|
* This function manages ALL the GOBs(Group of Bytes) Inside a single block.
|
|
|
|
|
|
|
|
* Instead of going gob by gob, we map the coordinates inside a block and manage from
|
|
|
|
|
|
|
|
* those. Block_Width is assumed to be 1.
|
|
|
|
|
|
|
|
*/
|
|
|
|
|
|
|
|
void FastProcessBlock(u8* swizzled_data, u8* unswizzled_data, const bool unswizzle,
|
|
|
|
|
|
|
|
const u32 x_start, const u32 y_start, const u32 z_start, const u32 x_end,
|
|
|
|
|
|
|
|
const u32 y_end, const u32 z_end, const u32 tile_offset,
|
|
|
|
|
|
|
|
const u32 xy_block_size, const u32 layer_z, const u32 stride_x,
|
|
|
|
|
|
|
|
const u32 bytes_per_pixel, const u32 out_bytes_per_pixel) {
|
|
|
|
|
|
|
|
std::array<u8*, 2> data_ptrs;
|
|
|
|
|
|
|
|
u32 z_address = tile_offset;
|
|
|
|
|
|
|
|
const u32 x_startb = x_start * bytes_per_pixel;
|
|
|
|
|
|
|
|
const u32 x_endb = x_end * bytes_per_pixel;
|
|
|
|
|
|
|
|
const u32 copy_size = 16;
|
|
|
|
|
|
|
|
const u32 gob_size_x = 64;
|
|
|
|
|
|
|
|
const u32 gob_size_y = 8;
|
|
|
|
|
|
|
|
const u32 gob_size_z = 1;
|
|
|
|
|
|
|
|
const u32 gob_size = gob_size_x * gob_size_y * gob_size_z;
|
|
|
|
|
|
|
|
for (u32 z = z_start; z < z_end; z++) {
|
|
|
|
|
|
|
|
u32 y_address = z_address;
|
|
|
|
|
|
|
|
u32 pixel_base = layer_z * z + y_start * stride_x;
|
|
|
|
|
|
|
|
for (u32 y = y_start; y < y_end; y++) {
|
|
|
|
|
|
|
|
const auto& table = fast_swizzle_table[y % gob_size_y];
|
|
|
|
|
|
|
|
for (u32 xb = x_startb; xb < x_endb; xb += copy_size) {
|
|
|
|
|
|
|
|
const u32 swizzle_offset{y_address + table[(xb / copy_size) % 4]};
|
|
|
|
|
|
|
|
const u32 out_x = xb * out_bytes_per_pixel / bytes_per_pixel;
|
|
|
|
|
|
|
|
const u32 pixel_index{out_x + pixel_base};
|
|
|
|
|
|
|
|
data_ptrs[unswizzle] = swizzled_data + swizzle_offset;
|
|
|
|
|
|
|
|
data_ptrs[!unswizzle] = unswizzled_data + pixel_index;
|
|
|
|
|
|
|
|
std::memcpy(data_ptrs[0], data_ptrs[1], copy_size);
|
|
|
|
|
|
|
|
}
|
|
|
|
|
|
|
|
pixel_base += stride_x;
|
|
|
|
|
|
|
|
if ((y + 1) % gob_size_y == 0)
|
|
|
|
|
|
|
|
y_address += gob_size;
|
|
|
|
|
|
|
|
}
|
|
|
|
|
|
|
|
z_address += xy_block_size;
|
|
|
|
|
|
|
|
}
|
|
|
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
|
|
std::memcpy(data_ptrs[0], data_ptrs[1], bytes_per_pixel);
|
|
|
|
/**
|
|
|
|
|
|
|
|
* This function unswizzles or swizzles a texture by mapping Linear to BlockLinear Textue.
|
|
|
|
|
|
|
|
* The body of this function takes care of splitting the swizzled texture into blocks,
|
|
|
|
|
|
|
|
* and managing the extents of it. Once all the parameters of a single block are obtained,
|
|
|
|
|
|
|
|
* the function calls 'ProcessBlock' to process that particular Block.
|
|
|
|
|
|
|
|
*
|
|
|
|
|
|
|
|
* Documentation for the memory layout and decoding can be found at:
|
|
|
|
|
|
|
|
* https://envytools.readthedocs.io/en/latest/hw/memory/g80-surface.html#blocklinear-surfaces
|
|
|
|
|
|
|
|
*/
|
|
|
|
|
|
|
|
template <bool fast>
|
|
|
|
|
|
|
|
void SwizzledData(u8* swizzled_data, u8* unswizzled_data, const bool unswizzle, const u32 width,
|
|
|
|
|
|
|
|
const u32 height, const u32 depth, const u32 bytes_per_pixel,
|
|
|
|
|
|
|
|
const u32 out_bytes_per_pixel, const u32 block_height, const u32 block_depth) {
|
|
|
|
|
|
|
|
auto div_ceil = [](const u32 x, const u32 y) { return ((x + y - 1) / y); };
|
|
|
|
|
|
|
|
const u32 stride_x = width * out_bytes_per_pixel;
|
|
|
|
|
|
|
|
const u32 layer_z = height * stride_x;
|
|
|
|
|
|
|
|
const u32 gob_x_bytes = 64;
|
|
|
|
|
|
|
|
const u32 gob_elements_x = gob_x_bytes / bytes_per_pixel;
|
|
|
|
|
|
|
|
const u32 gob_elements_y = 8;
|
|
|
|
|
|
|
|
const u32 gob_elements_z = 1;
|
|
|
|
|
|
|
|
const u32 block_x_elements = gob_elements_x;
|
|
|
|
|
|
|
|
const u32 block_y_elements = gob_elements_y * block_height;
|
|
|
|
|
|
|
|
const u32 block_z_elements = gob_elements_z * block_depth;
|
|
|
|
|
|
|
|
const u32 blocks_on_x = div_ceil(width, block_x_elements);
|
|
|
|
|
|
|
|
const u32 blocks_on_y = div_ceil(height, block_y_elements);
|
|
|
|
|
|
|
|
const u32 blocks_on_z = div_ceil(depth, block_z_elements);
|
|
|
|
|
|
|
|
const u32 blocks = blocks_on_x * blocks_on_y * blocks_on_z;
|
|
|
|
|
|
|
|
const u32 gob_size = gob_x_bytes * gob_elements_y * gob_elements_z;
|
|
|
|
|
|
|
|
const u32 xy_block_size = gob_size * block_height;
|
|
|
|
|
|
|
|
const u32 block_size = xy_block_size * block_depth;
|
|
|
|
|
|
|
|
u32 tile_offset = 0;
|
|
|
|
|
|
|
|
for (u32 zb = 0; zb < blocks_on_z; zb++) {
|
|
|
|
|
|
|
|
const u32 z_start = zb * block_z_elements;
|
|
|
|
|
|
|
|
const u32 z_end = std::min(depth, z_start + block_z_elements);
|
|
|
|
|
|
|
|
for (u32 yb = 0; yb < blocks_on_y; yb++) {
|
|
|
|
|
|
|
|
const u32 y_start = yb * block_y_elements;
|
|
|
|
|
|
|
|
const u32 y_end = std::min(height, y_start + block_y_elements);
|
|
|
|
|
|
|
|
for (u32 xb = 0; xb < blocks_on_x; xb++) {
|
|
|
|
|
|
|
|
const u32 x_start = xb * block_x_elements;
|
|
|
|
|
|
|
|
const u32 x_end = std::min(width, x_start + block_x_elements);
|
|
|
|
|
|
|
|
if (fast) {
|
|
|
|
|
|
|
|
FastProcessBlock(swizzled_data, unswizzled_data, unswizzle, x_start, y_start,
|
|
|
|
|
|
|
|
z_start, x_end, y_end, z_end, tile_offset, xy_block_size,
|
|
|
|
|
|
|
|
layer_z, stride_x, bytes_per_pixel, out_bytes_per_pixel);
|
|
|
|
|
|
|
|
} else {
|
|
|
|
|
|
|
|
PreciseProcessBlock(swizzled_data, unswizzled_data, unswizzle, x_start, y_start,
|
|
|
|
|
|
|
|
z_start, x_end, y_end, z_end, tile_offset, xy_block_size,
|
|
|
|
|
|
|
|
layer_z, stride_x, bytes_per_pixel, out_bytes_per_pixel);
|
|
|
|
|
|
|
|
}
|
|
|
|
|
|
|
|
tile_offset += block_size;
|
|
|
|
|
|
|
|
}
|
|
|
|
}
|
|
|
|
}
|
|
|
|
}
|
|
|
|
}
|
|
|
|
}
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
|
|
static void FastSwizzleData(u32 width, u32 height, u32 bytes_per_pixel, u32 out_bytes_per_pixel,
|
|
|
|
void CopySwizzledData(u32 width, u32 height, u32 depth, u32 bytes_per_pixel,
|
|
|
|
u8* swizzled_data, u8* unswizzled_data, bool unswizzle,
|
|
|
|
u32 out_bytes_per_pixel, u8* swizzled_data, u8* unswizzled_data,
|
|
|
|
u32 block_height) {
|
|
|
|
bool unswizzle, u32 block_height, u32 block_depth) {
|
|
|
|
std::array<u8*, 2> data_ptrs;
|
|
|
|
|
|
|
|
const std::size_t stride{width * bytes_per_pixel};
|
|
|
|
|
|
|
|
const std::size_t gobs_in_x = 64;
|
|
|
|
|
|
|
|
const std::size_t gobs_in_y = 8;
|
|
|
|
|
|
|
|
const std::size_t gobs_size = gobs_in_x * gobs_in_y;
|
|
|
|
|
|
|
|
const std::size_t image_width_in_gobs{(stride + gobs_in_x - 1) / gobs_in_x};
|
|
|
|
|
|
|
|
const std::size_t copy_size{16};
|
|
|
|
|
|
|
|
for (std::size_t y = 0; y < height; ++y) {
|
|
|
|
|
|
|
|
const std::size_t initial_gob =
|
|
|
|
|
|
|
|
(y / (gobs_in_y * block_height)) * gobs_size * block_height * image_width_in_gobs +
|
|
|
|
|
|
|
|
(y % (gobs_in_y * block_height) / gobs_in_y) * gobs_size;
|
|
|
|
|
|
|
|
const std::size_t pixel_base{y * width * out_bytes_per_pixel};
|
|
|
|
|
|
|
|
const auto& table = fast_swizzle_table[y % gobs_in_y];
|
|
|
|
|
|
|
|
for (std::size_t xb = 0; xb < stride; xb += copy_size) {
|
|
|
|
|
|
|
|
const std::size_t gob_address{initial_gob +
|
|
|
|
|
|
|
|
(xb / gobs_in_x) * gobs_size * block_height};
|
|
|
|
|
|
|
|
const std::size_t swizzle_offset{gob_address + table[(xb / 16) % 4]};
|
|
|
|
|
|
|
|
const std::size_t out_x = xb * out_bytes_per_pixel / bytes_per_pixel;
|
|
|
|
|
|
|
|
const std::size_t pixel_index{out_x + pixel_base};
|
|
|
|
|
|
|
|
data_ptrs[unswizzle] = swizzled_data + swizzle_offset;
|
|
|
|
|
|
|
|
data_ptrs[!unswizzle] = unswizzled_data + pixel_index;
|
|
|
|
|
|
|
|
std::memcpy(data_ptrs[0], data_ptrs[1], copy_size);
|
|
|
|
|
|
|
|
}
|
|
|
|
|
|
|
|
}
|
|
|
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
void CopySwizzledData(u32 width, u32 height, u32 bytes_per_pixel, u32 out_bytes_per_pixel,
|
|
|
|
|
|
|
|
u8* swizzled_data, u8* unswizzled_data, bool unswizzle, u32 block_height) {
|
|
|
|
|
|
|
|
if (bytes_per_pixel % 3 != 0 && (width * bytes_per_pixel) % 16 == 0) {
|
|
|
|
if (bytes_per_pixel % 3 != 0 && (width * bytes_per_pixel) % 16 == 0) {
|
|
|
|
FastSwizzleData(width, height, bytes_per_pixel, out_bytes_per_pixel, swizzled_data,
|
|
|
|
SwizzledData<true>(swizzled_data, unswizzled_data, unswizzle, width, height, depth,
|
|
|
|
unswizzled_data, unswizzle, block_height);
|
|
|
|
bytes_per_pixel, out_bytes_per_pixel, block_height, block_depth);
|
|
|
|
} else {
|
|
|
|
} else {
|
|
|
|
LegacySwizzleData(width, height, bytes_per_pixel, out_bytes_per_pixel, swizzled_data,
|
|
|
|
SwizzledData<false>(swizzled_data, unswizzled_data, unswizzle, width, height, depth,
|
|
|
|
unswizzled_data, unswizzle, block_height);
|
|
|
|
bytes_per_pixel, out_bytes_per_pixel, block_height, block_depth);
|
|
|
|
}
|
|
|
|
}
|
|
|
|
}
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
|
@ -153,10 +227,11 @@ u32 BytesPerPixel(TextureFormat format) {
|
|
|
|
}
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
|
|
std::vector<u8> UnswizzleTexture(VAddr address, u32 tile_size, u32 bytes_per_pixel, u32 width,
|
|
|
|
std::vector<u8> UnswizzleTexture(VAddr address, u32 tile_size, u32 bytes_per_pixel, u32 width,
|
|
|
|
u32 height, u32 block_height) {
|
|
|
|
u32 height, u32 depth, u32 block_height, u32 block_depth) {
|
|
|
|
std::vector<u8> unswizzled_data(width * height * bytes_per_pixel);
|
|
|
|
std::vector<u8> unswizzled_data(width * height * depth * bytes_per_pixel);
|
|
|
|
CopySwizzledData(width / tile_size, height / tile_size, bytes_per_pixel, bytes_per_pixel,
|
|
|
|
CopySwizzledData(width / tile_size, height / tile_size, depth, bytes_per_pixel, bytes_per_pixel,
|
|
|
|
Memory::GetPointer(address), unswizzled_data.data(), true, block_height);
|
|
|
|
Memory::GetPointer(address), unswizzled_data.data(), true, block_height,
|
|
|
|
|
|
|
|
block_depth);
|
|
|
|
return unswizzled_data;
|
|
|
|
return unswizzled_data;
|
|
|
|
}
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
|
|