/*
* Glide64 - Glide video plugin for Nintendo 64 emulators.
* Copyright (c) 2002  Dave2001
* Copyright (c) 2003-2009  Sergey 'Gonetz' Lipski
*
* 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
* 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
*/

//****************************************************************
//
// Glide64 - Glide Plugin for Nintendo 64 emulators
// Project started on December 29th, 2001
//
// Authors:
// Dave2001, original author, founded the project in 2001, left it in 2002
// Gugaman, joined the project in 2002, left it in 2002
// Sergey 'Gonetz' Lipski, joined the project in 2002, main author since fall of 2002
// Hiroshi 'KoolSmoky' Morii, joined the project in 2007
//
//****************************************************************
//
// To modify Glide64:
// * Write your name and (optional)email, commented by your work, so I know who did it, and so that you can find which parts you modified when it comes time to send it to me.
// * Do NOT send me the whole project or file that you modified.  Take out your modified code sections, and tell me where to put them.  If people sent the whole thing, I would have many different versions, but no idea how to combine them all.
//
//****************************************************************

static void mod_tex_inter_color_using_factor (uint16_t *dst, int size, uint32_t color, uint32_t factor)
{
	float percent = factor / 255.0f;
	float percent_i = 1 - percent;
	uint32_t cr, cg, cb;
	uint16_t col, a;
	uint8_t r, g, b;

	cr = (color >> 12) & 0xF;
	cg = (color >> 8) & 0xF;
	cb = (color >> 4) & 0xF;

	for (int i=0; i<size; i++)
	{
		col = *dst;
		a = col & 0xF000;
		r = (uint8_t)(percent_i * ((col >> 8) & 0xF) + percent * cr);
		g = (uint8_t)(percent_i * ((col >> 4) & 0xF) + percent * cg);
		b = (uint8_t)(percent_i * (col & 0xF) + percent * cb);
		*(dst++) = a | (r << 8) | (g << 4) | b;
	}
}

static void mod_tex_inter_col_using_col1 (uint16_t *dst, int size, uint32_t color0, uint32_t color1)
{
	uint32_t cr, cg, cb;
	uint16_t col, a;
	uint8_t r, g, b;

	float percent_r = ((color1 >> 12) & 0xF) / 15.0f;
	float percent_g = ((color1 >> 8) & 0xF) / 15.0f;
	float percent_b = ((color1 >> 4) & 0xF) / 15.0f;
	float percent_r_i = 1.0f - percent_r;
	float percent_g_i = 1.0f - percent_g;
	float percent_b_i = 1.0f - percent_b;

	cr = (color0 >> 12) & 0xF;
	cg = (color0 >> 8) & 0xF;
	cb = (color0 >> 4) & 0xF;

	for (int i=0; i<size; i++)
	{
		col = *dst;
		a = col & 0xF000;
		r = (uint8_t)(percent_r_i * ((col >> 8) & 0xF) + percent_r * cr);
		g = (uint8_t)(percent_g_i * ((col >> 4) & 0xF) + percent_g * cg);
		b = (uint8_t)(percent_b_i * (col & 0xF) + percent_b * cb);
		*(dst++) = a | (r << 8) | (g << 4) | b;
	}
}

static void mod_full_color_sub_tex (uint16_t *dst, int size, uint32_t color)
{
	uint32_t cr, cg, cb, ca;
	uint16_t col;
	uint8_t a, r, g, b;

	cr = (color >> 12) & 0xF;
	cg = (color >> 8) & 0xF;
	cb = (color >> 4) & 0xF;
	ca = color & 0xF;

	for (int i=0; i<size; i++)
	{
		col = *dst;
		a = (uint8_t)(ca - ((col >> 12) & 0xF));
		r = (uint8_t)(cr - ((col >> 8) & 0xF));
		g = (uint8_t)(cg - ((col >> 4) & 0xF));
		b = (uint8_t)(cb - (col & 0xF));
		*(dst++) = (a << 12) | (r << 8) | (g << 4) | b;
	}
}

static void mod_col_inter_col1_using_tex (uint16_t *dst, int size, uint32_t color0, uint32_t color1)
{
	uint32_t cr0, cg0, cb0, cr1, cg1, cb1;
	uint16_t col;
	uint8_t r, g, b;
	uint16_t a;
	float percent_r, percent_g, percent_b;

	cr0 = (color0 >> 12) & 0xF;
	cg0 = (color0 >> 8) & 0xF;
	cb0 = (color0 >> 4) & 0xF;
	cr1 = (color1 >> 12) & 0xF;
	cg1 = (color1 >> 8) & 0xF;
	cb1 = (color1 >> 4) & 0xF;

	for (int i=0; i<size; i++)
	{
		col = *dst;
		a = col & 0xF000;
		percent_r = ((col >> 8) & 0xF) / 15.0f;
		percent_g = ((col >> 4) & 0xF) / 15.0f;
		percent_b = (col & 0xF) / 15.0f;
		r = min(15, (uint8_t)((1.0f-percent_r) * cr0 + percent_r * cr1 + 0.0001f));
		g = min(15, (uint8_t)((1.0f-percent_g) * cg0 + percent_g * cg1 + 0.0001f));
		b = min(15, (uint8_t)((1.0f-percent_b) * cb0 + percent_b * cb1 + 0.0001f));
		*(dst++) = a | (r << 8) | (g << 4) | b;
	}
}

static void mod_col_inter_col1_using_texa (uint16_t *dst, int size, uint32_t color0, uint32_t color1)
{
	uint32_t cr0, cg0, cb0, cr1, cg1, cb1;
	uint16_t col;
	uint8_t r, g, b;
	uint16_t a;
	float percent, percent_i;

	cr0 = (color0 >> 12) & 0xF;
	cg0 = (color0 >> 8) & 0xF;
	cb0 = (color0 >> 4) & 0xF;
	cr1 = (color1 >> 12) & 0xF;
	cg1 = (color1 >> 8) & 0xF;
	cb1 = (color1 >> 4) & 0xF;

	for (int i=0; i<size; i++)
	{
		col = *dst;
		a = col & 0xF000;
		percent = (a >> 12) / 15.0f;
		percent_i = 1.0f - percent;
		r = (uint8_t)(percent_i * cr0 + percent * cr1);
		g = (uint8_t)(percent_i * cg0 + percent * cg1);
		b = (uint8_t)(percent_i * cb0 + percent * cb1);
		*(dst++) = a | (r << 8) | (g << 4) | b;
	}
}

static void mod_col_inter_col1_using_texa__mul_tex (uint16_t *dst, int size, uint32_t color0, uint32_t color1)
{
	uint32_t cr0, cg0, cb0, cr1, cg1, cb1;
	uint16_t col;
	uint8_t r, g, b;
	uint16_t a;
	float percent, percent_i;

	cr0 = (color0 >> 12) & 0xF;
	cg0 = (color0 >> 8) & 0xF;
	cb0 = (color0 >> 4) & 0xF;
	cr1 = (color1 >> 12) & 0xF;
	cg1 = (color1 >> 8) & 0xF;
	cb1 = (color1 >> 4) & 0xF;

	for (int i=0; i<size; i++)
	{
		col = *dst;
		a = col & 0xF000;
		percent = (a >> 12) / 15.0f;
		percent_i = 1.0f - percent;
		r = (uint8_t)(((percent_i * cr0 + percent * cr1) / 15.0f) * (((col & 0x0F00) >> 8) / 15.0f) * 15.0f);
		g = (uint8_t)(((percent_i * cg0 + percent * cg1) / 15.0f) * (((col & 0x00F0) >> 4) / 15.0f) * 15.0f);
		b = (uint8_t)(((percent_i * cb0 + percent * cb1) / 15.0f) * ((col & 0x000F) / 15.0f) * 15.0f);
		*(dst++) = a | (r << 8) | (g << 4) | b;
	}
}

static void mod_col_inter_tex_using_tex (uint16_t *dst, int size, uint32_t color)
{
	uint32_t cr, cg, cb;
	uint16_t col;
	uint8_t r, g, b;
	uint16_t a;
	float percent_r, percent_g, percent_b;

	cr = (color >> 12) & 0xF;
	cg = (color >> 8) & 0xF;
	cb = (color >> 4) & 0xF;

	for (int i=0; i<size; i++)
	{
		col = *dst;
		a = col & 0xF000;
		percent_r = ((col >> 8) & 0xF) / 15.0f;
		percent_g = ((col >> 4) & 0xF) / 15.0f;
		percent_b = (col & 0xF) / 15.0f;
		r = (uint8_t)((1.0f-percent_r) * cr + percent_r * ((col & 0x0F00) >> 8));
		g = (uint8_t)((1.0f-percent_g) * cg + percent_g * ((col & 0x00F0) >> 4));
		b = (uint8_t)((1.0f-percent_b) * cb + percent_b * (col & 0x000F));       
		*(dst++) = a | (r << 8) | (g << 4) | b;
	}
}

static void mod_col_inter_tex_using_texa (uint16_t *dst, int size, uint32_t color)
{
	uint32_t cr, cg, cb;
	uint16_t col;
	uint8_t r, g, b;
	uint16_t a;
	float percent, percent_i;

	cr = (color >> 12) & 0xF;
	cg = (color >> 8) & 0xF;
	cb = (color >> 4) & 0xF;

	for (int i=0; i<size; i++)
	{
		col = *dst;
		a = col & 0xF000;
		percent = (a >> 12) / 15.0f;
		percent_i = 1.0f - percent;
		r = (uint8_t)(percent_i * cr + percent * ((col & 0x0F00) >> 8));
		g = (uint8_t)(percent_i * cg + percent * ((col & 0x00F0) >> 4));
		b = (uint8_t)(percent_i * cb + percent * (col & 0x000F));
		*(dst++) = a | (r << 8) | (g << 4) | b;
	}
}

static void mod_col2_inter__col_inter_col1_using_tex__using_texa (uint16_t *dst, int size,
																  uint32_t color0, uint32_t color1,
																  uint32_t color2)
{
	uint32_t cr0, cg0, cb0, cr1, cg1, cb1, cr2, cg2, cb2;
	uint16_t col;
	uint8_t r, g, b;
	uint16_t a;
	float percent_r, percent_g, percent_b, percent_a;

	cr0 = (color0 >> 12) & 0xF;
	cg0 = (color0 >> 8) & 0xF;
	cb0 = (color0 >> 4) & 0xF;
	cr1 = (color1 >> 12) & 0xF;
	cg1 = (color1 >> 8) & 0xF;
	cb1 = (color1 >> 4) & 0xF;
	cr2 = (color2 >> 12) & 0xF;
	cg2 = (color2 >> 8) & 0xF;
	cb2 = (color2 >> 4) & 0xF;

	for (int i=0; i<size; i++)
	{
		col = *dst;
		a = col & 0xF000;
		percent_a = (a >> 12) / 15.0f;
		percent_r = ((col >> 8) & 0xF) / 15.0f;
		percent_g = ((col >> 4) & 0xF) / 15.0f;
		percent_b = (col & 0xF) / 15.0f;
		r = (uint8_t)(((1.0f-percent_r) * cr0 + percent_r * cr1) * percent_a + cr2 * (1.0f-percent_a));
		g = (uint8_t)(((1.0f-percent_g) * cg0 + percent_g * cg1) * percent_a + cg2 * (1.0f-percent_a));
		b = (uint8_t)(((1.0f-percent_b) * cb0 + percent_b * cb1) * percent_a + cb2 * (1.0f-percent_a));
		*(dst++) = a | (r << 8) | (g << 4) | b;
	}
}

static void mod_tex_scale_fac_add_fac (uint16_t *dst, int size, uint32_t factor)
{
	float percent = factor / 255.0f;
	uint16_t col;
	uint8_t a;
	float base_a = (1.0f - percent) * 15.0f;

	for (int i=0; i<size; i++)
	{
		col = *dst;
		a = (uint8_t)(base_a + percent * (col>>12));
		*(dst++) = (a<<12) | (col & 0x0FFF);
	}
}

static void mod_tex_sub_col_mul_fac_add_tex (uint16_t *dst, int size, uint32_t color, uint32_t factor)
{
	float percent = factor / 255.0f;
	uint32_t cr, cg, cb;
	uint16_t col, a;
	float r, g, b;

	cr = (color >> 12) & 0xF;
	cg = (color >> 8) & 0xF;
	cb = (color >> 4) & 0xF;

	for (int i=0; i<size; i++)
	{
		col = *dst;
		a = col & 0xF000;
		r = (float)((col >> 8) & 0xF);
		r = /*max(*/(r - cr) * percent/*, 0.0f)*/ + r;
		if (r > 15.0f) r = 15.0f;
		if (r < 0.0f) r = 0.0f;
		g = (float)((col >> 4) & 0xF);
		g = /*max(*/(g - cg) * percent/*, 0.0f)*/ + g;
		if (g > 15.0f) g = 15.0f;
		if (g < 0.0f) g = 0.0f;
		b = (float)(col & 0xF);
		b = /*max(*/(b - cb) * percent/*, 0.0f)*/ + b;
		if (b > 15.0f) b = 15.0f;
		if (b < 0.0f) b = 0.0f;

		*(dst++) = a | ((uint16_t)r << 8) | ((uint16_t)g << 4) | (uint16_t)b;
	}
}

static void mod_tex_scale_col_add_col (uint16_t *dst, int size, uint32_t color0, uint32_t color1)
{
	uint32_t cr0, cg0, cb0, cr1, cg1, cb1;
	uint16_t col;
	uint8_t r, g, b;
	uint16_t a;
	float percent_r, percent_g, percent_b;

	cr0 = (color0 >> 12) & 0xF;
	cg0 = (color0 >> 8) & 0xF;
	cb0 = (color0 >> 4) & 0xF;
	cr1 = (color1 >> 12) & 0xF;
	cg1 = (color1 >> 8) & 0xF;
	cb1 = (color1 >> 4) & 0xF;

	for (int i=0; i<size; i++)
	{
		col = *dst;
		a = col & 0xF000;
		percent_r = ((col >> 8) & 0xF) / 15.0f;
		percent_g = ((col >> 4) & 0xF) / 15.0f;
		percent_b = (col & 0xF) / 15.0f;
		r = min(15, (uint8_t)(percent_r * cr0 + cr1 + 0.0001f));
		g = min(15, (uint8_t)(percent_g * cg0 + cg1 + 0.0001f));
		b = min(15, (uint8_t)(percent_b * cb0 + cb1 + 0.0001f));
		*(dst++) = a | (r << 8) | (g << 4) | b;
	}
}

static void mod_tex_add_col (uint16_t *dst, int size, uint32_t color)
{
	uint32_t cr, cg, cb;
	uint16_t col;
	uint8_t a, r, g, b;

	cr = (color >> 12) & 0xF;
	cg = (color >> 8) & 0xF;
	cb = (color >> 4) & 0xF;

	for (int i=0; i<size; i++)
	{
		col = *dst;
		a = (uint8_t)((col >> 12) & 0xF);
//		a = col & 0xF000;
		r = (uint8_t)(cr + ((col >> 8) & 0xF))&0xF;
		g = (uint8_t)(cg + ((col >> 4) & 0xF))&0xF;
		b = (uint8_t)(cb + (col & 0xF))&0xF;
		*(dst++) = (a << 12) | (r << 8) | (g << 4) | b;
	}
}

static void mod_col_mul_texa_add_tex (uint16_t *dst, int size, uint32_t color)
{
	uint32_t cr, cg, cb;
	uint16_t col;
	uint8_t r, g, b;
	uint16_t a;
	float factor;

	cr = (color >> 12) & 0xF;
	cg = (color >> 8) & 0xF;
	cb = (color >> 4) & 0xF;

	for (int i=0; i<size; i++)
	{
		col = *dst;
		a = col & 0xF000;
		factor = (a >> 12) / 15.0f;
		r = (uint8_t)(cr*factor + ((col >> 8) & 0xF))&0xF;
		g = (uint8_t)(cg*factor + ((col >> 4) & 0xF))&0xF;
		b = (uint8_t)(cb*factor + (col & 0xF))&0xF;
		*(dst++) = a | (r << 8) | (g << 4) | b;
	}
}

static void mod_tex_sub_col (uint16_t *dst, int size, uint32_t color)
{
	int cr, cg, cb;
	uint16_t col;
	uint8_t a, r, g, b;

	cr = (color >> 12) & 0xF;
	cg = (color >> 8) & 0xF;
	cb = (color >> 4) & 0xF;

	for (int i=0; i<size; i++)
	{
		col = *dst;
		a = (uint8_t)(col & 0xF000);
		r = (uint8_t)max((((col >> 8) & 0xF) - cr), 0);
		g = (uint8_t)max((((col >> 4) & 0xF) - cg), 0);
		b = (uint8_t)max(((col & 0xF) - cb), 0);
		*(dst++) = (a << 12) | (r << 8) | (g << 4) | b;
	}
}

static void mod_tex_sub_col_mul_fac (uint16_t *dst, int size, uint32_t color, uint32_t factor)
{
	float percent = factor / 255.0f;
	uint32_t cr, cg, cb;
	uint16_t col, a;
	float r, g, b;

	cr = (color >> 12) & 0xF;
	cg = (color >> 8) & 0xF;
	cb = (color >> 4) & 0xF;

	for (int i=0; i<size; i++)
	{
		col = *dst;
		a = (uint8_t)((col >> 12) & 0xF);
		r = (float)((col >> 8) & 0xF);
		r = (r - cr) * percent;
		if (r > 15.0f) r = 15.0f;
		if (r < 0.0f) r = 0.0f;
		g = (float)((col >> 4) & 0xF);
		g = (g - cg) * percent;
		if (g > 15.0f) g = 15.0f;
		if (g < 0.0f) g = 0.0f;
		b = (float)(col & 0xF);
		b = (b - cb) * percent;
		if (b > 15.0f) b = 15.0f;
		if (b < 0.0f) b = 0.0f;

		*(dst++) = (a << 12) | ((uint16_t)r << 8) | ((uint16_t)g << 4) | (uint16_t)b;
	}
}

static void mod_col_inter_tex_using_col1 (uint16_t *dst, int size, uint32_t color0, uint32_t color1)
{
	uint32_t cr, cg, cb;
	uint16_t col, a;
	uint8_t r, g, b;

	float percent_r = ((color1 >> 12) & 0xF) / 15.0f;
	float percent_g = ((color1 >> 8) & 0xF) / 15.0f;
	float percent_b = ((color1 >> 4) & 0xF) / 15.0f;
	float percent_r_i = 1.0f - percent_r;
	float percent_g_i = 1.0f - percent_g;
	float percent_b_i = 1.0f - percent_b;

	cr = (color0 >> 12) & 0xF;
	cg = (color0 >> 8) & 0xF;
	cb = (color0 >> 4) & 0xF;

	for (int i=0; i<size; i++)
	{
		col = *dst;
		a = (uint8_t)((col >> 12) & 0xF);
		r = (uint8_t)(percent_r * ((col >> 8) & 0xF) + percent_r_i * cr);
		g = (uint8_t)(percent_g * ((col >> 4) & 0xF) + percent_g_i * cg);
		b = (uint8_t)(percent_b * (col & 0xF) + percent_b_i * cb);
		*(dst++) = (a << 12) | (r << 8) | (g << 4) | b;
	}
}

static void mod_tex_inter_noise_using_col (uint16_t *dst, int size, uint32_t color)
{
	uint16_t col, a;
	uint8_t r, g, b, noise;

	float percent_r = ((color >> 12) & 0xF) / 15.0f;
	float percent_g = ((color >> 8) & 0xF) / 15.0f;
	float percent_b = ((color >> 4) & 0xF) / 15.0f;
	float percent_r_i = 1.0f - percent_r;
	float percent_g_i = 1.0f - percent_g;
	float percent_b_i = 1.0f - percent_b;

	for (int i=0; i<size; i++)
	{
		col = *dst;
		a = col & 0xF000;
        noise = rand()%16;
		r = (uint8_t)(percent_r_i * ((col >> 8) & 0xF) + percent_r * noise);
		g = (uint8_t)(percent_g_i * ((col >> 4) & 0xF) + percent_g * noise);
		b = (uint8_t)(percent_b_i * (col & 0xF) + percent_b * noise);
		*(dst++) = a | (r << 8) | (g << 4) | b;
	}
}

static void mod_tex_inter_col_using_texa (uint16_t *dst, int size, uint32_t color)
{
	uint32_t cr, cg, cb;
	uint16_t col;
	uint8_t r, g, b;
	uint16_t a;
	float percent, percent_i;

	cr = (color >> 12) & 0xF;
	cg = (color >> 8) & 0xF;
	cb = (color >> 4) & 0xF;

	for (int i=0; i<size; i++)
	{
		col = *dst;
		a = col & 0xF000;
		percent = (a >> 12) / 15.0f;
		percent_i = 1.0f - percent;
		r = (uint8_t)(percent * cr + percent_i * ((col & 0x0F00) >> 8));
		g = (uint8_t)(percent * cg + percent_i * ((col & 0x00F0) >> 4));
		b = (uint8_t)(percent * cb + percent_i * (col & 0x000F));
		*(dst++) = a | (r << 8) | (g << 4) | b;
	}
}

static void mod_tex_mul_col (uint16_t *dst, int size, uint32_t color)
{
	float cr, cg, cb;
	uint16_t col;
	uint8_t r, g, b;
	uint16_t a;

	cr = (float)((color >> 12) & 0xF)/16.0f;
	cg = (float)((color >> 8) & 0xF)/16.0f;
	cb = (float)((color >> 4) & 0xF)/16.0f;

	for (int i=0; i<size; i++)
	{
		col = *dst;
		a = col & 0xF000;
		r = (uint8_t)(cr * ((col & 0x0F00) >> 8));
		g = (uint8_t)(cg * ((col & 0x00F0) >> 4));
		b = (uint8_t)(cb * (col & 0x000F));
		*(dst++) = a | (r << 8) | (g << 4) | b;
	}
}

static void mod_tex_scale_fac_add_col (uint16_t *dst, int size, uint32_t color, uint32_t factor)
{
	float percent = factor / 255.0f;
	uint32_t cr, cg, cb;
	uint16_t col;
	float r, g, b;

	cr = (color >> 12) & 0xF;
	cg = (color >> 8) & 0xF;
	cb = (color >> 4) & 0xF;

	for (int i=0; i<size; i++)
	{
		col = *dst;
		r = cr + percent * (float)((col>>8)&0xF);
		g = cg + percent * (float)((col>>4)&0xF);
		b = cb + percent * (float)(col&0xF);
		*(dst++) = (col&0xF000) | ((uint8_t)r << 8) | ((uint8_t)g << 4) | (uint8_t)b;
	}
}