/*PCem v0.8 by Tom Walker

  AD1848 CODEC emulation (Windows Sound System compatible)*/

#include "ibm.h"
#include "sound_ad1848.h"

static int ad1848_vols[64];

void ad1848_setirq(ad1848_t *ad1848, int irq)
{
        ad1848->irq = irq;
}

void ad1848_setdma(ad1848_t *ad1848, int dma)
{
        ad1848->dma = dma;
}

uint8_t ad1848_read(uint16_t addr, void *p)
{
        ad1848_t *ad1848 = (ad1848_t *)p;
        uint8_t temp = 0xff;
//        pclog("ad1848_read - addr %04X %04X(%08X):%08X ", addr, CS, cs, pc);
        switch (addr & 3)
        {
                case 0: /*Index*/
                temp = ad1848->index | ad1848->trd | ad1848->mce;
                break;
                case 1:
                temp = ad1848->regs[ad1848->index];
                break;
                case 2:
                temp = ad1848->status;
                break;
        }
//        pclog("return %02X\n", temp);
        return temp;
}

void ad1848_write(uint16_t addr, uint8_t val, void *p)
{
        ad1848_t *ad1848 = (ad1848_t *)p;
        double freq;
//        pclog("ad1848_write - addr %04X val %02X  %04X(%08X):%08X\n", addr, val, CS, cs, pc);
        switch (addr & 3)
        {
                case 0: /*Index*/
                ad1848->index = val & 0xf;
                ad1848->trd   = val & 0x20;
                ad1848->mce   = val & 0x40;
                break;
                case 1:
                switch (ad1848->index)
                {
                        case 8:
                        freq = (val & 1) ? 16934400 : 24576000;
                        switch ((val >> 1) & 7)
                        {
                                case 0: freq /= 3072; break;
                                case 1: freq /= 1536; break;
                                case 2: freq /= 896;  break;
                                case 3: freq /= 768;  break;
                                case 4: freq /= 448;  break;
                                case 5: freq /= 384;  break;
                                case 6: freq /= 512;  break;
                                case 7: freq /= 2560; break;
                        }
                        ad1848->inc = (int)((freq * 65536) / 48000);
                        break;
                        
                        case 9:
                        if (!ad1848->enable)
                                ad1848->interp_count = 0;
                                
                        ad1848->enable = ((val & 0x41) == 0x01);
                        break;
                                
                        case 12:
                        return;
                        
                        case 14:
                        ad1848->count = ad1848->regs[15] | (val << 8);
                        break;
                }
                ad1848->regs[ad1848->index] = val;
                break;
                case 2:
                ad1848->status &= 0xfe;
                break;              
        }
}

void ad1848_poll(void *p, int16_t *l, int16_t *r)
{
        ad1848_t *ad1848 = (ad1848_t *)p;
        
//        opl3_poll(&ad1848->opl, &ad1848->opl_buffer[ad1848->pos * 2], &ad1848->opl_buffer[(ad1848->pos * 2) + 1]);
        
        if (ad1848->enable)
        {
                int32_t temp;
                
                if (ad1848->regs[6] & 0x80)
                        *l = 0;
                else
                        *l = (ad1848->out_l * ad1848_vols[ad1848->regs[6] & 0x3f]) >> 16;

                if (ad1848->regs[7] & 0x80)
                        *r = 0;
                else
                        *r = (ad1848->out_r * ad1848_vols[ad1848->regs[7] & 0x3f]) >> 16;
                
                ad1848->interp_count += ad1848->inc;
                if (ad1848->interp_count >= 0x10000)
                {
                        ad1848->interp_count -= 0x10000;

                        if (ad1848->count < 0)
                        {               
                                ad1848->count = ad1848->regs[15] | (ad1848->regs[14] << 8);
                                if (!(ad1848->status & 0x01))
                                {
                                        ad1848->status |= 0x01;
                                        if (ad1848->regs[0xa] & 2)
                                                picint(1 << ad1848->irq);
                                }                                
                        }

                        switch (ad1848->regs[8] & 0x70)
                        {
                                case 0x00: /*Mono, 8-bit PCM*/
                                ad1848->out_l = ad1848->out_r = (dma_channel_read(ad1848->dma) ^ 0x80) * 256;
                                break;
                                case 0x10: /*Stereo, 8-bit PCM*/
                                ad1848->out_l = (dma_channel_read(ad1848->dma) ^ 0x80)  * 256;
                                ad1848->out_r = (dma_channel_read(ad1848->dma) ^ 0x80)  * 256;
                                break;
                
                                case 0x40: /*Mono, 16-bit PCM*/
                                temp = dma_channel_read(ad1848->dma);
                                ad1848->out_l = ad1848->out_r = dma_channel_read(ad1848->dma) | (temp << 8);
                                break;
                                case 0x50: /*Stereo, 16-bit PCM*/
                                temp = dma_channel_read(ad1848->dma);
                                ad1848->out_l = dma_channel_read(ad1848->dma) | (temp << 8);
                                temp = dma_channel_read(ad1848->dma);
                                ad1848->out_r = dma_channel_read(ad1848->dma) | (temp << 8);
                                break;
                        }
        
                        ad1848->count--;
                }
//                pclog("ad1848_poll : enable %X %X  %X %X  %X %X\n", ad1848->pcm_buffer[0][ad1848->pos], ad1848->pcm_buffer[1][ad1848->pos], ad1848->out_l[0], ad1848->out_r[0], ad1848->out_l[1], ad1848->out_r[1]);
        }
        else
        {
                *l = *r = 0;
//                pclog("ad1848_poll : not enable\n");
        }
}

void ad1848_init(ad1848_t *ad1848)
{
        int c;
        double attenuation;

        ad1848->enable = 0;
                        
        ad1848->status = 0xcc;
        ad1848->index = ad1848->trd = 0;
        ad1848->mce = 0x40;
        
        ad1848->regs[0] = ad1848->regs[1] = 0;
        ad1848->regs[2] = ad1848->regs[3] = 0x80;
        ad1848->regs[4] = ad1848->regs[5] = 0x80;
        ad1848->regs[6] = ad1848->regs[7] = 0x80;
        ad1848->regs[8] = 0;
        ad1848->regs[9] = 0x08;
        ad1848->regs[10] = ad1848->regs[11] = 0;
        ad1848->regs[12] = 0xa;
        ad1848->regs[13] = 0;
        ad1848->regs[14] = ad1848->regs[15] = 0;
        
        ad1848->out_l = 0;
        ad1848->out_r = 0;
        ad1848->interp_count = 0;
        
        for (c = 0; c < 64; c++)
        {
                attenuation = 0.0;
                if (c & 0x01) attenuation -= 1.5;
                if (c & 0x02) attenuation -= 3.0;
                if (c & 0x04) attenuation -= 6.0;
                if (c & 0x08) attenuation -= 12.0;
                if (c & 0x10) attenuation -= 24.0;
                if (c & 0x20) attenuation -= 48.0;
                
                attenuation = pow(10, attenuation / 10);
                
                ad1848_vols[c] = (int)(attenuation * 65536);
//                pclog("ad1848_vols %i = %f %i\n", c, attenuation, ad1848_vols[c]);
        }
}