--- np2/io/fdc.c 2003/10/16 17:57:52 1.1.1.1 +++ np2/io/fdc.c 2003/12/08 00:55:32 1.5 @@ -4,14 +4,12 @@ #include "compiler.h" -#include "dosio.h" -#include "i286.h" #include "pccore.h" #include "iocore.h" #include "fddfile.h" -static const BYTE FDCCMD_TABLE[32] = { +static const UINT8 FDCCMD_TABLE[32] = { 0, 0, 8, 2, 1, 8, 8, 1, 0, 8, 1, 0, 8, 5, 0, 2, 0, 8, 0, 0, 0, 0, 0, 0, 0, 8, 0, 0, 0, 8, 0, 0}; @@ -42,7 +40,7 @@ static BOOL fdc_isfdcinterrupt(void) { return(fdc.intreq); } -BYTE DMACCALL fdc_dmafunc(BYTE func) { +REG8 DMACCALL fdc_dmafunc(REG8 func) { switch(func) { case DMAEXT_START: @@ -55,7 +53,7 @@ BYTE DMACCALL fdc_dmafunc(BYTE func) { return(0); } -static void fdc_dmaready(BYTE enable) { +static void fdc_dmaready(REG8 enable) { if (CTRL_FDMEDIA == DISKTYPE_2HD) { dmac.dmach[DMA_2HD].ready = enable; @@ -74,6 +72,7 @@ void fdcbusy_error7(NEVENTITEM item) { } } +#if 0 // ↑イベントは残しとく... static void fdcderay_error7(SINT16 ms) { // ver0.27 fdc.busy = 1; @@ -81,6 +80,7 @@ static void fdcderay_error7(SINT16 ms) { fdc.status &= ~FDCSTAT_RQM; nevent_setbyms(NEVENT_FDCBUSY, ms, fdcbusy_error7, NEVENT_ABSOLUTE); } +#endif // ---------------------------------------------------------------------- @@ -143,7 +143,7 @@ static void fdc_timeoutset(void) { -static BOOL FDC_DriveCheck(BYTE protectcheck) { +static BOOL FDC_DriveCheck(BOOL protectcheck) { if (!fddfile[fdc.us].fname[0]) { fdc.stat[fdc.us] = FDCRLT_IC0 | FDCRLT_NR | (fdc.hd << 2) | fdc.us; @@ -352,6 +352,7 @@ static void readsector(void) { fdcsend_error7(); return; } + fdc.event = FDCEVENT_BUFSEND2; fdc.bufp = 0; #if 1 // ver0.27 ?? @@ -467,7 +468,16 @@ static void FDC_ReadID(void) { // switch(fdc.event) { case FDCEVENT_CMDRECV: + fdc.mf = fdc.cmd & 0x40; get_hdus(); + if (fdd_readid() == SUCCESS) { + fdcsend_success7(); + } + else { + fdc.stat[fdc.us] = fdc.us | (fdc.hd << 2) | + FDCRLT_IC0 | FDCRLT_MA; + fdcsend_error7(); + } break; } } @@ -586,7 +596,7 @@ static const FDCOPE FDC_Ope[0x20] = { FDC_Recalibrate, FDC_SenceintStatus, FDC_WriteData, - FDC_Invalid, // FDC_ReadID, + FDC_ReadID, FDC_Invalid, FDC_ReadData, FDC_WriteID, @@ -618,7 +628,7 @@ static void fdcstatusreset(void) { fdc.status = FDCSTAT_RQM; } -void DMACCALL fdc_DataRegWrite(BYTE data) { +void DMACCALL fdc_DataRegWrite(REG8 data) { // if ((fdc.status & (FDCSTAT_RQM | FDCSTAT_DIO)) == FDCSTAT_RQM) { switch(fdc.event) { @@ -657,8 +667,7 @@ void DMACCALL fdc_DataRegWrite(BYTE data // } } - -BYTE DMACCALL fdc_DataRegRead(void) { +REG8 DMACCALL fdc_DataRegRead(void) { // if ((fdc.status & (FDCSTAT_RQM | FDCSTAT_DIO)) // == (FDCSTAT_RQM | FDCSTAT_DIO)) { @@ -702,8 +711,9 @@ BYTE DMACCALL fdc_DataRegRead(void) { // ---- I/O -static void IOOUTCALL fdc_o92(UINT port, BYTE dat) { +static void IOOUTCALL fdc_o92(UINT port, REG8 dat) { +// TRACEOUT(("fdc out %x %x", port, dat)); CTRL_FDMEDIA = DISKTYPE_2HD; if ((fdc.status & (FDCSTAT_RQM | FDCSTAT_DIO)) == FDCSTAT_RQM) { fdc_DataRegWrite(dat); @@ -711,8 +721,9 @@ static void IOOUTCALL fdc_o92(UINT port, (void)port; } -static void IOOUTCALL fdc_o94(UINT port, BYTE dat) { +static void IOOUTCALL fdc_o94(UINT port, REG8 dat) { +// TRACEOUT(("fdc out %x %x", port, dat)); CTRL_FDMEDIA = DISKTYPE_2HD; if ((fdc.ctrlreg ^ dat) & 0x10) { fdcstatusreset(); @@ -723,17 +734,18 @@ static void IOOUTCALL fdc_o94(UINT port, (void)port; } -static BYTE IOINPCALL fdc_i90(UINT port) { +static REG8 IOINPCALL fdc_i90(UINT port) { +// TRACEOUT(("fdc in %x %x", port, fdc.status)); CTRL_FDMEDIA = DISKTYPE_2HD; (void)port; return(fdc.status); } -static BYTE IOINPCALL fdc_i92(UINT port) { +static REG8 IOINPCALL fdc_i92(UINT port) { - BYTE ret; + REG8 ret; CTRL_FDMEDIA = DISKTYPE_2HD; if ((fdc.status & (FDCSTAT_RQM | FDCSTAT_DIO)) @@ -744,10 +756,11 @@ static BYTE IOINPCALL fdc_i92(UINT port) ret = fdc.lastdata; } (void)port; +// TRACEOUT(("fdc in %x %x", port, ret)); return(ret); } -static BYTE IOINPCALL fdc_i94(UINT port) { +static REG8 IOINPCALL fdc_i94(UINT port) { CTRL_FDMEDIA = DISKTYPE_2HD; @@ -756,21 +769,21 @@ static BYTE IOINPCALL fdc_i94(UINT port) } -static void IOOUTCALL fdc_oca(UINT port, BYTE dat) { +static void IOOUTCALL fdc_oca(UINT port, REG8 dat) { CTRL_FDMEDIA = DISKTYPE_2DD; fdc_DataRegWrite(dat); (void)port; } -static void IOOUTCALL fdc_occ(UINT port, BYTE dat) { +static void IOOUTCALL fdc_occ(UINT port, REG8 dat) { CTRL_FDMEDIA = DISKTYPE_2DD; fdc.ctrlreg = dat; (void)port; } -static BYTE IOINPCALL fdc_ic8(UINT port) { +static REG8 IOINPCALL fdc_ic8(UINT port) { CTRL_FDMEDIA = DISKTYPE_2DD; @@ -778,9 +791,9 @@ static BYTE IOINPCALL fdc_ic8(UINT port) return(fdc.status); } -static BYTE IOINPCALL fdc_ica(UINT port) { +static REG8 IOINPCALL fdc_ica(UINT port) { - BYTE ret; + REG8 ret; CTRL_FDMEDIA = DISKTYPE_2DD; ret = fdc_DataRegRead(); @@ -789,7 +802,7 @@ static BYTE IOINPCALL fdc_ica(UINT port) return(ret); } -static BYTE IOINPCALL fdc_icc(UINT port) { +static REG8 IOINPCALL fdc_icc(UINT port) { CTRL_FDMEDIA = DISKTYPE_2DD; @@ -798,13 +811,13 @@ static BYTE IOINPCALL fdc_icc(UINT port) } -static void IOOUTCALL fdc_obe(UINT port, BYTE dat) { +static void IOOUTCALL fdc_obe(UINT port, REG8 dat) { fdc.chgreg = dat; (void)port; } -static BYTE IOINPCALL fdc_ibe(UINT port) { +static REG8 IOINPCALL fdc_ibe(UINT port) { (void)port; return((fdc.chgreg & 3) | 8);