--- xmil/io/fdc.c 2004/08/11 12:08:16 1.7 +++ xmil/io/fdc.c 2004/08/11 17:45:06 1.10 @@ -18,7 +18,7 @@ void nvitem_fdcbusy(UINT id) { fdc.s.busy = FALSE; if (fdc.s.bufdir) { TRACEOUT(("dma ready!")); - dma.DMA_REDY = 0; + dmac_sendready(TRUE); } } @@ -130,6 +130,7 @@ static REG8 type2cmd(REG8 sc) { fdc.s.bufmark = fdc.s.cmd & 1; fdc.s.bufpos = 0; fdc.s.bufsize = size; + fdc.s.curtime = 0; return(stat); } @@ -169,6 +170,7 @@ static REG8 crccmd(void) { fdc.s.bufsize = 0; } fdc.s.bufwrite = FALSE; + fdc.s.curtime = 0; return(stat); } @@ -181,6 +183,7 @@ static void bufposinc(void) { return; } fdc.s.bufpos++; + fdc.s.curtime = 0; if (fdc.s.bufpos >= fdc.s.bufsize) { r = FALSE; if (fdc.s.type == 2) { @@ -208,8 +211,8 @@ static void bufposinc(void) { } } if (!r) { - dma.DMA_REDY = 8; fdc.s.bufdir = FDCDIR_NONE; + dmac_sendready(FALSE); } } } @@ -221,246 +224,209 @@ void IOOUTCALL fdc_o(UINT port, REG8 val if ((port & (~7)) != 0x0ff8) { 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(); - } - 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; +// TRACEOUT(("fdc %.4x,%.2x [%.4x]", port, value, Z80_PC)); + 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; + // マリオは コマンド発行後にbusyを見張る + // 逆にソーサリアンとかは busyだとエラーになる… + // 条件は何? + 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(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 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 + dmac_sendready(FALSE); + 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: // ステータス +#endif + switch(port & 7) { + case 0: // ステータス ret = fdc.s.busy; if (ret) { return(ret); } -#if 0 - if (fdc.s.type == 2) { - if (last_r == _fdc.r && last_off == fdc.off && - !(--timeoutwait)) { - inc_off(); - timeoutwait = 4; +#if 1 + if (fdc.s.bufdir) { // YsII + fdc.s.curtime++; + if (fdc.s.curtime >= 8) { + fdc.s.stat |= 0x04; + bufposinc(); } - last_r = _fdc.r; - last_off = fdc.off; - } // Read Write時のみの変化でいい筈 + } #endif ret = getstat(); if (!(ret & 0x02)) { - dma.DMA_REDY = 8; + dmac_sendready(FALSE); } 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) [%.4x]", fdc.s.data, fdc.s.bufpos, Z80_PC)); +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); }