/*  i8259.c: Intel i8259 PIC adapter

    Copyright (c) 2010, William A. Beech

        Permission is hereby granted, free of charge, to any person obtaining a
        copy of this software and associated documentation files (the "Software"),
        to deal in the Software without restriction, including without limitation
        the rights to use, copy, modify, merge, publish, distribute, sublicense,
        and/or sell copies of the Software, and to permit persons to whom the
        Software is furnished to do so, subject to the following conditions:

        The above copyright notice and this permission notice shall be included in
        all copies or substantial portions of the Software.

        THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR
        IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY,
        FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT.  IN NO EVENT SHALL
        WILLIAM A. BEECH BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER LIABILITY, WHETHER
        IN AN ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING FROM, OUT OF OR IN
        CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS IN THE SOFTWARE.

        Except as contained in this notice, the name of William A. Beech shall not be
        used in advertising or otherwise to promote the sale, use or other dealings
        in this Software without prior written authorization from William A. Beech.

    NOTES:

        This software was written by Bill Beech, 24 Jan 13, to allow emulation of 
        more complex Computer Systems.

        This program simulates up to 4 i8259 devices.

        u3 = IRR
        u4 = ISR
        u5 = IMR
*/

#include "system_defs.h"                /* system header in system dir */

/* external globals */

extern uint16 port;                     //port called in dev_table[port]

/* function prototypes */

void i8259_dump(uint8 devnum);
t_stat i8259_reset (DEVICE *dptr, uint16 base);
uint8 i8259_get_dn(void);
uint8 i8259a(t_bool io, uint8 data);
uint8 i8259b(t_bool io, uint8 data);

/* external function prototypes */

extern uint16 reg_dev(uint8 (*routine)(t_bool, uint8), uint16);

/* globals */

int32 i8259_devnum = 0;             //initially, no 8259 instances
uint16 i8259_port[4];               //base port assigned to each 8259 instance
uint8 i8259_ints[4];                //8 interrupt inputs for each 8259 instance

uint8 i8259_icw1[4];
uint8 i8259_icw2[4];
uint8 i8259_icw3[4];
uint8 i8259_icw4[4];
uint8 i8259_ocw1[4];
uint8 i8259_ocw2[4];
uint8 i8259_ocw3[4];
uint8 icw_num0 = 1, icw_num1 = 1;

/* i8259 Standard I/O Data Structures */
/* up to 4 i8259 devices */

UNIT i8259_unit[] = {
    { UDATA (0, 0, 0) },                /* i8259 0 */
    { UDATA (0, 0, 0) },                /* i8259 1 */
    { UDATA (0, 0, 0) },                /* i8259 2 */
    { UDATA (0, 0, 0) }                 /* i8259 3 */
};

REG i8259_reg[] = {
    { HRDATA (IRR0, i8259_unit[0].u3, 8) }, /* i8259 0 */
    { HRDATA (ISR0, i8259_unit[0].u4, 8) },
    { HRDATA (IMR0, i8259_unit[0].u5, 8) },
    { HRDATA (IRR1, i8259_unit[1].u3, 8) }, /* i8259 0 */
    { HRDATA (ISR1, i8259_unit[1].u4, 8) },
    { HRDATA (IMR1, i8259_unit[1].u5, 8) },
    { HRDATA (IRR2, i8259_unit[2].u3, 8) }, /* i8259 2 */
    { HRDATA (ISR2, i8259_unit[2].u4, 8) },
    { HRDATA (IMR2, i8259_unit[2].u5, 8) },
    { HRDATA (IRR3, i8259_unit[3].u3, 8) }, /* i8259 3 */
    { HRDATA (ISR3, i8259_unit[3].u4, 8) },
    { HRDATA (IMR3, i8259_unit[3].u5, 8) },
    { NULL }
};

DEBTAB i8259_debug[] = {
    { "ALL", DEBUG_all },
    { "FLOW", DEBUG_flow },
    { "READ", DEBUG_read },
    { "WRITE", DEBUG_write },
    { "LEV1", DEBUG_level1 },
    { "LEV2", DEBUG_level2 },
    { NULL }
};

/* address width is set to 16 bits to use devices in 8086/8088 implementations */

DEVICE i8259_dev = {
    "8259",             //name
    i8259_unit,         //units
    i8259_reg,          //registers
    NULL,               //modifiers
    1,                  //numunits
    16,                 //aradix
    16,                 //awidth
    1,                  //aincr
    16,                 //dradix
    8,                  //dwidth
    NULL,               //examine
    NULL,               //deposit
//    &i8259_reset,       //reset
    NULL,               //reset
    NULL,               //boot
    NULL,               //attach
    NULL,               //detach
    NULL,               //ctxt
    0,                  //flags
    0,                  //dctrl
    i8259_debug,        //debflags
    NULL,               //msize
    NULL                //lname
};

void i8259_dump(uint8 devnum)
{
    sim_printf("Device %d\n", devnum);
    sim_printf("   IRR = %02X\n", i8259_unit[devnum].u3);
    sim_printf("   ISR = %02X\n", i8259_unit[devnum].u4);
    sim_printf("   IMR = %02X\n", i8259_unit[devnum].u5);
    sim_printf("   ICW1 = %02X\n", i8259_icw1[devnum]);
    sim_printf("   ICW2 = %02X\n", i8259_icw2[devnum]);
    sim_printf("   ICW3 = %02X\n", i8259_icw3[devnum]);
    sim_printf("   ICW4 = %02X\n", i8259_icw4[devnum]);
    sim_printf("   OCW1 = %02X\n", i8259_ocw1[devnum]);
    sim_printf("   OCW2 = %02X\n", i8259_ocw2[devnum]);
    sim_printf("   OCW3 = %02X\n", i8259_ocw3[devnum]);
}

/* Reset routine */

t_stat i8259_reset (DEVICE *dptr, uint16 base)
{
     if (i8259_devnum > I8259_NUM) {
        sim_printf("i8259_reset: too many devices!\n");
        return SCPE_MEM;
    }
    i8259_port[i8259_devnum] = reg_dev(i8259a, base); 
    reg_dev(i8259b, base + 1); 
    i8259_unit[i8259_devnum].u3 = 0x00; /* IRR */
    i8259_unit[i8259_devnum].u4 = 0x00; /* ISR */
    i8259_unit[i8259_devnum].u5 = 0x00; /* IMR */
    sim_printf("   8259-%d: Reset\n", i8259_devnum);
    sim_printf("   8259-%d: Registered at %03X\n", i8259_devnum, base);
    i8259_devnum++;
    return SCPE_OK;
}

uint8 i8259_get_dn(void)
{
    int i;

    for (i=0; i<I8259_NUM; i++)
        if (port >=i8259_port[i] && port <= i8259_port[i] + 2)
            return i;
    sim_printf("i8259_get_dn: port %03X not in 8259 device table\n", port);
    return 0xFF;
}

/*  I/O instruction handlers, called from the CPU module when an
    IN or OUT instruction is issued.
*/


uint8 i8259a(t_bool io, uint8 data)
{
    uint8 devnum;

    if ((devnum = i8259_get_dn()) != 0xFF) {
        if (io == 0) {                      /* read data port */
            if ((i8259_ocw3[devnum] & 0x03) == 0x02)
                return (i8259_unit[devnum].u3);  /* IRR */
            if ((i8259_ocw3[devnum] & 0x03) == 0x03)
                return (i8259_unit[devnum].u4);  /* ISR */
        } else {                            /* write data port */
            if (data & 0x10) {
                icw_num0 = 1;
            }
            if (icw_num0 == 1) {
                i8259_icw1[devnum] = data;       /* ICW1 */
                i8259_unit[devnum].u5 = 0x00;    /* clear IMR */
                i8259_ocw3[devnum] = 0x02;       /* clear OCW3, Sel IRR */
            } else {
                switch (data & 0x18) {
                case 0:                     /* OCW2 */
                    i8259_ocw2[devnum] = data;
                    break;
                case 8:                     /* OCW3 */
                    i8259_ocw3[devnum] = data;
                    break;
                default:
                    sim_printf("8259a-%d: OCW Error %02X\n", devnum, data);
                    break;
                }
            }
            sim_printf("8259a-%d: data = %02X\n", devnum, data);
                    icw_num0++;             /* step ICW number */
        }
    }
    //i8259_dump(devnum);
    return 0;
}

uint8 i8259b(t_bool io, uint8 data)
{
    uint8 devnum;

    if ((devnum = i8259_get_dn()) != 0xFF) {
        if (io == 0) {                      /* read data port */
            if ((i8259_ocw3[devnum] & 0x03) == 0x02)
                return (i8259_unit[devnum].u3);  /* IRR */
            if ((i8259_ocw3[devnum] & 0x03) == 0x03)
                return (i8259_unit[devnum].u4);  /* ISR */
        } else {                            /* write data port */
            if (data & 0x10) {
                icw_num1 = 1;
            }
            if (icw_num1 == 1) {
                i8259_icw1[devnum] = data;       /* ICW1 */
                i8259_unit[devnum].u5 = 0x00;    /* clear IMR */
                i8259_ocw3[devnum] = 0x02;       /* clear OCW3, Sel IRR */
            } else {
                switch (data & 0x18) {
                case 0:                     /* OCW2 */
                    i8259_ocw2[devnum] = data;
                    break;
                case 8:                     /* OCW3 */
                    i8259_ocw3[devnum] = data;
                    break;
                default:
                    sim_printf("8259b-%d: OCW Error %02X\n", devnum, data);
                    break;
                }
            }
            sim_printf("8259b-%d: data = %02X\n", devnum, data);
            icw_num1++;                     /* step ICW number */
        }
    }
    //i8259_dump(devnum);
    return 0;
}

/* end of i8259.c */