/* ScummVM - Scumm Interpreter
 * Copyright (C) 2001  Ludvig Strigeus
 * Copyright (C) 2001-2003 The ScummVM project
 *
 * 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.
 *
 * $Header$
 *
 */

#include "stdafx.h"
#include "scummsys.h"
#include "scaler.h"

/********** 2XSAI Filter *****************/
static uint32 colorMask = 0xF7DEF7DE;
static uint32 lowPixelMask = 0x08210821;
static uint32 qcolorMask = 0xE79CE79C;
static uint32 qlowpixelMask = 0x18631863;
static uint32 redblueMask = 0xF81F;
static uint32 greenMask = 0x7E0;

static const uint16 dotmatrix_565[16] = {
	0x01E0, 0x0007, 0x3800, 0x0000,
	0x39E7, 0x0000, 0x39E7, 0x0000,
	0x3800, 0x0000, 0x01E0, 0x0007,
	0x39E7, 0x0000, 0x39E7, 0x0000
};
static const uint16 dotmatrix_555[16] = {
	0x00E0, 0x0007, 0x1C00, 0x0000,
	0x1CE7, 0x0000, 0x1CE7, 0x0000,
	0x1C00, 0x0000, 0x00E0, 0x0007,
	0x1CE7, 0x0000, 0x1CE7, 0x0000
};
static const uint16 *dotmatrix;

int Init_2xSaI(uint32 BitFormat) {
	if (BitFormat == 565) {
		colorMask = 0xF7DEF7DE;
		lowPixelMask = 0x08210821;
		qcolorMask = 0xE79CE79C;
		qlowpixelMask = 0x18631863;
		redblueMask = 0xF81F;
		greenMask = 0x7E0;
		dotmatrix = dotmatrix_565;
	} else if (BitFormat == 555) {
		colorMask = 0x7BDE7BDE;
		lowPixelMask = 0x04210421;
		qcolorMask = 0x739C739C;
		qlowpixelMask = 0x0C630C63;
		redblueMask = 0x7C1F;
		greenMask = 0x3E0;
		dotmatrix = dotmatrix_555;
	} else {
		return 0;
	}

	return 1;
}

static inline int GetResult1(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 int GetResult2(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 int GetResult(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 uint32 INTERPOLATE(uint32 A, uint32 B) {
	if (A != B) {
		return (((A & colorMask) >> 1) + ((B & colorMask) >> 1) + (A & B & lowPixelMask));
	} else
		return A;
}

static inline uint32 Q_INTERPOLATE(uint32 A, uint32 B, uint32 C, uint32 D) {
	register uint32 x = ((A & qcolorMask) >> 2) +
		((B & qcolorMask) >> 2) + ((C & qcolorMask) >> 2) + ((D & qcolorMask) >> 2);
	register uint32 y = (A & qlowpixelMask) +
		(B & qlowpixelMask) + (C & qlowpixelMask) + (D & qlowpixelMask);

	y = (y >> 2) & qlowpixelMask;
	return x + y;
}

#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 *srcPtr, uint32 srcPitch, uint8 *dstPtr, uint32 dstPitch, int width, int height) {
	uint16 *bP;
	uint8 *dP;
	uint32 inc_bP;

	{
		uint32 Nextline = srcPitch >> 1;
		inc_bP = 1;

		while (height--) {
			bP = (uint16 *)srcPtr;
			dP = (uint8 *)dstPtr;

			for (uint32 finish = width; finish; finish -= inc_bP) {
				uint32 color4, color5, color6;
				uint32 color1, color2, color3;
				uint32 colorA0, colorA1, colorA2, colorA3, colorB0, colorB1, colorB2, colorB3, colorS1, colorS2;
				uint32 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 SCUMM_LITTLE_ENDIAN
				product1a = product1a | (product1b << 16);
				product2a = product2a | (product2b << 16);
#endif

#ifdef SCUMM_BIG_ENDIAN
				product1a = product1b | (product1a << 16);
				product2a = product2b | (product2a << 16);
#endif
				*((uint32 *)dP) = product1a;
				*((uint32 *)(dP + dstPitch)) = product2a;

				bP += inc_bP;
				dP += sizeof(uint32);
			}													// end of for ( finish= width etc..)

			srcPtr += srcPitch;
			dstPtr += dstPitch * 2;
		}														// while (height--)
	}
}

void SuperEagle(uint8 *srcPtr, uint32 srcPitch, uint8 *dstPtr, uint32 dstPitch, int width, int height) {
	uint8 *dP;
	uint16 *bP;
	uint32 inc_bP;

	{
		inc_bP = 1;

		uint32 Nextline = srcPitch >> 1;

		while (height--) {
			bP = (uint16 *)srcPtr;
			dP = dstPtr;
			for (uint32 finish = width; finish; finish -= inc_bP) {
				uint32 color4, color5, color6;
				uint32 color1, color2, color3;
				uint32 colorA1, colorA2, colorB1, colorB2, colorS1, colorS2;
				uint32 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);
					} else {
						product1a = INTERPOLATE(color5, color6);
					}

					if ((color6 == colorS2) || (color2 == colorA1)) {
						product2b = INTERPOLATE(color2, color3);
						product2b = INTERPOLATE(color2, product2b);
					} 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);
					} else {
						product1b = INTERPOLATE(color5, color6);
					}

					if ((color3 == colorA2) || (color4 == color5)) {
						product2a = INTERPOLATE(color5, color2);
						product2a = INTERPOLATE(color5, product2a);
					} 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);
				}
#ifdef SCUMM_LITTLE_ENDIAN
				product1a = product1a | (product1b << 16);
				product2a = product2a | (product2b << 16);
#endif

#ifdef SCUMM_BIG_ENDIAN
				product1a = product1b | (product1a << 16);
				product2a = product2b | (product2a << 16);
#endif
				*((uint32 *)dP) = product1a;
				*((uint32 *)(dP + dstPitch)) = product2a;

				bP += inc_bP;
				dP += sizeof(uint32);
			}													// end of for ( finish= width etc..)

			srcPtr += srcPitch;
			dstPtr += dstPitch * 2;
		}														// endof: while (height--)
	}
}

void _2xSaI(uint8 *srcPtr, uint32 srcPitch, uint8 *dstPtr, uint32 dstPitch, int width, int height) {
	uint8 *dP;
	uint16 *bP;
	uint32 inc_bP;

	{
		inc_bP = 1;

		uint32 Nextline = srcPitch >> 1;

		while (height--) {
			bP = (uint16 *)srcPtr;
			dP = dstPtr;

			for (uint32 finish = width; finish; finish -= inc_bP) {

				register uint32 colorA, colorB;
				uint32 colorC, colorD,
					colorE, colorF, colorG, colorH, colorI, colorJ, colorK, colorL, colorM, colorN, colorO, colorP;
				uint32 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 SCUMM_LITTLE_ENDIAN
				product = colorA | (product << 16);
				product1 = product1 | (product2 << 16);
#endif

#ifdef SCUMM_BIG_ENDIAN
				product = (colorA << 16) | product;
				product1 = (product1 << 16) | product2;
#endif
				*((int32 *)dP) = product;
				*((uint32 *)(dP + dstPitch)) = product1;

				bP += inc_bP;
				dP += sizeof(uint32);
			}													// end of for ( finish= width etc..)

			srcPtr += srcPitch;
			dstPtr += dstPitch * 2;
		}														// endof: while (height--)
	}
}

static uint32 Bilinear(uint32 A, uint32 B, uint32 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 Bilinear4(uint32 A, uint32 B, uint32 C, uint32 D, uint32 x, uint32 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);
}

// FIXME: Scale_2xSaI is not used anywhere; however, contrary to the _2xSaI function,
// it seems to allow for arbitrary scale factors, not just 2x... hence I leave this in
// for now, as that seems to be a very useful feature
void Scale_2xSaI(uint8 *srcPtr, uint32 srcPitch, uint8 *dstPtr, uint32 dstPitch,
								 uint32 dstWidth, uint32 dstHeight, int width, int height) {
	uint8 *dP;
	uint16 *bP;

	uint32 w;
	uint32 h;
	uint32 dw;
	uint32 dh;
	uint32 hfinish;
	uint32 wfinish;

	uint32 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 y1, y2;

		y1 = h & 0xffff;						// fraction part of fixed point
		bP = (uint16 *)(srcPtr + ((h >> 16) * srcPitch));
		dP = dstPtr;
		y2 = 0x10000 - y1;

		w = 0;

		for (; w < wfinish;) {
			uint32 A, B, C, D;
			uint32 E, F, G, H;
			uint32 I, J, K, L;
			uint32 x1, x2, a1, f1, f2;
			uint32 position, product1 = 0;

			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 *)dP = product1;
			dP += 2;
			w += dw;
		}
		dstPtr += dstPitch;
	}
}

void AdvMame2x(uint8 *srcPtr, uint32 srcPitch, uint8 *dstPtr, uint32 dstPitch,
							 int width, int height) {
	unsigned int nextlineSrc = srcPitch / sizeof(uint16);
	uint16 *p = (uint16 *)srcPtr;

	unsigned int nextlineDst = dstPitch / sizeof(uint16);
	uint16 *q = (uint16 *)dstPtr;
	
	uint16 A, B, C;
	uint16 D, E, F;
	uint16 G, H, I;

	while (height--) {
		B = *(p - 1 - nextlineSrc);
		E = *(p - 1);
		H = *(p - 1 + nextlineSrc);
		C = *(p - nextlineSrc);
		F = *(p);
		I = *(p + nextlineSrc);
		for (int i = 0; i < width; ++i) {
			p++;
			A = B; B = C; C = *(p - nextlineSrc);
			D = E; E = F; F = *(p);
			G = H; H = I; I = *(p + nextlineSrc);

			*(q) = D == B && B != F && D != H ? D : E;
			*(q + 1) = B == F && B != D && F != H ? F : E;
			*(q + nextlineDst) = D == H && D != B && H != F ? D : E;
			*(q + nextlineDst + 1) = H == F && D != H && B != F ? F : E;
			q += 2;
		}
		p += nextlineSrc - width;
		q += (nextlineDst - width) << 1;
	}
}

void AdvMame3x(uint8 *srcPtr, uint32 srcPitch, uint8 *dstPtr, uint32 dstPitch,
							 int width, int height) {
	unsigned int nextlineSrc = srcPitch / sizeof(uint16);
	uint16 *p = (uint16 *)srcPtr;

	unsigned int nextlineDst = dstPitch / sizeof(uint16);
	uint16 *q = (uint16 *)dstPtr;
	
	uint16 A, B, C;
	uint16 D, E, F;
	uint16 G, H, I;

	while (height--) {
		B = *(p - 1 - nextlineSrc);
		E = *(p - 1);
		H = *(p - 1 + nextlineSrc);
		C = *(p - nextlineSrc);
		F = *(p);
		I = *(p + nextlineSrc);
		for (int i = 0; i < width; ++i) {
			p++;
			A = B; B = C; C = *(p - nextlineSrc);
			D = E; E = F; F = *(p);
			G = H; H = I; I = *(p + nextlineSrc);

			*(q) = D == B && B != F && D != H ? D : E;
			*(q + 1) = E;
			*(q + 2) = B == F && B != D && F != H ? F : E;
			*(q + nextlineDst) = E;
			*(q + nextlineDst + 1) = E;
			*(q + nextlineDst + 2) = E;
			*(q + 2 * nextlineDst) = D == H && D != B && H != F ? D : E;
			*(q + 2 * nextlineDst + 1) = E;
			*(q + 2 * nextlineDst + 2) = H == F && D != H && B != F ? F : E;
			q += 3;
		}
		p += nextlineSrc - width;
		q += (nextlineDst - width) * 3;
	}
}

void Normal1x(uint8 *srcPtr, uint32 srcPitch, uint8 *dstPtr, uint32 dstPitch,
							int width, int height) {
	while (height--) {
		memcpy(dstPtr, srcPtr, 2 * width);
		srcPtr += srcPitch;
		dstPtr += dstPitch;
	}
}

void Normal2x(uint8 *srcPtr, uint32 srcPitch, uint8 *dstPtr, uint32 dstPitch,
							int width, int height) {
	uint8 *r;

	while (height--) {
		r = dstPtr;
		for (int i = 0; i < width; ++i, r += 4) {
			uint16 color = *(((uint16 *)srcPtr) + i);

			*(uint16 *)(r + 0) = color;
			*(uint16 *)(r + 2) = color;
			*(uint16 *)(r + 0 + dstPitch) = color;
			*(uint16 *)(r + 2 + dstPitch) = color;
		}
		srcPtr += srcPitch;
		dstPtr += dstPitch << 1;
	}
}

void Normal3x(uint8 *srcPtr, uint32 srcPitch, uint8 *dstPtr, uint32 dstPitch,
							int width, int height) {
	uint8 *r;
	uint32 dstPitch2 = dstPitch * 2;
	uint32 dstPitch3 = dstPitch * 3;

	while (height--) {
		r = dstPtr;
		for (int i = 0; i < width; ++i, r += 6) {
			uint16 color = *(((uint16 *)srcPtr) + i);

			*(uint16 *)(r + 0) = color;
			*(uint16 *)(r + 2) = color;
			*(uint16 *)(r + 4) = color;
			*(uint16 *)(r + 0 + dstPitch) = color;
			*(uint16 *)(r + 2 + dstPitch) = color;
			*(uint16 *)(r + 4 + dstPitch) = color;
			*(uint16 *)(r + 0 + dstPitch2) = color;
			*(uint16 *)(r + 2 + dstPitch2) = color;
			*(uint16 *)(r + 4 + dstPitch2) = color;
		}
		srcPtr += srcPitch;
		dstPtr += dstPitch3;
	}
}

void TV2x(uint8 *srcPtr, uint32 srcPitch, uint8 *dstPtr, uint32 dstPitch, 
					int width, int height) {
	unsigned int nextlineSrc = srcPitch / sizeof(uint16);
	uint16 *p = (uint16 *)srcPtr;

	unsigned int nextlineDst = dstPitch / sizeof(uint16);
	uint16 *q = (uint16 *)dstPtr;

	while(height--) {
		for (int i = 0, j = 0; i < width; ++i, j += 2) {
			uint16 p1 = *(p + i);
			uint32 pi;

			pi = (((p1 & redblueMask) * 7) >> 3) & redblueMask;
			pi |= (((p1 & greenMask) * 7) >> 3) & greenMask;

			*(q + j) = p1;
			*(q + j + 1) = p1;
			*(q + j + nextlineDst) = (uint16)pi;
			*(q + j + nextlineDst + 1) = (uint16)pi;
		}
		p += nextlineSrc;
		q += nextlineDst << 1;
	}
}

static inline uint16 DOT_16(uint16 c, int j, int i) {
  return c - ((c >> 2) & *(dotmatrix + ((j & 3) << 2) + (i & 3)));
}

void DotMatrix(uint8 *srcPtr, uint32 srcPitch, uint8 *dstPtr, uint32 dstPitch,
					int width, int height)
{
	unsigned int nextlineSrc = srcPitch / sizeof(uint16);
	uint16 *p = (uint16 *)srcPtr;

	unsigned int nextlineDst = dstPitch / sizeof(uint16);
	uint16 *q = (uint16 *)dstPtr;

	for (int j = 0, jj = 0; j < height; ++j, jj += 2) {
		for (int i = 0, ii = 0; i < width; ++i, ii += 2) {
			uint16 c = *(p + i);
			*(q + ii) = DOT_16(c, jj, ii);
			*(q + ii + 1) = DOT_16(c, jj, ii + 1);
			*(q + ii + nextlineDst) = DOT_16(c, jj + 1, ii);
			*(q + ii + nextlineDst + 1) = DOT_16(c, jj + 1, ii + 1);
		}
		p += nextlineSrc;
		q += nextlineDst << 1;
	}
}