--- xmil/fdd/fdd_d88.c 2004/08/04 15:18:26 1.4 +++ xmil/fdd/fdd_d88.c 2008/06/02 20:07:31 1.16 @@ -1,83 +1,37 @@ #include "compiler.h" #include "dosio.h" #include "pccore.h" -#include "iocore.h" #include "fddfile.h" #include "fdd_d88.h" #include "fdd_mtr.h" -static D88_HEADER d88head[4]; -static _D88SEC cursec; -static REG8 curdrv = (REG8)-1; -static UINT curtrk = (UINT)-1; -static BYTE curtype = 0; -static UINT cursct = (UINT)-1; -static long curfp = 0; -static UINT cursize = 0; -static BYTE curwrite = 0; -static BYTE curtrkerr = 0; -static BYTE hole = 0; -static BYTE *curdata; -static UINT crcnum = 0; -static BYTE crcerror = FALSE; - -extern WORD readdiag; - -#define TAO_MODE_GAP 0x4e -#define TAO_MODE_SYNC 0x00 -#define TAO_MODE_AM 0xf5 -#define TAO_MODE_IM 0xf6 -#define TAO_MODE_ID 0xfe -#define TAO_MODE_DATA 0xfb -#define TAO_ENDOFDATA 0xf7 - -#define TAO_CMD_GAP 0x4e -#define TAO_CMD_SYNC 0x00 -#define TAO_CMD_IM_IN 0xf6 -#define TAO_CMD_IM 0xfc -#define TAO_CMD_AM_IN 0xf5 -#define TAO_CMD_IAM 0xfe -#define TAO_CMD_DAM 0xfb -#define TAO_CMD_DDAM 0xf8 -#define TAO_CMD_CRC 0xf7 +enum { + D88BUFSIZE = 0x4000 +}; typedef struct { - BYTE mode; - BYTE flag; - WORD cnt; - WORD size; - WORD ptr; - WORD top; - WORD gap; - BYTE sector; - WORD lostdatacnt; - BYTE maxsector; - WORD maxsize; -} WID_PARA; - -#define LOSTDATA_COUNT 256 - -static WID_PARA WID_2D = {TAO_ENDOFDATA, 3, 0, 0, 0, 0, 0, 0, 0, 33, 0x1f80}; -static WID_PARA WID_2HD= {TAO_ENDOFDATA, 3, 0, 0, 0, 0, 0, 0, 0, 55, 0x2f80}; -static WID_PARA WID_ERR= {TAO_ENDOFDATA, 4, 0, 0, 0, 0, 0, 0, 0, 0, 0x0000}; -static WID_PARA tao = {TAO_ENDOFDATA, 4, 0, 0, 0, 0, 0, 0, 0, 0, 0x0000}; - -static BYTE D88_BUF[0x4000]; -static BYTE TAO_BUF[0x3000]; + FDDFILE fdd; + UINT8 media; + UINT8 write; + UINT8 padding[2]; + UINT track; + long fptr; + UINT size; + UINT sectors; + UINT8 buf[D88BUFSIZE]; +} _D88TRK, *D88TRK; +static _D88TRK d88trk; -//---------------------------------------------------------------------- -static UINT32 nexttrackp(D88_HEADER *head, UINT32 fptr, UINT32 last) { +static UINT32 nexttrackptr(FDDFILE fdd, UINT32 fptr, UINT32 last) { UINT t; -const DWORD *trkp; UINT32 cur; - trkp = (DWORD *)head->trackp; for (t=0; t<164; t++) { - cur = trkp[t]; + cur = fdd->inf.d88.ptr[t]; if ((cur > fptr) && (cur < last)) { last = cur; } @@ -85,609 +39,473 @@ const DWORD *trkp; return(last); } - -int curdataflush(void) { +static BRESULT trackflush(D88TRK trk) { FDDFILE fdd; FILEH fh; - int ret = 0; - if ((!curfp) || (!cursize)) { - return(-1); + fdd = trk->fdd; + trk->fdd = NULL; + if ((fdd == NULL) || (trk->size == 0) || (!trk->write)) { + goto dtfd_exit; } - if (!curwrite) { - return(0); - } - curwrite = 0; - fdd = fddfile + curdrv; fh = file_open(fdd->fname); if (fh == FILEH_INVALID) { - return(-1); - } - if ((file_seek(fh, curfp, FSEEK_SET) != curfp) || - (file_write(fh, D88_BUF, cursize) != cursize)) { - ret = -1; + goto dtfd_err1; } - if (file_close(fh)) { - ret = -1; + if ((file_seek(fh, trk->fptr, FSEEK_SET) != trk->fptr) || + (file_write(fh, trk->buf, trk->size) != trk->size)) { + goto dtfd_err2; } - return(ret); -} + file_close(fh); + trk->write = FALSE; +dtfd_exit: + return(SUCCESS); -static DWORD read_d88track(REG8 drv, UINT track, BYTE type) { +dtfd_err2: + file_close(fh); - FDDFILE fdd; - FILEH hdr; +dtfd_err1: + return(FAILURE); +} - curdataflush(); - curdrv = drv; - curtrk = track; - curtype = type; - cursct = (UINT)-1; - curwrite = 0; - curtrkerr = 0; - crcnum = 0; - crcerror = 0; +static D88TRK trackread(D88TRK trk, FDDFILE fdd, REG8 media, UINT track) { - if ((drv < 0) || (drv > 3) || (track > 163) || - ((type == 0) && (d88head[drv].fd_type == 0x20)) || - ((type == 1) && (d88head[drv].fd_type != 0x20)) || - ((curfp = d88head[drv].trackp[track]) == 0) || - ((cursize = nexttrackp(&d88head[drv], curfp, - d88head[drv].fd_size) - curfp) > 0x4000)) { - goto readd88_err; - } + FILEH fh; + UINT32 fptr; + UINT size; +const _D88SEC *sec; + UINT rem; + UINT maxsectors; + UINT sectors; + UINT secsize; - fdd = fddfile + drv; - if ((hdr = file_open(fdd->fname)) == FILEH_INVALID) { - goto readd88_err; + trackflush(trk); + if (media != (REG8)((fdd->inf.d88.head.fd_type >> 4))) { + goto dtrd_err1; } - if (file_seek(hdr, curfp, FSEEK_SET) != curfp) { - file_close(hdr); - goto readd88_err; + if (track >= 164) { + goto dtrd_err1; } - if (file_read(hdr, D88_BUF, cursize) != cursize) { - file_close(hdr); - goto readd88_err; + fptr = fdd->inf.d88.ptr[track]; + if (fptr == 0) { + goto dtrd_err1; } - if (file_close(hdr)) { - goto readd88_err; + size = nexttrackptr(fdd, fptr, fdd->inf.d88.fd_size) - fptr; + if (size > D88BUFSIZE) { + size = D88BUFSIZE; } - return(TRUE); - -readd88_err: - curfp = 0; - cursize = 0; - curtrkerr = 1; - return(FALSE); -} - - - - -static int seeksector(REG8 drv, UINT track, UINT r) { - -static int lastflag = FALSE; - -const _D88SEC *p; - UINT sec; - UINT sectors; - UINT secsize; - - if ((curdrv != drv) || (curtrk != track) || (curtype != fdc.media)) { - read_d88track(drv, track, fdc.media); + fh = file_open_rb(fdd->fname); + if (fh == FILEH_INVALID) { + goto dtrd_err1; } - if (curtrkerr) { - cursct = r; - goto seekerror; - } - if (cursct != r) { - cursct = r; - p = (D88SEC)D88_BUF; - for (sec=0; sec<40; ) { - sectors = LOADINTELWORD(p->sectors); - secsize = LOADINTELWORD(p->size); - if (p->r == r) { - CopyMemory(&cursec, p, sizeof(_D88SEC)); - curdata = (UINT8 *)(p + 1); - lastflag = TRUE; - break; - } - sec++; - if (sec >= sectors) { - goto seekerror; - } - p = (D88SEC)(((UINT8 *)(p + 1)) + secsize); - } - if (sec >= 40) { - goto seekerror; + if ((file_seek(fh, (long)fptr, FSEEK_SET) != (long)fptr) || + (file_read(fh, trk->buf, size) != size)) { + goto dtrd_err2; + } + file_close(fh); + + trk->fdd = fdd; + trk->media = media; + trk->write = FALSE; + trk->track = track; + trk->fptr = fptr; + trk->size = size; + + /* セクタ数チェック */ + sec = (D88SEC)trk->buf; + rem = size; + maxsectors = 0; + if (rem >= sizeof(_D88SEC)) { + maxsectors = LOADINTELWORD(sec->sectors); + } + sectors = 0; + while(sectors < maxsectors) { + secsize = LOADINTELWORD(sec->size); + secsize += sizeof(_D88SEC); + if (rem < secsize) { + break; } + rem -= secsize; + maxsectors = LOADINTELWORD(sec->sectors); + sec = (D88SEC)(((UINT8 *)sec) + secsize); + sectors++; } - return(lastflag); + trk->sectors = sectors; + return(trk); + +dtrd_err2: + file_close(fh); -seekerror:; - ZeroMemory(&cursec, sizeof(_D88SEC)); - curdata = &D88_BUF[16]; - lastflag = FALSE; - return(FALSE); +dtrd_err1: + return(NULL); } -static void drvflush(REG8 drv) { +static void drvflush(FDDFILE fdd) { - if (curdrv == drv) { - curdataflush(); - curdrv = (REG8)-1; - curtrk = (UINT)-1; - cursct = (UINT)-1; + D88TRK trk; + + trk = &d88trk; + if (trk->fdd == fdd) { + trackflush(trk); } } +static D88TRK trackseek(FDDFILE fdd, REG8 media, UINT track) { + D88TRK trk; + trk = &d88trk; + if ((trk->fdd != fdd) || (trk->media != media) || (trk->track != track)) { + trk = trackread(trk, fdd, media, track); + } + return(trk); +} -//********************************************************************** - -short fdd_crc_d88(void) { +static D88SEC sectorseek(const _D88TRK *trk, REG8 r) { - UINT track; -const _D88SEC *p; - UINT sec; +const _D88SEC *sec; UINT sectors; - UINT secsize; + UINT size; - ZeroMemory(fdc.crc_dat, 6); - track = (fdc.c << 1) + fdc.h; - if (track >= 164) { - goto crcerror_d88; - } - seeksector(fdc.drv, track, fdc.r); - if (curtrkerr) { - goto crcerror_d88; - } - p = (D88SEC)D88_BUF; - for (sec=0; secsectors); - secsize = LOADINTELWORD(p->size); - sec++; - if (sec >= sectors) { - goto crcerror_d88; + sec = (D88SEC)trk->buf; + sectors = trk->sectors; + while(sectors) { + sectors--; + if (sec->r == r) { + return((D88SEC)sec); } - p = (D88SEC)(((UINT8 *)(p + 1)) + secsize); - } - fdc.rreg = p->c; // メルヘンヴェール - fdc.crc_dat[0] = p->c; - fdc.crc_dat[1] = p->h; - fdc.crc_dat[2] = p->r; - fdc.crc_dat[3] = p->n; - crcnum++; - if (p->stat) { - crcerror = TRUE; + size = LOADINTELWORD(sec->size); + size += sizeof(_D88SEC); + sec = (D88SEC)(((UINT8 *)sec) + size); } - else { - crcerror = FALSE; - } - return(0); - -crcerror_d88:; - crcerror = TRUE; - return(1); + return(NULL); } -BYTE fdd_stat_d88(void) { +/* ---- */ + +static BRESULT fileappend(FILEH fh, UINT32 ptr, UINT size) { - FDDFILE fdd; - BYTE type; - REG8 cmd; - UINT trk; - BYTE ans = 0; - int seekable; + UINT filesize; + UINT r; + UINT8 work[0x400]; - fdd = fddfile + fdc.drv; - if (fdd->type != DISKTYPE_D88) { - return(0x80); // NOT READY + filesize = file_getsize(fh); + if (filesize < ptr) { + return(FAILURE); } - type = fdc.type; - cmd = (REG8)(fdc.cmd >> 4); - trk = (fdc.c << 1) + fdc.h; - seekable = seeksector(fdc.drv, trk, fdc.r); - if (!fdc.r) { - seekable = TRUE; + filesize -= ptr; + while(filesize) { + r = min(filesize, sizeof(work)); + filesize -= r; + file_seek(fh, ptr + filesize, FSEEK_SET); + r = file_read(fh, work, r); + file_seek(fh, ptr + filesize + size, FSEEK_SET); + file_write(fh, work, r); } + return(SUCCESS); +} - if (type == 0 || type == 1 || type == 4 || - cmd == 0x0a || cmd == 0x0b || cmd == 0x0f) { - if (fdd->protect) { // WRITE PROTECT - ans |= 0x40; - } +static BRESULT writetrack(FDDFILE fdd, REG8 media, UINT track, + UINT8 *buf, UINT size) { + + FILEH fh; + UINT i; + UINT32 curptr; + UINT32 nextptr; + UINT cursize; + UINT addsize; + UINT32 cur; + UINT8 ptr[D88_TRACKMAX][4]; + + if ((track >= D88_TRACKMAX) || (size == 0)) { + return(FAILURE); } - if (type == 2 || cmd == 0x0f) { - if (fdc.r && cursec.del_flg) { - ans |= 0x20; // RECODE TYPE / WRITE FAULT - } + + fh = file_open(fdd->fname); + if (fh == FILEH_INVALID) { + return(FAILURE); } - if (type == 1 || type == 2) { - if ((trk > 163) || (!seekable)) { - ans |= 0x10; // SEEK ERROR / RECORD NOT FOUND - } - if ((!(ans & 0xf0)) && fdc.r && (cursec.stat)) { - ans |= 0x08; // CRC ERROR + curptr = fdd->inf.d88.ptr[track]; + if (curptr == 0) { + for (i=track; i>0;) { /* 新規トラック */ + curptr = fdd->inf.d88.ptr[--i]; + if (curptr) { + break; + } } - } - if (cmd == 0x0c) { - if (curtrkerr) { - ans |= 0x10; + if (curptr) { /* ヒットした */ + curptr = nexttrackptr(fdd, curptr, fdd->inf.d88.fd_size); } - if (crcerror) { - ans |= 0x08; // CRC ERROR + else { + curptr = D88_HEADERSIZE; } + nextptr = curptr; } - if (type == 1 || type == 4) { - if (type == 1) { // ver0.25 - ans |= 0x20; // HEAD ENGAGED (X1 デハ ツネニ 1) - if (!fdc.c) { // TRACK00 - ans |= 0x04; - } - } - if (++hole < 8) { // ver0.25 - ans |= 0x02; // INDEX - } + else { /* トラックデータは既にある */ + nextptr = nexttrackptr(fdd, curptr, fdd->inf.d88.fd_size); } - else if (!(ans & 0xf0)) { - if ((type != 4) && (FDDMTR_BUSY)) { - ans |= 0x01; - } - if (type == 2) { - UINT secsize = LOADINTELWORD(cursec.size); - if ((UINT)fdc.off < secsize) { - ans |= 0x03; // DATA REQUEST / BUSY + cursize = nextptr - curptr; + if (size > cursize) { + addsize = size - cursize; + fileappend(fh, curptr, addsize); + fdd->inf.d88.fd_size += addsize; + for (i=0; iinf.d88.ptr[i]; + if ((cur) && (cur >= curptr)) { + fdd->inf.d88.ptr[i] = cur + addsize; } } - else if ((cmd == 0x0e) && (readdiag < 0x1a00)) { - ans |= 0x03; - } - else if ((cmd == 0x0c) && (fdc.crc_off < 6)) { // ver0.25 - ans |= 0x03; - } - else if (cmd == 0x0f) { - if (tao.flag == 3) { - if (++tao.lostdatacnt > LOSTDATA_COUNT) { - tao.flag = 4; - } - } - ans |= tao.flag; - } - } - return(ans); -} - - -//********************************************************************** - -void fdd_read_d88(void) { - // POCO:読めなかったらレジスタを変更させない - if ((fdd_stat_d88() & 0xf3) == 3) { - fdc.data = curdata[fdc.off]; } + STOREINTELDWORD(fdd->inf.d88.head.fd_size, fdd->inf.d88.fd_size); + fdd->inf.d88.ptr[track] = curptr; + for (i=0; iinf.d88.ptr[i]); + } + file_seek(fh, 0, FSEEK_SET); + file_write(fh, &fdd->inf.d88.head, sizeof(fdd->inf.d88.head)); + file_write(fh, ptr, sizeof(ptr)); + file_seek(fh, curptr, FSEEK_SET); + file_write(fh, buf, size); + file_close(fh); + return(SUCCESS); } -void fdd_write_d88(void) { - if ((fdd_stat_d88() & 0xf3) == 3) { - curdata[fdc.off] = fdc.data; - curwrite = 1; - } -} - -BYTE fdd_incoff_d88(void) { +/* ---- */ - REG8 cmd; - UINT trk; - UINT secsize; +static REG8 fddd88_seek(FDDFILE fdd, REG8 media, UINT track) { - cmd = (REG8)(fdc.cmd >> 4); - trk = (fdc.c << 1) + fdc.h; - seeksector(fdc.drv, trk, fdc.r); - fdc.off++; - secsize = LOADINTELWORD(cursec.size); - if ((UINT)fdc.off < secsize) { - return(0); + if (trackseek(fdd, media, track) != NULL) { + return(0x00); } - fdc.off = secsize; - if ((cmd == 0x09) || (cmd == 0x0b)) { - fdc.rreg = fdc.r + 1; // ver0.25 - if (seeksector(fdc.drv, trk, fdc.rreg)) { - fdc.r++; - fdc.off = 0; - return(0); - } + else { + return(FDDSTAT_SEEKERR); } - return(1); } +static REG8 fddd88_read(FDDFILE fdd, REG8 media, UINT track, REG8 sc, + UINT8 *ptr, UINT *size) { -// --------------------------------------------------------------------------- - -void init_tao_d88(void) { +const _D88TRK *trk; +const _D88SEC *sec; + UINT secsize; + REG8 ret; - if ((fdc.media == 0) && (d88head[fdc.drv].fd_type != 0x20)) { - tao = WID_2D; - } - else if ((fdc.media == 1) && (d88head[fdc.drv].fd_type == 0x20)) { - tao = WID_2HD; - } - else { - tao = WID_ERR; + TRACEOUT(("d88 read %d:%.2x", track, sc)); + trk = trackseek(fdd, media, track); + if (trk == NULL) { + goto fd8r_err; + } + sec = sectorseek(trk, sc); + if (sec == NULL) { + goto fd8r_err; + } + ret = 0x00; + if (sec->del_flg) { + ret |= FDDSTAT_RECTYPE; + } + if (sec->stat) { + ret |= FDDSTAT_CRCERR; + } + secsize = LOADINTELWORD(sec->size); + secsize = min(secsize, *size); + if ((ptr) && (secsize)) { + CopyMemory(ptr, sec + 1, secsize); } + *size = secsize; + return(ret); + +fd8r_err: + return(FDDSTAT_RECNFND); } -int fileappend(FILEH hdr, D88_HEADER *head, - long ptr, long last, long apsize) { +static REG8 fddd88_write(FDDFILE fdd, REG8 media, UINT track, REG8 sc, + const UINT8 *ptr, UINT size) { - long length; - WORD size; - WORD rsize; - int t; - long *trkp; + D88TRK trk; + D88SEC sec; + UINT secsize; - if ((length = last - ptr) <= 0) { // 書き換える必要なし - return(0); + TRACEOUT(("d88 write %d:%.2x", track, sc)); + trk = trackseek(fdd, media, track); + if (trk == NULL) { + goto fd8w_err; + } + sec = sectorseek(trk, sc); + if (sec == NULL) { + goto fd8w_err; + } + secsize = LOADINTELWORD(sec->size); + size = min(size, secsize); + if (size) { + CopyMemory(sec + 1, ptr, size); + trk->write = TRUE; + } + return(0x00); + +fd8w_err: + return(FDDSTAT_RECNFND | FDDSTAT_WRITEFAULT); +} + +static REG8 fddd88_wrtrk(FDDFILE fdd, REG8 media, UINT track, REG8 sc, + const UINT8 *ptr, UINT size) { + + UINT pos; + UINT i; + UINT datsize; + D88SEC dst; + + trackflush(&d88trk); + + /* データ作る */ + ZeroMemory(d88trk.buf, sizeof(d88trk.buf)); + pos = 0; + for (i=0; isize); + pos += sizeof(_D88SEC) + datsize; + if (pos > D88BUFSIZE) { + goto fd8wt_err; + } + dst->c = ((TAOSEC *)ptr)->c; + dst->h = ((TAOSEC *)ptr)->h; + dst->r = ((TAOSEC *)ptr)->r; + dst->n = ((TAOSEC *)ptr)->n; + dst->sectors[0] = sc; + STOREINTELWORD(dst->size, datsize); + CopyMemory((dst + 1), ptr + sizeof(TAOSEC), datsize); + ptr += sizeof(TAOSEC) + datsize; } - while(length) { - if (length >= 0x4000) { - size = 0x4000; - } - else { - size = (WORD)length; - } - length -= (long)size; - file_seek(hdr, ptr+length, 0); - rsize = file_read(hdr, D88_BUF, size); - file_seek(hdr, ptr+length+apsize, 0); - file_write(hdr, D88_BUF, rsize); - } - - trkp = head->trackp; - for (t=0; t<164; t++, trkp++) { - if ((*trkp) && (*trkp >= ptr)) { - (*trkp) += apsize; - } + if (writetrack(fdd, media, track, d88trk.buf, pos) != SUCCESS) { + goto fd8wt_err; } return(0); -} - +fd8wt_err: + return(FDDSTAT_RECNFND | FDDSTAT_WRITEFAULT); +} -void endoftrack(void) { +static REG8 fddd88_crc(FDDFILE fdd, REG8 media, UINT track, UINT num, + UINT8 *ptr) { - FDDFILE fdd; - FILEH hdr; - int i; - WORD trk; - D88_HEADER *head; - long fpointer; - long endpointer; - long lastpointer; - long trksize; - long apsize; - D88SEC p; - UINT secsize; +const _D88TRK *trk; +const _D88SEC *sec; + UINT sectors; + UINT size; - if (!tao.sector) { - tao.flag = 4; - return; - } - tao.flag = 0; - - curdataflush(); // write cache flush & - curdrv = (REG8)-1; // use D88_BUF[] for temp - - head = &d88head[fdc.drv]; - trk = (fdc.c << 1) + fdc.h; - - p = (D88SEC)TAO_BUF; - for (i=0; i<(int)tao.sector; i++) { - STOREINTELWORD(p->sectors, tao.sector); - secsize = LOADINTELWORD(p->size); - p = (D88SEC)(((UINT8 *)(p + 1)) + secsize); - } - - fdd = fddfile + fdc.drv; - if ((hdr = file_open(fdd->fname)) == FILEH_INVALID) { - return; - } - lastpointer = file_seek(hdr, 0, 2); - if ((fpointer = head->trackp[trk]) == 0) { - fpointer = 0; // 新規トラック - for (i=trk; i>=0; i--) { - if (head->trackp[i]) { - fpointer = head->trackp[i]; - break; - } - } - if (fpointer) { // ヒットした - fpointer = nexttrackp(head, fpointer, lastpointer); - } - else { - fpointer = sizeof(D88_HEADER); - } - endpointer = fpointer; - } - else { // トラックデータは既にある - endpointer = nexttrackp(head, fpointer, lastpointer); - } - trksize = endpointer - fpointer; - if ((apsize = (long)tao.size - trksize) > 0) { - // 書き込むデータのほーが大きい - fileappend(hdr, head, endpointer, lastpointer, apsize); - head->fd_size += apsize; + trk = trackseek(fdd, media, track); + if (trk == NULL) { + return(FDDSTAT_RECNFND); + } + sec = (D88SEC)trk->buf; + sectors = trk->sectors; + if (num >= sectors) { + return(FDDSTAT_RECNFND); + } + while(num) { + num--; + size = LOADINTELWORD(sec->size); + size += sizeof(_D88SEC); + sec = (D88SEC)(((UINT8 *)sec) + size); + } + ptr[0] = sec->c; + ptr[1] = sec->h; + ptr[2] = sec->r; + ptr[3] = sec->n; + ptr[4] = 0; + ptr[5] = 0; +#if 0 + fdc.s.rreg = sec->c; /* メルヘンヴェール */ +#endif /* 0 */ + if (sec->stat) { + return(FDDSTAT_CRCERR); } - head->trackp[trk] = fpointer; - file_seek(hdr, fpointer, 0); - file_write(hdr, TAO_BUF, tao.size); - file_seek(hdr, 0, 0); - file_write(hdr, head, sizeof(D88_HEADER)); - file_close(hdr); + return(0x00); } +#if defined(SUPPORT_DISKEXT) +static UINT32 fddd88_sec(FDDFILE fdd, REG8 media, UINT track, REG8 sc) { -void fdd_wtao_d88(BYTE data) { - - D88SEC p; +const _D88TRK *trk; +const _D88SEC *sec; + UINT sectors; + UINT num; + UINT size; - if (tao.flag != 3) { - return; - } - tao.lostdatacnt = 0; - if (tao.cnt > tao.maxsize) { - endoftrack(); - return; + trk = trackseek(fdd, media, track); + if (trk == NULL) { + return(0); } - tao.cnt++; - switch(tao.mode) { - case TAO_ENDOFDATA: - if (data == TAO_MODE_GAP) { - tao.mode = TAO_MODE_GAP; - tao.gap = 0; - } - break; - - case TAO_MODE_GAP: - if (data == TAO_MODE_GAP) { - if (tao.gap++ > 256) { - endoftrack(); - } - } - else if (data == TAO_CMD_SYNC) { - tao.mode = TAO_MODE_SYNC; - } -#if 1 // ver0.26 Zeliard - else if (data == 0xf4) { - endoftrack(); - } -#endif - else { - tao.flag = 4; - } - break; - - case TAO_MODE_SYNC: -// tao.cnt--; // ver0.26 Zeliard - if (data == TAO_CMD_AM_IN) { - tao.mode = TAO_MODE_AM; - } - else if (data == TAO_CMD_IM_IN) { - tao.mode = TAO_MODE_IM; - } - else if (data) { - tao.flag = 4; - } - break; - - case TAO_MODE_IM: - if (data == TAO_CMD_IM) { - tao.mode = TAO_ENDOFDATA; - } - else if (data != TAO_CMD_IM_IN) { - tao.flag = 4; - } - break; - - case TAO_MODE_AM: - if (data == TAO_CMD_IAM) { - tao.mode = TAO_MODE_ID; - tao.ptr = 0; - tao.top = tao.size; - } - else if (data == TAO_CMD_DAM) { - tao.mode = TAO_MODE_DATA; - tao.ptr = 0; - } - else if (data == TAO_CMD_DDAM) { - tao.mode = TAO_MODE_DATA; - tao.ptr = 0; - p = (D88SEC)(TAO_BUF + tao.top); - p->del_flg = 1; - } - break; - - case TAO_MODE_ID: - if ((data == TAO_CMD_IAM) && (!tao.ptr)) { - break; - } - else if (tao.ptr < 4) { - TAO_BUF[tao.size++] = data; - tao.ptr++; - } - else if (data == TAO_CMD_CRC) { - tao.mode = TAO_ENDOFDATA; - ZeroMemory(TAO_BUF + tao.size, 12); - tao.size += 12; - } - break; - - case TAO_MODE_DATA: // DATA WRITE - if ((!tao.ptr) && - ((data == TAO_CMD_DAM) || (data == TAO_CMD_DDAM))) { - break; - } - else if (data == TAO_CMD_CRC) { // nで判定した方が無難か? - tao.mode = TAO_ENDOFDATA; - p = (D88SEC)(TAO_BUF + tao.top); - STOREINTELWORD(p->size, tao.ptr); - if (tao.sector++ > tao.maxsector) { - tao.flag = 4; - } - } - else { - TAO_BUF[tao.size++] = data; - tao.ptr++; - } + sec = (D88SEC)trk->buf; + sectors = trk->sectors; + num = 0; + while(num < sectors) { + if (sec->r == sc) { break; + } + size = LOADINTELWORD(sec->size); + size += sizeof(_D88SEC); + sec = (D88SEC)(((UINT8 *)sec) + size); + num++; } + return((UINT32)(sectors << 16) + num); } +#endif -// ---- - -BRESULT fddd88_eject(FDDFILE fdd, REG8 drv) { - - drvflush(drv); - ZeroMemory(&d88head[drv], sizeof(D88_HEADER)); - fdd->fname[0] = '\0'; - fdd->type = DISKTYPE_NOTREADY; - return(SUCCESS); -} +/* ---- */ -BRESULT fddd88_set(FDDFILE fdd, REG8 drv, const OEMCHAR *fname) { +BRESULT fddd88_set(FDDFILE fdd, const OEMCHAR *fname) { short attr; FILEH fh; - UINT rsize; + BRESULT r; + UINT8 ptr[D88_TRACKMAX][4]; + UINT i; attr = file_attr(fname); if (attr & 0x18) { goto fdst_err; } - fh = file_open(fname); + fh = file_open_rb(fname); if (fh == FILEH_INVALID) { goto fdst_err; } - rsize = file_read(fh, &d88head[drv], sizeof(D88_HEADER)); + r = (file_read(fh, &fdd->inf.d88.head, sizeof(fdd->inf.d88.head)) + != sizeof(fdd->inf.d88.head)) || + (file_read(fh, ptr, sizeof(ptr)) != sizeof(ptr)); file_close(fh); - if (rsize != sizeof(D88_HEADER)) { + if (r) { goto fdst_err; } - if (d88head[drv].protect & 0x10) { + fdd->inf.d88.fd_size = LOADINTELDWORD(fdd->inf.d88.head.fd_size); + for (i=0; iinf.d88.ptr[i] = LOADINTELDWORD(ptr[i]); + } + if (fdd->inf.d88.head.protect & 0x10) { attr |= 1; } - milstr_ncpy(fdd->fname, fname, NELEMENTS(fdd->fname)); fdd->type = DISKTYPE_D88; fdd->protect = (UINT8)(attr & 1); + fdd->seek = fddd88_seek; + fdd->read = fddd88_read; + fdd->write = fddd88_write; + fdd->wrtrk = fddd88_wrtrk; + fdd->crc = fddd88_crc; +#if defined(SUPPORT_DISKEXT) + fdd->sec = fddd88_sec; +#endif return(SUCCESS); fdst_err: return(FAILURE); } +void fddd88_eject(FDDFILE fdd) { + + drvflush(fdd); +} +