mirror of https://github.com/bsnes-emu/bsnes.git
1172 lines
37 KiB
C++
Executable File
1172 lines
37 KiB
C++
Executable File
static uint32_t colorMask = 0xFEFEFE;
|
|
static uint32_t lowPixelMask = 0x010101;
|
|
static uint32_t qcolorMask = 0xFCFCFC;
|
|
static uint32_t qlowpixelMask = 0x030303;
|
|
static uint32_t redblueMask = 0xFF00FF;
|
|
static uint32_t greenMask = 0xFF00;
|
|
|
|
uint32_t qRGB_COLOR_MASK[2] = { 0xFEFEFE, 0xFEFEFE };
|
|
|
|
static inline int GetResult1 (uint32_t A, uint32_t B, uint32_t C, uint32_t D,
|
|
uint32_t /* E */)
|
|
{
|
|
int x = 0;
|
|
int y = 0;
|
|
int r = 0;
|
|
|
|
if (A == C)
|
|
x += 1;
|
|
else if (B == C)
|
|
y += 1;
|
|
if (A == D)
|
|
x += 1;
|
|
else if (B == D)
|
|
y += 1;
|
|
if (x <= 1)
|
|
r += 1;
|
|
if (y <= 1)
|
|
r -= 1;
|
|
return r;
|
|
}
|
|
|
|
static inline int GetResult2 (uint32_t A, uint32_t B, uint32_t C, uint32_t D,
|
|
uint32_t /* E */)
|
|
{
|
|
int x = 0;
|
|
int y = 0;
|
|
int r = 0;
|
|
|
|
if (A == C)
|
|
x += 1;
|
|
else if (B == C)
|
|
y += 1;
|
|
if (A == D)
|
|
x += 1;
|
|
else if (B == D)
|
|
y += 1;
|
|
if (x <= 1)
|
|
r -= 1;
|
|
if (y <= 1)
|
|
r += 1;
|
|
return r;
|
|
}
|
|
|
|
static inline int GetResult (uint32_t A, uint32_t B, uint32_t C, uint32_t D)
|
|
{
|
|
int x = 0;
|
|
int y = 0;
|
|
int r = 0;
|
|
|
|
if (A == C)
|
|
x += 1;
|
|
else if (B == C)
|
|
y += 1;
|
|
if (A == D)
|
|
x += 1;
|
|
else if (B == D)
|
|
y += 1;
|
|
if (x <= 1)
|
|
r += 1;
|
|
if (y <= 1)
|
|
r -= 1;
|
|
return r;
|
|
}
|
|
|
|
static inline uint32_t INTERPOLATE (uint32_t A, uint32_t B)
|
|
{
|
|
if (A != B) {
|
|
return (((A & colorMask) >> 1) + ((B & colorMask) >> 1) +
|
|
(A & B & lowPixelMask));
|
|
} else
|
|
return A;
|
|
}
|
|
|
|
static inline uint32_t Q_INTERPOLATE (uint32_t A, uint32_t B, uint32_t C, uint32_t D)
|
|
{
|
|
register uint32_t x = ((A & qcolorMask) >> 2) +
|
|
((B & qcolorMask) >> 2) +
|
|
((C & qcolorMask) >> 2) + ((D & qcolorMask) >> 2);
|
|
register uint32_t y = (A & qlowpixelMask) +
|
|
(B & qlowpixelMask) + (C & qlowpixelMask) + (D & qlowpixelMask);
|
|
|
|
y = (y >> 2) & qlowpixelMask;
|
|
return x + y;
|
|
}
|
|
|
|
static inline int GetResult1_32 (uint32_t A, uint32_t B, uint32_t C, uint32_t D,
|
|
uint32_t /* E */)
|
|
{
|
|
int x = 0;
|
|
int y = 0;
|
|
int r = 0;
|
|
|
|
if (A == C)
|
|
x += 1;
|
|
else if (B == C)
|
|
y += 1;
|
|
if (A == D)
|
|
x += 1;
|
|
else if (B == D)
|
|
y += 1;
|
|
if (x <= 1)
|
|
r += 1;
|
|
if (y <= 1)
|
|
r -= 1;
|
|
return r;
|
|
}
|
|
|
|
static inline int GetResult2_32 (uint32_t A, uint32_t B, uint32_t C, uint32_t D,
|
|
uint32_t /* E */)
|
|
{
|
|
int x = 0;
|
|
int y = 0;
|
|
int r = 0;
|
|
|
|
if (A == C)
|
|
x += 1;
|
|
else if (B == C)
|
|
y += 1;
|
|
if (A == D)
|
|
x += 1;
|
|
else if (B == D)
|
|
y += 1;
|
|
if (x <= 1)
|
|
r -= 1;
|
|
if (y <= 1)
|
|
r += 1;
|
|
return r;
|
|
}
|
|
|
|
#define BLUE_MASK565 0x001F001F
|
|
#define RED_MASK565 0xF800F800
|
|
#define GREEN_MASK565 0x07E007E0
|
|
|
|
#define BLUE_MASK555 0x001F001F
|
|
#define RED_MASK555 0x7C007C00
|
|
#define GREEN_MASK555 0x03E003E0
|
|
|
|
void Super2xSaI (uint8_t *srcPtr, uint32_t srcPitch,
|
|
uint8_t *deltaPtr, uint8_t *dstPtr, uint32_t dstPitch,
|
|
int width, int height)
|
|
{
|
|
uint16_t *bP;
|
|
uint8_t *dP;
|
|
uint32_t inc_bP;
|
|
uint32_t Nextline = srcPitch >> 1;
|
|
{
|
|
inc_bP = 1;
|
|
|
|
for (; height; height--) {
|
|
bP = (uint16_t *) srcPtr;
|
|
dP = (uint8_t *) dstPtr;
|
|
|
|
for (uint32_t finish = width; finish; finish -= inc_bP) {
|
|
uint32_t color4, color5, color6;
|
|
uint32_t color1, color2, color3;
|
|
uint32_t colorA0, colorA1, colorA2, colorA3,
|
|
colorB0, colorB1, colorB2, colorB3, colorS1, colorS2;
|
|
uint32_t product1a, product1b, product2a, product2b;
|
|
|
|
//--------------------------------------- B1 B2
|
|
// 4 5 6 S2
|
|
// 1 2 3 S1
|
|
// A1 A2
|
|
|
|
colorB0 = *(bP - Nextline - 1);
|
|
colorB1 = *(bP - Nextline);
|
|
colorB2 = *(bP - Nextline + 1);
|
|
colorB3 = *(bP - Nextline + 2);
|
|
|
|
color4 = *(bP - 1);
|
|
color5 = *(bP);
|
|
color6 = *(bP + 1);
|
|
colorS2 = *(bP + 2);
|
|
|
|
color1 = *(bP + Nextline - 1);
|
|
color2 = *(bP + Nextline);
|
|
color3 = *(bP + Nextline + 1);
|
|
colorS1 = *(bP + Nextline + 2);
|
|
|
|
colorA0 = *(bP + Nextline + Nextline - 1);
|
|
colorA1 = *(bP + Nextline + Nextline);
|
|
colorA2 = *(bP + Nextline + Nextline + 1);
|
|
colorA3 = *(bP + Nextline + Nextline + 2);
|
|
|
|
//--------------------------------------
|
|
if (color2 == color6 && color5 != color3) {
|
|
product2b = product1b = color2;
|
|
} else if (color5 == color3 && color2 != color6) {
|
|
product2b = product1b = color5;
|
|
} else if (color5 == color3 && color2 == color6) {
|
|
register int r = 0;
|
|
|
|
r += GetResult (color6, color5, color1, colorA1);
|
|
r += GetResult (color6, color5, color4, colorB1);
|
|
r += GetResult (color6, color5, colorA2, colorS1);
|
|
r += GetResult (color6, color5, colorB2, colorS2);
|
|
|
|
if (r > 0)
|
|
product2b = product1b = color6;
|
|
else if (r < 0)
|
|
product2b = product1b = color5;
|
|
else {
|
|
product2b = product1b = INTERPOLATE (color5, color6);
|
|
}
|
|
} else {
|
|
if (color6 == color3 && color3 == colorA1
|
|
&& color2 != colorA2 && color3 != colorA0)
|
|
product2b =
|
|
Q_INTERPOLATE (color3, color3, color3, color2);
|
|
else if (color5 == color2 && color2 == colorA2
|
|
&& colorA1 != color3 && color2 != colorA3)
|
|
product2b =
|
|
Q_INTERPOLATE (color2, color2, color2, color3);
|
|
else
|
|
product2b = INTERPOLATE (color2, color3);
|
|
|
|
if (color6 == color3 && color6 == colorB1
|
|
&& color5 != colorB2 && color6 != colorB0)
|
|
product1b =
|
|
Q_INTERPOLATE (color6, color6, color6, color5);
|
|
else if (color5 == color2 && color5 == colorB2
|
|
&& colorB1 != color6 && color5 != colorB3)
|
|
product1b =
|
|
Q_INTERPOLATE (color6, color5, color5, color5);
|
|
else
|
|
product1b = INTERPOLATE (color5, color6);
|
|
}
|
|
|
|
if (color5 == color3 && color2 != color6 && color4 == color5
|
|
&& color5 != colorA2)
|
|
product2a = INTERPOLATE (color2, color5);
|
|
else
|
|
if (color5 == color1 && color6 == color5
|
|
&& color4 != color2 && color5 != colorA0)
|
|
product2a = INTERPOLATE (color2, color5);
|
|
else
|
|
product2a = color2;
|
|
|
|
if (color2 == color6 && color5 != color3 && color1 == color2
|
|
&& color2 != colorB2)
|
|
product1a = INTERPOLATE (color2, color5);
|
|
else
|
|
if (color4 == color2 && color3 == color2
|
|
&& color1 != color5 && color2 != colorB0)
|
|
product1a = INTERPOLATE (color2, color5);
|
|
else
|
|
product1a = color5;
|
|
|
|
#ifdef WORDS_BIGENDIAN
|
|
product1a = (product1a << 16) | product1b;
|
|
product2a = (product2a << 16) | product2b;
|
|
#else
|
|
product1a = product1a | (product1b << 16);
|
|
product2a = product2a | (product2b << 16);
|
|
#endif
|
|
|
|
*((uint32_t *) dP) = product1a;
|
|
*((uint32_t *) (dP + dstPitch)) = product2a;
|
|
|
|
bP += inc_bP;
|
|
dP += sizeof (uint32_t);
|
|
} // end of for ( finish= width etc..)
|
|
|
|
srcPtr += srcPitch;
|
|
dstPtr += dstPitch << 1;
|
|
deltaPtr += srcPitch;
|
|
} // endof: for (; height; height--)
|
|
}
|
|
}
|
|
|
|
void Super2xSaI32 (uint8_t *srcPtr, uint32_t srcPitch,
|
|
uint8_t * /* deltaPtr */, uint8_t *dstPtr, uint32_t dstPitch,
|
|
int width, int height)
|
|
{
|
|
uint32_t *bP;
|
|
uint32_t *dP;
|
|
uint32_t inc_bP;
|
|
uint32_t Nextline = srcPitch >> 2;
|
|
inc_bP = 1;
|
|
|
|
for (; height; height--) {
|
|
bP = (uint32_t *) srcPtr;
|
|
dP = (uint32_t *) dstPtr;
|
|
|
|
for (uint32_t finish = width; finish; finish -= inc_bP) {
|
|
uint32_t color4, color5, color6;
|
|
uint32_t color1, color2, color3;
|
|
uint32_t colorA0, colorA1, colorA2, colorA3,
|
|
colorB0, colorB1, colorB2, colorB3, colorS1, colorS2;
|
|
uint32_t product1a, product1b, product2a, product2b;
|
|
|
|
//--------------------------------------- B1 B2
|
|
// 4 5 6 S2
|
|
// 1 2 3 S1
|
|
// A1 A2
|
|
|
|
colorB0 = *(bP - Nextline - 1);
|
|
colorB1 = *(bP - Nextline);
|
|
colorB2 = *(bP - Nextline + 1);
|
|
colorB3 = *(bP - Nextline + 2);
|
|
|
|
color4 = *(bP - 1);
|
|
color5 = *(bP);
|
|
color6 = *(bP + 1);
|
|
colorS2 = *(bP + 2);
|
|
|
|
color1 = *(bP + Nextline - 1);
|
|
color2 = *(bP + Nextline);
|
|
color3 = *(bP + Nextline + 1);
|
|
colorS1 = *(bP + Nextline + 2);
|
|
|
|
colorA0 = *(bP + Nextline + Nextline - 1);
|
|
colorA1 = *(bP + Nextline + Nextline);
|
|
colorA2 = *(bP + Nextline + Nextline + 1);
|
|
colorA3 = *(bP + Nextline + Nextline + 2);
|
|
|
|
//--------------------------------------
|
|
if (color2 == color6 && color5 != color3) {
|
|
product2b = product1b = color2;
|
|
} else if (color5 == color3 && color2 != color6) {
|
|
product2b = product1b = color5;
|
|
} else if (color5 == color3 && color2 == color6) {
|
|
register int r = 0;
|
|
|
|
r += GetResult (color6, color5, color1, colorA1);
|
|
r += GetResult (color6, color5, color4, colorB1);
|
|
r += GetResult (color6, color5, colorA2, colorS1);
|
|
r += GetResult (color6, color5, colorB2, colorS2);
|
|
|
|
if (r > 0)
|
|
product2b = product1b = color6;
|
|
else if (r < 0)
|
|
product2b = product1b = color5;
|
|
else {
|
|
product2b = product1b = INTERPOLATE (color5, color6);
|
|
}
|
|
} else {
|
|
if (color6 == color3 && color3 == colorA1
|
|
&& color2 != colorA2 && color3 != colorA0)
|
|
product2b =
|
|
Q_INTERPOLATE (color3, color3, color3, color2);
|
|
else if (color5 == color2 && color2 == colorA2
|
|
&& colorA1 != color3 && color2 != colorA3)
|
|
product2b =
|
|
Q_INTERPOLATE (color2, color2, color2, color3);
|
|
else
|
|
product2b = INTERPOLATE (color2, color3);
|
|
|
|
if (color6 == color3 && color6 == colorB1
|
|
&& color5 != colorB2 && color6 != colorB0)
|
|
product1b =
|
|
Q_INTERPOLATE (color6, color6, color6, color5);
|
|
else if (color5 == color2 && color5 == colorB2
|
|
&& colorB1 != color6 && color5 != colorB3)
|
|
product1b =
|
|
Q_INTERPOLATE (color6, color5, color5, color5);
|
|
else
|
|
product1b = INTERPOLATE (color5, color6);
|
|
}
|
|
|
|
if (color5 == color3 && color2 != color6 && color4 == color5
|
|
&& color5 != colorA2)
|
|
product2a = INTERPOLATE (color2, color5);
|
|
else
|
|
if (color5 == color1 && color6 == color5
|
|
&& color4 != color2 && color5 != colorA0)
|
|
product2a = INTERPOLATE (color2, color5);
|
|
else
|
|
product2a = color2;
|
|
|
|
if (color2 == color6 && color5 != color3 && color1 == color2
|
|
&& color2 != colorB2)
|
|
product1a = INTERPOLATE (color2, color5);
|
|
else
|
|
if (color4 == color2 && color3 == color2
|
|
&& color1 != color5 && color2 != colorB0)
|
|
product1a = INTERPOLATE (color2, color5);
|
|
else
|
|
product1a = color5;
|
|
*(dP) = product1a;
|
|
*(dP+1) = product1b;
|
|
*(dP + (dstPitch >> 2)) = product2a;
|
|
*(dP + (dstPitch >> 2) + 1) = product2b;
|
|
|
|
bP += inc_bP;
|
|
dP += 2;
|
|
} // end of for ( finish= width etc..)
|
|
|
|
srcPtr += srcPitch;
|
|
dstPtr += dstPitch << 1;
|
|
// deltaPtr += srcPitch;
|
|
} // endof: for (; height; height--)
|
|
}
|
|
|
|
void SuperEagle (uint8_t *srcPtr, uint32_t srcPitch, uint8_t *deltaPtr,
|
|
uint8_t *dstPtr, uint32_t dstPitch, int width, int height)
|
|
{
|
|
uint8_t *dP;
|
|
uint16_t *bP;
|
|
uint16_t *xP;
|
|
uint32_t inc_bP;
|
|
|
|
{
|
|
inc_bP = 1;
|
|
|
|
uint32_t Nextline = srcPitch >> 1;
|
|
|
|
for (; height; height--) {
|
|
bP = (uint16_t *) srcPtr;
|
|
xP = (uint16_t *) deltaPtr;
|
|
dP = dstPtr;
|
|
for (uint32_t finish = width; finish; finish -= inc_bP) {
|
|
uint32_t color4, color5, color6;
|
|
uint32_t color1, color2, color3;
|
|
uint32_t colorA1, colorA2, colorB1, colorB2, colorS1, colorS2;
|
|
uint32_t product1a, product1b, product2a, product2b;
|
|
|
|
colorB1 = *(bP - Nextline);
|
|
colorB2 = *(bP - Nextline + 1);
|
|
|
|
color4 = *(bP - 1);
|
|
color5 = *(bP);
|
|
color6 = *(bP + 1);
|
|
colorS2 = *(bP + 2);
|
|
|
|
color1 = *(bP + Nextline - 1);
|
|
color2 = *(bP + Nextline);
|
|
color3 = *(bP + Nextline + 1);
|
|
colorS1 = *(bP + Nextline + 2);
|
|
|
|
colorA1 = *(bP + Nextline + Nextline);
|
|
colorA2 = *(bP + Nextline + Nextline + 1);
|
|
|
|
// --------------------------------------
|
|
if (color2 == color6 && color5 != color3) {
|
|
product1b = product2a = color2;
|
|
if ((color1 == color2) || (color6 == colorB2)) {
|
|
product1a = INTERPOLATE (color2, color5);
|
|
product1a = INTERPOLATE (color2, product1a);
|
|
// product1a = color2;
|
|
} else {
|
|
product1a = INTERPOLATE (color5, color6);
|
|
}
|
|
|
|
if ((color6 == colorS2) || (color2 == colorA1)) {
|
|
product2b = INTERPOLATE (color2, color3);
|
|
product2b = INTERPOLATE (color2, product2b);
|
|
// product2b = color2;
|
|
} else {
|
|
product2b = INTERPOLATE (color2, color3);
|
|
}
|
|
} else if (color5 == color3 && color2 != color6) {
|
|
product2b = product1a = color5;
|
|
|
|
if ((colorB1 == color5) || (color3 == colorS1)) {
|
|
product1b = INTERPOLATE (color5, color6);
|
|
product1b = INTERPOLATE (color5, product1b);
|
|
// product1b = color5;
|
|
} else {
|
|
product1b = INTERPOLATE (color5, color6);
|
|
}
|
|
|
|
if ((color3 == colorA2) || (color4 == color5)) {
|
|
product2a = INTERPOLATE (color5, color2);
|
|
product2a = INTERPOLATE (color5, product2a);
|
|
// product2a = color5;
|
|
} else {
|
|
product2a = INTERPOLATE (color2, color3);
|
|
}
|
|
|
|
} else if (color5 == color3 && color2 == color6) {
|
|
register int r = 0;
|
|
|
|
r += GetResult (color6, color5, color1, colorA1);
|
|
r += GetResult (color6, color5, color4, colorB1);
|
|
r += GetResult (color6, color5, colorA2, colorS1);
|
|
r += GetResult (color6, color5, colorB2, colorS2);
|
|
|
|
if (r > 0) {
|
|
product1b = product2a = color2;
|
|
product1a = product2b = INTERPOLATE (color5, color6);
|
|
} else if (r < 0) {
|
|
product2b = product1a = color5;
|
|
product1b = product2a = INTERPOLATE (color5, color6);
|
|
} else {
|
|
product2b = product1a = color5;
|
|
product1b = product2a = color2;
|
|
}
|
|
} else {
|
|
product2b = product1a = INTERPOLATE (color2, color6);
|
|
product2b =
|
|
Q_INTERPOLATE (color3, color3, color3, product2b);
|
|
product1a =
|
|
Q_INTERPOLATE (color5, color5, color5, product1a);
|
|
|
|
product2a = product1b = INTERPOLATE (color5, color3);
|
|
product2a =
|
|
Q_INTERPOLATE (color2, color2, color2, product2a);
|
|
product1b =
|
|
Q_INTERPOLATE (color6, color6, color6, product1b);
|
|
|
|
// product1a = color5;
|
|
// product1b = color6;
|
|
// product2a = color2;
|
|
// product2b = color3;
|
|
}
|
|
#ifdef WORDS_BIGENDIAN
|
|
product1a = (product1a << 16) | product1b;
|
|
product2a = (product2a << 16) | product2b;
|
|
#else
|
|
product1a = product1a | (product1b << 16);
|
|
product2a = product2a | (product2b << 16);
|
|
#endif
|
|
|
|
*((uint32_t *) dP) = product1a;
|
|
*((uint32_t *) (dP + dstPitch)) = product2a;
|
|
*xP = color5;
|
|
|
|
bP += inc_bP;
|
|
xP += inc_bP;
|
|
dP += sizeof (uint32_t);
|
|
} // end of for ( finish= width etc..)
|
|
|
|
srcPtr += srcPitch;
|
|
dstPtr += dstPitch << 1;
|
|
deltaPtr += srcPitch;
|
|
} // endof: for (height; height; height--)
|
|
}
|
|
}
|
|
|
|
void SuperEagle32 (uint8_t *srcPtr, uint32_t srcPitch, uint8_t */*deltaPtr*/,
|
|
uint8_t *dstPtr, uint32_t dstPitch, int width, int height)
|
|
{
|
|
uint32_t *dP;
|
|
uint32_t *bP;
|
|
//uint32_t *xP;
|
|
uint32_t inc_bP;
|
|
|
|
inc_bP = 1;
|
|
|
|
uint32_t Nextline = srcPitch >> 2;
|
|
|
|
for (; height; height--) {
|
|
bP = (uint32_t *) srcPtr;
|
|
//xP = (uint32_t *) deltaPtr;
|
|
dP = (uint32_t *)dstPtr;
|
|
for (uint32_t finish = width; finish; finish -= inc_bP) {
|
|
uint32_t color4, color5, color6;
|
|
uint32_t color1, color2, color3;
|
|
uint32_t colorA1, colorA2, colorB1, colorB2, colorS1, colorS2;
|
|
uint32_t product1a, product1b, product2a, product2b;
|
|
|
|
colorB1 = *(bP - Nextline);
|
|
colorB2 = *(bP - Nextline + 1);
|
|
|
|
color4 = *(bP - 1);
|
|
color5 = *(bP);
|
|
color6 = *(bP + 1);
|
|
colorS2 = *(bP + 2);
|
|
|
|
color1 = *(bP + Nextline - 1);
|
|
color2 = *(bP + Nextline);
|
|
color3 = *(bP + Nextline + 1);
|
|
colorS1 = *(bP + Nextline + 2);
|
|
|
|
colorA1 = *(bP + Nextline + Nextline);
|
|
colorA2 = *(bP + Nextline + Nextline + 1);
|
|
|
|
// --------------------------------------
|
|
if (color2 == color6 && color5 != color3) {
|
|
product1b = product2a = color2;
|
|
if ((color1 == color2) || (color6 == colorB2)) {
|
|
product1a = INTERPOLATE (color2, color5);
|
|
product1a = INTERPOLATE (color2, product1a);
|
|
// product1a = color2;
|
|
} else {
|
|
product1a = INTERPOLATE (color5, color6);
|
|
}
|
|
|
|
if ((color6 == colorS2) || (color2 == colorA1)) {
|
|
product2b = INTERPOLATE (color2, color3);
|
|
product2b = INTERPOLATE (color2, product2b);
|
|
// product2b = color2;
|
|
} else {
|
|
product2b = INTERPOLATE (color2, color3);
|
|
}
|
|
} else if (color5 == color3 && color2 != color6) {
|
|
product2b = product1a = color5;
|
|
|
|
if ((colorB1 == color5) || (color3 == colorS1)) {
|
|
product1b = INTERPOLATE (color5, color6);
|
|
product1b = INTERPOLATE (color5, product1b);
|
|
// product1b = color5;
|
|
} else {
|
|
product1b = INTERPOLATE (color5, color6);
|
|
}
|
|
|
|
if ((color3 == colorA2) || (color4 == color5)) {
|
|
product2a = INTERPOLATE (color5, color2);
|
|
product2a = INTERPOLATE (color5, product2a);
|
|
// product2a = color5;
|
|
} else {
|
|
product2a = INTERPOLATE (color2, color3);
|
|
}
|
|
|
|
} else if (color5 == color3 && color2 == color6) {
|
|
register int r = 0;
|
|
|
|
r += GetResult (color6, color5, color1, colorA1);
|
|
r += GetResult (color6, color5, color4, colorB1);
|
|
r += GetResult (color6, color5, colorA2, colorS1);
|
|
r += GetResult (color6, color5, colorB2, colorS2);
|
|
|
|
if (r > 0) {
|
|
product1b = product2a = color2;
|
|
product1a = product2b = INTERPOLATE (color5, color6);
|
|
} else if (r < 0) {
|
|
product2b = product1a = color5;
|
|
product1b = product2a = INTERPOLATE (color5, color6);
|
|
} else {
|
|
product2b = product1a = color5;
|
|
product1b = product2a = color2;
|
|
}
|
|
} else {
|
|
product2b = product1a = INTERPOLATE (color2, color6);
|
|
product2b =
|
|
Q_INTERPOLATE (color3, color3, color3, product2b);
|
|
product1a =
|
|
Q_INTERPOLATE (color5, color5, color5, product1a);
|
|
|
|
product2a = product1b = INTERPOLATE (color5, color3);
|
|
product2a =
|
|
Q_INTERPOLATE (color2, color2, color2, product2a);
|
|
product1b =
|
|
Q_INTERPOLATE (color6, color6, color6, product1b);
|
|
|
|
// product1a = color5;
|
|
// product1b = color6;
|
|
// product2a = color2;
|
|
// product2b = color3;
|
|
}
|
|
*(dP) = product1a;
|
|
*(dP+1) = product1b;
|
|
*(dP + (dstPitch >> 2)) = product2a;
|
|
*(dP + (dstPitch >> 2) +1) = product2b;
|
|
//*xP = color5;
|
|
|
|
bP += inc_bP;
|
|
//xP += inc_bP;
|
|
dP += 2;
|
|
} // end of for ( finish= width etc..)
|
|
|
|
srcPtr += srcPitch;
|
|
dstPtr += dstPitch << 1;
|
|
//deltaPtr += srcPitch;
|
|
} // endof: for (height; height; height--)
|
|
}
|
|
|
|
void _2xSaI (uint8_t *srcPtr, uint32_t srcPitch, uint8_t *deltaPtr,
|
|
uint8_t *dstPtr, uint32_t dstPitch, int width, int height)
|
|
{
|
|
uint8_t *dP;
|
|
uint16_t *bP;
|
|
uint32_t inc_bP;
|
|
|
|
{
|
|
inc_bP = 1;
|
|
|
|
uint32_t Nextline = srcPitch >> 1;
|
|
|
|
for (; height; height--) {
|
|
bP = (uint16_t *) srcPtr;
|
|
dP = dstPtr;
|
|
|
|
for (uint32_t finish = width; finish; finish -= inc_bP) {
|
|
|
|
register uint32_t colorA, colorB;
|
|
uint32_t colorC, colorD,
|
|
colorE, colorF, colorG, colorH,
|
|
colorI, colorJ, colorK, colorL,
|
|
|
|
colorM, colorN, colorO, colorP;
|
|
uint32_t product, product1, product2;
|
|
|
|
//---------------------------------------
|
|
// Map of the pixels: I|E F|J
|
|
// G|A B|K
|
|
// H|C D|L
|
|
// M|N O|P
|
|
colorI = *(bP - Nextline - 1);
|
|
colorE = *(bP - Nextline);
|
|
colorF = *(bP - Nextline + 1);
|
|
colorJ = *(bP - Nextline + 2);
|
|
|
|
colorG = *(bP - 1);
|
|
colorA = *(bP);
|
|
colorB = *(bP + 1);
|
|
colorK = *(bP + 2);
|
|
|
|
colorH = *(bP + Nextline - 1);
|
|
colorC = *(bP + Nextline);
|
|
colorD = *(bP + Nextline + 1);
|
|
colorL = *(bP + Nextline + 2);
|
|
|
|
colorM = *(bP + Nextline + Nextline - 1);
|
|
colorN = *(bP + Nextline + Nextline);
|
|
colorO = *(bP + Nextline + Nextline + 1);
|
|
colorP = *(bP + Nextline + Nextline + 2);
|
|
|
|
if ((colorA == colorD) && (colorB != colorC)) {
|
|
if (((colorA == colorE) && (colorB == colorL)) ||
|
|
((colorA == colorC) && (colorA == colorF)
|
|
&& (colorB != colorE) && (colorB == colorJ))) {
|
|
product = colorA;
|
|
} else {
|
|
product = INTERPOLATE (colorA, colorB);
|
|
}
|
|
|
|
if (((colorA == colorG) && (colorC == colorO)) ||
|
|
((colorA == colorB) && (colorA == colorH)
|
|
&& (colorG != colorC) && (colorC == colorM))) {
|
|
product1 = colorA;
|
|
} else {
|
|
product1 = INTERPOLATE (colorA, colorC);
|
|
}
|
|
product2 = colorA;
|
|
} else if ((colorB == colorC) && (colorA != colorD)) {
|
|
if (((colorB == colorF) && (colorA == colorH)) ||
|
|
((colorB == colorE) && (colorB == colorD)
|
|
&& (colorA != colorF) && (colorA == colorI))) {
|
|
product = colorB;
|
|
} else {
|
|
product = INTERPOLATE (colorA, colorB);
|
|
}
|
|
|
|
if (((colorC == colorH) && (colorA == colorF)) ||
|
|
((colorC == colorG) && (colorC == colorD)
|
|
&& (colorA != colorH) && (colorA == colorI))) {
|
|
product1 = colorC;
|
|
} else {
|
|
product1 = INTERPOLATE (colorA, colorC);
|
|
}
|
|
product2 = colorB;
|
|
} else if ((colorA == colorD) && (colorB == colorC)) {
|
|
if (colorA == colorB) {
|
|
product = colorA;
|
|
product1 = colorA;
|
|
product2 = colorA;
|
|
} else {
|
|
register int r = 0;
|
|
|
|
product1 = INTERPOLATE (colorA, colorC);
|
|
product = INTERPOLATE (colorA, colorB);
|
|
|
|
r +=
|
|
GetResult1 (colorA, colorB, colorG, colorE,
|
|
colorI);
|
|
r +=
|
|
GetResult2 (colorB, colorA, colorK, colorF,
|
|
colorJ);
|
|
r +=
|
|
GetResult2 (colorB, colorA, colorH, colorN,
|
|
colorM);
|
|
r +=
|
|
GetResult1 (colorA, colorB, colorL, colorO,
|
|
colorP);
|
|
|
|
if (r > 0)
|
|
product2 = colorA;
|
|
else if (r < 0)
|
|
product2 = colorB;
|
|
else {
|
|
product2 =
|
|
Q_INTERPOLATE (colorA, colorB, colorC,
|
|
colorD);
|
|
}
|
|
}
|
|
} else {
|
|
product2 = Q_INTERPOLATE (colorA, colorB, colorC, colorD);
|
|
|
|
if ((colorA == colorC) && (colorA == colorF)
|
|
&& (colorB != colorE) && (colorB == colorJ)) {
|
|
product = colorA;
|
|
} else if ((colorB == colorE) && (colorB == colorD)
|
|
&& (colorA != colorF) && (colorA == colorI)) {
|
|
product = colorB;
|
|
} else {
|
|
product = INTERPOLATE (colorA, colorB);
|
|
}
|
|
|
|
if ((colorA == colorB) && (colorA == colorH)
|
|
&& (colorG != colorC) && (colorC == colorM)) {
|
|
product1 = colorA;
|
|
} else if ((colorC == colorG) && (colorC == colorD)
|
|
&& (colorA != colorH) && (colorA == colorI)) {
|
|
product1 = colorC;
|
|
} else {
|
|
product1 = INTERPOLATE (colorA, colorC);
|
|
}
|
|
}
|
|
|
|
#ifdef WORDS_BIGENDIAN
|
|
product = (colorA << 16) | product ;
|
|
product1 = (product1 << 16) | product2 ;
|
|
#else
|
|
product = colorA | (product << 16);
|
|
product1 = product1 | (product2 << 16);
|
|
#endif
|
|
*((int32_t *) dP) = product;
|
|
*((uint32_t *) (dP + dstPitch)) = product1;
|
|
|
|
bP += inc_bP;
|
|
dP += sizeof (uint32_t);
|
|
} // end of for ( finish= width etc..)
|
|
|
|
srcPtr += srcPitch;
|
|
dstPtr += dstPitch << 1;
|
|
deltaPtr += srcPitch;
|
|
} // endof: for (height; height; height--)
|
|
}
|
|
}
|
|
|
|
void _2xSaI32 (uint8_t *srcPtr, uint32_t srcPitch, uint8_t * /* deltaPtr */,
|
|
uint8_t *dstPtr, uint32_t dstPitch, int width, int height)
|
|
{
|
|
uint32_t *dP;
|
|
uint32_t *bP;
|
|
uint32_t inc_bP = 1;
|
|
|
|
uint32_t Nextline = srcPitch >> 2;
|
|
|
|
for (; height; height--) {
|
|
bP = (uint32_t *) srcPtr;
|
|
dP = (uint32_t *) dstPtr;
|
|
|
|
for (uint32_t finish = width; finish; finish -= inc_bP) {
|
|
register uint32_t colorA, colorB;
|
|
uint32_t colorC, colorD,
|
|
colorE, colorF, colorG, colorH,
|
|
colorI, colorJ, colorK, colorL,
|
|
|
|
colorM, colorN, colorO, colorP;
|
|
uint32_t product, product1, product2;
|
|
|
|
//---------------------------------------
|
|
// Map of the pixels: I|E F|J
|
|
// G|A B|K
|
|
// H|C D|L
|
|
// M|N O|P
|
|
colorI = *(bP - Nextline - 1);
|
|
colorE = *(bP - Nextline);
|
|
colorF = *(bP - Nextline + 1);
|
|
colorJ = *(bP - Nextline + 2);
|
|
|
|
colorG = *(bP - 1);
|
|
colorA = *(bP);
|
|
colorB = *(bP + 1);
|
|
colorK = *(bP + 2);
|
|
|
|
colorH = *(bP + Nextline - 1);
|
|
colorC = *(bP + Nextline);
|
|
colorD = *(bP + Nextline + 1);
|
|
colorL = *(bP + Nextline + 2);
|
|
|
|
colorM = *(bP + Nextline + Nextline - 1);
|
|
colorN = *(bP + Nextline + Nextline);
|
|
colorO = *(bP + Nextline + Nextline + 1);
|
|
colorP = *(bP + Nextline + Nextline + 2);
|
|
|
|
if ((colorA == colorD) && (colorB != colorC)) {
|
|
if (((colorA == colorE) && (colorB == colorL)) ||
|
|
((colorA == colorC) && (colorA == colorF)
|
|
&& (colorB != colorE) && (colorB == colorJ))) {
|
|
product = colorA;
|
|
} else {
|
|
product = INTERPOLATE (colorA, colorB);
|
|
}
|
|
|
|
if (((colorA == colorG) && (colorC == colorO)) ||
|
|
((colorA == colorB) && (colorA == colorH)
|
|
&& (colorG != colorC) && (colorC == colorM))) {
|
|
product1 = colorA;
|
|
} else {
|
|
product1 = INTERPOLATE (colorA, colorC);
|
|
}
|
|
product2 = colorA;
|
|
} else if ((colorB == colorC) && (colorA != colorD)) {
|
|
if (((colorB == colorF) && (colorA == colorH)) ||
|
|
((colorB == colorE) && (colorB == colorD)
|
|
&& (colorA != colorF) && (colorA == colorI))) {
|
|
product = colorB;
|
|
} else {
|
|
product = INTERPOLATE (colorA, colorB);
|
|
}
|
|
|
|
if (((colorC == colorH) && (colorA == colorF)) ||
|
|
((colorC == colorG) && (colorC == colorD)
|
|
&& (colorA != colorH) && (colorA == colorI))) {
|
|
product1 = colorC;
|
|
} else {
|
|
product1 = INTERPOLATE (colorA, colorC);
|
|
}
|
|
product2 = colorB;
|
|
} else if ((colorA == colorD) && (colorB == colorC)) {
|
|
if (colorA == colorB) {
|
|
product = colorA;
|
|
product1 = colorA;
|
|
product2 = colorA;
|
|
} else {
|
|
register int r = 0;
|
|
|
|
product1 = INTERPOLATE (colorA, colorC);
|
|
product = INTERPOLATE (colorA, colorB);
|
|
|
|
r +=
|
|
GetResult1 (colorA, colorB, colorG, colorE,
|
|
colorI);
|
|
r +=
|
|
GetResult2 (colorB, colorA, colorK, colorF,
|
|
colorJ);
|
|
r +=
|
|
GetResult2 (colorB, colorA, colorH, colorN,
|
|
colorM);
|
|
r +=
|
|
GetResult1 (colorA, colorB, colorL, colorO,
|
|
colorP);
|
|
|
|
if (r > 0)
|
|
product2 = colorA;
|
|
else if (r < 0)
|
|
product2 = colorB;
|
|
else {
|
|
product2 =
|
|
Q_INTERPOLATE (colorA, colorB, colorC,
|
|
colorD);
|
|
}
|
|
}
|
|
} else {
|
|
product2 = Q_INTERPOLATE (colorA, colorB, colorC, colorD);
|
|
|
|
if ((colorA == colorC) && (colorA == colorF)
|
|
&& (colorB != colorE) && (colorB == colorJ)) {
|
|
product = colorA;
|
|
} else if ((colorB == colorE) && (colorB == colorD)
|
|
&& (colorA != colorF) && (colorA == colorI)) {
|
|
product = colorB;
|
|
} else {
|
|
product = INTERPOLATE (colorA, colorB);
|
|
}
|
|
|
|
if ((colorA == colorB) && (colorA == colorH)
|
|
&& (colorG != colorC) && (colorC == colorM)) {
|
|
product1 = colorA;
|
|
} else if ((colorC == colorG) && (colorC == colorD)
|
|
&& (colorA != colorH) && (colorA == colorI)) {
|
|
product1 = colorC;
|
|
} else {
|
|
product1 = INTERPOLATE (colorA, colorC);
|
|
}
|
|
}
|
|
*(dP) = colorA;
|
|
*(dP + 1) = product;
|
|
*(dP + (dstPitch >> 2)) = product1;
|
|
*(dP + (dstPitch >> 2) + 1) = product2;
|
|
|
|
bP += inc_bP;
|
|
dP += 2;
|
|
} // end of for ( finish= width etc..)
|
|
|
|
srcPtr += srcPitch;
|
|
dstPtr += dstPitch << 1;
|
|
// deltaPtr += srcPitch;
|
|
} // endof: for (height; height; height--)
|
|
}
|
|
|
|
static uint32_t Bilinear (uint32_t A, uint32_t B, uint32_t x)
|
|
{
|
|
unsigned long areaA, areaB;
|
|
unsigned long result;
|
|
|
|
if (A == B)
|
|
return A;
|
|
|
|
areaB = (x >> 11) & 0x1f; // reduce 16 bit fraction to 5 bits
|
|
areaA = 0x20 - areaB;
|
|
|
|
A = (A & redblueMask) | ((A & greenMask) << 16);
|
|
B = (B & redblueMask) | ((B & greenMask) << 16);
|
|
|
|
result = ((areaA * A) + (areaB * B)) >> 5;
|
|
|
|
return (result & redblueMask) | ((result >> 16) & greenMask);
|
|
}
|
|
|
|
static uint32_t Bilinear4 (uint32_t A, uint32_t B, uint32_t C, uint32_t D, uint32_t x,
|
|
uint32_t y)
|
|
{
|
|
unsigned long areaA, areaB, areaC, areaD;
|
|
unsigned long result, xy;
|
|
|
|
x = (x >> 11) & 0x1f;
|
|
y = (y >> 11) & 0x1f;
|
|
xy = (x * y) >> 5;
|
|
|
|
A = (A & redblueMask) | ((A & greenMask) << 16);
|
|
B = (B & redblueMask) | ((B & greenMask) << 16);
|
|
C = (C & redblueMask) | ((C & greenMask) << 16);
|
|
D = (D & redblueMask) | ((D & greenMask) << 16);
|
|
|
|
areaA = 0x20 + xy - x - y;
|
|
areaB = x - xy;
|
|
areaC = y - xy;
|
|
areaD = xy;
|
|
|
|
result = ((areaA * A) + (areaB * B) + (areaC * C) + (areaD * D)) >> 5;
|
|
|
|
return (result & redblueMask) | ((result >> 16) & greenMask);
|
|
}
|
|
|
|
void Scale_2xSaI (uint8_t *srcPtr, uint32_t srcPitch, uint8_t * /* deltaPtr */,
|
|
uint8_t *dstPtr, uint32_t dstPitch,
|
|
uint32_t dstWidth, uint32_t dstHeight, int width, int height)
|
|
{
|
|
uint8_t *dP;
|
|
uint16_t *bP;
|
|
|
|
uint32_t w;
|
|
uint32_t h;
|
|
uint32_t dw;
|
|
uint32_t dh;
|
|
uint32_t hfinish;
|
|
uint32_t wfinish;
|
|
|
|
uint32_t Nextline = srcPitch >> 1;
|
|
|
|
wfinish = (width - 1) << 16; // convert to fixed point
|
|
dw = wfinish / (dstWidth - 1);
|
|
hfinish = (height - 1) << 16; // convert to fixed point
|
|
dh = hfinish / (dstHeight - 1);
|
|
|
|
for (h = 0; h < hfinish; h += dh) {
|
|
uint32_t y1, y2;
|
|
|
|
y1 = h & 0xffff; // fraction part of fixed point
|
|
bP = (uint16_t *) (srcPtr + ((h >> 16) * srcPitch));
|
|
dP = dstPtr;
|
|
y2 = 0x10000 - y1;
|
|
|
|
w = 0;
|
|
|
|
for (; w < wfinish;) {
|
|
uint32_t A, B, C, D;
|
|
uint32_t E, F, G, H;
|
|
uint32_t I, J, K, L;
|
|
uint32_t x1, x2, a1, f1, f2;
|
|
uint32_t position, product1;
|
|
|
|
position = w >> 16;
|
|
A = bP[position]; // current pixel
|
|
B = bP[position + 1]; // next pixel
|
|
C = bP[position + Nextline];
|
|
D = bP[position + Nextline + 1];
|
|
E = bP[position - Nextline];
|
|
F = bP[position - Nextline + 1];
|
|
G = bP[position - 1];
|
|
H = bP[position + Nextline - 1];
|
|
I = bP[position + 2];
|
|
J = bP[position + Nextline + 2];
|
|
K = bP[position + Nextline + Nextline];
|
|
L = bP[position + Nextline + Nextline + 1];
|
|
|
|
x1 = w & 0xffff; // fraction part of fixed point
|
|
x2 = 0x10000 - x1;
|
|
|
|
/*0*/
|
|
if (A == B && C == D && A == C)
|
|
product1 = A;
|
|
else /*1*/ if (A == D && B != C) {
|
|
f1 = (x1 >> 1) + (0x10000 >> 2);
|
|
f2 = (y1 >> 1) + (0x10000 >> 2);
|
|
if (y1 <= f1 && A == J && A != E) // close to B
|
|
{
|
|
a1 = f1 - y1;
|
|
product1 = Bilinear (A, B, a1);
|
|
} else if (y1 >= f1 && A == G && A != L) // close to C
|
|
{
|
|
a1 = y1 - f1;
|
|
product1 = Bilinear (A, C, a1);
|
|
}
|
|
else if (x1 >= f2 && A == E && A != J) // close to B
|
|
{
|
|
a1 = x1 - f2;
|
|
product1 = Bilinear (A, B, a1);
|
|
}
|
|
else if (x1 <= f2 && A == L && A != G) // close to C
|
|
{
|
|
a1 = f2 - x1;
|
|
product1 = Bilinear (A, C, a1);
|
|
}
|
|
else if (y1 >= x1) // close to C
|
|
{
|
|
a1 = y1 - x1;
|
|
product1 = Bilinear (A, C, a1);
|
|
}
|
|
else if (y1 <= x1) // close to B
|
|
{
|
|
a1 = x1 - y1;
|
|
product1 = Bilinear (A, B, a1);
|
|
}
|
|
}
|
|
else
|
|
/*2*/
|
|
if (B == C && A != D)
|
|
{
|
|
f1 = (x1 >> 1) + (0x10000 >> 2);
|
|
f2 = (y1 >> 1) + (0x10000 >> 2);
|
|
if (y2 >= f1 && B == H && B != F) // close to A
|
|
{
|
|
a1 = y2 - f1;
|
|
product1 = Bilinear (B, A, a1);
|
|
}
|
|
else if (y2 <= f1 && B == I && B != K) // close to D
|
|
{
|
|
a1 = f1 - y2;
|
|
product1 = Bilinear (B, D, a1);
|
|
}
|
|
else if (x2 >= f2 && B == F && B != H) // close to A
|
|
{
|
|
a1 = x2 - f2;
|
|
product1 = Bilinear (B, A, a1);
|
|
}
|
|
else if (x2 <= f2 && B == K && B != I) // close to D
|
|
{
|
|
a1 = f2 - x2;
|
|
product1 = Bilinear (B, D, a1);
|
|
}
|
|
else if (y2 >= x1) // close to A
|
|
{
|
|
a1 = y2 - x1;
|
|
product1 = Bilinear (B, A, a1);
|
|
}
|
|
else if (y2 <= x1) // close to D
|
|
{
|
|
a1 = x1 - y2;
|
|
product1 = Bilinear (B, D, a1);
|
|
}
|
|
}
|
|
/*3*/
|
|
else
|
|
{
|
|
product1 = Bilinear4 (A, B, C, D, x1, y1);
|
|
}
|
|
|
|
//end First Pixel
|
|
*(uint32_t *) dP = product1;
|
|
dP += 2;
|
|
w += dw;
|
|
}
|
|
dstPtr += dstPitch;
|
|
}
|
|
}
|