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; } }