|
|
| version 1.7, 2004/08/11 12:08:16 | version 1.12, 2004/08/12 17:57:36 |
|---|---|
| Line 13 | Line 13 |
| static const UINT8 fdctype[] = {1,1,1,1,1,1,1,1,2,2,2,2,3,4,3,3}; | static const UINT8 fdctype[] = {1,1,1,1,1,1,1,1,2,2,2,2,3,4,3,3}; |
| void nvitem_fdcbusy(UINT id) { | void neitem_fdcbusy(UINT id) { |
| fdc.s.busy = FALSE; | fdc.s.busy = FALSE; |
| if (fdc.s.bufdir) { | if (fdc.s.bufdir) { |
| TRACEOUT(("dma ready!")); | TRACEOUT(("dma ready!")); |
| dma.DMA_REDY = 0; | dmac_sendready(TRUE); |
| } | } |
| (void)id; | |
| } | } |
| static void setbusy(UINT clock) { | static void setbusy(UINT clock) { |
| fdc.s.busy = TRUE; | fdc.s.busy = TRUE; |
| nevent_set(NEVENT_FDC, clock, nvitem_fdcbusy, NEVENT_ABSOLUTE); | nevent_set(NEVENT_FDC, clock, neitem_fdcbusy, NEVENT_ABSOLUTE); |
| } | } |
| static REG8 getstat(void) { | static REG8 getstat(void) { |
| Line 130 static REG8 type2cmd(REG8 sc) { | Line 131 static REG8 type2cmd(REG8 sc) { |
| fdc.s.bufmark = fdc.s.cmd & 1; | fdc.s.bufmark = fdc.s.cmd & 1; |
| fdc.s.bufpos = 0; | fdc.s.bufpos = 0; |
| fdc.s.bufsize = size; | fdc.s.bufsize = size; |
| fdc.s.curtime = 0; | |
| return(stat); | return(stat); |
| } | } |
| Line 169 static REG8 crccmd(void) { | Line 171 static REG8 crccmd(void) { |
| fdc.s.bufsize = 0; | fdc.s.bufsize = 0; |
| } | } |
| fdc.s.bufwrite = FALSE; | fdc.s.bufwrite = FALSE; |
| fdc.s.curtime = 0; | |
| return(stat); | return(stat); |
| } | } |
| Line 181 static void bufposinc(void) { | Line 184 static void bufposinc(void) { |
| return; | return; |
| } | } |
| fdc.s.bufpos++; | fdc.s.bufpos++; |
| fdc.s.curtime = 0; | |
| if (fdc.s.bufpos >= fdc.s.bufsize) { | if (fdc.s.bufpos >= fdc.s.bufsize) { |
| r = FALSE; | r = FALSE; |
| if (fdc.s.type == 2) { | if (fdc.s.type == 2) { |
| Line 208 static void bufposinc(void) { | Line 212 static void bufposinc(void) { |
| } | } |
| } | } |
| if (!r) { | if (!r) { |
| dma.DMA_REDY = 8; | |
| fdc.s.bufdir = FDCDIR_NONE; | fdc.s.bufdir = FDCDIR_NONE; |
| dmac_sendready(FALSE); | |
| } | } |
| } | } |
| } | } |
| Line 221 void IOOUTCALL fdc_o(UINT port, REG8 val | Line 225 void IOOUTCALL fdc_o(UINT port, REG8 val |
| if ((port & (~7)) != 0x0ff8) { | if ((port & (~7)) != 0x0ff8) { |
| return; | return; |
| } | } |
| TRACEOUT(("fdc %.4x,%.2x [%.4x]", port, value, Z80_PC)); | // TRACEOUT(("fdc %.4x,%.2x [%.4x]", port, value, Z80_PC)); |
| port &= 0xf; | switch(port & 7) { |
| if (port == 8) { // コマンド | case 0: // コマンド |
| fdc.s.cmd = value; | fdc.s.cmd = value; |
| cmd = (REG8)(value >> 4); | cmd = (REG8)(value >> 4); |
| fdc.s.type = fdctype[cmd]; | fdc.s.type = fdctype[cmd]; |
| TRACEOUT(("fdc cmd: %.2x", value)); | TRACEOUT(("fdc cmd: %.2x", value)); |
| if (fdc.s.bufwrite) { | if (fdc.s.bufwrite) { |
| fdc.s.stat = type2flash(); | fdc.s.stat = type2flash(); |
| } | } |
| fdc.s.bufdir = FDCDIR_NONE; | fdc.s.bufdir = FDCDIR_NONE; |
| setbusy(20); | // リストアコマンドにおいて |
| switch(cmd) { | // マリオは コマンド発行後にbusyを見張る |
| case 0x00: // リストア | // 逆にソーサリアンとかは busyだとエラーになる… |
| if (value & 8) { // LAYDOCK | // 条件は何? |
| setbusy(0); | setbusy(20); |
| } | switch(cmd) { |
| fdc.s.motor = 0x80; // モーターOn? | case 0x00: // リストア |
| fdc.s.c = 0; | // if (value & 8) { // LAYDOCK |
| fdc.s.step = 1; | // setbusy(0); |
| fdc.s.r = 0; // デゼニワールド | // } |
| seekcmd(); | fdc.s.motor = 0x80; // モーターOn? |
| fdc.s.rreg = 0; | fdc.s.c = 0; |
| break; | fdc.s.step = 1; |
| fdc.s.r = 0; // デゼニワールド | |
| seekcmd(); | |
| fdc.s.rreg = 0; | |
| break; | |
| case 0x01: // シーク | case 0x01: // シーク |
| fdc.s.motor = 0x80; // モーターOn | fdc.s.motor = 0x80; // モーターOn |
| fdc.s.step = (SINT8)((fdc.s.c<=fdc.s.data)?1:-1); | fdc.s.step = (SINT8)((fdc.s.c<=fdc.s.data)?1:-1); |
| fdc.s.c = fdc.s.data; | fdc.s.c = fdc.s.data; |
| seekcmd(); | seekcmd(); |
| break; | break; |
| case 0x02: // ステップ | case 0x02: // ステップ |
| case 0x03: | case 0x03: |
| if (fdc.s.motor) { | if (fdc.s.motor) { |
| fdc.s.c += fdc.s.step; | fdc.s.c += fdc.s.step; |
| if (cmd & 1) { | if (cmd & 1) { |
| seekcmd(); | seekcmd(); |
| } | |
| } | } |
| } | break; |
| break; | |
| case 0x04: // ステップイン | case 0x04: // ステップイン |
| case 0x05: | case 0x05: |
| if (fdc.s.motor) { | if (fdc.s.motor) { |
| fdc.s.step = 1; | fdc.s.step = 1; |
| fdc.s.c++; | fdc.s.c++; |
| if (cmd & 1) { | if (cmd & 1) { |
| seekcmd(); | seekcmd(); |
| } | |
| } | } |
| } | break; |
| break; | |
| case 0x06: // ステップアウト | case 0x06: // ステップアウト |
| case 0x07: | case 0x07: |
| if (fdc.s.motor) { | if (fdc.s.motor) { |
| fdc.s.step = -1; | fdc.s.step = -1; |
| fdc.s.c--; | fdc.s.c--; |
| if (cmd & 1) { | if (cmd & 1) { |
| seekcmd(); | seekcmd(); |
| } | |
| } | } |
| } | break; |
| break; | |
| case 0x08: // リードデータ | case 0x08: // リードデータ |
| case 0x09: | case 0x09: |
| case 0x0a: // ライトデータ | case 0x0a: // ライトデータ |
| case 0x0b: | case 0x0b: |
| setbusy(500); | setbusy(500); |
| fdc.s.stat = type2cmd(fdc.s.r); | fdc.s.stat = type2cmd(fdc.s.r); |
| break; | break; |
| case 0xc: // リードアドレス | case 0xc: // リードアドレス |
| setbusy(200); | setbusy(200); |
| fdc.s.stat = crccmd(); | fdc.s.stat = crccmd(); |
| break; | break; |
| case 0x0d: // フォースインタラプト | case 0x0d: // フォースインタラプト |
| setbusy(0); // 必要ない? | setbusy(0); // 必要ない? |
| // fdc.s.skip = 0; // 000330 | // fdc.s.skip = 0; // 000330 |
| dma.DMA_REDY = 8; // ver0.25 | dmac_sendready(FALSE); |
| break; | break; |
| case 0x0e: // リードトラック | case 0x0e: // リードトラック |
| setbusy(200); | setbusy(200); |
| ZeroMemory(fdc.s.buffer, 0x1a00); | ZeroMemory(fdc.s.buffer, 0x1a00); |
| fdc.s.bufpos = 0; | fdc.s.bufpos = 0; |
| fdc.s.bufsize = 0x1a00; | fdc.s.bufsize = 0x1a00; |
| fdc.s.bufdir = FDCDIR_IN; | fdc.s.bufdir = FDCDIR_IN; |
| break; | break; |
| case 0x0f: // ライトトラック | case 0x0f: // ライトトラック |
| #if 0 | break; |
| { | } |
| FDDFILE fdd = fddfile + fdc.s.drv; | break; |
| 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 0x0c: // ドライブ・サイド | case 1: // トラック |
| fdc.s.ctbl[fdc.s.drv] = fdc.s.c; | fdc.s.c = value; |
| fdc.s.c = fdc.s.ctbl[value & 0x03]; | break; |
| fdc.s.motor = (UINT8)(value & 0x80); | |
| fdc.s.drv = (UINT8)(value & 0x03); | case 2: // セクタ |
| fdc.s.h = (UINT8)((value >> 4) & 1); | FDDMTR_WAITSEC(value); |
| fdc.s.cmd = 0; // T&E SORCERIAN | fdc.s.r = value; |
| fdc.s.type = 0; | fdc.s.rreg = value; |
| break; | |
| FDDMTR_DRVSET; | |
| if (!fdc.s.motor) { | case 3: // データ |
| fdc.s.r = 0; // SACOM TELENET | fdc.s.data = value; |
| fdc.s.rreg = 0; | if ((fdc.s.motor) && (fdc.s.bufdir == FDCDIR_OUT)) { |
| } | fdc.s.buffer[fdc.s.bufpos] = value; |
| break; | 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) { | REG8 IOINPCALL fdc_i(UINT port) { |
| static BYTE timeoutwait; | // static BYTE timeoutwait; |
| static BYTE last_r; | // static BYTE last_r; |
| static short last_off; | // static short last_off; |
| REG8 cmd; | |
| REG8 ret; | REG8 ret; |
| if ((port & (~7)) != 0x0ff8) { | if ((port & (~7)) != 0x0ff8) { |
| return(0xff); | return(0xff); |
| } | } |
| cmd = (REG8)(fdc.s.cmd >> 4); | #if 0 |
| if ((port &= 0xf) != 8) { | if ((port &= 0xf) != 8) { |
| last_r = -1; | last_r = -1; |
| last_off = -1; | last_off = -1; |
| timeoutwait = 4; | timeoutwait = 4; |
| } | } |
| switch(port) { | #endif |
| case 0x8: // ステータス | switch(port & 7) { |
| case 0: // ステータス | |
| ret = fdc.s.busy; | ret = fdc.s.busy; |
| if (ret) { | if (ret) { |
| return(ret); | return(ret); |
| } | } |
| #if 0 | #if 1 |
| if (fdc.s.type == 2) { | if (fdc.s.bufdir) { // YsII |
| if (last_r == _fdc.r && last_off == fdc.off && | fdc.s.curtime++; |
| !(--timeoutwait)) { | if (fdc.s.curtime >= 8) { |
| inc_off(); | fdc.s.stat |= 0x04; |
| timeoutwait = 4; | bufposinc(); |
| } | } |
| last_r = _fdc.r; | } |
| last_off = fdc.off; | |
| } // Read Write時のみの変化でいい筈 | |
| #endif | #endif |
| ret = getstat(); | ret = getstat(); |
| if (!(ret & 0x02)) { | if (!(ret & 0x02)) { |
| dma.DMA_REDY = 8; | dmac_sendready(FALSE); |
| } | } |
| return(ret); | return(ret); |
| case 0x9: // トラック | case 1: // トラック |
| return(fdc.s.creg); | return(fdc.s.creg); |
| case 0xa: // セクタ | case 2: // セクタ |
| return(fdc.s.rreg); | return(fdc.s.rreg); |
| case 0xb: // データ | case 3: // データ |
| if (fdc.s.motor) { | if (fdc.s.motor) { |
| if (fdc.s.bufdir == FDCDIR_IN) { | if (fdc.s.bufdir == FDCDIR_IN) { |
| fdc.s.data = fdc.s.buffer[fdc.s.bufpos]; | 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(); | bufposinc(); |
| } | } |
| } | } |
| return(fdc.s.data); // WOODY POCO !!! | return(fdc.s.data); |
| // case 0xc: // FM | case 4: // FM |
| // case 0xd: // MFM | case 5: // MFM |
| // break; | return(0x00); |
| case 0xe: // 1.6M | case 6: // 1.6M |
| fdc.s.media = DISKTYPE_2HD; | fdc.s.media = DISKTYPE_2HD; |
| return(0xff); | break; |
| case 0xf: // 500K/1M | case 7: // 500K/1M |
| fdc.s.media = DISKTYPE_2D; | fdc.s.media = DISKTYPE_2D; |
| return(0xff); | break; |
| } | } |
| return(0); | return(0xff); |
| } | } |
| Line 471 void fdc_reset(void) { | Line 439 void fdc_reset(void) { |
| FDDMTR_INIT; | FDDMTR_INIT; |
| ZeroMemory(&fdc, sizeof(fdc)); | ZeroMemory(&fdc, sizeof(fdc)); |
| fdc.s.step = 1; | fdc.s.step = 1; |
| fdc.s.equip = xmilcfg.fddequip; | |
| } | } |