Ishotihadus
272 lines
11 KiB
C
272 lines
11 KiB
C
#include <stdint.h>
|
|
#include <string.h>
|
|
#include "etc.h"
|
|
|
|
uint_fast8_t WriteOrderTable[16] = { 0, 4, 8, 12, 1, 5, 9, 13, 2, 6, 10, 14, 3, 7, 11, 15 };
|
|
uint_fast8_t WriteOrderTableRev[16] = { 15, 11, 7, 3, 14, 10, 6, 2, 13, 9, 5, 1, 12, 8, 4, 0 };
|
|
uint_fast8_t Etc1ModifierTable[8][2] = {{2, 8}, {5, 17}, {9, 29}, {13, 42}, {18, 60}, {24, 80}, {33, 106}, {47, 183}};
|
|
uint_fast8_t Etc1SubblockTable[2][16] = {{0, 0, 0, 0, 0, 0, 0, 0, 1, 1, 1, 1, 1, 1, 1, 1}, {0, 0, 1, 1, 0, 0, 1, 1, 0, 0, 1, 1, 0, 0, 1, 1}};
|
|
uint_fast8_t Etc2DistanceTable[8] = {3, 6, 11, 16, 23, 32, 41, 64};
|
|
int_fast8_t Etc2AlphaModTable[16][8] = {
|
|
{-3, -6, -9, -15, 2, 5, 8, 14},
|
|
{-3, -7, -10, -13, 2, 6, 9, 12},
|
|
{-2, -5, -8, -13, 1, 4, 7, 12},
|
|
{-2, -4, -6, -13, 1, 3, 5, 12},
|
|
{-3, -6, -8, -12, 2, 5, 7, 11},
|
|
{-3, -7, -9, -11, 2, 6, 8, 10},
|
|
{-4, -7, -8, -11, 3, 6, 7, 10},
|
|
{-3, -5, -8, -11, 2, 4, 7, 10},
|
|
{-2, -6, -8, -10, 1, 5, 7, 9},
|
|
{-2, -5, -8, -10, 1, 4, 7, 9},
|
|
{-2, -4, -8, -10, 1, 3, 7, 9},
|
|
{-2, -5, -7, -10, 1, 4, 6, 9},
|
|
{-3, -4, -7, -10, 2, 3, 6, 9},
|
|
{-1, -2, -3, -10, 0, 1, 2, 9},
|
|
{-4, -6, -8, -9, 3, 5, 7, 8},
|
|
{-3, -5, -7, -9, 2, 4, 6, 8}
|
|
};
|
|
|
|
static inline uint_fast32_t color(uint_fast32_t r, uint_fast32_t g, uint_fast32_t b, uint_fast32_t a) {
|
|
return r | g << 8 | b << 16 | a << 24;
|
|
}
|
|
|
|
static inline uint_fast8_t clamp(const int n) {
|
|
return n < 0 ? 0 : n > 255 ? 255 : n;
|
|
}
|
|
|
|
static inline uint32_t applicate_color(uint_fast8_t c[3], int_fast16_t m) {
|
|
return color(clamp(c[0] + m), clamp(c[1] + m), clamp(c[2] + m), 255);
|
|
}
|
|
|
|
static inline uint32_t applicate_color_raw(uint_fast8_t c[3]) {
|
|
return color(c[0], c[1], c[2], 255);
|
|
}
|
|
|
|
static inline void decode_etc1_block(const uint8_t *data, uint32_t *outbuf) {
|
|
uint_fast8_t code[2] = { data[3] >> 5, data[3] >> 2 & 7 };
|
|
uint_fast8_t *table = Etc1SubblockTable[data[3] & 1];
|
|
uint_fast8_t c[2][3];
|
|
if (data[3] & 2) {
|
|
c[0][0] = data[0] & 0xf8;
|
|
c[0][1] = data[1] & 0xf8;
|
|
c[0][2] = data[2] & 0xf8;
|
|
c[1][0] = c[0][0] + (data[0] << 3 & 0x18) - (data[0] << 3 & 0x20);
|
|
c[1][1] = c[0][1] + (data[1] << 3 & 0x18) - (data[1] << 3 & 0x20);
|
|
c[1][2] = c[0][2] + (data[2] << 3 & 0x18) - (data[2] << 3 & 0x20);
|
|
c[0][0] |= c[0][0] >> 5;
|
|
c[0][1] |= c[0][1] >> 5;
|
|
c[0][2] |= c[0][2] >> 5;
|
|
c[1][0] |= c[1][0] >> 5;
|
|
c[1][1] |= c[1][1] >> 5;
|
|
c[1][2] |= c[1][2] >> 5;
|
|
} else {
|
|
c[0][0] = data[0] & 0xf0 | data[0] >> 4;
|
|
c[1][0] = data[0] & 0x0f | data[0] << 4;
|
|
c[0][1] = data[1] & 0xf0 | data[1] >> 4;
|
|
c[1][1] = data[1] & 0x0f | data[1] << 4;
|
|
c[0][2] = data[2] & 0xf0 | data[2] >> 4;
|
|
c[1][2] = data[2] & 0x0f | data[2] << 4;
|
|
}
|
|
|
|
uint_fast16_t j = data[6] << 8 | data[7];
|
|
uint_fast16_t k = data[4] << 8 | data[5];
|
|
for (int i = 0; i < 16; i++, j >>= 1, k >>= 1) {
|
|
uint_fast8_t s = table[i];
|
|
uint_fast8_t m = Etc1ModifierTable[code[s]][j & 1];
|
|
outbuf[WriteOrderTable[i]] = applicate_color(c[s], k & 1 ? -m : m);
|
|
}
|
|
}
|
|
|
|
void decode_etc1(const void *data, const int w, const int h, uint32_t *image) {
|
|
int bcw = (w + 3) / 4;
|
|
int bch = (h + 3) / 4;
|
|
int clen_last = (w + 3) % 4 + 1;
|
|
uint32_t buf[16];
|
|
const uint8_t *d = (uint8_t*)data;
|
|
for (int t = 0; t < bch; t++) {
|
|
for (int s = 0; s < bcw; s++, d += 8) {
|
|
decode_etc1_block(d, buf);
|
|
int clen = (s < bcw - 1 ? 4 : clen_last) * 4;
|
|
for (int i = 0, y = h - t * 4 - 1; i < 4 && y >= 0; i++, y--)
|
|
memcpy(image + y * w + s * 4, buf + i * 4, clen);
|
|
}
|
|
}
|
|
}
|
|
|
|
static inline void decode_etc2_block(const uint8_t *data, uint32_t *outbuf) {
|
|
uint_fast16_t j = data[6] << 8 | data[7];
|
|
uint_fast16_t k = data[4] << 8 | data[5];
|
|
uint_fast8_t c[3][3] = {};
|
|
|
|
if (data[3] & 2) {
|
|
uint_fast8_t r = data[0] & 0xf8;
|
|
int_fast16_t dr = (data[0] << 3 & 0x18) - (data[0] << 3 & 0x20);
|
|
uint_fast8_t g = data[1] & 0xf8;
|
|
int_fast16_t dg = (data[1] << 3 & 0x18) - (data[1] << 3 & 0x20);
|
|
uint_fast8_t b = data[2] & 0xf8;
|
|
int_fast16_t db = (data[2] << 3 & 0x18) - (data[2] << 3 & 0x20);
|
|
if (r + dr < 0 || r + dr > 255) {
|
|
// T
|
|
c[0][0] = data[0] << 3 & 0xc0 | data[0] << 4 & 0x30 | data[0] >> 1 & 0xc | data[0] & 3;
|
|
c[0][1] = data[1] & 0xf0 | data[1] >> 4;
|
|
c[0][2] = data[1] & 0x0f | data[1] << 4;
|
|
c[1][0] = data[2] & 0xf0 | data[2] >> 4;
|
|
c[1][1] = data[2] & 0x0f | data[2] << 4;
|
|
c[1][2] = data[3] & 0xf0 | data[3] >> 4;
|
|
uint_fast8_t d = Etc2DistanceTable[data[3] >> 1 & 6 | data[3] & 1];
|
|
uint_fast32_t color_set[4] = {
|
|
applicate_color_raw(c[0]),
|
|
applicate_color(c[1], d),
|
|
applicate_color_raw(c[1]),
|
|
applicate_color(c[1], -d)
|
|
};
|
|
for (int i = 0; i < 16; i++, j >>= 1, k >>= 1)
|
|
outbuf[WriteOrderTable[i]] = color_set[k << 1 & 2 | j & 1];
|
|
} else if (g + dg < 0 || g + dg > 255) {
|
|
// H
|
|
c[0][0] = data[0] << 1 & 0xf0 | data[0] >> 3 & 0xf;
|
|
c[0][1] = data[0] << 5 & 0xe0 | data[1] & 0x10;
|
|
c[0][1] |= c[0][1] >> 4;
|
|
c[0][2] = data[1] & 8 | data[1] << 1 & 6 | data[2] >> 7;
|
|
c[0][2] |= c[0][2] << 4;
|
|
c[1][0] = data[2] << 1 & 0xf0 | data[2] >> 3 & 0xf;
|
|
c[1][1] = data[2] << 5 & 0xe0 | data[3] >> 3 & 0x10;
|
|
c[1][1] |= c[1][1] >> 4;
|
|
c[1][2] = data[3] << 1 & 0xf0 | data[3] >> 3 & 0xf;
|
|
uint_fast8_t d = data[3] & 4 | data[3] << 1 & 2;
|
|
if (c[0][0] > c[1][0] || (c[0][0] == c[1][0] && (c[0][1] > c[1][1] || (c[0][1] == c[1][1] && c[0][2] >= c[1][2]))))
|
|
++d;
|
|
d = Etc2DistanceTable[d];
|
|
uint_fast32_t color_set[4] = {
|
|
applicate_color(c[0], d),
|
|
applicate_color(c[0], -d),
|
|
applicate_color(c[1], d),
|
|
applicate_color(c[1], -d)
|
|
};
|
|
for (int i = 0; i < 16; i++, j >>= 1, k >>= 1)
|
|
outbuf[WriteOrderTable[i]] = color_set[k << 1 & 2 | j & 1];
|
|
} else if (b + db < 0 || b + db > 255) {
|
|
// planar
|
|
c[0][0] = data[0] << 1 & 0xfc | data[0] >> 5 & 3;
|
|
c[0][1] = data[0] << 7 & 0x80 | data[1] & 0x7e | data[0] & 1;
|
|
c[0][2] = data[1] << 7 & 0x80 | data[2] << 2 & 0x60 | data[2] << 3 & 0x18 | data[3] >> 5 & 4;
|
|
c[0][2] |= c[0][2] >> 6;
|
|
c[1][0] = data[3] << 1 & 0xf8 | data[3] << 2 & 4 | data[3] >> 5 & 3;
|
|
c[1][1] = data[4] & 0xfe | data[4] >> 7;
|
|
c[1][2] = data[4] << 7 & 0x80 | data[5] >> 1 & 0x7c;
|
|
c[1][2] |= c[1][2] >> 6;
|
|
c[2][0] = data[5] << 5 & 0xe0 | data[6] >> 3 & 0x1c | data[5] >> 1 & 3;
|
|
c[2][1] = data[6] << 3 & 0xf8 | data[7] >> 5 & 0x6 | data[6] >> 4 & 1;
|
|
c[2][2] = data[7] << 2 | data[7] >> 4 & 3;
|
|
for (int x = 3, i = 0; x >= 0; x--) {
|
|
for (int y = 3; y >= 0; y--, i++) {
|
|
uint8_t r = clamp((x * (c[1][0] - c[0][0]) + y * (c[2][0] - c[0][0]) + 4 * c[0][0] + 2) >> 2);
|
|
uint8_t g = clamp((x * (c[1][1] - c[0][1]) + y * (c[2][1] - c[0][1]) + 4 * c[0][1] + 2) >> 2);
|
|
uint8_t b = clamp((x * (c[1][2] - c[0][2]) + y * (c[2][2] - c[0][2]) + 4 * c[0][2] + 2) >> 2);
|
|
outbuf[i] = color(r, g, b, 255);
|
|
}
|
|
}
|
|
} else {
|
|
// differential
|
|
uint_fast8_t code[2] = { data[3] >> 5, data[3] >> 2 & 7 };
|
|
uint_fast8_t *table = Etc1SubblockTable[data[3] & 1];
|
|
c[0][0] = r | r >> 5;
|
|
c[0][1] = g | g >> 5;
|
|
c[0][2] = b | b >> 5;
|
|
c[1][0] = r + dr;
|
|
c[1][1] = g + dg;
|
|
c[1][2] = b + db;
|
|
c[1][0] |= c[1][0] >> 5;
|
|
c[1][1] |= c[1][1] >> 5;
|
|
c[1][2] |= c[1][2] >> 5;
|
|
for (int i = 0; i < 16; i++, j >>= 1, k >>= 1) {
|
|
uint_fast8_t s = table[i];
|
|
uint_fast8_t m = Etc1ModifierTable[code[s]][j & 1];
|
|
outbuf[WriteOrderTable[i]] = applicate_color(c[s], k & 1 ? -m : m);
|
|
}
|
|
}
|
|
} else {
|
|
// individual
|
|
uint_fast8_t code[2] = { data[3] >> 5, data[3] >> 2 & 7 };
|
|
uint_fast8_t *table = Etc1SubblockTable[data[3] & 1];
|
|
c[0][0] = data[0] & 0xf0 | data[0] >> 4;
|
|
c[1][0] = data[0] & 0x0f | data[0] << 4;
|
|
c[0][1] = data[1] & 0xf0 | data[1] >> 4;
|
|
c[1][1] = data[1] & 0x0f | data[1] << 4;
|
|
c[0][2] = data[2] & 0xf0 | data[2] >> 4;
|
|
c[1][2] = data[2] & 0x0f | data[2] << 4;
|
|
for (int i = 0; i < 16; i++, j >>= 1, k >>= 1) {
|
|
uint_fast8_t s = table[i];
|
|
uint_fast8_t m = Etc1ModifierTable[code[s]][j & 1];
|
|
outbuf[WriteOrderTable[i]] = applicate_color(c[s], k & 1 ? -m : m);
|
|
}
|
|
}
|
|
}
|
|
|
|
static inline void decode_etc2a8_block(const uint8_t *data, uint32_t *outbuf) {
|
|
if (data[2] & 0xf0) {
|
|
uint_fast8_t mult = data[1] >> 4;
|
|
int_fast8_t *table = Etc2AlphaModTable[data[1] & 0xf];
|
|
uint_fast64_t l =
|
|
data[7] | (uint_fast16_t)data[6] << 8 |
|
|
(uint_fast32_t)data[5] << 16 | (uint_fast32_t)data[4] << 24 |
|
|
(uint_fast64_t)data[3] << 32 | (uint_fast64_t)data[2] << 40;
|
|
for (int i = 0; i < 16; i++, l >>= 3)
|
|
((uint8_t*)(outbuf + WriteOrderTableRev[i]))[3] = clamp(data[0] + mult * table[l & 7]);
|
|
} else {
|
|
for (int i = 0; i < 16; i++)
|
|
((uint8_t*)(outbuf + i))[3] = data[0];
|
|
}
|
|
}
|
|
|
|
void decode_etc2(const void *data, const int w, const int h, uint32_t *image) {
|
|
int bcw = (w + 3) / 4;
|
|
int bch = (h + 3) / 4;
|
|
int clen_last = (w + 3) % 4 + 1;
|
|
uint32_t buf[16];
|
|
const uint8_t *d = (uint8_t*)data;
|
|
for (int t = 0; t < bch; t++) {
|
|
for (int s = 0; s < bcw; s++, d += 8) {
|
|
decode_etc2_block(d, buf);
|
|
int clen = (s < bcw - 1 ? 4 : clen_last) * 4;
|
|
for (int i = 0, y = h - t * 4 - 1; i < 4 && y >= 0; i++, y--)
|
|
memcpy(image + y * w + s * 4, buf + i * 4, clen);
|
|
}
|
|
}
|
|
}
|
|
|
|
void decode_etc2a1(const void *data, const int w, const int h, uint32_t *image) {
|
|
int bcw = (w + 3) / 4;
|
|
int bch = (h + 3) / 4;
|
|
int clen_last = (w + 3) % 4 + 1;
|
|
uint32_t buf[16];
|
|
const uint8_t *d = (uint8_t*)data;
|
|
for (int t = 0; t < bch; t++) {
|
|
for (int s = 0; s < bcw; s++, d += 9) {
|
|
decode_etc2_block(d + 1, buf);
|
|
for (int i = 0; i < 16; i++)
|
|
((uint8_t*)(buf + i))[3] = d[0];
|
|
int clen = (s < bcw - 1 ? 4 : clen_last) * 4;
|
|
for (int i = 0, y = h - t * 4 - 1; i < 4 && y >= 0; i++, y--)
|
|
memcpy(image + y * w + s * 4, buf + i * 4, clen);
|
|
}
|
|
}
|
|
}
|
|
|
|
void decode_etc2a8(const void *data, const int w, const int h, uint32_t *image) {
|
|
int bcw = (w + 3) / 4;
|
|
int bch = (h + 3) / 4;
|
|
int clen_last = (w + 3) % 4 + 1;
|
|
uint32_t buf[16];
|
|
const uint8_t *d = (uint8_t*)data;
|
|
for (int t = 0; t < bch; t++) {
|
|
for (int s = 0; s < bcw; s++, d += 16) {
|
|
decode_etc2_block(d + 8, buf);
|
|
decode_etc2a8_block(d, buf);
|
|
int clen = (s < bcw - 1 ? 4 : clen_last) * 4;
|
|
for (int i = 0, y = h - t * 4 - 1; i < 4 && y >= 0; i++, y--)
|
|
memcpy(image + y * w + s * 4, buf + i * 4, clen);
|
|
}
|
|
}
|
|
}
|