/***************************************************************************

                          mos656x.cpp  -  Minimal VIC emulation
                             -------------------
    begin                : Wed May 21 2001
    copyright            : (C) 2001 by Simon White
    email                : s_a_white@email.com
 ***************************************************************************/

/***************************************************************************
 *                                                                         *
 *   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.                                   *
 *                                                                         *
 ***************************************************************************/

// References below are from:
//     The MOS 6567/6569 video controller (VIC-II)
//     and its application in the Commodore 64
//     http://www.uni-mainz.de/~bauec002/VIC-Article.gz


#include <string.h>
#include "config.h"
#include "sidendian.h"
#include "mos656x.h"

#define MOS6567R56A_SCREEN_HEIGHT  262
#define MOS6567R56A_SCREEN_WIDTH   64
#define MOS6567R56A_FIRST_DMA_LINE 0x30
#define MOS6567R56A_LAST_DMA_LINE  0xf7

#define MOS6567R8_SCREEN_HEIGHT    263
#define MOS6567R8_SCREEN_WIDTH     65
#define MOS6567R8_FIRST_DMA_LINE   0x30
#define MOS6567R8_LAST_DMA_LINE    0xf7

#define MOS6569_SCREEN_HEIGHT      312
#define MOS6569_SCREEN_WIDTH       63
#define MOS6569_FIRST_DMA_LINE     0x30
#define MOS6569_LAST_DMA_LINE      0xf7

const char *MOS656X::credit =
{   // Optional information
	"blah"
//    "*MOS656X (VICII) Emulation:\0"
//    "\tCopyright (C) 2001 Simon White <" S_A_WHITE_EMAIL ">\0"
};


MOS656X::MOS656X (EventContext *context)
:Event("VIC Raster"),
 event_context(*context),
 m_phase(EVENT_CLOCK_PHI1),
 sprite_enable(regs[0x15]),
 sprite_y_expansion(regs[0x17])
{
    chip (MOS6569);
}

void MOS656X::reset ()
{
    icr          = idr = ctrl1 = 0;
    raster_irq   = 0;
    y_scroll     = 0;
    raster_y     = yrasters - 1;
    raster_x     = 0;
    bad_lines_enabled = false;
    m_rasterClk  = 0;
    vblanking    = lp_triggered = false;
    lpx          = lpy = 0;
    sprite_dma   = 0;
    sprite_expand_y = 0xff;
    memset (regs, 0, sizeof (regs));
    memset (sprite_mc_base, 0, sizeof (sprite_mc_base));
    schedule (event_context, 0, m_phase);
}

void MOS656X::chip (mos656x_model_t model)
{
    switch (model)
    {
    // Seems to be an older NTSC chip
    case MOS6567R56A:
        yrasters       = MOS6567R56A_SCREEN_HEIGHT;
        xrasters       = MOS6567R56A_SCREEN_WIDTH;
        first_dma_line = MOS6567R56A_FIRST_DMA_LINE;
        last_dma_line  = MOS6567R56A_LAST_DMA_LINE;
    break;

    // NTSC Chip
    case MOS6567R8:
        yrasters       = MOS6567R8_SCREEN_HEIGHT;
        xrasters       = MOS6567R8_SCREEN_WIDTH;
        first_dma_line = MOS6567R8_FIRST_DMA_LINE;
        last_dma_line  = MOS6567R8_LAST_DMA_LINE;
    break;

    // PAL Chip
    case MOS6569:
        yrasters       = MOS6569_SCREEN_HEIGHT;
        xrasters       = MOS6569_SCREEN_WIDTH;
        first_dma_line = MOS6569_FIRST_DMA_LINE;
        last_dma_line  = MOS6569_LAST_DMA_LINE;
    break;
    }

    reset ();
}

uint8_t MOS656X::read (uint_least8_t addr)
{
    if (addr > 0x3f) return 0;
    if (addr > 0x2e) return 0xff;
 
    // Sync up timers
    event ();

    switch (addr)
    {
    case 0x11:    // Control register 1 
        return (ctrl1 & 0x7f) | ((raster_y & 0x100) >> 1);
    case 0x12:    // Raster counter
        return raster_y & 0xFF;
    case 0x13:
        return lpx;
    case 0x14:
        return lpy;
    case 0x19:    // IRQ flags
        return idr;
    case 0x1a:    // IRQ mask
        return icr | 0xf0;
    default: return regs[addr];
    }
}

void MOS656X::write (uint_least8_t addr, uint8_t data)
{
    if (addr > 0x3f) return;

    regs[addr] = data;

    // Sync up timers
    event ();

    switch (addr)
    {
    case 0x11: // Control register 1
    {
        endian_16hi8 (raster_irq, data >> 7);
        ctrl1    = data;
        y_scroll = data & 7;

        if (raster_x < 11)
            break;

        // In line $30, the DEN bit controls if Bad Lines can occur
        if ((raster_y == first_dma_line) && (data & 0x10))
            bad_lines_enabled = true;
 
        // Bad Line condition?
        bad_line = (raster_y >= first_dma_line) &&
                   (raster_y <= last_dma_line)  &&
                   ((raster_y & 7) == y_scroll) &&
                   bad_lines_enabled;

        // Start bad dma line now
        if (bad_line && (raster_x < 53))
            addrctrl (false);
        break;
    }

    case 0x12: // Raster counter
        endian_16lo8 (raster_irq, data);
        break;

    case 0x17:
        sprite_expand_y |= ~data; // 3.8.1-1
        break;

    case 0x19: // IRQ flags
        idr &= ((~data & 0x0f) | 0x80);
        if (idr == 0x80)
            trigger (0);
        break;

    case 0x1a: // IRQ mask 
        icr = data & 0x0f; 
        trigger (icr & idr); 
        break;
    }
}


void MOS656X::trigger (int irq)
{
    if (!irq)
    {   // Clear any requested IRQs
        if (idr & MOS656X_INTERRUPT_REQUEST)
            interrupt (false);
        idr = 0;
        return;
    }

    idr |= irq;
    if (icr & idr)
    {
        if (!(idr & MOS656X_INTERRUPT_REQUEST))
        {
            idr |= MOS656X_INTERRUPT_REQUEST;
            interrupt (true);
        }
    }
}

void MOS656X::event (void)
{
    event_clock_t  cycles = event_context.getTime (m_rasterClk, event_context.phase());

    // Cycle already executed check
    if (!cycles)
        return;

    event_clock_t  delay  = 1;
    uint_least16_t cycle;

	// AV
	static bool calced = false;
	static int table[ 100 ];
	static int table2[ 100 ];

	if ( !calced ) {
		for ( int i = 0; i < 100; i++ ) {
			table[i] = (i + 9) % xrasters;
			table2[i] = i % xrasters;
		}
		calced = true;
	}

    // Update x raster
    m_rasterClk += cycles;
    raster_x    += cycles;
    
	//cycle        = (raster_x + 9) % xrasters;
    //raster_x    %= xrasters;

	cycle		= table[raster_x];
    raster_x    = table2[raster_x];
	

    switch (cycle)
    {
    case 0:
    {   // Calculate sprite DMA
        uint8_t y    = raster_y & 0xff;
        uint8_t mask = 1;
        sprite_expand_y ^= sprite_y_expansion; // 3.8.1-2
        for (unsigned int i=1; i<0x10; i+=2, mask<<=1)
        {   // 3.8.1-3
            if ((sprite_enable & mask) && (y == regs[i]))
            {
                sprite_dma |= mask;
                sprite_mc_base[i >> 1] = 0;
                sprite_expand_y &= ~(sprite_y_expansion & mask);
            }
        }

        delay = 2;
        if (sprite_dma & 0x01)
            addrctrl (false);
        else
        {
            addrctrl (true);
            // No sprites before next compulsory cycle
            if (!(sprite_dma & 0x1f))
                delay = 9;
        }
        break;
    }

    case 1:
        break;

    case 2:
        if (sprite_dma & 0x02)
            addrctrl (false);
        break;

    case 3:
        if (!(sprite_dma & 0x03))
            addrctrl (true);
        break;

    case 4:
        if (sprite_dma & 0x04)
            addrctrl (false);
        break;

    case 5:
        if (!(sprite_dma & 0x06))
            addrctrl (true);
        break;

    case 6:
        if (sprite_dma & 0x08)
            addrctrl (false);
        break;

    case 7:
        if (!(sprite_dma & 0x0c))
            addrctrl (true);
        break;

    case 8:
        if (sprite_dma & 0x10)
            addrctrl (false);
        break;

    case 9:  // IRQ occurred (xraster != 0)
        if (raster_y == (yrasters - 1))
            vblanking = true;
        else
        {
            raster_y++;
            // Trigger raster IRQ if IRQ line reached
            if (raster_y == raster_irq)
                trigger (MOS656X_INTERRUPT_RST);
        }
        if (!(sprite_dma & 0x18))
            addrctrl (true);
        break;

    case 10:  // Vertical blank (line 0)
        if (vblanking)
        {
            vblanking = lp_triggered = false;
            raster_y = 0;
            // Trigger raster IRQ if IRQ in line 0
            if (raster_irq == 0)
                trigger (MOS656X_INTERRUPT_RST);
        }
        if (sprite_dma & 0x20)
            addrctrl (false);
        // No sprites before next compulsory cycle
        else if (!(sprite_dma & 0xf8))
           delay = 10;
        break;

    case 11:
        if (!(sprite_dma & 0x30))
            addrctrl (true);
        break;

    case 12:
        if (sprite_dma & 0x40)
            addrctrl (false);
        break;

    case 13:
        if (!(sprite_dma & 0x60))
            addrctrl (true);
        break;

    case 14:
        if (sprite_dma & 0x80)
            addrctrl (false);
        break;

    case 15:
        delay = 2;
        if (!(sprite_dma & 0xc0))
        {
            addrctrl (true);
            delay = 5;
        }
        break;

    case 16:
        break;

    case 17:
        delay = 2;
        if (!(sprite_dma & 0x80))
        {
            addrctrl (true);
            delay = 3;
        }
        break;

    case 18:
        break;

    case 19:
        addrctrl (true);
        break;

    case 20: // Start bad line
    {   // In line $30, the DEN bit controls if Bad Lines can occur
        if (raster_y == first_dma_line)
            bad_lines_enabled = (ctrl1 & 0x10) != 0;

        // Test for bad line condition
        bad_line = (raster_y >= first_dma_line) &&
                   (raster_y <= last_dma_line)  &&
                   ((raster_y & 7) == y_scroll) &&
                   bad_lines_enabled;

        if (bad_line)
        {   // DMA starts on cycle 23
            addrctrl (false);
        }
        delay = 3;
        break;
    }

    case 23:
    {   // 3.8.1-7
        for (unsigned int i=0; i<8; i++)
        {
            if (sprite_expand_y & (1 << i))
                sprite_mc_base[i] += 2;
        }
        break;
    }

    case 24:
    {
        uint8_t mask = 1;
        for (unsigned int i=0; i<8; i++, mask<<=1)
        {   // 3.8.1-8
            if (sprite_expand_y & mask)
                sprite_mc_base[i]++;
            if ((sprite_mc_base[i] & 0x3f) == 0x3f)
                sprite_dma &= ~mask;
        }
        delay = 39;
        break;
    }

    case 63: // End DMA - Only get here for non PAL
        addrctrl (true);
        delay = xrasters - cycle;
        break;

    default:
        if (cycle < 23)
            delay = 23 - cycle;
        else if (cycle < 63)
            delay = 63 - cycle;
        else
            delay = xrasters - cycle;
    }

    schedule (event_context, delay - event_context.phase(), m_phase);
}

// Handle light pen trigger
void MOS656X::lightpen ()
{   // Synchronise simulation
    event ();

    if (!lp_triggered)
    {   // Latch current coordinates
        lpx = raster_x << 2;
        lpy = (uint8_t) raster_y & 0xff;
        trigger(MOS656X_INTERRUPT_LP);
    }
}
