#include #include using namespace nall; extern "C" { void filter_size(unsigned&, unsigned&); void filter_render(uint32_t*, uint32_t*, unsigned, const uint16_t*, unsigned, unsigned, unsigned); }; enum { diff_offset = (0x440 << 21) + (0x207 << 11) + 0x407, diff_mask = (0x380 << 21) + (0x1f0 << 11) + 0x3f0, }; uint32_t *yuvTable; uint8_t rotate[256]; const uint8_t hqTable[256] = { 4, 4, 6, 2, 4, 4, 6, 2, 5, 3, 15, 12, 5, 3, 17, 13, 4, 4, 6, 18, 4, 4, 6, 18, 5, 3, 12, 12, 5, 3, 1, 12, 4, 4, 6, 2, 4, 4, 6, 2, 5, 3, 17, 13, 5, 3, 16, 14, 4, 4, 6, 18, 4, 4, 6, 18, 5, 3, 16, 12, 5, 3, 1, 14, 4, 4, 6, 2, 4, 4, 6, 2, 5, 19, 12, 12, 5, 19, 16, 12, 4, 4, 6, 2, 4, 4, 6, 2, 5, 3, 16, 12, 5, 3, 16, 12, 4, 4, 6, 2, 4, 4, 6, 2, 5, 19, 1, 12, 5, 19, 1, 14, 4, 4, 6, 2, 4, 4, 6, 18, 5, 3, 16, 12, 5, 19, 1, 14, 4, 4, 6, 2, 4, 4, 6, 2, 5, 3, 15, 12, 5, 3, 17, 13, 4, 4, 6, 2, 4, 4, 6, 2, 5, 3, 16, 12, 5, 3, 16, 12, 4, 4, 6, 2, 4, 4, 6, 2, 5, 3, 17, 13, 5, 3, 16, 14, 4, 4, 6, 2, 4, 4, 6, 2, 5, 3, 16, 13, 5, 3, 1, 14, 4, 4, 6, 2, 4, 4, 6, 2, 5, 3, 16, 12, 5, 3, 16, 13, 4, 4, 6, 2, 4, 4, 6, 2, 5, 3, 16, 12, 5, 3, 1, 12, 4, 4, 6, 2, 4, 4, 6, 2, 5, 3, 16, 12, 5, 3, 1, 14, 4, 4, 6, 2, 4, 4, 6, 2, 5, 3, 1, 12, 5, 3, 1, 14, }; static void initialize() { static bool initialized = false; if(initialized == true) return; initialized = true; yuvTable = new uint32_t[32768]; for(unsigned i = 0; i < 32768; i++) { uint8_t R = (i >> 0) & 31; uint8_t G = (i >> 5) & 31; uint8_t B = (i >> 10) & 31; //bgr555->bgr888 double r = (R << 3) | (R >> 2); double g = (G << 3) | (G >> 2); double b = (B << 3) | (B >> 2); //bgr888->yuv double y = (r + g + b) * (0.25f * (63.5f / 48.0f)); double u = ((r - b) * 0.25f + 128.0f) * (7.5f / 7.0f); double v = ((g * 2.0f - r - b) * 0.125f + 128.0f) * (7.5f / 6.0f); yuvTable[i] = ((unsigned)y << 21) + ((unsigned)u << 11) + ((unsigned)v); } //counter-clockwise rotation table; one revolution: //123 369 12346789 //4.6 -> 2.8 = //789 147 36928147 for(unsigned n = 0; n < 256; n++) { rotate[n] = ((n >> 2) & 0x11) | ((n << 2) & 0x88) | ((n & 0x01) << 5) | ((n & 0x08) << 3) | ((n & 0x10) >> 3) | ((n & 0x80) >> 5); } } static void terminate() { delete[] yuvTable; } static bool same(uint16_t x, uint16_t y) { return !((yuvTable[x] - yuvTable[y] + diff_offset) & diff_mask); } static bool diff(uint32_t x, uint16_t y) { return ((x - yuvTable[y]) & diff_mask); } static void grow(uint32_t &n) { n |= n << 16; n &= 0x03e07c1f; } static uint16_t pack(uint32_t n) { n &= 0x03e07c1f; return n | (n >> 16); } static uint16_t blend1(uint32_t A, uint32_t B) { grow(A); grow(B); return pack((A * 3 + B) >> 2); } static uint16_t blend2(uint32_t A, uint32_t B, uint32_t C) { grow(A); grow(B); grow(C); return pack((A * 2 + B + C) >> 2); } static uint16_t blend3(uint32_t A, uint32_t B, uint32_t C) { grow(A); grow(B); grow(C); return pack((A * 5 + B * 2 + C) >> 3); } static uint16_t blend4(uint32_t A, uint32_t B, uint32_t C) { grow(A); grow(B); grow(C); return pack((A * 6 + B + C) >> 3); } static uint16_t blend5(uint32_t A, uint32_t B, uint32_t C) { grow(A); grow(B); grow(C); return pack((A * 2 + (B + C) * 3) >> 3); } static uint16_t blend6(uint32_t A, uint32_t B, uint32_t C) { grow(A); grow(B); grow(C); return pack((A * 14 + B + C) >> 4); } static uint16_t blend(unsigned rule, uint16_t E, uint16_t A, uint16_t B, uint16_t D, uint16_t F, uint16_t H) { switch(rule) { default: case 0: return E; case 1: return blend1(E, A); case 2: return blend1(E, D); case 3: return blend1(E, B); case 4: return blend2(E, D, B); case 5: return blend2(E, A, B); case 6: return blend2(E, A, D); case 7: return blend3(E, B, D); case 8: return blend3(E, D, B); case 9: return blend4(E, D, B); case 10: return blend5(E, D, B); case 11: return blend6(E, D, B); case 12: return same(B, D) ? blend2(E, D, B) : E; case 13: return same(B, D) ? blend5(E, D, B) : E; case 14: return same(B, D) ? blend6(E, D, B) : E; case 15: return same(B, D) ? blend2(E, D, B) : blend1(E, A); case 16: return same(B, D) ? blend4(E, D, B) : blend1(E, A); case 17: return same(B, D) ? blend5(E, D, B) : blend1(E, A); case 18: return same(B, F) ? blend3(E, B, D) : blend1(E, D); case 19: return same(D, H) ? blend3(E, D, B) : blend1(E, B); } } dllexport void filter_size(unsigned &width, unsigned &height) { initialize(); width *= 2; height *= 2; } dllexport void filter_render( uint32_t *colortable, uint32_t *output, unsigned outpitch, const uint16_t *input, unsigned pitch, unsigned width, unsigned height ) { initialize(); pitch >>= 1; outpitch >>= 2; //#pragma omp parallel for for(unsigned y = 0; y < height; y++) { const uint16_t *in = input + y * pitch; uint32_t *out0 = output + y * outpitch * 2; uint32_t *out1 = output + y * outpitch * 2 + outpitch; int prevline = (y == 0 ? 0 : pitch); int nextline = (y == height - 1 ? 0 : pitch); in++; *out0++ = 0; *out0++ = 0; *out1++ = 0; *out1++ = 0; for(unsigned x = 1; x < width - 1; x++) { uint16_t A = *(in - prevline - 1); uint16_t B = *(in - prevline + 0); uint16_t C = *(in - prevline + 1); uint16_t D = *(in - 1); uint16_t E = *(in + 0); uint16_t F = *(in + 1); uint16_t G = *(in + nextline - 1); uint16_t H = *(in + nextline + 0); uint16_t I = *(in + nextline + 1); uint32_t e = yuvTable[E] + diff_offset; uint8_t pattern; pattern = diff(e, A) << 0; pattern |= diff(e, B) << 1; pattern |= diff(e, C) << 2; pattern |= diff(e, D) << 3; pattern |= diff(e, F) << 4; pattern |= diff(e, G) << 5; pattern |= diff(e, H) << 6; pattern |= diff(e, I) << 7; *(out0 + 0) = colortable[blend(hqTable[pattern], E, A, B, D, F, H)]; pattern = rotate[pattern]; *(out0 + 1) = colortable[blend(hqTable[pattern], E, C, F, B, H, D)]; pattern = rotate[pattern]; *(out1 + 1) = colortable[blend(hqTable[pattern], E, I, H, F, D, B)]; pattern = rotate[pattern]; *(out1 + 0) = colortable[blend(hqTable[pattern], E, G, D, H, B, F)]; in++; out0 += 2; out1 += 2; } in++; *out0++ = 0; *out0++ = 0; *out1++ = 0; *out1++ = 0; } }