--- /dev/null
+/*
+Copyright (C) 2003 Rice1964
+
+This program is free software; you can redistribute it and/or
+modify it under the terms of the GNU General Public License
+as published by the Free Software Foundation; either version 2
+of the License, or (at your option) any later version.
+
+This program is distributed in the hope that it will be useful,
+but WITHOUT ANY WARRANTY; without even the implied warranty of
+MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
+GNU General Public License for more details.
+
+You should have received a copy of the GNU General Public License
+along with this program; if not, write to the Free Software
+Foundation, Inc., 59 Temple Place - Suite 330, Boston, MA 02111-1307, USA.
+
+*/
+
+#include "TextureFilters.h"
+
+
+/************************************************************************/
+/* 2xSAI filters */
+/************************************************************************/
+static __inline int SAI_GetResult1_32( uint32 A, uint32 B, uint32 C, uint32 D, uint32 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 uint16 SAI_GetResult1_16( uint16 A, uint16 B, uint16 C, uint16 D, uint16 E )
+{
+ uint16 x = 0;
+ uint16 y = 0;
+ uint16 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>0) r -= 1;
+
+ return r;
+}
+
+static __inline int SAI_GetResult2_32( uint32 A, uint32 B, uint32 C, uint32 D, uint32 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 uint16 SAI_GetResult2_16( uint16 A, uint16 B, uint16 C, uint16 D, uint16 E)
+{
+ uint16 x = 0;
+ uint16 y = 0;
+ uint16 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>0 ) r -= 1;
+ if (y <= 1) r += 1;
+
+ return r;
+}
+
+
+static __inline int SAI_GetResult_32( uint32 A, uint32 B, uint32 C, uint32 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 uint16 SAI_GetResult_16( uint16 A, uint16 B, uint16 C, uint16 D )
+{
+ uint16 x = 0;
+ uint16 y = 0;
+ uint16 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>0 ) r -= 1;
+
+ return r;
+}
+
+
+static __inline uint32 SAI_INTERPOLATE_32( uint32 A, uint32 B)
+{
+ if (A != B)
+ return ((A & 0xFEFEFEFE) >> 1) +
+ (((B & 0xFEFEFEFE) >> 1) |
+ (A & B & 0x01010101));
+ else
+ return A;
+}
+
+static __inline uint16 SAI_INTERPOLATE_16( uint16 A, uint16 B)
+{
+ if (A != B)
+ return ((A & 0xFEFE) >> 1) +
+ (((B & 0xFEFE) >> 1) |
+ (A & B & 0x0101));
+ else
+ return A;
+}
+
+
+static __inline uint32 SAI_Q_INTERPOLATE_32( uint32 A, uint32 B, uint32 C, uint32 D)
+{
+ uint32 x = ((A & 0xFCFCFCFC) >> 2) +
+ ((B & 0xFCFCFCFC) >> 2) +
+ ((C & 0xFCFCFCFC) >> 2) +
+ ((D & 0xFCFCFCFC) >> 2);
+ uint32 y = (((A & 0x03030303) +
+ (B & 0x03030303) +
+ (C & 0x03030303) +
+ (D & 0x03030303)) >> 2) & 0x03030303;
+ return x | y;
+}
+
+static __inline uint16 SAI_Q_INTERPOLATE_16( uint16 A, uint16 B, uint16 C, uint16 D)
+{
+ uint16 x = ((A & 0xFCFC) >> 2) +
+ ((B & 0xFCFC) >> 2) +
+ ((C & 0xFCFC) >> 2) +
+ ((D & 0xFCFC) >> 2);
+ uint16 y = (((A & 0x0303) +
+ (B & 0x0303) +
+ (C & 0x0303) +
+ (D & 0x0303)) >> 2) & 0x0303;
+ return x | y;
+}
+
+
+void Super2xSaI_32( uint32 *srcPtr, uint32 *destPtr, uint32 width, uint32 height, uint32 pitch)
+{
+ uint32 destWidth = width << 1;
+ //uint32 destHeight = height << 1;
+
+ uint32 color4, color5, color6;
+ uint32 color1, color2, color3;
+ uint32 colorA0, colorA1, colorA2, colorA3;
+ uint32 colorB0, colorB1, colorB2, colorB3;
+ uint32 colorS1, colorS2;
+ uint32 product1a, product1b, product2a, product2b;
+
+ int row0, row1, row2, row3;
+ int col0, col1, col2, col3;
+
+ for (uint16 y = 0; y < height; y++)
+ {
+ if (y > 0)
+ {
+ row0 = width;
+ row0 = -row0;
+ }
+ else
+ row0 = 0;
+
+ row1 = 0;
+
+ if (y < height - 1)
+ {
+ row2 = width;
+
+ if (y < height - 2)
+ row3 = width << 1;
+ else
+ row3 = width;
+ }
+ else
+ {
+ row2 = 0;
+ row3 = 0;
+ }
+
+ for (uint16 x = 0; x < width; x++)
+ {
+ //--------------------------------------- B0 B1 B2 B3
+ // 4 5 6 S2
+ // 1 2 3 S1
+ // A0 A1 A2 A3
+ if (x > 0)
+ col0 = -1;
+ else
+ col0 = 0;
+
+ col1 = 0;
+
+ if (x < width - 1)
+ {
+ col2 = 1;
+
+ if (x < width - 2)
+ col3 = 2;
+ else
+ col3 = 1;
+ }
+ else
+ {
+ col2 = 0;
+ col3 = 0;
+ }
+
+ colorB0 = *(srcPtr + col0 + row0);
+ colorB1 = *(srcPtr + col1 + row0);
+ colorB2 = *(srcPtr + col2 + row0);
+ colorB3 = *(srcPtr + col3 + row0);
+
+ color4 = *(srcPtr + col0 + row1);
+ color5 = *(srcPtr + col1 + row1);
+ color6 = *(srcPtr + col2 + row1);
+ colorS2 = *(srcPtr + col3 + row1);
+
+ color1 = *(srcPtr + col0 + row2);
+ color2 = *(srcPtr + col1 + row2);
+ color3 = *(srcPtr + col2 + row2);
+ colorS1 = *(srcPtr + col3 + row2);
+
+ colorA0 = *(srcPtr + col0 + row3);
+ colorA1 = *(srcPtr + col1 + row3);
+ colorA2 = *(srcPtr + col2 + row3);
+ colorA3 = *(srcPtr + col3 + row3);
+
+ //--------------------------------------
+ if (color2 == color6 && color5 != color3)
+ product2b = product1b = color2;
+ else if (color5 == color3 && color2 != color6)
+ product2b = product1b = color5;
+ else if (color5 == color3 && color2 == color6)
+ {
+ int r = 0;
+
+ r += SAI_GetResult_32 (color6, color5, color1, colorA1);
+ r += SAI_GetResult_32 (color6, color5, color4, colorB1);
+ r += SAI_GetResult_32 (color6, color5, colorA2, colorS1);
+ r += SAI_GetResult_32 (color6, color5, colorB2, colorS2);
+
+ if (r > 0)
+ product2b = product1b = color6;
+ else if (r < 0)
+ product2b = product1b = color5;
+ else
+ product2b = product1b = SAI_INTERPOLATE_32 (color5, color6);
+ }
+ else
+ {
+
+ if (color6 == color3 && color3 == colorA1 && color2 != colorA2 && color3 != colorA0)
+ product2b = SAI_Q_INTERPOLATE_32 (color3, color3, color3, color2);
+ else if (color5 == color2 && color2 == colorA2 && colorA1 != color3 && color2 != colorA3)
+ product2b = SAI_Q_INTERPOLATE_32 (color2, color2, color2, color3);
+ else
+ product2b = SAI_INTERPOLATE_32 (color2, color3);
+
+ if (color6 == color3 && color6 == colorB1 && color5 != colorB2 && color6 != colorB0)
+ product1b = SAI_Q_INTERPOLATE_32 (color6, color6, color6, color5);
+ else if (color5 == color2 && color5 == colorB2 && colorB1 != color6 && color5 != colorB3)
+ product1b = SAI_Q_INTERPOLATE_32 (color6, color5, color5, color5);
+ else
+ product1b = SAI_INTERPOLATE_32 (color5, color6);
+ }
+
+ if (color5 == color3 && color2 != color6 && color4 == color5 && color5 != colorA2)
+ product2a = SAI_INTERPOLATE_32 (color2, color5);
+ else if (color5 == color1 && color6 == color5 && color4 != color2 && color5 != colorA0)
+ product2a = SAI_INTERPOLATE_32(color2, color5);
+ else
+ product2a = color2;
+
+ if (color2 == color6 && color5 != color3 && color1 == color2 && color2 != colorB2)
+ product1a = SAI_INTERPOLATE_32 (color2, color5);
+ else if (color4 == color2 && color3 == color2 && color1 != color5 && color2 != colorB0)
+ product1a = SAI_INTERPOLATE_32(color2, color5);
+ else
+ product1a = color5;
+
+
+ destPtr[0] = product1a;
+ destPtr[1] = product1b;
+ destPtr[destWidth] = product2a;
+ destPtr[destWidth + 1] = product2b;
+
+ srcPtr++;
+ destPtr += 2;
+ }
+ srcPtr += (pitch-width);
+ destPtr += (((pitch-width)<<1)+(pitch<<1));
+ }
+}
+
+
+void Super2xSaI_16( uint16 *srcPtr, uint16 *destPtr, uint32 width, uint32 height, uint32 pitch)
+{
+ uint32 destWidth = width << 1;
+ //uint32 destHeight = height << 1;
+
+ uint16 color4, color5, color6;
+ uint16 color1, color2, color3;
+ uint16 colorA0, colorA1, colorA2, colorA3;
+ uint16 colorB0, colorB1, colorB2, colorB3;
+ uint16 colorS1, colorS2;
+ uint16 product1a, product1b, product2a, product2b;
+
+ int row0, row1, row2, row3;
+ int col0, col1, col2, col3;
+
+ for (uint16 y = 0; y < height; y++)
+ {
+ if (y > 0)
+ {
+ row0 = width;
+ row0 = -row0;
+ }
+ else
+ row0 = 0;
+
+ row1 = 0;
+
+ if (y < height - 1)
+ {
+ row2 = width;
+
+ if (y < height - 2)
+ row3 = width << 1;
+ else
+ row3 = width;
+ }
+ else
+ {
+ row2 = 0;
+ row3 = 0;
+ }
+
+ for (uint16 x = 0; x < width; x++)
+ {
+ //--------------------------------------- B0 B1 B2 B3
+ // 4 5 6 S2
+ // 1 2 3 S1
+ // A0 A1 A2 A3
+ if (x > 0)
+ col0 = -1;
+ else
+ col0 = 0;
+
+ col1 = 0;
+
+ if (x < width - 1)
+ {
+ col2 = 1;
+
+ if (x < width - 2)
+ col3 = 2;
+ else
+ col3 = 1;
+ }
+ else
+ {
+ col2 = 0;
+ col3 = 0;
+ }
+
+ colorB0 = *(srcPtr + col0 + row0);
+ colorB1 = *(srcPtr + col1 + row0);
+ colorB2 = *(srcPtr + col2 + row0);
+ colorB3 = *(srcPtr + col3 + row0);
+
+ color4 = *(srcPtr + col0 + row1);
+ color5 = *(srcPtr + col1 + row1);
+ color6 = *(srcPtr + col2 + row1);
+ colorS2 = *(srcPtr + col3 + row1);
+
+ color1 = *(srcPtr + col0 + row2);
+ color2 = *(srcPtr + col1 + row2);
+ color3 = *(srcPtr + col2 + row2);
+ colorS1 = *(srcPtr + col3 + row2);
+
+ colorA0 = *(srcPtr + col0 + row3);
+ colorA1 = *(srcPtr + col1 + row3);
+ colorA2 = *(srcPtr + col2 + row3);
+ colorA3 = *(srcPtr + col3 + row3);
+
+ //--------------------------------------
+ if (color2 == color6 && color5 != color3)
+ product2b = product1b = color2;
+ else if (color5 == color3 && color2 != color6)
+ product2b = product1b = color5;
+ else if (color5 == color3 && color2 == color6)
+ {
+ int r = 0;
+
+ r += SAI_GetResult_16 (color6, color5, color1, colorA1);
+ r += SAI_GetResult_16 (color6, color5, color4, colorB1);
+ r += SAI_GetResult_16 (color6, color5, colorA2, colorS1);
+ r += SAI_GetResult_16 (color6, color5, colorB2, colorS2);
+
+ if (r > 0)
+ product2b = product1b = color6;
+ else if (r < 0)
+ product2b = product1b = color5;
+ else
+ product2b = product1b = SAI_INTERPOLATE_16 (color5, color6);
+ }
+ else
+ {
+
+ if (color6 == color3 && color3 == colorA1 && color2 != colorA2 && color3 != colorA0)
+ product2b = SAI_Q_INTERPOLATE_16 (color3, color3, color3, color2);
+ else if (color5 == color2 && color2 == colorA2 && colorA1 != color3 && color2 != colorA3)
+ product2b = SAI_Q_INTERPOLATE_16 (color2, color2, color2, color3);
+ else
+ product2b = SAI_INTERPOLATE_16 (color2, color3);
+
+ if (color6 == color3 && color6 == colorB1 && color5 != colorB2 && color6 != colorB0)
+ product1b = SAI_Q_INTERPOLATE_16 (color6, color6, color6, color5);
+ else if (color5 == color2 && color5 == colorB2 && colorB1 != color6 && color5 != colorB3)
+ product1b = SAI_Q_INTERPOLATE_16 (color6, color5, color5, color5);
+ else
+ product1b = SAI_INTERPOLATE_16 (color5, color6);
+ }
+
+ if (color5 == color3 && color2 != color6 && color4 == color5 && color5 != colorA2)
+ product2a = SAI_INTERPOLATE_16 (color2, color5);
+ else if (color5 == color1 && color6 == color5 && color4 != color2 && color5 != colorA0)
+ product2a = SAI_INTERPOLATE_16(color2, color5);
+ else
+ product2a = color2;
+
+ if (color2 == color6 && color5 != color3 && color1 == color2 && color2 != colorB2)
+ product1a = SAI_INTERPOLATE_16 (color2, color5);
+ else if (color4 == color2 && color3 == color2 && color1 != color5 && color2 != colorB0)
+ product1a = SAI_INTERPOLATE_16(color2, color5);
+ else
+ product1a = color5;
+
+
+ destPtr[0] = product1a;
+ destPtr[1] = product1b;
+ destPtr[destWidth] = product2a;
+ destPtr[destWidth + 1] = product2b;
+
+ srcPtr++;
+ destPtr += 2;
+ }
+ srcPtr += (pitch-width);
+ destPtr += (((pitch-width)<<1)+(pitch<<1));
+ }
+}
+