/***************************************************************************
 *             __________               __   ___.
 *   Open      \______   \ ____   ____ |  | _\_ |__   _______  ___
 *   Source     |       _//  _ \_/ ___\|  |/ /| __ \ /  _ \  \/  /
 *   Jukebox    |    |   (  <_> )  \___|    < | \_\ (  <_> > <  <
 *   Firmware   |____|_  /\____/ \___  >__|_ \|___  /\____/__/\_ \
 *                     \/            \/     \/    \/            \/
 * $Id$
 *
 * The following code is rewrite of the C++ code provided in VisualBoyAdvance.
 * There are also portions of the original GNUboy code.
 * Copyright (C) 2001 the GNUboy development team
 *
 * VisualBoyAdvance - Nintendo Gameboy/GameboyAdvance (TM) emulator.
 * Copyright (C) 1999-2003 Forgotten
 * Copyright (C) 2004 Forgotten and the VBA development team
 *
 * VisualBoyAdvance conversion from C++ to C by Karl Kurbjun July, 2007
 *
 * 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 software is distributed on an "AS IS" basis, WITHOUT WARRANTY OF ANY
 * KIND, either express or implied.
 *
 */

#include "rockmacros.h"
#include "defs.h"
#include "pcm.h"
#include "sound.h"
#include "cpu-gb.h"
#include "hw.h"
#include "regs.h"

static const byte soundWavePattern[4][32] = {
  {0x01,0x01,0x01,0x01,
   0xff,0xff,0xff,0xff,
   0xff,0xff,0xff,0xff,
   0xff,0xff,0xff,0xff,
   0xff,0xff,0xff,0xff,
   0xff,0xff,0xff,0xff,
   0xff,0xff,0xff,0xff,
   0xff,0xff,0xff,0xff},
  {0x01,0x01,0x01,0x01,
   0x01,0x01,0x01,0x01,
   0xff,0xff,0xff,0xff,
   0xff,0xff,0xff,0xff,
   0xff,0xff,0xff,0xff,
   0xff,0xff,0xff,0xff,
   0xff,0xff,0xff,0xff,
   0xff,0xff,0xff,0xff},
  {0x01,0x01,0x01,0x01,
   0x01,0x01,0x01,0x01,
   0x01,0x01,0x01,0x01,
   0x01,0x01,0x01,0x01,
   0xff,0xff,0xff,0xff,
   0xff,0xff,0xff,0xff,
   0xff,0xff,0xff,0xff,
   0xff,0xff,0xff,0xff},
  {0x01,0x01,0x01,0x01,
   0x01,0x01,0x01,0x01,
   0x01,0x01,0x01,0x01,
   0x01,0x01,0x01,0x01,
   0x01,0x01,0x01,0x01,
   0x01,0x01,0x01,0x01,
   0xff,0xff,0xff,0xff,
   0xff,0xff,0xff,0xff}
};

int soundFreqRatio[8] ICONST_ATTR= {
  1048576, // 0
  524288,  // 1
  262144,  // 2
  174763,  // 3
  131072,  // 4
  104858,  // 5
  87381,   // 6
  74898    // 7
};

int soundShiftClock[16] ICONST_ATTR= {
      2, // 0
      4, // 1
      8, // 2
     16, // 3
     32, // 4
     64, // 5
    128, // 6
    256, // 7
    512, // 8
   1024, // 9
   2048, // 10
   4096, // 11
   8192, // 12
  16384, // 13
  1,     // 14
  1      // 15
};

struct snd snd IBSS_ATTR;

#define RATE (snd.rate)
#define WAVE (ram.hi+0x30)
#define S1 (snd.ch[0])
#define S2 (snd.ch[1])
#define S3 (snd.ch[2])
#define S4 (snd.ch[3])

#define SOUND_MAGIC   0x60000000
#define SOUND_MAGIC_2 0x30000000
#define NOISE_MAGIC 5

static void gbSoundChannel1(int *r, int *l)
{
    int vol = S1.envol;

    int freq = 0;

    int value = 0;

    if(S1.on && (S1.len || !S1.cont))
    {
        S1.pos += snd.quality*S1.skip;
        S1.pos &= 0x1fffffff;

        value = ((signed char)S1.wave[S1.pos>>24]) * vol;
    }

    if (snd.balance & 1) *r += value;
    if (snd.balance & 16) *l += value;

    if(S1.on)
    {
        if(S1.len) 
        {
            S1.len-=snd.quality;

            if(S1.len <=0 && S1.cont) 
            {
                R_NR52 &= 0xfe;
                S1.on = 0;
            }
        }

        if(S1.enlen)
        {
            S1.enlen-=snd.quality;

            if(S1.enlen<=0) 
            {
                if(S1.endir)
                {
                    if(S1.envol < 15)
                        S1.envol++;
                }
                else 
                {
                    if(S1.envol)
                        S1.envol--;
                }

                S1.enlen += S1.enlenreload;
            }
        }

        if(S1.swlen)
        {
            S1.swlen-=snd.quality;

            if(S1.swlen<=0)
            {
                freq = (((int)(R_NR14&7) << 8) | R_NR13);

                int updown = 1;
        
                if(S1.swdir)
                    updown = -1;

                int newfreq = 0;
                if(S1.swsteps)
                {
                    newfreq = freq + updown * freq / (1 << S1.swsteps);
                    if(newfreq == freq)
                        newfreq = 0;
                }
                else
                    newfreq = freq;

                if(newfreq < 0)
                {
                    S1.swlen += S1.swlenreload;
                }
                else if(newfreq > 2047)
                {
                    S1.swlen = 0;
                    S1.on = 0;
                    R_NR52 &= 0xfe;
                } 
                else 
                {
                    S1.swlen += S1.swlenreload;
                    S1.skip = SOUND_MAGIC/(2048 - newfreq);

                    R_NR13 = newfreq & 0xff;
                    R_NR14 = (R_NR14 & 0xf8) |((newfreq >> 8) & 7);
                }
            }
        }
    }
}

static void gbSoundChannel2(int *r, int *l)
{
    int vol = S2.envol;
  
    int value = 0;
    
    if(S2.on && (S2.len || !S2.cont))
    {
        S2.pos += snd.quality*S2.skip;
        S2.pos &= 0x1fffffff;
    
        value = ((signed char)S2.wave[S2.pos>>24]) * vol;
    }

    if (snd.balance & 2) *r += value;
    if (snd.balance & 32) *l += value;

    if(S2.on) {
        if(S2.len) {
            S2.len-=snd.quality;
            
            if(S2.len <= 0 && S2.cont) {
                R_NR52 &= 0xfd;
                S2.on = 0;
            }
        }
        
        if(S2.enlen) {
            S2.enlen-=snd.quality;
          
            if(S2.enlen <= 0) {
                if(S2.endir) {
                    if(S2.envol < 15)
                        S2.envol++;
                } else {
                    if(S2.envol)
                        S2.envol--;
                }
                S2.enlen += S2.enlenreload;
            }
        }
    }
}

static void gbSoundChannel3(int *r, int *l)
{
    int s;
    if (S3.on && (S3.len || !S3.cont))
    {
        S3.pos += S3.skip*snd.quality;
        S3.pos &= 0x1fffffff;
        s=ram.hi[0x30 + (S3.pos>>25)];
        if (S3.pos & 0x01000000)
            s &= 0x0f;
        else
            s >>= 4;

        s -= 8;

        switch(S3.outputlevel)
        {
            case 0:
                s=0;
                break;
            case 1:
                break;
            case 2:
                s=s>>1;
                break;
            case 3:
                s=s>>2;
                break;
        }

        if (snd.balance & 4) *r += s;
        if (snd.balance & 64) *l += s;
    }

    if(S3.on)
    {
        if(S3.len)
        {
            S3.len-=snd.quality;
            if(S3.len<=0 && S3.cont)
            {
                R_NR52 &= 0xFB;
                S3.on=0;
            }
        }
    }
}

static void gbSoundChannel4(int *r, int *l)
{
    int vol = S4.envol;
  
    int value = 0;
  
    if(S4.clock <= 0x0c)
    {
        if(S4.on && (S4.len || !S4.cont))
        {
            S4.pos += snd.quality*S4.skip;
            S4.shiftpos += snd.quality*S4.shiftskip;
      
            if(S4.nsteps)
            {
                while(S4.shiftpos > 0x1fffff) {
                    S4.shiftright = (((S4.shiftright << 6) ^
                        (S4.shiftright << 5)) & 0x40) | (S4.shiftright >> 1);
                    S4.shiftpos -= 0x200000;
                }
            } 
            else 
            {
                while(S4.shiftpos > 0x1fffff)
                {
                    S4.shiftright = (((S4.shiftright << 14) ^
                        (S4.shiftright << 13)) & 0x4000) | (S4.shiftright >> 1);
                    S4.shiftpos -= 0x200000;
                }
            }
      
            S4.pos &= 0x1fffff;
            S4.shiftpos &= 0x1fffff;
          
            value = ((S4.shiftright & 1)*2-1) * vol;
        } 
        else
        {
            value = 0;
        }
    }
  
    if (snd.balance & 8) *r += value;
    if (snd.balance & 128) *l += value;
  
    if(S4.on) {
        if(S4.len) {
            S4.len-=snd.quality;
            
            if(S4.len <= 0 && S4.cont) {
                R_NR52 &= 0xfd;
                S4.on = 0;
            }
        }
        
        if(S4.enlen) {
            S4.enlen-=snd.quality;
            
            if(S4.enlen <= 0)
            {
                if(S4.endir)
                {
                    if(S4.envol < 15)
                        S4.envol++;
                } 
                else 
                {
                    if(S4.envol)
                        S4.envol--;
                }
                S4.enlen += S4.enlenreload;
            }
        }
    }
}

void sound_mix(void)
{
    int l, r;

    if (!RATE || cpu.snd < RATE) return;

    for (; cpu.snd >= RATE; cpu.snd -= RATE)
    {
        l = r = 0;

        gbSoundChannel1(&r,&l);

        gbSoundChannel2(&r,&l);

        gbSoundChannel3(&r,&l);

        gbSoundChannel4(&r,&l);

        if(snd.gbDigitalSound)
        {
            l = snd.level1<<8;
            r = snd.level2<<8;
        }
        else
        {
            l *= snd.level1*60;
            r *= snd.level2*60;
        }

        if(l > 32767)
            l = 32767;
        if(l < -32768)
            l = -32768;
            
        if(r > 32767)
            r = 32767;
        if(r < -32768)
            r = -32768;

        if (pcm.buf)
        {
            if (pcm.pos >= pcm.len)
                pcm_submit();
            if (pcm.stereo)
            {
                pcm.buf[pcm.pos++] = l;
                pcm.buf[pcm.pos++] = r;
            }
            else pcm.buf[pcm.pos++] = ((l+r)>>1);
        }
    }
    R_NR52 = (R_NR52&0xf0) | S1.on | (S2.on<<1) | (S3.on<<2) | (S4.on<<3);
}

byte sound_read(byte r)
{
    if(!options.sound) return 0;
    sound_mix();
    /* printf("read %02X: %02X\n", r, REG(r)); */
    return REG(r);
}

void sound_write(byte r, byte b)
{
    int freq=0;
    ram.hi[r]=b;

    if(!options.sound)
        return;

    sound_mix();

    switch (r)
    {
    case RI_NR10:
        S1.swlen = S1.swlenreload = 344 * ((b >> 4) & 7);
        S1.swsteps = b & 7;
        S1.swdir = b & 0x08;
        S1.swstep = 0;
        break;
    case RI_NR11:
        S1.len = 172 * (64 - (b & 0x3f));
        S1.wave = soundWavePattern[b >> 6];
        break;
    case RI_NR12:
        S1.envol = b >> 4;
        S1.endir = b & 0x08;
        S1.enlenreload = S1.enlen = 689 * (b & 7);
        break;
    case RI_NR13:
        freq = (((int)(R_NR14 & 7)) << 8) | b;
        S1.len = 172 * (64 - (R_NR11 & 0x3f));
        freq = 2048 - freq;
        if(freq)
        {
            S1.skip = SOUND_MAGIC / freq;
        }
        else
        {
            S1.skip = 0;
        }
        break;
    case RI_NR14:
        freq = (((int)(b&7) << 8) | R_NR13);
        freq = 2048 - freq;
        S1.len = 172 * (64 - (R_NR11 & 0x3f));
        S1.cont = b & 0x40;
        if(freq) 
        {
            S1.skip = SOUND_MAGIC / freq;
        } 
        else
        {
            S1.skip = 0;
        }
        if(b & 0x80)
        {
            R_NR52 |= 1;
            S1.envol = R_NR12 >> 4;
            S1.endir = R_NR12 & 0x08;
            S1.len = 172 * (64 - (R_NR11 & 0x3f));
            S1.enlenreload = S1.enlen = 689 * (R_NR12 & 7);
            S1.swlen = S1.swlenreload = 344 * ((R_NR10 >> 4) & 7);
            S1.swsteps = R_NR10 & 7;
            S1.swdir = R_NR10 & 0x08;
            S1.swstep = 0;
  
            S1.pos = 0;
            S1.on = 1;
        }
        break;
    case RI_NR21:
        S2.wave = soundWavePattern[b >> 6];
        S2.len = 172 * (64 - (b & 0x3f));
        break;
    case RI_NR22:
        S2.envol = b >> 4;
        S2.endir = b & 0x08;
        S2.enlenreload = S2.enlen = 689 * (b & 7);
        break;
    case RI_NR23:
        freq = (((int)(R_NR24 & 7)) << 8) | b;
        S2.len = 172 * (64 - (R_NR21 & 0x3f));
        freq = 2048 - freq;
        if(freq)
        {
            S2.skip = SOUND_MAGIC / freq;
        } 
        else
        {
            S2.skip = 0;
        }
        break;
    case RI_NR24:
        freq = (((int)(b&7) << 8) | R_NR23);
        freq = 2048 - freq;
        S2.len = 172 * (64 - (R_NR21 & 0x3f));
        S2.cont = b & 0x40;
        if(freq) {
            S2.skip = SOUND_MAGIC / freq;
        } else
            S2.skip = 0;
        if(b & 0x80) {
            R_NR52 |= 2;
            S2.envol = R_NR22 >> 4;
            S2.endir = R_NR22 & 0x08;
            S2.len = 172 * (64 - (R_NR21 & 0x3f));
            S2.enlenreload = S2.enlen = 689 * (R_NR22 & 7);

            S2.pos = 0;
            S2.on = 1;
        }
        break;
    case RI_NR30:
        if (!(b & 0x80)){
            R_NR52 &= 0xfb;
            S3.on = 0;
        }
        break;
    case RI_NR31:
        S3.len = (256-R_NR31) * 172;
        break;
    case RI_NR32:
        S3.outputlevel = (b >> 5) & 3;
        break;
    case RI_NR33:
        freq = 2048 - (((int)(R_NR34&7) << 8) | b);
        if(freq)
            S3.skip = SOUND_MAGIC_2 / freq;
        else
            S3.skip = 0;
        break;
    case RI_NR34:
        freq = 2048 - (((b&7)<<8) | R_NR33);

        if(freq)
            S3.skip = SOUND_MAGIC_2 / freq;
        else
            S3.skip = 0;

        S3.cont=b & 0x40;
        if((b & 0x80) && (R_NR30 & 0x80))
        {
            R_NR52 |= 4;
            S3.len = 172 * (256 - R_NR31);
            S3.pos = 0;
            S3.on = 1;
        }
        break;
    case RI_NR41:
        S4.len = 172 * (64 - (b & 0x3f));
        break;
    case RI_NR42:
        S4.envol = b >> 4;
        S4.endir = b & 0x08;
        S4.enlenreload = S4.enlen = 689 * (b & 7);
        break;
    case RI_NR43:
        freq = soundFreqRatio[b & 7];

        S4.nsteps = b & 0x08;
        S4.skip = (freq << 8) / NOISE_MAGIC;
        S4.clock = b >> 4;

        freq = freq / soundShiftClock[S4.clock];
        S4.shiftskip = (freq << 8) / NOISE_MAGIC;
        break;
    case RI_NR44:
        S4.cont = b & 0x40;
        if(b & 0x80)
        {
            R_NR52 |= 8;
            S4.envol = R_NR42 >> 4;
            S4.endir = R_NR42 & 0x08;
            S4.len = 172 * (64 - (R_NR41 & 0x3f));
            S4.enlenreload = S4.enlen = 689 * (R_NR42 & 7);

            S4.on = 1;
            
            S4.pos = 0;
            S4.shiftpos = 0;
            
            freq = soundFreqRatio[R_NR43 & 7];
      
            S4.shiftpos = (freq << 8) / NOISE_MAGIC;

            S4.nsteps = R_NR43 & 0x08;
            
            freq = freq / soundShiftClock[R_NR43 >> 4];
      
            S4.shiftskip = (freq << 8) / NOISE_MAGIC;
            if(S4.nsteps)
            {
                S4.shiftright = 0x7fff;
            }
            else
            {
                S4.shiftright = 0x7f;
            }
        }
        break;
    case RI_NR50:
        snd.level1 = b & 7;
        snd.level2 = (b >> 4) & 7;
        break;
    case RI_NR51:
        snd.balance = b;
        break;
    case RI_NR52:
        if (!(b & 0x80))
        {
            S1.on=0;
            S2.on=0;
            S3.on=0;
            S4.on=0;
        }
        break;
    }
    
    snd.gbDigitalSound = true;

    if(S1.on && S1.envol != 0)
        snd.gbDigitalSound = false;
    if(S2.on && S2.envol != 0)
        snd.gbDigitalSound = false;
    if(S3.on && S3.outputlevel != 0)
        snd.gbDigitalSound = false;
    if(S4.on && S4.envol != 0)
        snd.gbDigitalSound = false;
}

void sound_reset(void)
{
    snd.level1 = 7;
    snd.level2 = 7;
    S1.on           = S2.on     = S3.on     = S4.on = 0;
    S1.len          = S2.len    = S3.len    = S4.len = 0;
    S1.skip         = S2.skip   = S3.skip   = S4.skip = 0;
    S1.pos          = S2.pos    = S3.pos    = S4.pos = 0;
    S1.cont         = S2.cont   = S3.cont   = S4.cont = 0;
    S1.envol        = S2.envol              = S4.envol = 0;
    S1.enlen        = S2.enlen              = S4.enlen = 0;
    S1.endir        = S2.endir              = S4.endir = 0;
    S1.enlenreload  = S2.enlenreload        = S4.enlenreload = 0;
    S1.swlen = 0;
    S1.swlenreload = 0;
    S1.swsteps = 0;
    S1.swdir = 0;
    S1.swstep = 0;
    S1.wave         = S2.wave = soundWavePattern[2];

    S3.outputlevel = 0;

    S4.clock = 0;
    S4.shiftright = 0x7f;
    S4.nsteps = 0;

    sound_write(0x10, 0x80);
    sound_write(0x11, 0xbf);
    sound_write(0x12, 0xf3);
    sound_write(0x14, 0xbf);
    sound_write(0x16, 0x3f);
    sound_write(0x17, 0x00);
    sound_write(0x19, 0xbf);
  
    sound_write(0x1a, 0x7f);
    sound_write(0x1b, 0xff);
    sound_write(0x1c, 0xbf);
    sound_write(0x1e, 0xbf);
  
    sound_write(0x20, 0xff);
    sound_write(0x21, 0x00);
    sound_write(0x22, 0x00);
    sound_write(0x23, 0xbf);
    sound_write(0x24, 0x77);
    sound_write(0x25, 0xf3);
  
    sound_write(0x26, 0xf0);
  
    S1.on = 0;
    S2.on = 0;
    S3.on = 0;
    S4.on = 0;

    int addr = 0x30;
	while(addr < 0x40) 
    {
        ram.hi[addr++] = 0x00;
        ram.hi[addr++] = 0xff;
    }

	if (pcm.hz)
    {
        snd.rate = (1<<21) / pcm.hz;
        snd.quality=44100 / pcm.hz;
    }
	else snd.rate = 0;
}

void sound_dirty(void)
{
    sound_write(RI_NR10, R_NR10);
    sound_write(RI_NR11, R_NR11);
    sound_write(RI_NR12, R_NR12);
    sound_write(RI_NR13, R_NR13);
    sound_write(RI_NR14, R_NR14);
    
    sound_write(RI_NR21, R_NR21);
    sound_write(RI_NR22, R_NR22);
    sound_write(RI_NR23, R_NR23);
    sound_write(RI_NR24, R_NR24);
    
    sound_write(RI_NR30, R_NR30);
    sound_write(RI_NR31, R_NR31);
    sound_write(RI_NR32, R_NR32);
    sound_write(RI_NR33, R_NR33);
    sound_write(RI_NR34, R_NR34);
    
    sound_write(RI_NR42, R_NR42);
    sound_write(RI_NR43, R_NR43);
    sound_write(RI_NR44, R_NR44);
    
    sound_write(RI_NR50, R_NR50);
    sound_write(RI_NR51, R_NR51);
    sound_write(RI_NR52, R_NR52);
}