--- xmil/io/fdc.c 2004/08/10 08:28:49 1.4 +++ xmil/io/fdc.c 2004/08/11 13:53:53 1.8 @@ -3,6 +3,7 @@ #include "z80core.h" #include "pccore.h" #include "iocore.h" +#include "nevent.h" #include "fddfile.h" #include "fdd_2d.h" #include "fdd_d88.h" @@ -12,30 +13,19 @@ static const UINT8 fdctype[] = {1,1,1,1,1,1,1,1,2,2,2,2,3,4,3,3}; -static void setbusy(UINT clock) { +void nvitem_fdcbusy(UINT id) { - fdc.s.busystart = h_cntbase + h_cnt; - fdc.s.busyclock = clock; + fdc.s.busy = FALSE; + if (fdc.s.bufdir) { + TRACEOUT(("dma ready!")); + dma.DMA_REDY = 0; + } } -REG8 fdcisbusy(void) { - - UINT clock; +static void setbusy(UINT clock) { - if (fdc.s.busyclock) { - clock = h_cntbase + h_cnt; - if ((clock - fdc.s.busystart) < fdc.s.busyclock) { - return(0x01); - } - fdc.s.busyclock = 0; - if ((fdc.s.type == 2) || (fdc.s.cmd == 0x0c) || (fdc.s.cmd == 0x0e)) { - if (fdc.s.bufpos < fdc.s.bufsize) { - TRACEOUT(("dma ready!")); - dma.DMA_REDY = 0; - } - } - } - return(0x00); + fdc.s.busy = TRUE; + nevent_set(NEVENT_FDC, clock, nvitem_fdcbusy, NEVENT_ABSOLUTE); } static REG8 getstat(void) { @@ -119,6 +109,7 @@ static REG8 type2cmd(REG8 sc) { } size = sizeof(fdc.s.buffer); fdd = fddfile + fdc.s.drv; + TRACEOUT(("read %.2x %d %d", fdc.s.drv, track, sc)); stat = fdd->read(fdd, fdc.s.media, track, sc, p, &size); if (stat & FDDSTAT_RECNFND) { size = 0; @@ -186,7 +177,7 @@ static void bufposinc(void) { BRESULT r; REG8 stat; - if (fdcisbusy()) { + if (fdc.s.busy) { return; } fdc.s.bufpos++; @@ -231,195 +222,158 @@ void IOOUTCALL fdc_o(UINT port, REG8 val return; } TRACEOUT(("fdc %.4x,%.2x [%.4x]", port, value, Z80_PC)); - port &= 0xf; - if (port == 8) { // コマンド - fdc.s.cmd = value; - cmd = (REG8)(value >> 4); - fdc.s.type = fdctype[cmd]; - TRACEOUT(("fdc cmd: %.2x", value)); - if (fdc.s.bufwrite) { - fdc.s.stat = type2flash(); - } - setbusy(20); - switch(cmd) { - case 0x00: // リストア - if (value & 8) { // LAYDOCK - setbusy(0); - } - fdc.s.motor = 0x80; // モーターOn? - fdc.s.c = 0; - fdc.s.step = 1; - fdc.s.r = 0; // デゼニワールド - seekcmd(); - fdc.s.rreg = 0; - break; + switch(port & 7) { + case 0: // コマンド + fdc.s.cmd = value; + cmd = (REG8)(value >> 4); + fdc.s.type = fdctype[cmd]; + TRACEOUT(("fdc cmd: %.2x", value)); + if (fdc.s.bufwrite) { + fdc.s.stat = type2flash(); + } + fdc.s.bufdir = FDCDIR_NONE; + setbusy(20); + switch(cmd) { + case 0x00: // リストア + if (value & 8) { // LAYDOCK + setbusy(0); + } + fdc.s.motor = 0x80; // モーターOn? + fdc.s.c = 0; + fdc.s.step = 1; + fdc.s.r = 0; // デゼニワールド + seekcmd(); + fdc.s.rreg = 0; + break; - case 0x01: // シーク - fdc.s.motor = 0x80; // モーターOn - fdc.s.step = (SINT8)((fdc.s.c<=fdc.s.data)?1:-1); - fdc.s.c = fdc.s.data; - seekcmd(); - break; - - case 0x02: // ステップ - case 0x03: - if (fdc.s.motor) { - fdc.s.c += fdc.s.step; - if (cmd & 1) { - seekcmd(); + case 0x01: // シーク + fdc.s.motor = 0x80; // モーターOn + fdc.s.step = (SINT8)((fdc.s.c<=fdc.s.data)?1:-1); + fdc.s.c = fdc.s.data; + seekcmd(); + break; + + case 0x02: // ステップ + case 0x03: + if (fdc.s.motor) { + fdc.s.c += fdc.s.step; + if (cmd & 1) { + seekcmd(); + } } - } - break; + break; - case 0x04: // ステップイン - case 0x05: - if (fdc.s.motor) { - fdc.s.step = 1; - fdc.s.c++; - if (cmd & 1) { - seekcmd(); + case 0x04: // ステップイン + case 0x05: + if (fdc.s.motor) { + fdc.s.step = 1; + fdc.s.c++; + if (cmd & 1) { + seekcmd(); + } } - } - break; + break; - case 0x06: // ステップアウト - case 0x07: - if (fdc.s.motor) { - fdc.s.step = -1; - fdc.s.c--; - if (cmd & 1) { - seekcmd(); + case 0x06: // ステップアウト + case 0x07: + if (fdc.s.motor) { + fdc.s.step = -1; + fdc.s.c--; + if (cmd & 1) { + seekcmd(); + } } - } - break; + break; - case 0x08: // リードデータ - case 0x09: - case 0x0a: // ライトデータ - case 0x0b: - setbusy(200); - fdc.s.stat = type2cmd(fdc.s.r); - break; - - case 0xc: // リードアドレス - setbusy(200); - fdc.s.stat = crccmd(); - break; - - case 0x0d: // フォースインタラプト - setbusy(0); // 必要ない? -// fdc.s.skip = 0; // 000330 - dma.DMA_REDY = 8; // ver0.25 - break; - - case 0x0e: // リードトラック - setbusy(200); - ZeroMemory(fdc.s.buffer, 0x1a00); - fdc.s.bufpos = 0; - fdc.s.bufsize = 0x1a00; - fdc.s.bufdir = FDCDIR_IN; - break; + case 0x08: // リードデータ + case 0x09: + case 0x0a: // ライトデータ + case 0x0b: + setbusy(500); + fdc.s.stat = type2cmd(fdc.s.r); + break; + + case 0xc: // リードアドレス + setbusy(200); + fdc.s.stat = crccmd(); + break; + + case 0x0d: // フォースインタラプト + setbusy(0); // 必要ない? +// fdc.s.skip = 0; // 000330 + dma.DMA_REDY = 8; // ver0.25 + break; + + case 0x0e: // リードトラック + setbusy(200); + ZeroMemory(fdc.s.buffer, 0x1a00); + fdc.s.bufpos = 0; + fdc.s.bufsize = 0x1a00; + fdc.s.bufdir = FDCDIR_IN; + break; - case 0x0f: // ライトトラック -#if 0 - { - FDDFILE fdd = fddfile + fdc.s.drv; - switch(fdd->type) { - case DISKTYPE_NOTREADY: - case DISKTYPE_BETA: - break; - - case DISKTYPE_D88: - default: - if (fdc.s.motor) { // ver0.25 - init_tao_d88(); - if (dma.DMA_ENBL) { - dma.DMA_REDY = 0; - } - } - break; - } - } -#endif - break; - } - } - else { - cmd = (REG8)(fdc.s.cmd >> 4); - switch(port) { - case 0x09: // トラック - fdc.s.c = value; - break; - - case 0x0a: // セクタ - FDDMTR_WAITSEC(value); - fdc.s.r = value; - fdc.s.rreg = value; - break; - - case 0x0b: // データ - fdc.s.data = value; - if ((fdc.s.motor) && (fdc.s.bufdir == FDCDIR_OUT)) { - fdc.s.buffer[fdc.s.bufpos] = value; - fdc.s.bufwrite = TRUE; - bufposinc(); - } -#if 0 - else if (cmd == 0x0f) { // TRACK WRITE - FDDFILE fdd = fddfile + fdc.s.drv; - switch(fdd->type) { - case DISKTYPE_NOTREADY: - case DISKTYPE_BETA: - break; - - case DISKTYPE_D88: - default: - fdd_wtao_d88(value); - break; - } - } -#endif - break; + case 0x0f: // ライトトラック + break; + } + break; - case 0x0c: // ドライブ・サイド - fdc.s.ctbl[fdc.s.drv] = fdc.s.c; - fdc.s.c = fdc.s.ctbl[value & 0x03]; - fdc.s.motor = (UINT8)(value & 0x80); - fdc.s.drv = (UINT8)(value & 0x03); - fdc.s.h = (UINT8)((value >> 4) & 1); - fdc.s.cmd = 0; // T&E SORCERIAN - fdc.s.type = 0; - - FDDMTR_DRVSET; - if (!fdc.s.motor) { - fdc.s.r = 0; // SACOM TELENET - fdc.s.rreg = 0; - } - break; - } + case 1: // トラック + fdc.s.c = value; + break; + + case 2: // セクタ + FDDMTR_WAITSEC(value); + fdc.s.r = value; + fdc.s.rreg = value; + break; + + case 3: // データ + fdc.s.data = value; + if ((fdc.s.motor) && (fdc.s.bufdir == FDCDIR_OUT)) { + fdc.s.buffer[fdc.s.bufpos] = value; + fdc.s.bufwrite = TRUE; + bufposinc(); + } + break; + + case 4: // ドライブ・サイド + fdc.s.ctbl[fdc.s.drv] = fdc.s.c; + fdc.s.c = fdc.s.ctbl[value & 0x03]; + fdc.s.motor = (UINT8)(value & 0x80); + fdc.s.drv = (UINT8)(value & 0x03); + fdc.s.h = (UINT8)((value >> 4) & 1); + fdc.s.cmd = 0; // T&E SORCERIAN + fdc.s.type = 0; + + FDDMTR_DRVSET; + if (!fdc.s.motor) { + fdc.s.r = 0; // SACOM TELENET + fdc.s.rreg = 0; + } + break; } } REG8 IOINPCALL fdc_i(UINT port) { -static BYTE timeoutwait; -static BYTE last_r; -static short last_off; - REG8 cmd; +// static BYTE timeoutwait; +// static BYTE last_r; +// static short last_off; REG8 ret; if ((port & (~7)) != 0x0ff8) { return(0xff); } - cmd = (REG8)(fdc.s.cmd >> 4); +#if 0 if ((port &= 0xf) != 8) { last_r = -1; last_off = -1; timeoutwait = 4; } - switch(port) { - case 0x8: // ステータス - ret = fdcisbusy(); +#endif + switch(port & 7) { + case 0: // ステータス + ret = fdc.s.busy; if (ret) { return(ret); } @@ -440,35 +394,35 @@ static short last_off; } return(ret); - case 0x9: // トラック + case 1: // トラック return(fdc.s.creg); - case 0xa: // セクタ + case 2: // セクタ return(fdc.s.rreg); - case 0xb: // データ + case 3: // データ if (fdc.s.motor) { if (fdc.s.bufdir == FDCDIR_IN) { fdc.s.data = fdc.s.buffer[fdc.s.bufpos]; -// TRACEOUT(("sector read %.2x [%.2x]", fdc.s.data, fdc.s.bufpos)); +TRACEOUT(("read %.2x %.2x [%.4x]", fdc.s.data, fdc.s.bufpos, Z80_PC)); bufposinc(); } } - return(fdc.s.data); // WOODY POCO !!! + return(fdc.s.data); -// case 0xc: // FM -// case 0xd: // MFM -// break; + case 4: // FM + case 5: // MFM + return(0x00); - case 0xe: // 1.6M + case 6: // 1.6M fdc.s.media = DISKTYPE_2HD; - return(0xff); + break; - case 0xf: // 500K/1M + case 7: // 500K/1M fdc.s.media = DISKTYPE_2D; - return(0xff); + break; } - return(0); + return(0xff); }