/*
 * 86Box    A hypervisor and IBM PC system emulator that specializes in
 *          running old operating systems and software designed for IBM
 *          PC systems and compatibles from 1981 through fairly recent
 *          system designs based on the PCI bus.
 *
 *          Emulation of the SFF-8038i IDE Bus Master.
 *
 *          PRD format :
 *            word 0 - base address
 *            word 1 - bits 1-15 = byte count, bit 31 = end of transfer
 *
 *
 *
 * Authors: Sarah Walker, <https://pcem-emulator.co.uk/>
 *          Miran Grca, <mgrca8@gmail.com>
 *
 *          Copyright 2008-2020 Sarah Walker.
 *          Copyright 2016-2020 Miran Grca.
 */
#include <stdarg.h>
#include <stdint.h>
#include <stdio.h>
#include <stdlib.h>
#include <string.h>
#include <wchar.h>
#define HAVE_STDARG_H
#include <86box/86box.h>
#include <86box/cdrom.h>
#include <86box/hdd.h>
#include <86box/scsi_device.h>
#include <86box/scsi_disk.h>
#include <86box/scsi_cdrom.h>
#include <86box/dma.h>
#include <86box/io.h>
#include <86box/device.h>
#include <86box/keyboard.h>
#include <86box/mem.h>
#include <86box/pci.h>
#include <86box/pic.h>
#include <86box/timer.h>
#include <86box/hdc.h>
#include <86box/hdc_ide.h>
#include <86box/hdc_ide_sff8038i.h>
#include <86box/rdisk.h>
#include <86box/mo.h>
#include <86box/plat_unused.h>

static int next_id = 0;

uint8_t         sff_bus_master_read(uint16_t port, void *priv);
static uint16_t sff_bus_master_readw(uint16_t port, void *priv);
static uint32_t sff_bus_master_readl(uint16_t port, void *priv);
void            sff_bus_master_write(uint16_t port, uint8_t val, void *priv);
static void     sff_bus_master_writew(uint16_t port, uint16_t val, void *priv);
static void     sff_bus_master_writel(uint16_t port, uint32_t val, void *priv);

#ifdef ENABLE_SFF_LOG
int sff_do_log = ENABLE_SFF_LOG;

static void
sff_log(const char *fmt, ...)
{
    va_list ap;

    if (sff_do_log) {
        va_start(ap, fmt);
        pclog_ex(fmt, ap);
        va_end(ap);
    }
}
#else
#    define sff_log(fmt, ...)
#endif

void
sff_bus_master_handler(sff8038i_t *dev, int enabled, uint16_t base)
{
    if (dev->enabled && (dev->base != 0x0000)) {
        io_removehandler(dev->base, 0x08,
                         sff_bus_master_read, sff_bus_master_readw, sff_bus_master_readl,
                         sff_bus_master_write, sff_bus_master_writew, sff_bus_master_writel,
                         dev);
    }

    if (enabled && (base != 0x0000)) {
        io_sethandler(base, 0x08,
                      sff_bus_master_read, sff_bus_master_readw, sff_bus_master_readl,
                      sff_bus_master_write, sff_bus_master_writew, sff_bus_master_writel,
                      dev);
    }

    dev->enabled = enabled;
    dev->base    = base;
}

static void
sff_bus_master_next_addr(sff8038i_t *dev)
{
    dma_bm_read(dev->ptr_cur, (uint8_t *) &(dev->addr), 4, 4);
    dma_bm_read(dev->ptr_cur + 4, (uint8_t *) &(dev->count), 4, 4);
    sff_log("SFF-8038i Bus master DWORDs: %08X %08X\n", dev->addr, dev->count);
    dev->eot = dev->count >> 31;
    dev->count &= 0xfffe;
    if (!dev->count)
        dev->count = 65536;
    dev->addr &= 0xfffffffe;
    dev->ptr_cur += 8;
}

void
sff_bus_master_write(uint16_t port, uint8_t val, void *priv)
{
    sff8038i_t *dev = (sff8038i_t *) priv;
#ifdef ENABLE_SFF_LOG
    int channel = (port & 8) ? 1 : 0;
#endif

    sff_log("SFF-8038i Bus master BYTE  write: %04X       %02X\n", port, val);

    if (dev->ven_write != NULL)
        val = dev->ven_write(port, val, dev->priv);

    switch (port & 7) {
        case 0:
            sff_log("sff Cmd   : val = %02X, old = %02X\n", val, dev->command);
            if ((val & 1) && !(dev->command & 1)) { /*Start*/
                sff_log("sff Bus Master start on channel %i\n", channel);
                dev->ptr_cur = dev->ptr;
                sff_bus_master_next_addr(dev);
                dev->status |= 1;
            }
            if (!(val & 1) && (dev->command & 1)) { /*Stop*/
                sff_log("sff Bus Master stop on channel %i\n", channel);
                dev->status &= ~1;
            }

            dev->command = val;
            break;
        case 1:
            dev->dma_mode = val & 0x03;
            break;
        case 2:
            sff_log("sff Status: val = %02X, old = %02X\n", val, dev->status);
            dev->status &= 0x07;
            dev->status |= (val & 0x60);
            if (val & 0x04)
                dev->status &= ~0x04;
            if (val & 0x02)
                dev->status &= ~0x02;
            break;
        case 4:
            dev->ptr = (dev->ptr & 0xffffff00) | (val & 0xfc);
            dev->ptr %= (mem_size * 1024);
            dev->ptr0 = val;
            break;
        case 5:
            dev->ptr = (dev->ptr & 0xffff00fc) | (val << 8);
            dev->ptr %= (mem_size * 1024);
            break;
        case 6:
            dev->ptr = (dev->ptr & 0xff00fffc) | (val << 16);
            dev->ptr %= (mem_size * 1024);
            break;
        case 7:
            dev->ptr = (dev->ptr & 0x00fffffc) | (val << 24);
            dev->ptr %= (mem_size * 1024);
            break;

        default:
            break;
    }
}

static void
sff_bus_master_writew(uint16_t port, uint16_t val, void *priv)
{
    sff8038i_t *dev = (sff8038i_t *) priv;

    sff_log("SFF-8038i Bus master WORD  write: %04X     %04X\n", port, val);

    switch (port & 7) {
        case 0:
        case 1:
        case 2:
            sff_bus_master_write(port, val & 0xff, priv);
            break;
        case 4:
            dev->ptr = (dev->ptr & 0xffff0000) | (val & 0xfffc);
            dev->ptr %= (mem_size * 1024);
            dev->ptr0 = val & 0xff;
            break;
        case 6:
            dev->ptr = (dev->ptr & 0x0000fffc) | (val << 16);
            dev->ptr %= (mem_size * 1024);
            break;

        default:
            break;
    }
}

static void
sff_bus_master_writel(uint16_t port, uint32_t val, void *priv)
{
    sff8038i_t *dev = (sff8038i_t *) priv;

    sff_log("SFF-8038i Bus master DWORD write: %04X %08X\n", port, val);

    switch (port & 7) {
        case 0:
        case 1:
        case 2:
            sff_bus_master_write(port, val & 0xff, priv);
            break;
        case 4:
            dev->ptr = (val & 0xfffffffc);
            dev->ptr %= (mem_size * 1024);
            dev->ptr0 = val & 0xff;
            break;

        default:
            break;
    }
}

uint8_t
sff_bus_master_read(uint16_t port, void *priv)
{
    const sff8038i_t *dev = (sff8038i_t *) priv;

    uint8_t ret = 0xff;

    switch (port & 7) {
        case 0:
            ret = dev->command;
            break;
        case 1:
            ret = dev->dma_mode & 0x03;
            break;
        case 2:
            ret = dev->status & 0x67;
            break;
        case 4:
            ret = dev->ptr0;
            break;
        case 5:
            ret = dev->ptr >> 8;
            break;
        case 6:
            ret = dev->ptr >> 16;
            break;
        case 7:
            ret = dev->ptr >> 24;
            break;

        default:
            break;
    }

    if (dev->ven_read != NULL)
        ret= dev->ven_read(port, ret, dev->priv);

    sff_log("SFF-8038i Bus master BYTE  read : %04X       %02X\n", port, ret);

    return ret;
}

static uint16_t
sff_bus_master_readw(uint16_t port, void *priv)
{
    const sff8038i_t *dev = (sff8038i_t *) priv;

    uint16_t ret = 0xffff;

    switch (port & 7) {
        case 0:
        case 1:
        case 2:
            ret = (uint16_t) sff_bus_master_read(port, priv);
            break;
        case 4:
            ret = dev->ptr0 | (dev->ptr & 0xff00);
            break;
        case 6:
            ret = dev->ptr >> 16;
            break;

        default:
            break;
    }

    sff_log("SFF-8038i Bus master WORD  read : %04X     %04X\n", port, ret);

    return ret;
}

static uint32_t
sff_bus_master_readl(uint16_t port, void *priv)
{
    const sff8038i_t *dev = (sff8038i_t *) priv;

    uint32_t ret = 0xffffffff;

    switch (port & 7) {
        case 0:
        case 1:
        case 2:
            ret = (uint32_t) sff_bus_master_read(port, priv);
            break;
        case 4:
            ret = dev->ptr0 | (dev->ptr & 0xffffff00);
            break;

        default:
            break;
    }

    sff_log("sff Bus master DWORD read : %04X %08X\n", port, ret);

    return ret;
}

int
sff_bus_master_dma(uint8_t *data, int transfer_length, int total_length, int out, void *priv)
{
    sff8038i_t *dev = (sff8038i_t *) priv;
#ifdef ENABLE_SFF_LOG
    char *sop;
#endif

    int force_end  = 0;
    int buffer_pos = 0;

#ifdef ENABLE_SFF_LOG
    sop = out ? "Read" : "Writ";
#endif

    if (!(dev->status & 1)) {
        sff_log("DMA disabled\n");
        return 2; /*DMA disabled*/
    }

    sff_log("SFF-8038i Bus master %s: %i bytes\n", out ? "write" : "read", transfer_length);

    while (1) {
        if (dev->count <= transfer_length) {
            sff_log("%sing %i bytes to %08X\n", sop, dev->count, dev->addr);
            if (out)
                dma_bm_read(dev->addr, (uint8_t *) (data + buffer_pos), dev->count, 4);
            else
                dma_bm_write(dev->addr, (uint8_t *) (data + buffer_pos), dev->count, 4);
            transfer_length -= dev->count;
            buffer_pos += dev->count;
        } else {
            sff_log("%sing %i bytes to %08X\n", sop, transfer_length, dev->addr);
            if (out)
                dma_bm_read(dev->addr, (uint8_t *) (data + buffer_pos), transfer_length, 4);
            else
                dma_bm_write(dev->addr, (uint8_t *) (data + buffer_pos), transfer_length, 4);
            /* Increase addr and decrease count so that resumed transfers do not mess up. */
            dev->addr += transfer_length;
            dev->count -= transfer_length;
            transfer_length = 0;
            force_end       = 1;
        }

        if (force_end) {
            sff_log("Total transfer length smaller than sum of all blocks, partial block\n");
            dev->status &= ~2;
            return 1; /* This block has exhausted the data to transfer and it was smaller than the count, break. */
        } else {
            if (!transfer_length && !dev->eot) {
                if (total_length) {
                    sff_log("Total transfer length smaller than sum of all blocks, partial transfer\n");
                    sff_bus_master_next_addr(dev);
                    return 1; /* We have exhausted the data to transfer but there's more blocks left, break. */
                } else {
                    sff_log("Total transfer length smaller than sum of all blocks, full block\n");
                    dev->status &= ~2;
                    return 1; /* We have exhausted the data to transfer but there's more blocks left, break. */
                }
            } else if (transfer_length && dev->eot) {
                sff_log("Total transfer length greater than sum of all blocks\n");
                dev->status |= 2;
                return 0; /* There is data left to transfer but we have reached EOT - return with error. */
            } else if (dev->eot) {
                sff_log("Regular EOT\n");
                dev->status &= ~3;
                return 3; /* We have regularly reached EOT - clear status and break. */
            } else {
                /* We have more to transfer and there are blocks left, get next block. */
                sff_bus_master_next_addr(dev);
            }
        }
    }

    return 1;
}

void
sff_bus_master_set_irq(uint8_t status, void *priv)
{
    sff8038i_t *dev = (sff8038i_t *) priv;
    uint8_t     irq = !!(status & 0x04);

    if (!(dev->status & 0x04) || (status & 0x04))
        dev->status = (dev->status & ~0x04) | status;

    switch (dev->irq_mode) {
        default:
        case IRQ_MODE_LEGACY:
            /* Legacy IRQ mode. */
            if (irq)
                picint(1 << dev->irq_line);
            else
                picintc(1 << dev->irq_line);
            break;
        case IRQ_MODE_PCI_IRQ_PIN:
            /* Native PCI IRQ mode with interrupt pin. */
            if (irq)
                pci_set_irq(dev->slot, dev->irq_pin, &dev->irq_state);
            else
                pci_clear_irq(dev->slot, dev->irq_pin, &dev->irq_state);
            break;
        case IRQ_MODE_MIRQ_0 ... IRQ_MODE_MIRQ_3:
            /* MIRQ 0, 1, 2, or 3. */
            if (irq)
                pci_set_mirq(dev->irq_mode & 3, 0, &dev->irq_state);
            else
                pci_clear_mirq(dev->irq_mode & 3, 0, &dev->irq_state);
            break;
        /* TODO: Redo this as a MIRQ. */
        case IRQ_MODE_PCI_IRQ_LINE:
            /* Native PCI IRQ mode with specified interrupt line. */
            if (irq)
                pci_set_dirq(dev->pci_irq_line, &dev->irq_state);
            else
                pci_clear_dirq(dev->pci_irq_line, &dev->irq_state);
            break;
        case IRQ_MODE_ALI_ALADDIN:
            /* ALi Aladdin Native PCI INTAJ mode. */
            if (irq)
                pci_set_mirq((dev->channel + 2), pci_get_mirq_level(dev->channel + 2), &dev->irq_state);
            else
                pci_clear_mirq((dev->channel + 2), pci_get_mirq_level(dev->channel + 2), &dev->irq_state);
            break;
        case IRQ_MODE_SIS_551X:
            /* SiS 551x mode. */
            if (irq)
                pci_set_mirq(dev->mirq, 1, &dev->irq_state);
            else
                pci_clear_mirq(dev->mirq, 1, &dev->irq_state);
            break;
    }
}

void
sff_bus_master_reset(sff8038i_t *dev)
{
    if (dev->enabled && (dev->base != 0x0000)) {
        io_removehandler(dev->base, 0x08,
                         sff_bus_master_read, sff_bus_master_readw, sff_bus_master_readl,
                         sff_bus_master_write, sff_bus_master_writew, sff_bus_master_writel,
                         dev);

        dev->enabled = 0;
    }

    dev->command = 0x00;
    dev->status  = 0x00;
    dev->ptr = dev->ptr_cur = 0x00000000;
    dev->addr               = 0x00000000;
    dev->ptr0               = 0x00;
    dev->count = dev->eot = 0x00000000;
    dev->irq_state = 0;

    ide_pri_disable();
    ide_sec_disable();
}

static void
sff_reset(void *priv)
{
#ifdef ENABLE_SFF_LOG
    sff_log("SFF8038i: Reset\n");
#endif

    for (uint8_t i = 0; i < HDD_NUM; i++) {
        if ((hdd[i].bus_type == HDD_BUS_ATAPI) && (hdd[i].ide_channel < 4) && hdd[i].priv)
            scsi_disk_reset((scsi_common_t *) hdd[i].priv);
    }
    for (uint8_t i = 0; i < CDROM_NUM; i++) {
        if ((cdrom[i].bus_type == CDROM_BUS_ATAPI) && (cdrom[i].ide_channel < 4) &&
            cdrom[i].priv)
            scsi_cdrom_reset((scsi_common_t *) cdrom[i].priv);
    }
    for (uint8_t i = 0; i < RDISK_NUM; i++) {
        if ((rdisk_drives[i].bus_type == RDISK_BUS_ATAPI) && (rdisk_drives[i].ide_channel < 4) &&
            rdisk_drives[i].priv)
            rdisk_reset((scsi_common_t *) rdisk_drives[i].priv);
    }
    for (uint8_t i = 0; i < MO_NUM; i++) {
        if ((mo_drives[i].bus_type == MO_BUS_ATAPI) && (mo_drives[i].ide_channel < 4) &&
            mo_drives[i].priv)
            mo_reset((scsi_common_t *) mo_drives[i].priv);
    }

    sff_bus_master_set_irq(0x00, priv);
    sff_bus_master_set_irq(0x01, priv);
}

void
sff_set_slot(sff8038i_t *dev, int slot)
{
    dev->slot = slot;
}

void
sff_set_irq_line(sff8038i_t *dev, int pci_irq_line)
{
    dev->pci_irq_line = pci_irq_line;
}

/* TODO: Why does this always set the level to 0, regardless of the parameter?! */
void
sff_set_irq_level(sff8038i_t *dev, UNUSED(int irq_level))
{
    dev->irq_level = 0;
}

void
sff_set_irq_mode(sff8038i_t *dev, int irq_mode)
{
    dev->irq_mode = irq_mode;

    switch (dev->irq_mode) {
        default:
        case IRQ_MODE_LEGACY:
            /* Legacy IRQ mode. */
            sff_log("[%08X] Setting IRQ mode to legacy IRQ %i\n", dev, dev->irq_line);
            break;
        case IRQ_MODE_PCI_IRQ_PIN:
            /* Native PCI IRQ mode with interrupt pin. */
            sff_log("[%08X] Setting IRQ mode to native PCI INT%c\n", dev, 0x40 + dev->irq_pin);
            break;
        case IRQ_MODE_MIRQ_0 ... IRQ_MODE_MIRQ_3:
            /* MIRQ 0, 1, 2, or 3. */
            sff_log("[%08X] Setting IRQ mode to PCI MIRQ%i\n", dev, dev->irq_mode & 3);
            break;
        case IRQ_MODE_PCI_IRQ_LINE:
            /* Native PCI IRQ mode with specified interrupt line. */
            sff_log("[%08X] Setting IRQ mode to native PCI IRQ %i\n", dev, dev->pci_irq_line);
            break;
        case IRQ_MODE_ALI_ALADDIN:
            /* ALi Aladdin Native PCI INTAJ mode. */
            sff_log("[%08X] Setting IRQ mode to INT%cJ\n", dev, 'A' + dev->channel);
            break;
        case IRQ_MODE_SIS_551X:
            /* SiS 551x mode. */
            sff_log("[%08X] Setting IRQ mode to PCI MIRQ2\n", dev);
            break;
    }
}

void
sff_set_irq_pin(sff8038i_t *dev, int irq_pin)
{
    dev->irq_pin = irq_pin;
}

void
sff_set_mirq(sff8038i_t *dev, uint8_t mirq)
{
    dev->mirq = mirq;
}

void
sff_set_ven_handlers(sff8038i_t *dev, uint8_t (*ven_write)(uint16_t port, uint8_t val, void *priv),
                     uint8_t (*ven_read)(uint16_t port, uint8_t val, void *priv), void *priv)
{
    dev->ven_write = ven_write;
    dev->ven_read  = ven_read;

    dev->priv      = priv;
}

static void
sff_close(void *priv)
{
    sff8038i_t *dev = (sff8038i_t *) priv;

    free(dev);

    next_id--;
    if (next_id < 0)
        next_id = 0;
}

static void *
sff_init(UNUSED(const device_t *info))
{
    sff8038i_t *dev = (sff8038i_t *) calloc(1, sizeof(sff8038i_t));

    /* Make sure to only add IDE once. */
    if (next_id == 0)
        device_add(&ide_pci_2ch_device);

    ide_set_bus_master(next_id, sff_bus_master_dma, sff_bus_master_set_irq, dev);

    dev->slot         = 7;
    /* Channel 0 goes to IRQ 14, channel 1 goes to MIRQ0. */
    dev->irq_mode     = next_id ? IRQ_MODE_MIRQ_0 : IRQ_MODE_LEGACY;
    dev->irq_pin      = PCI_INTA;
    dev->irq_line     = 14 + next_id;
    dev->pci_irq_line = 14;
    dev->irq_level    = 0;
    dev->irq_state    = 0;
    dev->mirq         = 2;

    dev->channel      = next_id;
    next_id++;

    return dev;
}

const device_t sff8038i_device = {
    .name          = "SFF-8038i IDE Bus Master",
    .internal_name = "sff8038i",
    .flags         = DEVICE_PCI,
    .local         = 0,
    .init          = sff_init,
    .close         = sff_close,
    .reset         = sff_reset,
    .available     = NULL,
    .speed_changed = NULL,
    .force_redraw  = NULL,
    .config        = NULL
};