mirror of
https://git.h3cjp.net/H3cJP/citra.git
synced 2024-11-23 13:03:05 +00:00
766 lines
27 KiB
C++
766 lines
27 KiB
C++
|
// SPDX-FileCopyrightText: fabian "ryg" giesen
|
||
|
|
// SPDX-License-Identifier: MIT
|
||
|
|
|
||
|
|
// stb_dxt.h - v1.12 - DXT1/DXT5 compressor
|
||
|
|
|
||
|
|
#include <stb_dxt.h>
|
||
|
|
|
||
|
|
#include <stdlib.h>
|
||
|
|
#include <string.h>
|
||
|
|
|
||
|
|
#if !defined(STBD_FABS)
|
||
|
|
#include <math.h>
|
||
|
|
#endif
|
||
|
|
|
||
|
|
#ifndef STBD_FABS
|
||
|
|
#define STBD_FABS(x) fabs(x)
|
||
|
|
#endif
|
||
|
|
|
||
|
|
static const unsigned char stb__OMatch5[256][2] = {
|
||
|
|
{0, 0}, {0, 0}, {0, 1}, {0, 1}, {1, 0}, {1, 0}, {1, 0}, {1, 1}, {1, 1},
|
||
|
|
{1, 1}, {1, 2}, {0, 4}, {2, 1}, {2, 1}, {2, 1}, {2, 2}, {2, 2}, {2, 2},
|
||
|
|
{2, 3}, {1, 5}, {3, 2}, {3, 2}, {4, 0}, {3, 3}, {3, 3}, {3, 3}, {3, 4},
|
||
|
|
{3, 4}, {3, 4}, {3, 5}, {4, 3}, {4, 3}, {5, 2}, {4, 4}, {4, 4}, {4, 5},
|
||
|
|
{4, 5}, {5, 4}, {5, 4}, {5, 4}, {6, 3}, {5, 5}, {5, 5}, {5, 6}, {4, 8},
|
||
|
|
{6, 5}, {6, 5}, {6, 5}, {6, 6}, {6, 6}, {6, 6}, {6, 7}, {5, 9}, {7, 6},
|
||
|
|
{7, 6}, {8, 4}, {7, 7}, {7, 7}, {7, 7}, {7, 8}, {7, 8}, {7, 8}, {7, 9},
|
||
|
|
{8, 7}, {8, 7}, {9, 6}, {8, 8}, {8, 8}, {8, 9}, {8, 9}, {9, 8}, {9, 8},
|
||
|
|
{9, 8}, {10, 7}, {9, 9}, {9, 9}, {9, 10}, {8, 12}, {10, 9}, {10, 9}, {10, 9},
|
||
|
|
{10, 10}, {10, 10}, {10, 10}, {10, 11}, {9, 13}, {11, 10}, {11, 10}, {12, 8}, {11, 11},
|
||
|
|
{11, 11}, {11, 11}, {11, 12}, {11, 12}, {11, 12}, {11, 13}, {12, 11}, {12, 11}, {13, 10},
|
||
|
|
{12, 12}, {12, 12}, {12, 13}, {12, 13}, {13, 12}, {13, 12}, {13, 12}, {14, 11}, {13, 13},
|
||
|
|
{13, 13}, {13, 14}, {12, 16}, {14, 13}, {14, 13}, {14, 13}, {14, 14}, {14, 14}, {14, 14},
|
||
|
|
{14, 15}, {13, 17}, {15, 14}, {15, 14}, {16, 12}, {15, 15}, {15, 15}, {15, 15}, {15, 16},
|
||
|
|
{15, 16}, {15, 16}, {15, 17}, {16, 15}, {16, 15}, {17, 14}, {16, 16}, {16, 16}, {16, 17},
|
||
|
|
{16, 17}, {17, 16}, {17, 16}, {17, 16}, {18, 15}, {17, 17}, {17, 17}, {17, 18}, {16, 20},
|
||
|
|
{18, 17}, {18, 17}, {18, 17}, {18, 18}, {18, 18}, {18, 18}, {18, 19}, {17, 21}, {19, 18},
|
||
|
|
{19, 18}, {20, 16}, {19, 19}, {19, 19}, {19, 19}, {19, 20}, {19, 20}, {19, 20}, {19, 21},
|
||
|
|
{20, 19}, {20, 19}, {21, 18}, {20, 20}, {20, 20}, {20, 21}, {20, 21}, {21, 20}, {21, 20},
|
||
|
|
{21, 20}, {22, 19}, {21, 21}, {21, 21}, {21, 22}, {20, 24}, {22, 21}, {22, 21}, {22, 21},
|
||
|
|
{22, 22}, {22, 22}, {22, 22}, {22, 23}, {21, 25}, {23, 22}, {23, 22}, {24, 20}, {23, 23},
|
||
|
|
{23, 23}, {23, 23}, {23, 24}, {23, 24}, {23, 24}, {23, 25}, {24, 23}, {24, 23}, {25, 22},
|
||
|
|
{24, 24}, {24, 24}, {24, 25}, {24, 25}, {25, 24}, {25, 24}, {25, 24}, {26, 23}, {25, 25},
|
||
|
|
{25, 25}, {25, 26}, {24, 28}, {26, 25}, {26, 25}, {26, 25}, {26, 26}, {26, 26}, {26, 26},
|
||
|
|
{26, 27}, {25, 29}, {27, 26}, {27, 26}, {28, 24}, {27, 27}, {27, 27}, {27, 27}, {27, 28},
|
||
|
|
{27, 28}, {27, 28}, {27, 29}, {28, 27}, {28, 27}, {29, 26}, {28, 28}, {28, 28}, {28, 29},
|
||
|
|
{28, 29}, {29, 28}, {29, 28}, {29, 28}, {30, 27}, {29, 29}, {29, 29}, {29, 30}, {29, 30},
|
||
|
|
{30, 29}, {30, 29}, {30, 29}, {30, 30}, {30, 30}, {30, 30}, {30, 31}, {30, 31}, {31, 30},
|
||
|
|
{31, 30}, {31, 30}, {31, 31}, {31, 31},
|
||
|
|
};
|
||
|
|
static const unsigned char stb__OMatch6[256][2] = {
|
||
|
|
{0, 0}, {0, 1}, {1, 0}, {1, 1}, {1, 1}, {1, 2}, {2, 1}, {2, 2}, {2, 2},
|
||
|
|
{2, 3}, {3, 2}, {3, 3}, {3, 3}, {3, 4}, {4, 3}, {4, 4}, {4, 4}, {4, 5},
|
||
|
|
{5, 4}, {5, 5}, {5, 5}, {5, 6}, {6, 5}, {6, 6}, {6, 6}, {6, 7}, {7, 6},
|
||
|
|
{7, 7}, {7, 7}, {7, 8}, {8, 7}, {8, 8}, {8, 8}, {8, 9}, {9, 8}, {9, 9},
|
||
|
|
{9, 9}, {9, 10}, {10, 9}, {10, 10}, {10, 10}, {10, 11}, {11, 10}, {8, 16}, {11, 11},
|
||
|
|
{11, 12}, {12, 11}, {9, 17}, {12, 12}, {12, 13}, {13, 12}, {11, 16}, {13, 13}, {13, 14},
|
||
|
|
{14, 13}, {12, 17}, {14, 14}, {14, 15}, {15, 14}, {14, 16}, {15, 15}, {15, 16}, {16, 14},
|
||
|
|
{16, 15}, {17, 14}, {16, 16}, {16, 17}, {17, 16}, {18, 15}, {17, 17}, {17, 18}, {18, 17},
|
||
|
|
{20, 14}, {18, 18}, {18, 19}, {19, 18}, {21, 15}, {19, 19}, {19, 20}, {20, 19}, {20, 20},
|
||
|
|
{20, 20}, {20, 21}, {21, 20}, {21, 21}, {21, 21}, {21, 22}, {22, 21}, {22, 22}, {22, 22},
|
||
|
|
{22, 23}, {23, 22}, {23, 23}, {23, 23}, {23, 24}, {24, 23}, {24, 24}, {24, 24}, {24, 25},
|
||
|
|
{25, 24}, {25, 25}, {25, 25}, {25, 26}, {26, 25}, {26, 26}, {26, 26}, {26, 27}, {27, 26},
|
||
|
|
{24, 32}, {27, 27}, {27, 28}, {28, 27}, {25, 33}, {28, 28}, {28, 29}, {29, 28}, {27, 32},
|
||
|
|
{29, 29}, {29, 30}, {30, 29}, {28, 33}, {30, 30}, {30, 31}, {31, 30}, {30, 32}, {31, 31},
|
||
|
|
{31, 32}, {32, 30}, {32, 31}, {33, 30}, {32, 32}, {32, 33}, {33, 32}, {34, 31}, {33, 33},
|
||
|
|
{33, 34}, {34, 33}, {36, 30}, {34, 34}, {34, 35}, {35, 34}, {37, 31}, {35, 35}, {35, 36},
|
||
|
|
{36, 35}, {36, 36}, {36, 36}, {36, 37}, {37, 36}, {37, 37}, {37, 37}, {37, 38}, {38, 37},
|
||
|
|
{38, 38}, {38, 38}, {38, 39}, {39, 38}, {39, 39}, {39, 39}, {39, 40}, {40, 39}, {40, 40},
|
||
|
|
{40, 40}, {40, 41}, {41, 40}, {41, 41}, {41, 41}, {41, 42}, {42, 41}, {42, 42}, {42, 42},
|
||
|
|
{42, 43}, {43, 42}, {40, 48}, {43, 43}, {43, 44}, {44, 43}, {41, 49}, {44, 44}, {44, 45},
|
||
|
|
{45, 44}, {43, 48}, {45, 45}, {45, 46}, {46, 45}, {44, 49}, {46, 46}, {46, 47}, {47, 46},
|
||
|
|
{46, 48}, {47, 47}, {47, 48}, {48, 46}, {48, 47}, {49, 46}, {48, 48}, {48, 49}, {49, 48},
|
||
|
|
{50, 47}, {49, 49}, {49, 50}, {50, 49}, {52, 46}, {50, 50}, {50, 51}, {51, 50}, {53, 47},
|
||
|
|
{51, 51}, {51, 52}, {52, 51}, {52, 52}, {52, 52}, {52, 53}, {53, 52}, {53, 53}, {53, 53},
|
||
|
|
{53, 54}, {54, 53}, {54, 54}, {54, 54}, {54, 55}, {55, 54}, {55, 55}, {55, 55}, {55, 56},
|
||
|
|
{56, 55}, {56, 56}, {56, 56}, {56, 57}, {57, 56}, {57, 57}, {57, 57}, {57, 58}, {58, 57},
|
||
|
|
{58, 58}, {58, 58}, {58, 59}, {59, 58}, {59, 59}, {59, 59}, {59, 60}, {60, 59}, {60, 60},
|
||
|
|
{60, 60}, {60, 61}, {61, 60}, {61, 61}, {61, 61}, {61, 62}, {62, 61}, {62, 62}, {62, 62},
|
||
|
|
{62, 63}, {63, 62}, {63, 63}, {63, 63},
|
||
|
|
};
|
||
|
|
|
||
|
|
static int stb__Mul8Bit(int a, int b) {
|
||
|
|
int t = a * b + 128;
|
||
|
|
return (t + (t >> 8)) >> 8;
|
||
|
|
}
|
||
|
|
|
||
|
|
static void stb__From16Bit(unsigned char* out, unsigned short v) {
|
||
|
|
int rv = (v & 0xf800) >> 11;
|
||
|
|
int gv = (v & 0x07e0) >> 5;
|
||
|
|
int bv = (v & 0x001f) >> 0;
|
||
|
|
|
||
|
|
// expand to 8 bits via bit replication
|
||
|
|
out[0] = static_cast<unsigned char>((rv * 33) >> 2);
|
||
|
|
out[1] = static_cast<unsigned char>((gv * 65) >> 4);
|
||
|
|
out[2] = static_cast<unsigned char>((bv * 33) >> 2);
|
||
|
|
out[3] = 0;
|
||
|
|
}
|
||
|
|
|
||
|
|
static unsigned short stb__As16Bit(int r, int g, int b) {
|
||
|
|
return (unsigned short)((stb__Mul8Bit(r, 31) << 11) + (stb__Mul8Bit(g, 63) << 5) +
|
||
|
|
stb__Mul8Bit(b, 31));
|
||
|
|
}
|
||
|
|
|
||
|
|
// linear interpolation at 1/3 point between a and b, using desired rounding
|
||
|
|
// type
|
||
|
|
static int stb__Lerp13(int a, int b) {
|
||
|
|
#ifdef STB_DXT_USE_ROUNDING_BIAS
|
||
|
|
// with rounding bias
|
||
|
|
return a + stb__Mul8Bit(b - a, 0x55);
|
||
|
|
#else
|
||
|
|
// without rounding bias
|
||
|
|
// replace "/ 3" by "* 0xaaab) >> 17" if your compiler sucks or you really
|
||
|
|
// need every ounce of speed.
|
||
|
|
return (2 * a + b) / 3;
|
||
|
|
#endif
|
||
|
|
}
|
||
|
|
|
||
|
|
// linear interpolation at 1/2 point between a and b
|
||
|
|
static int stb__Lerp12(int a, int b) {
|
||
|
|
return (a + b) / 2;
|
||
|
|
}
|
||
|
|
|
||
|
|
// lerp RGB color
|
||
|
|
static void stb__Lerp13RGB(unsigned char* out, unsigned char* p1, unsigned char* p2) {
|
||
|
|
out[0] = (unsigned char)stb__Lerp13(p1[0], p2[0]);
|
||
|
|
out[1] = (unsigned char)stb__Lerp13(p1[1], p2[1]);
|
||
|
|
out[2] = (unsigned char)stb__Lerp13(p1[2], p2[2]);
|
||
|
|
}
|
||
|
|
|
||
|
|
static void stb__Lerp12RGB(unsigned char* out, unsigned char* p1, unsigned char* p2) {
|
||
|
|
out[0] = (unsigned char)stb__Lerp12(p1[0], p2[0]);
|
||
|
|
out[1] = (unsigned char)stb__Lerp12(p1[1], p2[1]);
|
||
|
|
out[2] = (unsigned char)stb__Lerp12(p1[2], p2[2]);
|
||
|
|
}
|
||
|
|
|
||
|
|
/****************************************************************************/
|
||
|
|
|
||
|
|
static void stb__Eval4Colors(unsigned char* color, unsigned short c0, unsigned short c1) {
|
||
|
|
stb__From16Bit(color + 0, c0);
|
||
|
|
stb__From16Bit(color + 4, c1);
|
||
|
|
stb__Lerp13RGB(color + 8, color + 0, color + 4);
|
||
|
|
stb__Lerp13RGB(color + 12, color + 4, color + 0);
|
||
|
|
}
|
||
|
|
|
||
|
|
static void stb__Eval3Colors(unsigned char* color, unsigned short c0, unsigned short c1) {
|
||
|
|
stb__From16Bit(color + 0, c0);
|
||
|
|
stb__From16Bit(color + 4, c1);
|
||
|
|
stb__Lerp12RGB(color + 8, color + 0, color + 4);
|
||
|
|
}
|
||
|
|
|
||
|
|
// The color matching function
|
||
|
|
static unsigned int stb__MatchColorsBlock(unsigned char* block, unsigned char* color) {
|
||
|
|
unsigned int mask = 0;
|
||
|
|
int dirr = color[0 * 4 + 0] - color[1 * 4 + 0];
|
||
|
|
int dirg = color[0 * 4 + 1] - color[1 * 4 + 1];
|
||
|
|
int dirb = color[0 * 4 + 2] - color[1 * 4 + 2];
|
||
|
|
int dots[16];
|
||
|
|
int stops[4];
|
||
|
|
int i;
|
||
|
|
int c0Point, halfPoint, c3Point;
|
||
|
|
|
||
|
|
for (i = 0; i < 16; i++)
|
||
|
|
dots[i] = block[i * 4 + 0] * dirr + block[i * 4 + 1] * dirg + block[i * 4 + 2] * dirb;
|
||
|
|
|
||
|
|
for (i = 0; i < 4; i++)
|
||
|
|
stops[i] = color[i * 4 + 0] * dirr + color[i * 4 + 1] * dirg + color[i * 4 + 2] * dirb;
|
||
|
|
|
||
|
|
// think of the colors as arranged on a line; project point onto that line,
|
||
|
|
// then choose next color out of available ones. we compute the crossover
|
||
|
|
// points for "best color in top half"/"best in bottom half" and then the same
|
||
|
|
// inside that subinterval.
|
||
|
|
//
|
||
|
|
// relying on this 1d approximation isn't always optimal in terms of euclidean
|
||
|
|
// distance, but it's very close and a lot faster.
|
||
|
|
// http://cbloomrants.blogspot.com/2008/12/12-08-08-dxtc-summary.html
|
||
|
|
|
||
|
|
c0Point = (stops[1] + stops[3]);
|
||
|
|
halfPoint = (stops[3] + stops[2]);
|
||
|
|
c3Point = (stops[2] + stops[0]);
|
||
|
|
|
||
|
|
for (i = 15; i >= 0; i--) {
|
||
|
|
int dot = dots[i] * 2;
|
||
|
|
mask <<= 2;
|
||
|
|
|
||
|
|
if (dot < halfPoint)
|
||
|
|
mask |= (dot < c0Point) ? 1 : 3;
|
||
|
|
else
|
||
|
|
mask |= (dot < c3Point) ? 2 : 0;
|
||
|
|
}
|
||
|
|
|
||
|
|
return mask;
|
||
|
|
}
|
||
|
|
|
||
|
|
static unsigned int stb__MatchColorsAlphaBlock(unsigned char* block, unsigned char* color) {
|
||
|
|
unsigned int mask = 0;
|
||
|
|
int dirr = color[0 * 4 + 0] - color[1 * 4 + 0];
|
||
|
|
int dirg = color[0 * 4 + 1] - color[1 * 4 + 1];
|
||
|
|
int dirb = color[0 * 4 + 2] - color[1 * 4 + 2];
|
||
|
|
int dots[16];
|
||
|
|
int stops[3];
|
||
|
|
int i;
|
||
|
|
int c0Point, c2Point;
|
||
|
|
|
||
|
|
for (i = 0; i < 16; i++)
|
||
|
|
dots[i] = block[i * 4 + 0] * dirr + block[i * 4 + 1] * dirg + block[i * 4 + 2] * dirb;
|
||
|
|
|
||
|
|
for (i = 0; i < 3; i++)
|
||
|
|
stops[i] = color[i * 4 + 0] * dirr + color[i * 4 + 1] * dirg + color[i * 4 + 2] * dirb;
|
||
|
|
|
||
|
|
c0Point = (stops[1] + stops[2]);
|
||
|
|
c2Point = (stops[2] + stops[0]);
|
||
|
|
|
||
|
|
for (i = 15; i >= 0; i--) {
|
||
|
|
int dot = dots[i] * 2;
|
||
|
|
mask <<= 2;
|
||
|
|
|
||
|
|
if (block[i * 4 + 3] == 0)
|
||
|
|
mask |= 3;
|
||
|
|
else if (dot < c2Point)
|
||
|
|
mask |= (dot < c0Point) ? 0 : 2;
|
||
|
|
else
|
||
|
|
mask |= (dot < c0Point) ? 1 : 0;
|
||
|
|
}
|
||
|
|
|
||
|
|
return mask;
|
||
|
|
}
|
||
|
|
|
||
|
|
static void stb__ReorderColors(unsigned short* pmax16, unsigned short* pmin16) {
|
||
|
|
if (*pmin16 < *pmax16) {
|
||
|
|
unsigned short t = *pmin16;
|
||
|
|
*pmin16 = *pmax16;
|
||
|
|
*pmax16 = t;
|
||
|
|
}
|
||
|
|
}
|
||
|
|
|
||
|
|
static void stb__FinalizeColors(unsigned short* pmax16, unsigned short* pmin16,
|
||
|
|
unsigned int* pmask) {
|
||
|
|
if (*pmax16 < *pmin16) {
|
||
|
|
unsigned short t = *pmin16;
|
||
|
|
*pmin16 = *pmax16;
|
||
|
|
*pmax16 = t;
|
||
|
|
*pmask ^= 0x55555555;
|
||
|
|
}
|
||
|
|
}
|
||
|
|
|
||
|
|
// The color optimization function. (Clever code, part 1)
|
||
|
|
static void stb__OptimizeColorsBlock(unsigned char* block, unsigned short* pmax16,
|
||
|
|
unsigned short* pmin16) {
|
||
|
|
int mind, maxd;
|
||
|
|
unsigned char *minp, *maxp;
|
||
|
|
double magn;
|
||
|
|
int v_r, v_g, v_b;
|
||
|
|
static const int nIterPower = 4;
|
||
|
|
float covf[6], vfr, vfg, vfb;
|
||
|
|
|
||
|
|
// determine color distribution
|
||
|
|
int cov[6];
|
||
|
|
int mu[3], min[3], max[3];
|
||
|
|
int ch, i, iter;
|
||
|
|
|
||
|
|
for (ch = 0; ch < 3; ch++) {
|
||
|
|
const unsigned char* bp = ((const unsigned char*)block) + ch;
|
||
|
|
int muv, minv, maxv;
|
||
|
|
|
||
|
|
muv = minv = maxv = bp[0];
|
||
|
|
for (i = 4; i < 64; i += 4) {
|
||
|
|
muv += bp[i];
|
||
|
|
if (bp[i] < minv)
|
||
|
|
minv = bp[i];
|
||
|
|
else if (bp[i] > maxv)
|
||
|
|
maxv = bp[i];
|
||
|
|
}
|
||
|
|
|
||
|
|
mu[ch] = (muv + 8) >> 4;
|
||
|
|
min[ch] = minv;
|
||
|
|
max[ch] = maxv;
|
||
|
|
}
|
||
|
|
|
||
|
|
// determine covariance matrix
|
||
|
|
for (i = 0; i < 6; i++)
|
||
|
|
cov[i] = 0;
|
||
|
|
|
||
|
|
for (i = 0; i < 16; i++) {
|
||
|
|
int r = block[i * 4 + 0] - mu[0];
|
||
|
|
int g = block[i * 4 + 1] - mu[1];
|
||
|
|
int b = block[i * 4 + 2] - mu[2];
|
||
|
|
|
||
|
|
cov[0] += r * r;
|
||
|
|
cov[1] += r * g;
|
||
|
|
cov[2] += r * b;
|
||
|
|
cov[3] += g * g;
|
||
|
|
cov[4] += g * b;
|
||
|
|
cov[5] += b * b;
|
||
|
|
}
|
||
|
|
|
||
|
|
// convert covariance matrix to float, find principal axis via power iter
|
||
|
|
for (i = 0; i < 6; i++)
|
||
|
|
covf[i] = static_cast<float>(cov[i]) / 255.0f;
|
||
|
|
|
||
|
|
vfr = (float)(max[0] - min[0]);
|
||
|
|
vfg = (float)(max[1] - min[1]);
|
||
|
|
vfb = (float)(max[2] - min[2]);
|
||
|
|
|
||
|
|
for (iter = 0; iter < nIterPower; iter++) {
|
||
|
|
float r = vfr * covf[0] + vfg * covf[1] + vfb * covf[2];
|
||
|
|
float g = vfr * covf[1] + vfg * covf[3] + vfb * covf[4];
|
||
|
|
float b = vfr * covf[2] + vfg * covf[4] + vfb * covf[5];
|
||
|
|
|
||
|
|
vfr = r;
|
||
|
|
vfg = g;
|
||
|
|
vfb = b;
|
||
|
|
}
|
||
|
|
|
||
|
|
magn = STBD_FABS(vfr);
|
||
|
|
if (STBD_FABS(vfg) > magn)
|
||
|
|
magn = STBD_FABS(vfg);
|
||
|
|
if (STBD_FABS(vfb) > magn)
|
||
|
|
magn = STBD_FABS(vfb);
|
||
|
|
|
||
|
|
if (magn < 4.0f) { // too small, default to luminance
|
||
|
|
v_r = 299; // JPEG YCbCr luma coefs, scaled by 1000.
|
||
|
|
v_g = 587;
|
||
|
|
v_b = 114;
|
||
|
|
} else {
|
||
|
|
magn = 512.0 / magn;
|
||
|
|
v_r = (int)(vfr * magn);
|
||
|
|
v_g = (int)(vfg * magn);
|
||
|
|
v_b = (int)(vfb * magn);
|
||
|
|
}
|
||
|
|
|
||
|
|
minp = maxp = block;
|
||
|
|
mind = maxd = block[0] * v_r + block[1] * v_g + block[2] * v_b;
|
||
|
|
// Pick colors at extreme points
|
||
|
|
for (i = 1; i < 16; i++) {
|
||
|
|
int dot = block[i * 4 + 0] * v_r + block[i * 4 + 1] * v_g + block[i * 4 + 2] * v_b;
|
||
|
|
|
||
|
|
if (dot < mind) {
|
||
|
|
mind = dot;
|
||
|
|
minp = block + i * 4;
|
||
|
|
}
|
||
|
|
|
||
|
|
if (dot > maxd) {
|
||
|
|
maxd = dot;
|
||
|
|
maxp = block + i * 4;
|
||
|
|
}
|
||
|
|
}
|
||
|
|
|
||
|
|
*pmax16 = stb__As16Bit(maxp[0], maxp[1], maxp[2]);
|
||
|
|
*pmin16 = stb__As16Bit(minp[0], minp[1], minp[2]);
|
||
|
|
stb__ReorderColors(pmax16, pmin16);
|
||
|
|
}
|
||
|
|
|
||
|
|
static void stb__OptimizeColorsAlphaBlock(unsigned char* block, unsigned short* pmax16,
|
||
|
|
unsigned short* pmin16) {
|
||
|
|
int mind, maxd;
|
||
|
|
unsigned char *minp, *maxp;
|
||
|
|
double magn;
|
||
|
|
int v_r, v_g, v_b;
|
||
|
|
static const int nIterPower = 4;
|
||
|
|
float covf[6], vfr, vfg, vfb;
|
||
|
|
|
||
|
|
// determine color distribution
|
||
|
|
int cov[6];
|
||
|
|
int mu[3], min[3], max[3];
|
||
|
|
int ch, i, iter;
|
||
|
|
|
||
|
|
for (ch = 0; ch < 3; ch++) {
|
||
|
|
const unsigned char* bp = ((const unsigned char*)block) + ch;
|
||
|
|
int muv = 0, minv = 256, maxv = -1;
|
||
|
|
int num = 0;
|
||
|
|
|
||
|
|
for (i = 0; i < 64; i += 4) {
|
||
|
|
if (bp[3 - ch] == 0) {
|
||
|
|
continue;
|
||
|
|
}
|
||
|
|
|
||
|
|
muv += bp[i];
|
||
|
|
if (bp[i] < minv)
|
||
|
|
minv = bp[i];
|
||
|
|
else if (bp[i] > maxv)
|
||
|
|
maxv = bp[i];
|
||
|
|
|
||
|
|
num++;
|
||
|
|
}
|
||
|
|
|
||
|
|
mu[ch] = num > 0 ? (muv + 8) / num : 0;
|
||
|
|
min[ch] = minv;
|
||
|
|
max[ch] = maxv;
|
||
|
|
}
|
||
|
|
|
||
|
|
// determine covariance matrix
|
||
|
|
for (i = 0; i < 6; i++)
|
||
|
|
cov[i] = 0;
|
||
|
|
|
||
|
|
for (i = 0; i < 16; i++) {
|
||
|
|
if (block[i * 4 + 3] == 0) {
|
||
|
|
continue;
|
||
|
|
}
|
||
|
|
|
||
|
|
int r = block[i * 4 + 0] - mu[0];
|
||
|
|
int g = block[i * 4 + 1] - mu[1];
|
||
|
|
int b = block[i * 4 + 2] - mu[2];
|
||
|
|
|
||
|
|
cov[0] += r * r;
|
||
|
|
cov[1] += r * g;
|
||
|
|
cov[2] += r * b;
|
||
|
|
cov[3] += g * g;
|
||
|
|
cov[4] += g * b;
|
||
|
|
cov[5] += b * b;
|
||
|
|
}
|
||
|
|
|
||
|
|
// convert covariance matrix to float, find principal axis via power iter
|
||
|
|
for (i = 0; i < 6; i++)
|
||
|
|
covf[i] = static_cast<float>(cov[i]) / 255.0f;
|
||
|
|
|
||
|
|
vfr = (float)(max[0] - min[0]);
|
||
|
|
vfg = (float)(max[1] - min[1]);
|
||
|
|
vfb = (float)(max[2] - min[2]);
|
||
|
|
|
||
|
|
for (iter = 0; iter < nIterPower; iter++) {
|
||
|
|
float r = vfr * covf[0] + vfg * covf[1] + vfb * covf[2];
|
||
|
|
float g = vfr * covf[1] + vfg * covf[3] + vfb * covf[4];
|
||
|
|
float b = vfr * covf[2] + vfg * covf[4] + vfb * covf[5];
|
||
|
|
|
||
|
|
vfr = r;
|
||
|
|
vfg = g;
|
||
|
|
vfb = b;
|
||
|
|
}
|
||
|
|
|
||
|
|
magn = STBD_FABS(vfr);
|
||
|
|
if (STBD_FABS(vfg) > magn)
|
||
|
|
magn = STBD_FABS(vfg);
|
||
|
|
if (STBD_FABS(vfb) > magn)
|
||
|
|
magn = STBD_FABS(vfb);
|
||
|
|
|
||
|
|
if (magn < 4.0f) { // too small, default to luminance
|
||
|
|
v_r = 299; // JPEG YCbCr luma coefs, scaled by 1000.
|
||
|
|
v_g = 587;
|
||
|
|
v_b = 114;
|
||
|
|
} else {
|
||
|
|
magn = 512.0 / magn;
|
||
|
|
v_r = (int)(vfr * magn);
|
||
|
|
v_g = (int)(vfg * magn);
|
||
|
|
v_b = (int)(vfb * magn);
|
||
|
|
}
|
||
|
|
|
||
|
|
minp = maxp = NULL;
|
||
|
|
mind = 0x7fffffff;
|
||
|
|
maxd = -0x80000000;
|
||
|
|
|
||
|
|
// Pick colors at extreme points
|
||
|
|
for (i = 0; i < 16; i++) {
|
||
|
|
if (block[i * 4 + 3] == 0) {
|
||
|
|
continue;
|
||
|
|
}
|
||
|
|
|
||
|
|
int dot = block[i * 4 + 0] * v_r + block[i * 4 + 1] * v_g + block[i * 4 + 2] * v_b;
|
||
|
|
|
||
|
|
if (dot < mind) {
|
||
|
|
mind = dot;
|
||
|
|
minp = block + i * 4;
|
||
|
|
}
|
||
|
|
|
||
|
|
if (dot > maxd) {
|
||
|
|
maxd = dot;
|
||
|
|
maxp = block + i * 4;
|
||
|
|
}
|
||
|
|
}
|
||
|
|
|
||
|
|
if (!maxp) {
|
||
|
|
// all alpha, no color
|
||
|
|
*pmin16 = 0xffff;
|
||
|
|
*pmax16 = 0;
|
||
|
|
} else {
|
||
|
|
// endpoint colors found
|
||
|
|
*pmax16 = stb__As16Bit(maxp[0], maxp[1], maxp[2]);
|
||
|
|
*pmin16 = stb__As16Bit(minp[0], minp[1], minp[2]);
|
||
|
|
|
||
|
|
if (*pmax16 == *pmin16) {
|
||
|
|
// modify the endpoints to indicate presence of an alpha block
|
||
|
|
if (*pmax16 > 0) {
|
||
|
|
(*pmax16)--;
|
||
|
|
} else {
|
||
|
|
(*pmin16)++;
|
||
|
|
}
|
||
|
|
}
|
||
|
|
|
||
|
|
stb__ReorderColors(pmax16, pmin16);
|
||
|
|
}
|
||
|
|
}
|
||
|
|
|
||
|
|
static const float stb__midpoints5[32] = {
|
||
|
|
0.015686f, 0.047059f, 0.078431f, 0.111765f, 0.145098f, 0.176471f, 0.207843f, 0.241176f,
|
||
|
|
0.274510f, 0.305882f, 0.337255f, 0.370588f, 0.403922f, 0.435294f, 0.466667f, 0.5f,
|
||
|
|
0.533333f, 0.564706f, 0.596078f, 0.629412f, 0.662745f, 0.694118f, 0.725490f, 0.758824f,
|
||
|
|
0.792157f, 0.823529f, 0.854902f, 0.888235f, 0.921569f, 0.952941f, 0.984314f, 1.0f};
|
||
|
|
|
||
|
|
static const float stb__midpoints6[64] = {
|
||
|
|
0.007843f, 0.023529f, 0.039216f, 0.054902f, 0.070588f, 0.086275f, 0.101961f, 0.117647f,
|
||
|
|
0.133333f, 0.149020f, 0.164706f, 0.180392f, 0.196078f, 0.211765f, 0.227451f, 0.245098f,
|
||
|
|
0.262745f, 0.278431f, 0.294118f, 0.309804f, 0.325490f, 0.341176f, 0.356863f, 0.372549f,
|
||
|
|
0.388235f, 0.403922f, 0.419608f, 0.435294f, 0.450980f, 0.466667f, 0.482353f, 0.500000f,
|
||
|
|
0.517647f, 0.533333f, 0.549020f, 0.564706f, 0.580392f, 0.596078f, 0.611765f, 0.627451f,
|
||
|
|
0.643137f, 0.658824f, 0.674510f, 0.690196f, 0.705882f, 0.721569f, 0.737255f, 0.754902f,
|
||
|
|
0.772549f, 0.788235f, 0.803922f, 0.819608f, 0.835294f, 0.850980f, 0.866667f, 0.882353f,
|
||
|
|
0.898039f, 0.913725f, 0.929412f, 0.945098f, 0.960784f, 0.976471f, 0.992157f, 1.0f};
|
||
|
|
|
||
|
|
static unsigned short stb__Quantize5(float x) {
|
||
|
|
unsigned short q;
|
||
|
|
x = x < 0 ? 0 : x > 1 ? 1 : x; // saturate
|
||
|
|
q = (unsigned short)(x * 31);
|
||
|
|
q += (x > stb__midpoints5[q]);
|
||
|
|
return q;
|
||
|
|
}
|
||
|
|
|
||
|
|
static unsigned short stb__Quantize6(float x) {
|
||
|
|
unsigned short q;
|
||
|
|
x = x < 0 ? 0 : x > 1 ? 1 : x; // saturate
|
||
|
|
q = (unsigned short)(x * 63);
|
||
|
|
q += (x > stb__midpoints6[q]);
|
||
|
|
return q;
|
||
|
|
}
|
||
|
|
|
||
|
|
// The refinement function. (Clever code, part 2)
|
||
|
|
// Tries to optimize colors to suit block contents better.
|
||
|
|
// (By solving a least squares system via normal equations+Cramer's rule)
|
||
|
|
static int stb__RefineBlock(unsigned char* block, unsigned short* pmax16, unsigned short* pmin16,
|
||
|
|
unsigned int mask) {
|
||
|
|
static const int w1Tab[4] = {3, 0, 2, 1};
|
||
|
|
static const int prods[4] = {0x090000, 0x000900, 0x040102, 0x010402};
|
||
|
|
// ^some magic to save a lot of multiplies in the accumulating loop...
|
||
|
|
// (precomputed products of weights for least squares system, accumulated
|
||
|
|
// inside one 32-bit register)
|
||
|
|
|
||
|
|
float f;
|
||
|
|
unsigned short oldMin, oldMax, min16, max16;
|
||
|
|
int i, akku = 0, xx, xy, yy;
|
||
|
|
int At1_r, At1_g, At1_b;
|
||
|
|
int At2_r, At2_g, At2_b;
|
||
|
|
unsigned int cm = mask;
|
||
|
|
|
||
|
|
oldMin = *pmin16;
|
||
|
|
oldMax = *pmax16;
|
||
|
|
|
||
|
|
if ((mask ^ (mask << 2)) < 4) // all pixels have the same index?
|
||
|
|
{
|
||
|
|
// yes, linear system would be singular; solve using optimal
|
||
|
|
// single-color match on average color
|
||
|
|
int r = 8, g = 8, b = 8;
|
||
|
|
for (i = 0; i < 16; ++i) {
|
||
|
|
r += block[i * 4 + 0];
|
||
|
|
g += block[i * 4 + 1];
|
||
|
|
b += block[i * 4 + 2];
|
||
|
|
}
|
||
|
|
|
||
|
|
r >>= 4;
|
||
|
|
g >>= 4;
|
||
|
|
b >>= 4;
|
||
|
|
|
||
|
|
max16 = static_cast<unsigned short>((stb__OMatch5[r][0] << 11) | (stb__OMatch6[g][0] << 5) |
|
||
|
|
stb__OMatch5[b][0]);
|
||
|
|
min16 = static_cast<unsigned short>((stb__OMatch5[r][1] << 11) | (stb__OMatch6[g][1] << 5) |
|
||
|
|
stb__OMatch5[b][1]);
|
||
|
|
} else {
|
||
|
|
At1_r = At1_g = At1_b = 0;
|
||
|
|
At2_r = At2_g = At2_b = 0;
|
||
|
|
for (i = 0; i < 16; ++i, cm >>= 2) {
|
||
|
|
int step = cm & 3;
|
||
|
|
int w1 = w1Tab[step];
|
||
|
|
int r = block[i * 4 + 0];
|
||
|
|
int g = block[i * 4 + 1];
|
||
|
|
int b = block[i * 4 + 2];
|
||
|
|
|
||
|
|
akku += prods[step];
|
||
|
|
At1_r += w1 * r;
|
||
|
|
At1_g += w1 * g;
|
||
|
|
At1_b += w1 * b;
|
||
|
|
At2_r += r;
|
||
|
|
At2_g += g;
|
||
|
|
At2_b += b;
|
||
|
|
}
|
||
|
|
|
||
|
|
At2_r = 3 * At2_r - At1_r;
|
||
|
|
At2_g = 3 * At2_g - At1_g;
|
||
|
|
At2_b = 3 * At2_b - At1_b;
|
||
|
|
|
||
|
|
// extract solutions and decide solvability
|
||
|
|
xx = akku >> 16;
|
||
|
|
yy = (akku >> 8) & 0xff;
|
||
|
|
xy = (akku >> 0) & 0xff;
|
||
|
|
|
||
|
|
f = 3.0f / 255.0f / static_cast<float>(xx * yy - xy * xy);
|
||
|
|
|
||
|
|
max16 = static_cast<unsigned short>(
|
||
|
|
stb__Quantize5(static_cast<float>(At1_r * yy - At2_r * xy) * f) << 11);
|
||
|
|
max16 |= static_cast<unsigned short>(
|
||
|
|
stb__Quantize6(static_cast<float>(At1_g * yy - At2_g * xy) * f) << 5);
|
||
|
|
max16 |= static_cast<unsigned short>(
|
||
|
|
stb__Quantize5(static_cast<float>(At1_b * yy - At2_b * xy) * f) << 0);
|
||
|
|
|
||
|
|
min16 = static_cast<unsigned short>(
|
||
|
|
stb__Quantize5(static_cast<float>(At2_r * xx - At1_r * xy) * f) << 11);
|
||
|
|
min16 |= static_cast<unsigned short>(
|
||
|
|
stb__Quantize6(static_cast<float>(At2_g * xx - At1_g * xy) * f) << 5);
|
||
|
|
min16 |= static_cast<unsigned short>(
|
||
|
|
stb__Quantize5(static_cast<float>(At2_b * xx - At1_b * xy) * f) << 0);
|
||
|
|
}
|
||
|
|
|
||
|
|
*pmin16 = min16;
|
||
|
|
*pmax16 = max16;
|
||
|
|
stb__ReorderColors(pmax16, pmin16);
|
||
|
|
|
||
|
|
return oldMin != min16 || oldMax != max16;
|
||
|
|
}
|
||
|
|
|
||
|
|
// Color block compression
|
||
|
|
static void stb__CompressColorBlock(unsigned char* dest, unsigned char* block, int alpha,
|
||
|
|
int mode) {
|
||
|
|
unsigned int mask;
|
||
|
|
int i;
|
||
|
|
int refinecount;
|
||
|
|
unsigned short max16, min16;
|
||
|
|
unsigned char color[4 * 4];
|
||
|
|
|
||
|
|
refinecount = (mode & STB_DXT_HIGHQUAL) ? 2 : 1;
|
||
|
|
|
||
|
|
// check if block is constant
|
||
|
|
for (i = 1; i < 16; i++)
|
||
|
|
if (((unsigned int*)block)[i] != ((unsigned int*)block)[0])
|
||
|
|
break;
|
||
|
|
|
||
|
|
if (i == 16 && block[3] == 0 && alpha) { // constant alpha
|
||
|
|
mask = 0xffffffff;
|
||
|
|
max16 = 0;
|
||
|
|
min16 = 0xffff;
|
||
|
|
} else if (i == 16) { // constant color
|
||
|
|
int r = block[0], g = block[1], b = block[2];
|
||
|
|
mask = 0xaaaaaaaa;
|
||
|
|
max16 = static_cast<unsigned short>((stb__OMatch5[r][0] << 11) | (stb__OMatch6[g][0] << 5) |
|
||
|
|
stb__OMatch5[b][0]);
|
||
|
|
min16 = static_cast<unsigned short>((stb__OMatch5[r][1] << 11) | (stb__OMatch6[g][1] << 5) |
|
||
|
|
stb__OMatch5[b][1]);
|
||
|
|
} else if (alpha) {
|
||
|
|
stb__OptimizeColorsAlphaBlock(block, &max16, &min16);
|
||
|
|
stb__Eval3Colors(color, max16, min16);
|
||
|
|
mask = stb__MatchColorsAlphaBlock(block, color);
|
||
|
|
} else {
|
||
|
|
// first step: PCA+map along principal axis
|
||
|
|
stb__OptimizeColorsBlock(block, &max16, &min16);
|
||
|
|
if (max16 != min16) {
|
||
|
|
stb__Eval4Colors(color, max16, min16);
|
||
|
|
mask = stb__MatchColorsBlock(block, color);
|
||
|
|
} else
|
||
|
|
mask = 0;
|
||
|
|
|
||
|
|
// third step: refine (multiple times if requested)
|
||
|
|
for (i = 0; i < refinecount; i++) {
|
||
|
|
unsigned int lastmask = mask;
|
||
|
|
|
||
|
|
if (stb__RefineBlock(block, &max16, &min16, mask)) {
|
||
|
|
if (max16 != min16) {
|
||
|
|
stb__Eval4Colors(color, max16, min16);
|
||
|
|
mask = stb__MatchColorsBlock(block, color);
|
||
|
|
} else {
|
||
|
|
mask = 0;
|
||
|
|
break;
|
||
|
|
}
|
||
|
|
}
|
||
|
|
|
||
|
|
if (mask == lastmask)
|
||
|
|
break;
|
||
|
|
}
|
||
|
|
}
|
||
|
|
|
||
|
|
// write the color block
|
||
|
|
if (!alpha)
|
||
|
|
stb__FinalizeColors(&max16, &min16, &mask);
|
||
|
|
|
||
|
|
dest[0] = (unsigned char)(max16);
|
||
|
|
dest[1] = (unsigned char)(max16 >> 8);
|
||
|
|
dest[2] = (unsigned char)(min16);
|
||
|
|
dest[3] = (unsigned char)(min16 >> 8);
|
||
|
|
dest[4] = (unsigned char)(mask);
|
||
|
|
dest[5] = (unsigned char)(mask >> 8);
|
||
|
|
dest[6] = (unsigned char)(mask >> 16);
|
||
|
|
dest[7] = (unsigned char)(mask >> 24);
|
||
|
|
}
|
||
|
|
|
||
|
|
// Alpha block compression (this is easy for a change)
|
||
|
|
static void stb__CompressAlphaBlock(unsigned char* dest, unsigned char* src, int stride) {
|
||
|
|
int i, dist, bias, dist4, dist2, bits, mask;
|
||
|
|
|
||
|
|
// find min/max color
|
||
|
|
int mn, mx;
|
||
|
|
mn = mx = src[0];
|
||
|
|
|
||
|
|
for (i = 1; i < 16; i++) {
|
||
|
|
if (src[i * stride] < mn)
|
||
|
|
mn = src[i * stride];
|
||
|
|
else if (src[i * stride] > mx)
|
||
|
|
mx = src[i * stride];
|
||
|
|
}
|
||
|
|
|
||
|
|
// encode them
|
||
|
|
dest[0] = (unsigned char)mx;
|
||
|
|
dest[1] = (unsigned char)mn;
|
||
|
|
dest += 2;
|
||
|
|
|
||
|
|
// determine bias and emit color indices
|
||
|
|
// given the choice of mx/mn, these indices are optimal:
|
||
|
|
// http://fgiesen.wordpress.com/2009/12/15/dxt5-alpha-block-index-determination/
|
||
|
|
dist = mx - mn;
|
||
|
|
dist4 = dist * 4;
|
||
|
|
dist2 = dist * 2;
|
||
|
|
bias = (dist < 8) ? (dist - 1) : (dist / 2 + 2);
|
||
|
|
bias -= mn * 7;
|
||
|
|
bits = 0, mask = 0;
|
||
|
|
|
||
|
|
for (i = 0; i < 16; i++) {
|
||
|
|
int a = src[i * stride] * 7 + bias;
|
||
|
|
int ind, t;
|
||
|
|
|
||
|
|
// select index. this is a "linear scale" lerp factor between 0 (val=min)
|
||
|
|
// and 7 (val=max).
|
||
|
|
t = (a >= dist4) ? -1 : 0;
|
||
|
|
ind = t & 4;
|
||
|
|
a -= dist4 & t;
|
||
|
|
t = (a >= dist2) ? -1 : 0;
|
||
|
|
ind += t & 2;
|
||
|
|
a -= dist2 & t;
|
||
|
|
ind += (a >= dist);
|
||
|
|
|
||
|
|
// turn linear scale into DXT index (0/1 are extremal pts)
|
||
|
|
ind = -ind & 7;
|
||
|
|
ind ^= (2 > ind);
|
||
|
|
|
||
|
|
// write index
|
||
|
|
mask |= ind << bits;
|
||
|
|
if ((bits += 3) >= 8) {
|
||
|
|
*dest++ = (unsigned char)mask;
|
||
|
|
mask >>= 8;
|
||
|
|
bits -= 8;
|
||
|
|
}
|
||
|
|
}
|
||
|
|
}
|
||
|
|
|
||
|
|
void stb_compress_bc1_block(unsigned char* dest, const unsigned char* src, int alpha, int mode) {
|
||
|
|
stb__CompressColorBlock(dest, (unsigned char*)src, alpha, mode);
|
||
|
|
}
|
||
|
|
|
||
|
|
void stb_compress_bc3_block(unsigned char* dest, const unsigned char* src, int mode) {
|
||
|
|
unsigned char data[16][4];
|
||
|
|
int i;
|
||
|
|
|
||
|
|
stb__CompressAlphaBlock(dest, (unsigned char*)src + 3, 4);
|
||
|
|
dest += 8;
|
||
|
|
// make a new copy of the data in which alpha is opaque,
|
||
|
|
// because code uses a fast test for color constancy
|
||
|
|
memcpy(data, src, 4 * 16);
|
||
|
|
for (i = 0; i < 16; ++i)
|
||
|
|
data[i][3] = 255;
|
||
|
|
src = &data[0][0];
|
||
|
|
|
||
|
|
stb__CompressColorBlock(dest, (unsigned char*)src, 0, mode);
|
||
|
|
}
|