/*
 * 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.
 *
 *          This file is part of the 86Box distribution.
 *
 *          Driver for the IBM PC-AT MFM/RLL Fixed Disk controller.
 *
 *          This controller was a 16bit ISA card, and it used a WD1003
 *          based design. Most cards were WD1003-WA2 or -WAH, where the
 *          -WA2 cards had a floppy controller as well (to save space.)
 *
 * Authors: Sarah Walker, <https://pcem-emulator.co.uk/>
 *          Fred N. van Kempen, <decwiz@yahoo.com>
 *
 *          Copyright 2008-2019 Sarah Walker.
 *          Copyright 2017-2019 Fred N. van Kempen.
 */
#include <stdarg.h>
#include <stdint.h>
#include <stdio.h>
#include <string.h>
#include <stdlib.h>
#include <wchar.h>
#define HAVE_STDARG_H
#include <86box/86box.h>
#include <86box/device.h>
#include <86box/io.h>
#include <86box/pic.h>
#include "cpu.h"
#include <86box/machine.h>
#include <86box/timer.h>
#include <86box/plat.h>
#include <86box/ui.h>
#include <86box/hdc.h>
#include <86box/hdd.h>

#define MFM_TIME (TIMER_USEC * 10)

/*Rough estimate - MFM drives spin at 3600 RPM, with 17 sectors per track,
  meaning (3600/60)*17 = 1020 sectors per second, or 980us per sector.

  This is required for OS/2 on slow 286 systems, as the hard drive formatter
  will crash with 'internal processing error' if write sector interrupts are too
  close in time*/
#define SECTOR_TIME        (TIMER_USEC * 980)

#define STAT_ERR           0x01
#define STAT_INDEX         0x02
#define STAT_ECC           0x04
#define STAT_DRQ           0x08 /* data request */
#define STAT_DSC           0x10
#define STAT_WRFLT         0x20
#define STAT_READY         0x40
#define STAT_BUSY          0x80

#define ERR_DAM_NOT_FOUND  0x01 /* Data Address Mark not found */
#define ERR_TR000          0x02 /* track 0 not found */
#define ERR_ABRT           0x04 /* command aborted */
#define ERR_ID_NOT_FOUND   0x10 /* ID not found */
#define ERR_DATA_CRC       0x40 /* data CRC error */
#define ERR_BAD_BLOCK      0x80 /* bad block detected */

#define CMD_RESTORE        0x10
#define CMD_READ           0x20
#define CMD_WRITE          0x30
#define CMD_VERIFY         0x40
#define CMD_FORMAT         0x50
#define CMD_SEEK           0x70
#define CMD_DIAGNOSE       0x90
#define CMD_SET_PARAMETERS 0x91

typedef struct drive_t {
    int8_t  present;  /* drive is present */
    int8_t  hdd_num;  /* drive number in system */
    int8_t  steprate; /* current servo step rate */
    int8_t  spt;      /* physical #sectors per track */
    int8_t  hpc;      /* physical #heads per cylinder */
    int8_t  pad;
    int16_t tracks;   /* physical #tracks per cylinder */

    int8_t cfg_spt;   /* configured #sectors per track */
    int8_t cfg_hpc;   /* configured #heads per track */

    int16_t curcyl;   /* current track number */
} drive_t;

typedef struct mfm_t {
    uint8_t  precomp;  /* 1: precomp/error register */
    uint8_t  error;
    uint8_t  secount;  /* 2: sector count register */
    uint8_t  sector;   /* 3: sector number */
    uint8_t  head;     /* 6: head number + drive select */
    uint8_t  command;  /* 7: command/status */
    uint8_t  status;
    uint8_t  fdisk;    /* 8: control register */
    uint16_t cylinder; /* 4/5: cylinder LOW and HIGH */

    int8_t reset;      /* controller in reset */
    int8_t irqstat;    /* current IRQ status */
    int8_t drvsel;     /* current selected drive */
    int8_t pad;

    int        pos;            /* offset within data buffer */
    pc_timer_t callback_timer; /* callback delay timer */

    uint16_t buffer[256]; /* data buffer (16b wide) */

    drive_t drives[MFM_NUM]; /* attached drives */
} mfm_t;

static uint8_t mfm_read(uint16_t port, void *priv);
static void    mfm_write(uint16_t port, uint8_t val, void *priv);

#ifdef ENABLE_ST506_AT_LOG
int st506_at_do_log = ENABLE_ST506_AT_LOG;

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

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

static __inline void
irq_raise(mfm_t *mfm)
{
    mfm->irqstat = 1;
    if (!(mfm->fdisk & 2))
        picint_common(1 << 14, PIC_IRQ_EDGE, 1, NULL);
}

static __inline void
irq_lower(mfm_t *mfm)
{
    mfm->irqstat = 0;
    if (!(mfm->fdisk & 2))
        picint_common(1 << 14, PIC_IRQ_EDGE, 0, NULL);
}

static __inline void
irq_update(mfm_t *mfm)
{
    uint8_t set = !(mfm->fdisk & 2) && mfm->irqstat;
    picint_common(1 << 14, PIC_IRQ_EDGE, set, NULL);
}

/*
 * Return the sector offset for the current register values.
 *
 * According to the WD1002/WD1003 technical reference manual,
 * this is not done entirely correct. It specifies that the
 * parameters set with the SET_DRIVE_PARAMETERS command are
 * to be used only for multi-sector operations, and that any
 * such operation can only be executed AFTER these parameters
 * have been set. This would imply that for regular single
 * transfers, the controller uses (or, can use) the actual
 * geometry information...
 */
static int
get_sector(mfm_t *mfm, off64_t *addr)
{
    const drive_t *drive = &mfm->drives[mfm->drvsel];

    /* FIXME: See if this is even needed - if the code is present, IBM AT
              diagnostics v2.07 will error with: ERROR 152 - SYSTEM BOARD. */
    if (drive->curcyl != mfm->cylinder) {
        st506_at_log("WD1003(%d) sector: wrong cylinder\n");
        return 1;
    }

    if (mfm->head > drive->cfg_hpc) {
        st506_at_log("WD1003(%d) get_sector: past end of configured heads\n",
                     mfm->drvsel);
        return 1;
    }

    if (mfm->sector >= (drive->cfg_spt + 1)) {
        st506_at_log("WD1003(%d) get_sector: past end of configured sectors\n",
                     mfm->drvsel);
        return 1;
    }

    /* We should check this in the SET_DRIVE_PARAMETERS command!  --FvK */
    if (mfm->head > drive->hpc) {
        st506_at_log("WD1003(%d) get_sector: past end of heads\n", mfm->drvsel);
        return 1;
    }

    if (mfm->sector >= (drive->spt + 1)) {
        st506_at_log("WD1003(%d) get_sector: past end of sectors\n", mfm->drvsel);
        return 1;
    }

    *addr = ((((off64_t) mfm->cylinder * drive->cfg_hpc) + mfm->head) * drive->cfg_spt) + (mfm->sector - 1);

    return 0;
}

static int
get_sector_format(mfm_t *mfm, off64_t *addr)
{
    const drive_t *drive = &mfm->drives[mfm->drvsel];

    /* FIXME: See if this is even needed - if the code is present, IBM AT
              diagnostics v2.07 will error with: ERROR 152 - SYSTEM BOARD. */
    if (drive->curcyl != mfm->cylinder) {
        st506_at_log("WD1003(%d) sector: wrong cylinder\n");
        return 1;
    }

    if (mfm->head > drive->cfg_hpc) {
        st506_at_log("WD1003(%d) get_sector: past end of configured heads\n",
                     mfm->drvsel);
        return 1;
    }

    /* We should check this in the SET_DRIVE_PARAMETERS command!  --FvK */
    if (mfm->head > drive->hpc) {
        st506_at_log("WD1003(%d) get_sector: past end of heads\n", mfm->drvsel);
        return 1;
    }

    *addr = ((((off64_t) mfm->cylinder * drive->cfg_hpc) + mfm->head) * drive->cfg_spt);

    return 0;
}

/* Move to the next sector using CHS addressing. */
static void
next_sector(mfm_t *mfm)
{
    drive_t *drive = &mfm->drives[mfm->drvsel];

    if (++mfm->sector == (drive->cfg_spt + 1)) {
        mfm->sector = 1;
        if (++mfm->head == drive->cfg_hpc) {
            mfm->head = 0;
            mfm->cylinder++;
            if (drive->curcyl < drive->tracks)
                drive->curcyl++;
        }
    }
}

static void
mfm_cmd(mfm_t *mfm, uint8_t val)
{
    drive_t *drive = &mfm->drives[mfm->drvsel];

    if (!drive->present) {
        /* This happens if sofware polls all drives. */
        st506_at_log("WD1003(%d) command %02x on non-present drive\n",
                     mfm->drvsel, val);
        mfm->command = 0xff;
        mfm->status  = STAT_BUSY;
        timer_set_delay_u64(&mfm->callback_timer, 200 * MFM_TIME);
        return;
    }

    irq_lower(mfm);
    mfm->command = val;
    mfm->error   = 0;

    switch (val & 0xf0) {
        case CMD_RESTORE:
            drive->steprate = (val & 0x0f);
            mfm->command &= 0xf0;
            mfm->status = STAT_BUSY;
            timer_set_delay_u64(&mfm->callback_timer, 200 * MFM_TIME);
            break;

        case CMD_SEEK:
            drive->steprate = (val & 0x0f);
            mfm->command &= 0xf0;
            mfm->status = STAT_BUSY;
            timer_set_delay_u64(&mfm->callback_timer, 200 * MFM_TIME);
            break;

        default:
            mfm->command = val;
            switch (val) {
                case CMD_READ:
                case CMD_READ + 1:
                case CMD_READ + 2:
                case CMD_READ + 3:
                    st506_at_log("WD1003(%d) read, opt=%d\n",
                                 mfm->drvsel, val & 0x03);
                    mfm->command &= 0xfc;
                    if (val & 2)
                        fatal("WD1003: READ with ECC\n");
                    mfm->status = STAT_BUSY;
                    timer_set_delay_u64(&mfm->callback_timer, 200 * MFM_TIME);
                    break;

                case CMD_WRITE:
                case CMD_WRITE + 1:
                case CMD_WRITE + 2:
                case CMD_WRITE + 3:
                    st506_at_log("WD1003(%d) write, opt=%d\n",
                                 mfm->drvsel, val & 0x03);
                    mfm->command &= 0xfc;
                    if (val & 2)
                        fatal("WD1003: WRITE with ECC\n");
                    mfm->status = STAT_READY | STAT_DRQ | STAT_DSC;
                    mfm->pos    = 0;
                    break;

                case CMD_VERIFY:
                case CMD_VERIFY + 1:
                    mfm->command &= 0xfe;
                    mfm->status = STAT_BUSY;
                    timer_set_delay_u64(&mfm->callback_timer, 200 * MFM_TIME);
                    break;

                case CMD_FORMAT:
                    mfm->status = STAT_DRQ | STAT_BUSY;
                    mfm->pos    = 0;
                    break;

                case CMD_DIAGNOSE:
                    mfm->status = STAT_BUSY;
                    timer_set_delay_u64(&mfm->callback_timer, 200 * MFM_TIME);
                    break;

                case CMD_SET_PARAMETERS:
                    mfm->status = STAT_BUSY;
                    timer_set_delay_u64(&mfm->callback_timer, 200 * MFM_TIME);
                    break;

                default:
                    st506_at_log("WD1003: bad command %02X\n", val);
                    mfm->status = STAT_BUSY;
                    timer_set_delay_u64(&mfm->callback_timer, 200 * MFM_TIME);
                    break;
            }
    }
}

static void
mfm_writew(uint16_t port, uint16_t val, void *priv)
{
    mfm_t *mfm = (mfm_t *) priv;

    if (port > 0x01f0) {
        mfm_write(port, val & 0xff, priv);
        if (port != 0x01f7)
            mfm_write(port + 1, (val >> 8) & 0xff, priv);
    } else {
        mfm->buffer[mfm->pos >> 1] = val;
        mfm->pos += 2;

        if (mfm->pos >= 512) {
            mfm->pos    = 0;
            mfm->status = STAT_BUSY;
            timer_set_delay_u64(&mfm->callback_timer, SECTOR_TIME);
        }
    }
}

static void
mfm_write(uint16_t port, uint8_t val, void *priv)
{
    mfm_t *mfm = (mfm_t *) priv;
    uint8_t old;

    st506_at_log("WD1003 write(%04x, %02x)\n", port, val);

    switch (port) {
        case 0x01f0: /* data */
            mfm_writew(port, val | (val << 8), priv);
            return;

        case 0x01f1: /* write precompenstation */
            mfm->precomp = val;
            return;

        case 0x01f2: /* sector count */
            mfm->secount = val;
            return;

        case 0x01f3: /* sector */
            mfm->sector = val;
            return;

        case 0x01f4: /* cylinder low */
            mfm->cylinder = (mfm->cylinder & 0xff00) | val;
            return;

        case 0x01f5: /* cylinder high */
            mfm->cylinder = (mfm->cylinder & 0xff) | (val << 8);
            return;

        case 0x01f6: /* drive/head */
            mfm->head   = val & 0xF;
            mfm->drvsel = !!(val & 0x10);
            if (mfm->drives[mfm->drvsel].present)
                mfm->status = STAT_READY | STAT_DSC;
            else
                mfm->status = 0;
            return;

        case 0x01f7: /* command register */
            mfm_cmd(mfm, val);
            break;

        case 0x03f6: /* device control */
            val &= 0x0f;
            if ((mfm->fdisk & 0x04) && !(val & 0x04)) {
                timer_set_delay_u64(&mfm->callback_timer, 500 * MFM_TIME);
                mfm->reset  = 1;
                mfm->status = STAT_BUSY;
            } else if (!(mfm->fdisk & 0x04) && (val & 0x04)) {
                /* Drive held in reset. */
                timer_disable(&mfm->callback_timer);
                mfm->status = STAT_BUSY;
            }
            old = mfm->fdisk;
            mfm->fdisk = val;
            if (!(val & 0x02) && (old & 0x02))
                irq_update(mfm);
            break;

        default:
            break;
    }
}

static uint16_t
mfm_readw(uint16_t port, void *priv)
{
    mfm_t   *mfm = (mfm_t *) priv;
    uint16_t ret;

    if (port > 0x01f0) {
        ret = mfm_read(port, priv);
        if (port == 0x01f7)
            ret |= 0xff00;
        else
            ret |= (mfm_read(port + 1, priv) << 8);
    } else {
        ret = mfm->buffer[mfm->pos >> 1];
        mfm->pos += 2;
        if (mfm->pos >= 512) {
            mfm->pos    = 0;
            mfm->status = STAT_READY | STAT_DSC;
            if (mfm->command == CMD_READ) {
                mfm->secount = (mfm->secount - 1) & 0xff;
                if (mfm->secount) {
                    next_sector(mfm);
                    mfm->status = STAT_BUSY | STAT_READY | STAT_DSC;
                    timer_set_delay_u64(&mfm->callback_timer, SECTOR_TIME);
                } else
                    ui_sb_update_icon(SB_HDD | HDD_BUS_MFM, 0);
            }
        }
    }

    return ret;
}

static uint8_t
mfm_read(uint16_t port, void *priv)
{
    mfm_t  *mfm = (mfm_t *) priv;
    uint8_t ret = 0xff;

    switch (port) {
        case 0x01f0: /* data */
            ret = mfm_readw(port, mfm) & 0xff;
            break;

        case 0x01f1: /* error */
            ret = mfm->error;
            break;

        case 0x01f2: /* sector count */
            ret = mfm->secount;
            break;

        case 0x01f3: /* sector */
            ret = mfm->sector;
            break;

        case 0x01f4: /* CYlinder low */
            ret = (uint8_t) (mfm->cylinder & 0xff);
            break;

        case 0x01f5: /* Cylinder high */
            ret = (uint8_t) (mfm->cylinder >> 8);
            break;

        case 0x01f6: /* drive/head */
            ret = (uint8_t) (0xa0 | mfm->head | (mfm->drvsel ? 0x10 : 0));
            break;

        case 0x01f7: /* Status */
            irq_lower(mfm);
            ret = mfm->status;
            break;

        default:
            break;
    }

    st506_at_log("WD1003 read(%04x) = %02x\n", port, ret);

    return ret;
}

static void
do_seek(mfm_t *mfm)
{
    drive_t *drive = &mfm->drives[mfm->drvsel];

    st506_at_log("WD1003(%d) seek(%d) max=%d\n",
                 mfm->drvsel, mfm->cylinder, drive->tracks);

    if (mfm->cylinder < drive->tracks)
        drive->curcyl = mfm->cylinder;
    else
        drive->curcyl = drive->tracks - 1;
}

static void
do_callback(void *priv)
{
    mfm_t   *mfm   = (mfm_t *) priv;
    drive_t *drive = &mfm->drives[mfm->drvsel];
    off64_t  addr;

    if (mfm->reset) {
        st506_at_log("WD1003(%d) reset\n", mfm->drvsel);

        mfm->status   = STAT_READY | STAT_DSC;
        mfm->error    = 1;
        mfm->secount  = 1;
        mfm->sector   = 1;
        mfm->head     = 0;
        mfm->cylinder = 0;

        drive->steprate = 0x0f; /* default steprate */
        drive->cfg_spt  = 0;    /* need new parameters */

        mfm->reset = 0;

        ui_sb_update_icon(SB_HDD | HDD_BUS_MFM, 0);
        ui_sb_update_icon_write(SB_HDD | HDD_BUS_MFM, 0);

        return;
    }

    switch (mfm->command) {
        case CMD_RESTORE:
            st506_at_log("WD1003(%d) restore, step=%d\n",
                         mfm->drvsel, drive->steprate);
            drive->curcyl = 0;
            mfm->cylinder = 0;
            mfm->status   = STAT_READY | STAT_DSC;
            irq_raise(mfm);
            break;

        case CMD_SEEK:
            st506_at_log("WD1003(%d) seek, step=%d\n",
                         mfm->drvsel, drive->steprate);
            do_seek(mfm);
            mfm->status = STAT_READY | STAT_DSC;
            irq_raise(mfm);
            break;

        case CMD_READ:
            st506_at_log("WD1003(%d) read(%d,%d,%d)\n",
                         mfm->drvsel, mfm->cylinder, mfm->head, mfm->sector);
            do_seek(mfm);
            if (get_sector(mfm, &addr)) {
                mfm->error  = ERR_ID_NOT_FOUND;
read_error:
                mfm->status = STAT_READY | STAT_DSC | STAT_ERR;
                irq_raise(mfm);
                break;
            }

            if (hdd_image_read(drive->hdd_num, addr, 1, (uint8_t *) mfm->buffer) < 0) {
                mfm->error = ERR_BAD_BLOCK;
                goto read_error;
            }

            mfm->pos    = 0;
            mfm->status = STAT_DRQ | STAT_READY | STAT_DSC;
            irq_raise(mfm);
            ui_sb_update_icon(SB_HDD | HDD_BUS_MFM, 1);
            break;

        case CMD_WRITE:
            st506_at_log("WD1003(%d) write(%d,%d,%d)\n",
                         mfm->drvsel, mfm->cylinder, mfm->head, mfm->sector);
            do_seek(mfm);
            if (get_sector(mfm, &addr)) {
                mfm->error  = ERR_ID_NOT_FOUND;
write_error:
                mfm->status = STAT_READY | STAT_DSC | STAT_ERR;
                irq_raise(mfm);
                break;
            }

            if (hdd_image_write(drive->hdd_num, addr, 1, (uint8_t *) mfm->buffer) < 0) {
                mfm->error = ERR_BAD_BLOCK;
                goto write_error;
            }
            irq_raise(mfm);
            mfm->secount = (mfm->secount - 1) & 0xff;

            mfm->status = STAT_READY | STAT_DSC;
            if (mfm->secount) {
                /* More sectors to do.. */
                mfm->status |= STAT_DRQ;
                mfm->pos = 0;
                next_sector(mfm);
                ui_sb_update_icon_write(SB_HDD | HDD_BUS_MFM, 1);
            } else
                ui_sb_update_icon_write(SB_HDD | HDD_BUS_MFM, 0);
            break;

        case CMD_VERIFY:
            st506_at_log("WD1003(%d) verify(%d,%d,%d)\n",
                         mfm->drvsel, mfm->cylinder, mfm->head, mfm->sector);
            do_seek(mfm);
            mfm->pos    = 0;
            mfm->status = STAT_READY | STAT_DSC;
            irq_raise(mfm);
            ui_sb_update_icon(SB_HDD | HDD_BUS_MFM, 1);
            break;

        case CMD_FORMAT:
            st506_at_log("WD1003(%d) format(%d,%d)\n",
                         mfm->drvsel, mfm->cylinder, mfm->head);
            do_seek(mfm);
            if (get_sector_format(mfm, &addr)) {
                mfm->error  = ERR_ID_NOT_FOUND;
                mfm->status = STAT_READY | STAT_DSC | STAT_ERR;
                irq_raise(mfm);
                break;
            }

            hdd_image_zero(drive->hdd_num, addr, mfm->secount);

            mfm->status = STAT_READY | STAT_DSC;
            irq_raise(mfm);
            ui_sb_update_icon_write(SB_HDD | HDD_BUS_MFM, 1);
            break;

        case CMD_DIAGNOSE:
            st506_at_log("WD1003(%d) diag\n", mfm->drvsel);

            /* This is basically controller diagnostics - it resets drive select to 0,
               and resets error and status to ready, DSC, and no error detected. */
            mfm->drvsel = 0;
            drive       = &mfm->drives[mfm->drvsel];

            drive->steprate = 0x0f;
            mfm->error      = 1;
            mfm->status     = STAT_READY | STAT_DSC;
            irq_raise(mfm);
            break;

        case CMD_SET_PARAMETERS:
            /*
             * NOTE:
             *
             * We currently just set these parameters, and
             * never bother to check if they "fit within"
             * the actual parameters, as determined by the
             * image loader.
             *
             * The difference in parameters is OK, and
             * occurs when the BIOS or operating system
             * decides to use a different translation
             * scheme, but either way, it SHOULD always
             * fit within the actual parameters!
             *
             * We SHOULD check that here!! --FvK
             */
            if (drive->cfg_spt == 0) {
                /* Only accept after RESET or DIAG. */
                drive->cfg_spt = mfm->secount;
                drive->cfg_hpc = mfm->head + 1;
                st506_at_log("WD1003(%d) parameters: tracks=%d, spt=%i, hpc=%i\n",
                             mfm->drvsel, drive->tracks,
                             drive->cfg_spt, drive->cfg_hpc);
            } else {
                st506_at_log("WD1003(%d) parameters: tracks=%d,spt=%i,hpc=%i (IGNORED)\n",
                             mfm->drvsel, drive->tracks,
                             drive->cfg_spt, drive->cfg_hpc);
            }
            mfm->command = 0x00;
            mfm->status  = STAT_READY | STAT_DSC;
            mfm->error   = 1;
            irq_raise(mfm);
            break;

        default:
            st506_at_log("WD1003(%d) callback on unknown command %02x\n",
                         mfm->drvsel, mfm->command);
            mfm->status = STAT_READY | STAT_ERR | STAT_DSC;
            mfm->error  = ERR_ABRT;
            irq_raise(mfm);
            break;
    }
}

static void
loadhd(mfm_t *mfm, int c, int d, UNUSED(const char *fn))
{
    drive_t *drive = &mfm->drives[c];

    if (!hdd_image_load(d)) {
        drive->present = 0;

        return;
    }

    drive->spt     = hdd[d].spt;
    drive->hpc     = hdd[d].hpc;
    drive->tracks  = hdd[d].tracks;
    drive->hdd_num = d;
    drive->present = 1;
}

static void *
mfm_init(UNUSED(const device_t *info))
{
    mfm_t *mfm;
    int    c;

    st506_at_log("WD1003: ISA MFM/RLL Fixed Disk Adapter initializing ...\n");
    mfm = calloc(1, sizeof(mfm_t));

    c = 0;
    for (uint8_t d = 0; d < HDD_NUM; d++) {
        if ((hdd[d].bus_type == HDD_BUS_MFM) && (hdd[d].mfm_channel < MFM_NUM)) {
            loadhd(mfm, hdd[d].mfm_channel, d, hdd[d].fn);

            st506_at_log("WD1003(%d): (%s) geometry %d/%d/%d\n", c, hdd[d].fn,
                         (int) hdd[d].tracks, (int) hdd[d].hpc, (int) hdd[d].spt);

            if (++c >= MFM_NUM)
                break;
        }
    }

    mfm->status = STAT_READY | STAT_DSC; /* drive is ready */
    mfm->error  = 1;                     /* no errors */

    io_sethandler(0x01f0, 1,
                  mfm_read, mfm_readw, NULL, mfm_write, mfm_writew, NULL, mfm);
    io_sethandler(0x01f1, 7,
                  mfm_read, mfm_readw, NULL, mfm_write, mfm_writew, NULL, mfm);
    io_sethandler(0x03f6, 1,
                  NULL, NULL, NULL, mfm_write, NULL, NULL, mfm);

    timer_add(&mfm->callback_timer, do_callback, mfm, 0);

    ui_sb_update_icon(SB_HDD | HDD_BUS_MFM, 0);
    ui_sb_update_icon_write(SB_HDD | HDD_BUS_MFM, 0);

    return mfm;
}

static void
mfm_close(void *priv)
{
    mfm_t *mfm = (mfm_t *) priv;

    for (uint8_t d = 0; d < 2; d++) {
        const drive_t *drive = &mfm->drives[d];

        hdd_image_close(drive->hdd_num);
    }

    free(mfm);

    ui_sb_update_icon(SB_HDD | HDD_BUS_MFM, 0);
    ui_sb_update_icon_write(SB_HDD | HDD_BUS_MFM, 0);
}

const device_t st506_at_wd1003_device = {
    .name          = "WD1003 AT MFM/RLL Controller",
    .internal_name = "st506_at",
    .flags         = DEVICE_ISA16,
    .local         = 0,
    .init          = mfm_init,
    .close         = mfm_close,
    .reset         = NULL,
    .available     = NULL,
    .speed_changed = NULL,
    .force_redraw  = NULL,
    .config        = NULL
};
