/*
*   Glide64 - Glide video plugin for Nintendo 64 emulators.
*   Copyright (c) 2002  Dave2001
*
*   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., 51 Franklin Street, Fifth Floor, 
*   Boston, MA  02110-1301, USA
*/

//****************************************************************
//
// Glide64 - Glide Plugin for Nintendo 64 emulators (tested mostly with Project64)
// Project started on December 29th, 2001
//
// 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.
//
// Official Glide64 development channel: #Glide64 on EFnet
//
// Original author: Dave2001 (Dave2999@hotmail.com)
// Other authors: Gonetz, Gugaman
//
//****************************************************************

#ifndef _WIN32
#include <stdlib.h>
#endif

static void mod_tex_inter_color_using_factor (WORD *dst, int size, DWORD color, DWORD factor)
{
    float percent = factor / 255.0f;
    float percent_i = 1 - percent;
    DWORD cr, cg, cb;
    WORD col, a;
    BYTE 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 = (BYTE)(percent_i * ((col >> 8) & 0xF) + percent * cr);
        g = (BYTE)(percent_i * ((col >> 4) & 0xF) + percent * cg);
        b = (BYTE)(percent_i * (col & 0xF) + percent * cb);
        *(dst++) = a | (r << 8) | (g << 4) | b;
    }
}

static void mod_tex_inter_col_using_col1 (WORD *dst, int size, DWORD color0, DWORD color1)
{
    DWORD cr, cg, cb;
    WORD col, a;
    BYTE 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 = (BYTE)(percent_r_i * ((col >> 8) & 0xF) + percent_r * cr);
        g = (BYTE)(percent_g_i * ((col >> 4) & 0xF) + percent_g * cg);
        b = (BYTE)(percent_b_i * (col & 0xF) + percent_b * cb);
        *(dst++) = a | (r << 8) | (g << 4) | b;
    }
}

static void mod_full_color_sub_tex (WORD *dst, int size, DWORD color)
{
    DWORD cr, cg, cb, ca;
    WORD col;
    BYTE 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 = (BYTE)(ca - ((col >> 12) & 0xF));
        r = (BYTE)(cr - ((col >> 8) & 0xF));
        g = (BYTE)(cg - ((col >> 4) & 0xF));
        b = (BYTE)(cb - (col & 0xF));
        *(dst++) = (a << 12) | (r << 8) | (g << 4) | b;
    }
}

static void mod_col_inter_col1_using_tex (WORD *dst, int size, DWORD color0, DWORD color1)
{
    DWORD cr0, cg0, cb0, cr1, cg1, cb1;
    WORD col;
    BYTE r, g, b;
    WORD 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, (BYTE)((1.0f-percent_r) * cr0 + percent_r * cr1));
        g = min(15, (BYTE)((1.0f-percent_g) * cg0 + percent_g * cg1));
        b = min(15, (BYTE)((1.0f-percent_b) * cb0 + percent_b * cb1));
        *(dst++) = a | (r << 8) | (g << 4) | b;
    }
}

static void mod_col_inter_col1_using_texa (WORD *dst, int size, DWORD color0, DWORD color1)
{
    DWORD cr0, cg0, cb0, cr1, cg1, cb1;
    WORD col;
    BYTE r, g, b;
    WORD 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 = (BYTE)(percent_i * cr0 + percent * cr1);
        g = (BYTE)(percent_i * cg0 + percent * cg1);
        b = (BYTE)(percent_i * cb0 + percent * cb1);
        *(dst++) = a | (r << 8) | (g << 4) | b;
    }
}

static void mod_col_inter_col1_using_texa__mul_tex (WORD *dst, int size, DWORD color0, DWORD color1)
{
    DWORD cr0, cg0, cb0, cr1, cg1, cb1;
    WORD col;
    BYTE r, g, b;
    WORD 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 = (BYTE)(((percent_i * cr0 + percent * cr1) / 15.0f) * (((col & 0x0F00) >> 8) / 15.0f) * 15.0f);
        g = (BYTE)(((percent_i * cg0 + percent * cg1) / 15.0f) * (((col & 0x00F0) >> 4) / 15.0f) * 15.0f);
        b = (BYTE)(((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 (WORD *dst, int size, DWORD color)
{
    DWORD cr, cg, cb;
    WORD col;
    BYTE r, g, b;
    WORD 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 = (BYTE)((1.0f-percent_r) * cr + percent_r * ((col & 0x0F00) >> 8));
        g = (BYTE)((1.0f-percent_g) * cg + percent_g * ((col & 0x00F0) >> 4));
        b = (BYTE)((1.0f-percent_b) * cb + percent_b * (col & 0x000F));       
        *(dst++) = a | (r << 8) | (g << 4) | b;
    }
}

static void mod_col_inter_tex_using_texa (WORD *dst, int size, DWORD color)
{
    DWORD cr, cg, cb;
    WORD col;
    BYTE r, g, b;
    WORD 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 = (BYTE)(percent_i * cr + percent * ((col & 0x0F00) >> 8));
        g = (BYTE)(percent_i * cg + percent * ((col & 0x00F0) >> 4));
        b = (BYTE)(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 (WORD *dst, int size,
                                                                  DWORD color0, DWORD color1,
                                                                  DWORD color2)
{
    DWORD cr0, cg0, cb0, cr1, cg1, cb1, cr2, cg2, cb2;
    WORD col;
    BYTE r, g, b;
    WORD 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 = (BYTE)(((1.0f-percent_r) * cr0 + percent_r * cr1) * percent_a + cr2 * (1.0f-percent_a));
        g = (BYTE)(((1.0f-percent_g) * cg0 + percent_g * cg1) * percent_a + cg2 * (1.0f-percent_a));
        b = (BYTE)(((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 (WORD *dst, int size, DWORD factor)
{
    float percent = factor / 255.0f;
    WORD col;
    BYTE a;
    float base_a = (1.0f - percent) * 15.0f;

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

static void mod_tex_sub_col_mul_fac_add_tex (WORD *dst, int size, DWORD color, DWORD factor)
{
    float percent = factor / 255.0f;
    DWORD cr, cg, cb;
    WORD 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 | ((WORD)r << 8) | ((WORD)g << 4) | (WORD)b;
    }
}

static void mod_tex_scale_col_add_col (WORD *dst, int size, DWORD color, DWORD factor)
{
    float percent = factor / 255.0f;
    float percent_r = (1.0f - ((color>>12)&0xF) / 15.0f) * percent;
    float percent_g = (1.0f - ((color>>8)&0xF) / 15.0f) * percent;
    float percent_b = (1.0f - ((color>>4)&0xF) / 15.0f) * percent;
    WORD col;
    float base = (1.0f - percent) * 15.0f;
    float r, g, b;

    for (int i=0; i<size; i++)
    {
        col = *dst;
        r = base + percent_r * (float)((col>>8)&0xF);
        g = base + percent_g * (float)((col>>4)&0xF);
        b = base + percent_b * (float)(col&0xF);
        *(dst++) = (col&0xF000) | ((BYTE)r << 8) | ((BYTE)g << 4) | (BYTE)b;
    }
}

static void mod_tex_add_col (WORD *dst, int size, DWORD color)
{
    DWORD cr, cg, cb;
    WORD col;
    BYTE 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 = (BYTE)((col >> 12) & 0xF);
//      a = col & 0xF000;
        r = (BYTE)(cr + ((col >> 8) & 0xF))&0xF;
        g = (BYTE)(cg + ((col >> 4) & 0xF))&0xF;
        b = (BYTE)(cb + (col & 0xF))&0xF;
        *(dst++) = (a << 12) | (r << 8) | (g << 4) | b;
    }
}

static void mod_col_mul_texa_add_tex (WORD *dst, int size, DWORD color)
{
    DWORD cr, cg, cb;
    WORD col;
    BYTE r, g, b;
    WORD 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 = (BYTE)(cr*factor + ((col >> 8) & 0xF))&0xF;
        g = (BYTE)(cg*factor + ((col >> 4) & 0xF))&0xF;
        b = (BYTE)(cb*factor + (col & 0xF))&0xF;
        *(dst++) = a | (r << 8) | (g << 4) | b;
    }
}

static void mod_tex_sub_col (WORD *dst, int size, DWORD color)
{
    DWORD cr, cg, cb, ca;
    WORD col;
    BYTE 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 = (BYTE)(((col >> 12) & 0xF) - ca);
        r = (BYTE)(((col >> 8) & 0xF) - cr);
        g = (BYTE)(((col >> 4) & 0xF) - cg);
        b = (BYTE)((col & 0xF) - cb);
        *(dst++) = (a << 12) | (r << 8) | (g << 4) | b;
    }
}

static void mod_tex_sub_col_mul_fac (WORD *dst, int size, DWORD color, DWORD factor)
{
    float percent = factor / 255.0f;
    DWORD cr, cg, cb;
    WORD 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 = (BYTE)((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) | ((WORD)r << 8) | ((WORD)g << 4) | (WORD)b;
    }
}

static void mod_col_inter_tex_using_col1 (WORD *dst, int size, DWORD color0, DWORD color1)
{
    DWORD cr, cg, cb;
    WORD col, a;
    BYTE 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 = (BYTE)((col >> 12) & 0xF);
        r = (BYTE)(percent_r * ((col >> 8) & 0xF) + percent_r_i * cr);
        g = (BYTE)(percent_g * ((col >> 4) & 0xF) + percent_g_i * cg);
        b = (BYTE)(percent_b * (col & 0xF) + percent_b_i * cb);
        *(dst++) = (a << 12) | (r << 8) | (g << 4) | b;
    }
}

static void mod_tex_inter_noise_using_col (WORD *dst, int size, DWORD color)
{
    WORD col, a;
    BYTE 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 = (BYTE)(percent_r_i * ((col >> 8) & 0xF) + percent_r * noise);
        g = (BYTE)(percent_g_i * ((col >> 4) & 0xF) + percent_g * noise);
        b = (BYTE)(percent_b_i * (col & 0xF) + percent_b * noise);
        *(dst++) = a | (r << 8) | (g << 4) | b;
    }
}

static void mod_tex_inter_col_using_texa (WORD *dst, int size, DWORD color)
{
    DWORD cr, cg, cb;
    WORD col;
    BYTE r, g, b;
    WORD 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 = (BYTE)(percent * cr + percent_i * ((col & 0x0F00) >> 8));
        g = (BYTE)(percent * cg + percent_i * ((col & 0x00F0) >> 4));
        b = (BYTE)(percent * cb + percent_i * (col & 0x000F));
        *(dst++) = a | (r << 8) | (g << 4) | b;
    }
}

static void mod_tex_mul_col (WORD *dst, int size, DWORD color)
{
    float cr, cg, cb;
    WORD col;
    BYTE r, g, b;
    WORD 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 = (BYTE)(cr * ((col & 0x0F00) >> 8));
        g = (BYTE)(cg * ((col & 0x00F0) >> 4));
        b = (BYTE)(cb * (col & 0x000F));
        *(dst++) = a | (r << 8) | (g << 4) | b;
    }
}

static void mod_tex_scale_fac_add_col (WORD *dst, int size, DWORD color, DWORD factor)
{
    float percent = factor / 255.0f;
    DWORD cr, cg, cb;
    WORD 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) | ((BYTE)r << 8) | ((BYTE)g << 4) | (BYTE)b;
    }
}