811 lines
24 KiB
C
811 lines
24 KiB
C
/*
|
|
* 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
|
|
};
|