|
version 1.3, 2004/08/09 04:47:53
|
version 1.14, 2004/08/13 02:16:33
|
|
Line 3
|
Line 3
|
| #include "z80core.h" |
#include "z80core.h" |
| #include "pccore.h" |
#include "pccore.h" |
| #include "iocore.h" |
#include "iocore.h" |
| |
#include "nevent.h" |
| #include "fddfile.h" |
#include "fddfile.h" |
| #include "fdd_2d.h" |
#include "fdd_2d.h" |
| #include "fdd_d88.h" |
#include "fdd_d88.h" |
| #include "fdd_mtr.h" |
#include "fdd_mtr.h" |
| |
|
| |
|
| BYTE FDC_c[4]; |
|
| BYTE driveset = 0; |
|
| BYTE fdcdummyread = 0; |
|
| WORD readdiag = 0; |
|
| |
|
| 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}; |
| |
|
| |
|
| static BYTE fdd_stat(void) { |
void neitem_fdcbusy(UINT id) { |
| |
|
| |
fdc.s.busy = FALSE; |
| |
if (fdc.s.bufdir) { |
| |
// TRACEOUT(("dma ready!")); |
| |
dmac_sendready(TRUE); |
| |
} |
| |
(void)id; |
| |
} |
| |
|
| |
static void setbusy(SINT32 clock) { |
| |
|
| FDDFILE fdd; |
if (clock > 0) { |
| |
fdc.s.busy = TRUE; |
| |
nevent_set(NEVENT_FDC, clock, neitem_fdcbusy, NEVENT_ABSOLUTE); |
| |
} |
| |
} |
| |
|
| fdd = fddfile + fdc.drv; |
static void setmotor(REG8 drvcmd) { |
| switch(fdd->type) { |
|
| case DISKTYPE_NOTREADY: |
|
| return(0); |
|
| |
|
| case DISKTYPE_BETA: |
UINT drv; |
| return(fdd_stat_2d()); |
SINT32 clock; |
| |
|
| case DISKTYPE_D88: |
drv = drvcmd & 3; |
| default: |
clock = CPU_CLOCK + CPU_BASECLOCK - CPU_REMCLOCK; |
| return(fdd_stat_d88()); |
if (drvcmd & 0x80) { |
| |
if (fdc.s.motorevent[drv] == FDCMOTOR_STOP) { |
| |
fdc.s.motorevent[drv] = FDCMOTOR_STARTING; |
| |
fdc.s.motorclock[drv] = clock; |
| |
} |
| |
else if (fdc.s.motorevent[drv] == FDCMOTOR_STOPING) { |
| |
fdc.s.motorevent[drv] = FDCMOTOR_READY; |
| |
} |
| |
} |
| |
else { |
| |
if ((fdc.s.motorevent[drv] == FDCMOTOR_STARTING) || |
| |
(fdc.s.motorevent[drv] == FDCMOTOR_READY)) { |
| |
fdc.s.motorevent[drv] = FDCMOTOR_STOPING; |
| |
fdc.s.motorclock[drv] = clock; |
| |
} |
| } |
} |
| return(0); |
|
| } |
} |
| |
|
| |
void fdc_callback(void) { |
| |
|
| /*********************************************************************** |
SINT32 clock; |
| ＦＤＣ （Ｘ１から見るＩ／Ｏに相当する関数） |
UINT i; |
| ***********************************************************************/ |
|
| |
clock = CPU_CLOCK + CPU_BASECLOCK - CPU_REMCLOCK; |
| |
for (i=0; i<4; i++) { |
| |
if (fdc.s.motorevent[i] == FDCMOTOR_STARTING) { |
| |
if ((clock - fdc.s.motorclock[i]) >= (SINT32)pccore.realclock) { |
| |
fdc.s.motorevent[i] = FDCMOTOR_READY; |
| |
} |
| |
} |
| |
else if (fdc.s.motorevent[i] == FDCMOTOR_STOPING) { |
| |
if ((clock - fdc.s.motorclock[i]) >= (SINT32)pccore.realclock) { |
| |
fdc.s.motorevent[i] = FDCMOTOR_STOP; |
| |
} |
| |
} |
| |
} |
| |
} |
| |
|
| static int inc_off(void) { |
static REG8 getstat(void) { |
| |
|
| BYTE ret; |
FDDFILE fdd; |
| FDDFILE fdd; |
REG8 cmd; |
| |
REG8 type; |
| |
REG8 ret; |
| |
|
| if (!fdc.motor) { |
fdd = fddfile + fdc.s.drv; |
| return(0); |
cmd = (REG8)(fdc.s.cmd >> 4); |
| |
type = fdc.s.type; |
| |
if (fdd->type == DISKTYPE_NOTREADY) { |
| |
ret = FDDSTAT_NOTREADY; |
| } |
} |
| if (fdcdummyread) { |
else if (type != 0) { |
| fdcdummyread--; |
ret = fdc.s.stat; |
| return(0); |
|
| } |
} |
| else { |
else { |
| fdd = fddfile + fdc.drv; |
ret = 0; |
| switch(fdd->type) { |
} |
| case DISKTYPE_NOTREADY: |
if ((type == 1) && (fdc.s.c == 0)) { |
| return(0); |
ret |= FDDSTAT_TRACK00; |
| |
} |
| case DISKTYPE_BETA: |
if ((type == 0) || (type == 1) || (type == 4) || |
| ret = fdd_incoff_2d(); |
(cmd == 0x0a) || (cmd == 0x0b) || (cmd == 0x0f)) { |
| break; |
if (fdd->protect) { |
| |
ret |= FDDSTAT_WRITEP; |
| case DISKTYPE_D88: |
|
| default: |
|
| ret = fdd_incoff_d88(); |
|
| break; |
|
| } |
} |
| if (ret) { |
} |
| dma.DMA_REDY = 8; // <- DMA ノ レディシンゴウ ヲ クリア |
if ((type == 1) || (type == 4)) { |
| |
fdc.s.hole++; |
| |
if (fdc.s.hole < 8) { |
| |
ret |= FDDSTAT_INDEX; |
| |
} |
| |
} |
| |
else if (!(ret & 0xf0)) { |
| |
if (FDDMTR_BUSY) { |
| |
ret |= FDDSTAT_BUSY; |
| |
} |
| |
if (fdc.s.bufdir) { |
| |
ret |= FDDSTAT_DRQ | FDDSTAT_BUSY; |
| |
} |
| |
else if (cmd == 0x0f) { |
| |
ret |= FDDSTAT_LOSTDATA; |
| } |
} |
| } |
} |
| return(ret); |
return(ret); |
| } |
} |
| |
|
| void IOOUTCALL fdc_o(UINT port, REG8 value) { |
static void seekcmd(void) { |
| |
|
| REG8 cmd; |
FDDFILE fdd; |
| |
UINT track; |
| |
|
| if ((port & (~7)) != 0x0ff8) { |
fdc.s.crcnum = 0; |
| return; |
fdc.s.creg = fdc.s.c; |
| } |
fdd = fddfile + fdc.s.drv; |
| port &= 0xf; |
track = (fdc.s.c << 1) + fdc.s.h; |
| if (port == 8) { // コマンド |
fdc.s.stat = fdd->seek(fdd, fdc.s.media, track) | FDDSTAT_HEADENG; |
| driveset = 0; |
FDDMTR_MOVE; |
| fdc.cmd = value; |
} |
| cmd = (REG8)(value >> 4); |
|
| fdc.type = fdctype[cmd]; |
static REG8 type2cmd(REG8 sc) { |
| fdc.skip = 2; |
|
| switch(cmd) { |
REG8 dir; |
| case 0x00: // リストア |
UINT track; |
| if (value & 8) { // LAYDOCK |
UINT8 *p; |
| fdc.skip = 0; |
FDDFILE fdd; |
| fdc.busyclock = 20; // ver0.25 (now testing) |
UINT size; |
| fdc.busystart = h_cntbase + h_cnt; |
REG8 stat; |
| } |
#if defined(SUPPORT_DISKEXT) |
| fdc.motor = 0x80; // モーターOn? |
SINT32 clock; |
| fdc.c = 0; |
SINT32 curclock; |
| fdc.treg = 0; |
SINT32 nextclock; |
| FDDMTR_MOVE; |
UINT32 secinfo; |
| fdc.step = 1; |
|
| #if 1 // ver0.25 |
|
| fdc.r = 0; // デゼニワールド |
|
| fdc.rreg = 0; |
|
| #endif |
#endif |
| break; |
|
| |
|
| case 0x01: // シーク |
track = (fdc.s.c << 1) + fdc.s.h; |
| fdc.motor = 0x80; // モーターOn |
if (!(fdc.s.cmd & 0x20)) { |
| fdc.step = (char)((fdc.c<=fdc.data)?1:-1); |
p = fdc.s.buffer; |
| #if 0 // スタクル // ver0.50 |
dir = FDCDIR_IN; |
| fdc.rreg = fdc.r = 0; |
} |
| |
else { |
| |
p = NULL; |
| |
dir = FDCDIR_OUT; |
| |
} |
| |
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; |
| |
dir = FDCDIR_NONE; |
| |
} |
| |
else if (dir == FDCDIR_OUT) { |
| |
if (size) { |
| |
ZeroMemory(fdc.s.buffer, size); |
| |
} |
| |
stat = stat & (~FDDSTAT_RECTYPE); |
| |
} |
| |
fdc.s.bufmedia = fdc.s.media; |
| |
fdc.s.bufunit = fdc.s.drv; |
| |
fdc.s.buftrack = track; |
| |
fdc.s.bufsc = sc; |
| |
fdc.s.bufwrite = FALSE; |
| |
fdc.s.bufdir = dir; |
| |
fdc.s.bufmark = fdc.s.cmd & 1; |
| |
fdc.s.bufpos = 0; |
| |
fdc.s.bufsize = size; |
| |
fdc.s.curtime = 0; |
| |
|
| |
#if defined(SUPPORT_DISKEXT) |
| |
// ウェイト値を計算 |
| |
clock = 0; |
| |
if (fdc.s.motorevent[fdc.s.drv] == FDCMOTOR_STARTING) { |
| |
curclock = CPU_CLOCK + CPU_BASECLOCK - CPU_REMCLOCK; |
| |
curclock -= fdc.s.motorclock[fdc.s.drv]; |
| |
if (curclock < (SINT32)pccore.realclock) { |
| |
nextclock = pccore.realclock - curclock; |
| |
TRACEOUT(("motor starting busy %d", nextclock)); |
| |
clock += nextclock; |
| |
} |
| |
} |
| |
secinfo = fdd->sec(fdd, fdc.s.media, track, sc); |
| |
if (secinfo) { |
| |
nextclock = LOW16(secinfo); |
| |
nextclock *= fdc.s.loopclock; |
| |
nextclock /= LOW16(secinfo >> 16); |
| |
curclock = nevent_getwork(NEVENT_RTC); |
| |
nextclock -= curclock; |
| |
if (nextclock < 0) { |
| |
nextclock += fdc.s.loopclock; |
| |
} |
| |
TRACEOUT(("wait clock -> %d [%d/%d]", nextclock, |
| |
LOW16(secinfo), LOW16(secinfo >> 16))); |
| |
clock += nextclock; |
| |
} |
| |
setbusy(max(clock, 500)); |
| |
#else |
| |
setbusy(500); |
| #endif |
#endif |
| fdc.c = fdc.data; |
return(stat); |
| fdc.treg = fdc.data; |
} |
| FDDMTR_MOVE; |
|
| break; |
|
| |
|
| case 0x02: // ステップ |
|
| case 0x03: |
|
| if (fdc.motor) { |
|
| fdc.c += fdc.step; |
|
| if (cmd & 1) { |
|
| FDDMTR_MOVE; |
|
| fdc.treg = fdc.c; |
|
| } |
|
| } |
|
| break; |
|
| |
|
| case 0x04: // ステップイン |
static REG8 type2flash(void) { |
| case 0x05: |
|
| if (fdc.motor) { |
|
| fdc.step = 1; |
|
| fdc.c++; |
|
| if (cmd & 1) { |
|
| FDDMTR_MOVE; |
|
| fdc.treg = fdc.c; |
|
| } |
|
| } |
|
| break; |
|
| |
|
| case 0x06: // ステップアウト |
FDDFILE fdd; |
| case 0x07: |
|
| if (fdc.motor) { |
|
| fdc.step = -1; |
|
| fdc.c--; |
|
| if (cmd & 1) { |
|
| FDDMTR_MOVE; |
|
| fdc.treg = fdc.c; |
|
| } |
|
| } |
|
| break; |
|
| |
|
| case 0x08: // リードデータ |
fdc.s.bufwrite = FALSE; |
| case 0x09: |
fdd = fddfile + fdc.s.bufunit; |
| case 0x0a: // ライトデータ |
if (fdd->protect) { |
| case 0x0b: |
return(FDDSTAT_WRITEFAULT); |
| fdc.off = 0; |
} |
| fdcdummyread = 2; |
return(fdd->write(fdd, fdc.s.bufmedia, fdc.s.buftrack, |
| if (fdc.motor) { |
fdc.s.bufsc, fdc.s.buffer, fdc.s.bufpos)); |
| if (dma.DMA_ENBL) { |
} |
| dma.DMA_REDY = 0; |
|
| // fdc.skip = 0; // DMAで割り込みを監視する事！ |
|
| } |
|
| } |
|
| break; |
|
| |
|
| case 0xc: // リードアドレス |
static REG8 crccmd(void) { |
| fdc.s.bufpos = 0; |
|
| fdc.s.bufsize = 0; |
|
| fdcdummyread = 2; |
|
| if (fdc.motor) { // ver0.25 |
|
| if (dma.DMA_ENBL) { |
|
| dma.DMA_REDY = 0; |
|
| } |
|
| } |
|
| { |
|
| FDDFILE fdd = fddfile + fdc.drv; |
|
| switch(fdd->type) { |
|
| case DISKTYPE_BETA: |
|
| fdd2d_crc(fdd); |
|
| break; |
|
| |
|
| case DISKTYPE_D88: |
|
| default: |
|
| fddd88_crc(fdd); |
|
| break; |
|
| } |
|
| } |
|
| break; |
|
| |
|
| case 0x0d: // フォースインタラプト |
UINT track; |
| fdcdummyread = 0; // 必要ない？ |
FDDFILE fdd; |
| fdc.skip = 0; // 000330 |
REG8 stat; |
| dma.DMA_REDY = 8; // ver0.25 |
|
| break; |
track = (fdc.s.c << 1) + fdc.s.h; |
| |
fdd = fddfile + fdc.s.drv; |
| case 0x0e: // リードトラック |
stat = fdd->crc(fdd, fdc.s.media, track, fdc.s.crcnum, fdc.s.buffer); |
| readdiag = 0; |
if (stat & FDDSTAT_RECNFND) { |
| break; |
fdc.s.crcnum = 0; |
| |
stat = fdd->crc(fdd, fdc.s.media, track, 0, fdc.s.buffer); |
| case 0x0f: // ライトトラック |
} |
| { |
if (!(stat & FDDSTAT_RECNFND)) { |
| FDDFILE fdd = fddfile + fdc.drv; |
fdc.s.bufdir = FDCDIR_IN; |
| switch(fdd->type) { |
fdc.s.bufsize = 6; |
| case DISKTYPE_NOTREADY: |
fdc.s.rreg = fdc.s.buffer[0]; |
| case DISKTYPE_BETA: |
} |
| break; |
else { |
| |
fdc.s.bufdir = FDCDIR_NONE; |
| case DISKTYPE_D88: |
fdc.s.bufsize = 0; |
| default: |
} |
| if (fdc.motor) { // ver0.25 |
fdc.s.bufwrite = FALSE; |
| init_tao_d88(); |
fdc.s.curtime = 0; |
| if (dma.DMA_ENBL) { |
return(stat); |
| dma.DMA_REDY = 0; |
} |
| } |
|
| } |
static void bufposinc(void) { |
| break; |
|
| } |
BRESULT r; |
| |
REG8 stat; |
| |
|
| |
if (fdc.s.busy) { |
| |
return; |
| |
} |
| |
fdc.s.bufpos++; |
| |
fdc.s.curtime = 0; |
| |
if (fdc.s.bufpos >= fdc.s.bufsize) { |
| |
r = FALSE; |
| |
if (fdc.s.type == 2) { |
| |
stat = 0; |
| |
if (fdc.s.cmd & 0x10) { |
| |
r = TRUE; |
| |
} |
| |
if ((fdc.s.cmd & 0x20) && (fdc.s.bufwrite)) { |
| |
stat = type2flash(); |
| |
if (stat & (FDDSTAT_RECNFND | FDDSTAT_WRITEFAULT)) { |
| |
r = FALSE; |
| } |
} |
| break; |
fdc.s.stat = stat; |
| |
} |
| |
} |
| |
fdc.s.bufdir = FDCDIR_NONE; |
| |
dmac_sendready(FALSE); |
| |
if (r) { |
| |
fdc.s.rreg = fdc.s.r + 1; |
| |
stat = type2cmd(fdc.s.rreg); |
| |
if (!(stat & FDDSTAT_RECNFND)) { |
| |
fdc.s.r = fdc.s.r + 1; |
| |
fdc.s.stat = stat; |
| |
} |
| } |
} |
| } |
} |
| else { |
} |
| cmd = (REG8)(fdc.cmd >> 4); |
|
| switch(port) { |
void IOOUTCALL fdc_o(UINT port, REG8 value) { |
| case 0x09: // トラック |
|
| fdc.treg = value; |
REG8 cmd; |
| break; |
|
| |
if ((port & (~7)) != 0x0ff8) { |
| case 0x0a: // セクタ |
return; |
| FDDMTR_WAITSEC(value); |
} |
| fdc.r = value; |
TRACEOUT(("fdc %.4x,%.2x [%.4x]", port, value, Z80_PC)); |
| fdc.rreg = value; |
switch(port & 7) { |
| break; |
case 0: // コマンド |
| |
fdc.s.cmd = value; |
| case 0x0b: // データ |
cmd = (REG8)(value >> 4); |
| fdc.data = value; |
fdc.s.type = fdctype[cmd]; |
| if ((cmd == 0x0a) || (cmd == 0x0b)) { |
TRACEOUT(("fdc cmd: %.2x", value)); |
| FDDFILE fdd = fddfile + fdc.drv; |
if (fdc.s.bufwrite) { |
| switch(fdd->type) { |
fdc.s.stat = type2flash(); |
| case DISKTYPE_NOTREADY: |
} |
| break; |
fdc.s.bufdir = FDCDIR_NONE; |
| |
// リストアコマンドにおいて |
| case DISKTYPE_BETA: |
// マリオは コマンド発行後にbusyを見張る |
| fdd_write_2d(); |
// 逆にソーサリアンとかは busyだとエラーになる… |
| break; |
// 条件は何？ |
| |
setbusy(20); |
| case DISKTYPE_D88: |
switch(cmd) { |
| default: |
case 0x00: // リストア |
| fdd_write_d88(); |
// if (value & 8) { // LAYDOCK |
| break; |
// 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(); |
| |
} |
| } |
} |
| inc_off(); |
break; |
| } |
|
| else if (cmd == 0x0f) { // TRACK WRITE |
case 0x04: // ステップイン |
| FDDFILE fdd = fddfile + fdc.drv; |
case 0x05: |
| switch(fdd->type) { |
if (fdc.s.motor) { |
| case DISKTYPE_NOTREADY: |
fdc.s.step = 1; |
| case DISKTYPE_BETA: |
fdc.s.c++; |
| break; |
if (cmd & 1) { |
| |
seekcmd(); |
| case DISKTYPE_D88: |
} |
| default: |
|
| fdd_wtao_d88(value); |
|
| break; |
|
| } |
} |
| } |
break; |
| break; |
|
| |
|
| case 0x0c: // ドライブ・サイド |
case 0x06: // ステップアウト |
| driveset = 1; |
case 0x07: |
| FDC_c[fdc.drv] = fdc.c; |
if (fdc.s.motor) { |
| fdc.c = FDC_c[value & 0x03]; // XTAL !!! |
fdc.s.step = -1; |
| fdc.motor = (UINT8)(value & 0x80); |
fdc.s.c--; |
| fdc.drv = (UINT8)(value & 0x03); |
if (cmd & 1) { |
| fdc.h = (UINT8)((value >> 4) & 1); |
seekcmd(); |
| |
} |
| fdc.cmd = 0; // T&E SORCERIAN |
} |
| // fdc.data = 0; // 影の伝説 |
break; |
| fdc.type = 0; |
|
| |
case 0x08: // リードデータ |
| FDDMTR_DRVSET; |
case 0x09: |
| if (!fdc.motor) { |
case 0x0a: // ライトデータ |
| fdc.r = 0; // SACOM TELENET |
case 0x0b: |
| fdc.rreg = 0; |
fdc.s.stat = type2cmd(fdc.s.r); |
| #if 0 // XTAL |
break; |
| fdc.c = 0; |
|
| fdc.step = 1; |
case 0xc: // リードアドレス |
| #endif |
setbusy(200); |
| } |
fdc.s.stat = crccmd(); |
| break; |
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: // ライトトラック |
| |
break; |
| |
} |
| |
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; |
| |
} |
| |
setmotor(value); |
| |
break; |
| } |
} |
| } |
} |
| |
|
| REG8 IOINPCALL fdc_i(UINT port) { |
REG8 IOINPCALL fdc_i(UINT port) { |
| |
|
| static BYTE timeoutwait; |
REG8 ret; |
| static BYTE last_r; |
|
| static short last_off; |
// TRACEOUT(("fdc inp %.4x", port)); |
| BYTE ans; |
|
| REG8 cmd; |
|
| |
|
| if ((port & (~7)) != 0x0ff8) { |
if ((port & (~7)) != 0x0ff8) { |
| return(0xff); |
return(0xff); |
| } |
} |
| cmd = (REG8)(fdc.cmd >> 4); |
switch(port & 7) { |
| if ((port &= 0xf) != 8) { |
case 0: // ステータス |
| last_r = -1; |
ret = fdc.s.busy; |
| last_off = -1; |
if (ret) { |
| timeoutwait = 4; |
return(ret); |
| } |
|
| switch(port) { |
|
| case 0x8: // ステータス |
|
| ans = 0; |
|
| fdcdummyread = 0; |
|
| if (fdc.skip) { |
|
| fdc.skip--; |
|
| return(0x01); |
|
| } |
|
| if (fdc.busyclock) { // ver0.25 |
|
| if (((h_cntbase + h_cnt) - fdc.busystart) < fdc.busyclock) { |
|
| return(0x01); |
|
| } |
|
| fdc.busyclock = 0; |
|
| } |
|
| { |
|
| FDDFILE fdd = fddfile + fdc.drv; |
|
| if (fdd->type == DISKTYPE_NOTREADY) { |
|
| if (fdc.type == 1 && fdc.c == 0) { // ドライブチェック !!! |
|
| return(0x84); // ←接続されてる時だけ |
|
| } |
|
| return(0x80); |
|
| } |
|
| } |
|
| if (fdc.type == 2) { |
|
| if (last_r == fdc.r && last_off == fdc.off && |
|
| !(--timeoutwait)) { |
|
| inc_off(); |
|
| timeoutwait = 4; |
|
| } |
|
| last_r = fdc.r; |
|
| last_off = fdc.off; |
|
| } // Read Write時のみの変化でいい筈 |
|
| if (!((ans = fdd_stat()) & 2)) { |
|
| dma.DMA_REDY = 8; // <- DMA ノ レディシンゴウ ヲ クリア |
|
| } |
} |
| #if 1 |
#if 1 |
| if (driveset) { // 0xffcを叩いた直後だったら |
if (fdc.s.bufdir) { // YsII |
| ans &= 0xc4; |
fdc.s.curtime++; |
| |
if (fdc.s.curtime >= 8) { |
| |
fdc.s.stat |= 0x04; |
| |
bufposinc(); |
| |
} |
| } |
} |
| #endif |
#endif |
| return(ans); |
ret = getstat(); |
| |
if (!(ret & 0x02)) { |
| |
dmac_sendready(FALSE); |
| |
} |
| |
// TRACEOUT(("ret->%.2x", ret)); |
| |
return(ret); |
| |
|
| case 0x9: // トラック |
case 1: // トラック |
| return(fdc.treg); |
return(fdc.s.creg); |
| |
|
| case 0xa: // セクタ |
case 2: // セクタ |
| return(fdc.rreg); // ver0.25 |
return(fdc.s.rreg); |
| |
|
| case 0xb: // データ |
case 3: // データ |
| if (fdc.motor) { |
if (fdc.s.motor) { |
| if ((cmd == 0x08) || (cmd == 0x09)) { // リード・データ |
if (fdc.s.bufdir == FDCDIR_IN) { |
| FDDFILE fdd; |
fdc.s.data = fdc.s.buffer[fdc.s.bufpos]; |
| fdd = fddfile + fdc.drv; |
// TRACEOUT(("read %.2x %.2x [%.4x]", fdc.s.data, fdc.s.bufpos, Z80_PC)); |
| switch(fdd->type) { |
bufposinc(); |
| case DISKTYPE_NOTREADY: |
|
| break; |
|
| |
|
| case DISKTYPE_BETA: |
|
| fdd_read_2d(); |
|
| break; |
|
| |
|
| case DISKTYPE_D88: |
|
| default: |
|
| fdd_read_d88(); // WOODY POCO !!! |
|
| break; |
|
| } |
|
| inc_off(); |
|
| } |
|
| else if (cmd == 0x0c) { // リード・アドレス |
|
| if (fdc.s.bufpos < 6) { |
|
| fdc.data = fdc.s.buffer[fdc.s.bufpos]; |
|
| if (fdcdummyread) { |
|
| fdcdummyread--; |
|
| } |
|
| else { |
|
| fdc.s.bufpos++; |
|
| } |
|
| } |
|
| } |
|
| else if (cmd == 0x0e) { // ver0.25 |
|
| fdc.data = 0; |
|
| readdiag++; |
|
| } |
} |
| } |
} |
| return(fdc.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 421 void fdc_reset(void) {
|
Line 510 void fdc_reset(void) {
|
| |
|
| FDDMTR_INIT; |
FDDMTR_INIT; |
| ZeroMemory(&fdc, sizeof(fdc)); |
ZeroMemory(&fdc, sizeof(fdc)); |
| fdc.step = 1; |
fdc.s.step = 1; |
| ZeroMemory(FDC_c, 4); |
fdc.s.equip = xmilcfg.fddequip; |
| |
fdc.s.loopclock = pccore.realclock / 5; |
| } |
} |
| |
|
![[BACK]](/cvs/cvsweb/icons/back.gif){kind=icon}
Return to fdc.c CVS log ![[TXT]](/cvs/cvsweb/icons/text.gif){kind=icon}
![[DIR]](/cvs/cvsweb/icons/dir.gif){kind=icon}
Up to [RetroPC.NET] / xmil / io