|
|
| version 1.1, 2004/08/01 05:31:30 | version 1.12, 2004/08/17 09:35:09 |
|---|---|
| Line 1 | Line 1 |
| #include "compiler.h" | #include "compiler.h" |
| #include "dosio.h" | #include "dosio.h" |
| #include "pccore.h" | #include "pccore.h" |
| #include "x1_io.h" | |
| #include "x1_fdc.h" | |
| #include "fdd_mtr.h" | |
| #include "fdd_d88.h" | |
| #include "fddfile.h" | #include "fddfile.h" |
| #include "fdd_d88.h" | |
| #include "fdd_mtr.h" | |
| static D88_HEADER d88head[4]; | enum { |
| static D88_SECTOR cursec; | D88BUFSIZE = 0x4000 |
| static short curdrv = -1; | }; |
| static WORD curtrk = -1; | |
| static BYTE curtype = 0; | |
| static WORD cursct = -1; | |
| static long curfp = 0; | |
| static DWORD cursize = 0; | |
| static BYTE curwrite = 0; | |
| static BYTE curtrkerr = 0; | |
| static BYTE hole = 0; | |
| static BYTE *curdata; | |
| static WORD crcnum = 0; | |
| static BYTE crcerror = FALSE; | |
| extern BYTE WRITEPT[]; | |
| extern BYTE DISKNUM[]; | |
| 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 | |
| typedef struct { | typedef struct { |
| BYTE mode; | FDDFILE fdd; |
| BYTE flag; | UINT8 media; |
| WORD cnt; | UINT8 write; |
| WORD size; | UINT8 padding[2]; |
| WORD ptr; | UINT track; |
| WORD top; | long fptr; |
| WORD gap; | UINT size; |
| BYTE sector; | UINT sectors; |
| WORD lostdatacnt; | UINT8 buf[D88BUFSIZE]; |
| BYTE maxsector; | } _D88TRK, *D88TRK; |
| 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 _D88TRK d88trk; |
| static BYTE TAO_BUF[0x3000]; | |
| //---------------------------------------------------------------------- | static UINT32 nexttrackptr(FDDFILE fdd, UINT32 fptr, UINT32 last) { |
| DWORD nexttrackp(D88_HEADER *head, DWORD fptr, DWORD last) { | UINT t; |
| UINT32 cur; | |
| int t; | for (t=0; t<164; t++) { |
| DWORD ret; | cur = fdd->inf.d88.ptr[t]; |
| DWORD *trkp; | if ((cur > fptr) && (cur < last)) { |
| last = cur; | |
| ret = last; | |
| trkp = (DWORD *)head->trackp; | |
| for (t=0; t<164; t++, trkp++) { | |
| if ((*trkp > fptr) && (*trkp < ret)) { | |
| ret = *trkp; | |
| } | } |
| } | } |
| return(ret); | return(last); |
| } | } |
| static BRESULT trackflush(D88TRK trk) { | |
| int curdataflush(void) { | |
| FDDFILE fdd; | FDDFILE fdd; |
| FILEH fh; | FILEH fh; |
| int ret = 0; | |
| if ((!curfp) || (!cursize)) { | fdd = trk->fdd; |
| return(-1); | trk->fdd = NULL; |
| } | if ((fdd == NULL) || (trk->size == 0) || (!trk->write)) { |
| if (!curwrite) { | goto dtfd_exit; |
| return(0); | |
| } | } |
| curwrite = 0; | |
| fdd = fddfile + curdrv; | |
| fh = file_open(fdd->fname); | fh = file_open(fdd->fname); |
| if (fh == FILEH_INVALID) { | if (fh == FILEH_INVALID) { |
| return(-1); | goto dtfd_err1; |
| } | } |
| if ((file_seek(fh, curfp, FSEEK_SET) != curfp) || | if ((file_seek(fh, trk->fptr, FSEEK_SET) != trk->fptr) || |
| (file_write(fh, D88_BUF, cursize) != cursize)) { | (file_write(fh, trk->buf, trk->size) != trk->size)) { |
| ret = -1; | goto dtfd_err2; |
| } | } |
| if (file_close(fh)) { | file_close(fh); |
| ret = -1; | trk->write = FALSE; |
| } | |
| return(ret); | |
| } | |
| dtfd_exit: | |
| return(SUCCESS); | |
| DWORD read_d88track(short drv, WORD track, BYTE type) { | dtfd_err2: |
| file_close(fh); | |
| FDDFILE fdd; | dtfd_err1: |
| FILEH hdr; | return(FAILURE); |
| } | |
| curdataflush(); | static D88TRK trackread(D88TRK trk, FDDFILE fdd, REG8 media, UINT track) { |
| curdrv = drv; | |
| curtrk = track; | |
| curtype = type; | |
| cursct = -1; | |
| curwrite = 0; | |
| curtrkerr = 0; | |
| crcnum = 0; | |
| crcerror = 0; | |
| 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; | |
| } | |
| fdd = fddfile + drv; | FILEH fh; |
| if ((hdr = file_open(fdd->fname)) == FILEH_INVALID) { | UINT32 fptr; |
| goto readd88_err; | UINT size; |
| const _D88SEC *sec; | |
| UINT rem; | |
| UINT maxsectors; | |
| UINT sectors; | |
| UINT secsize; | |
| trackflush(trk); | |
| if (media != (REG8)((fdd->inf.d88.head.fd_type >> 4))) { | |
| goto dtrd_err1; | |
| } | } |
| if (file_seek(hdr, curfp, FSEEK_SET) != curfp) { | if (track >= 164) { |
| file_close(hdr); | goto dtrd_err1; |
| goto readd88_err; | |
| } | } |
| if (file_read(hdr, D88_BUF, (WORD)cursize) != (WORD)cursize) { | fptr = fdd->inf.d88.ptr[track]; |
| file_close(hdr); | if (fptr == 0) { |
| goto readd88_err; | goto dtrd_err1; |
| } | } |
| if (file_close(hdr)) { | size = nexttrackptr(fdd, fptr, fdd->inf.d88.fd_size) - fptr; |
| goto readd88_err; | if (size > D88BUFSIZE) { |
| size = D88BUFSIZE; | |
| } | |
| fh = file_open_rb(fdd->fname); | |
| if (fh == FILEH_INVALID) { | |
| goto dtrd_err1; | |
| } | |
| 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(TRUE); | trk->sectors = sectors; |
| return(trk); | |
| readd88_err: | dtrd_err2: |
| curfp = 0; | file_close(fh); |
| cursize = 0; | |
| curtrkerr = 1; | |
| return(FALSE); | |
| } | |
| dtrd_err1: | |
| return(NULL); | |
| } | |
| static void drvflush(FDDFILE fdd) { | |
| D88TRK trk; | |
| int seeksector(short drv, WORD track, WORD sector) { | trk = &d88trk; |
| if (trk->fdd == fdd) { | |
| trackflush(trk); | |
| } | |
| } | |
| static int lastflag = FALSE; | static D88TRK trackseek(FDDFILE fdd, REG8 media, UINT track) { |
| BYTE *p; | D88TRK trk; |
| WORD sec; | |
| if ((curdrv != drv) || (curtrk != track) || (curtype != FDC.media)) { | trk = &d88trk; |
| read_d88track(drv, track, FDC.media); | if ((trk->fdd != fdd) || (trk->media != media) || (trk->track != track)) { |
| } | trk = trackread(trk, fdd, media, track); |
| if (curtrkerr) { | |
| cursct = sector; | |
| goto seekerror; | |
| } | |
| if (cursct != sector) { | |
| cursct = sector; | |
| p = D88_BUF; | |
| for (sec=0; sec<40;) { | |
| if ((WORD)((D88_SECTOR *)p)->r == sector) { | |
| memcpy(&cursec, p, sizeof(D88_SECTOR)); | |
| curdata = p + sizeof(D88_SECTOR); | |
| lastflag = TRUE; | |
| break; | |
| } | |
| if (++sec >= ((D88_SECTOR *)p)->sectors) { | |
| goto seekerror; | |
| } | |
| p += ((D88_SECTOR *)p)->size; | |
| p += sizeof(D88_SECTOR); | |
| } | |
| if (sec >= 40) { | |
| goto seekerror; | |
| } | |
| } | } |
| return(lastflag); | return(trk); |
| seekerror:; | |
| ZeroMemory(&cursec, sizeof(D88_SECTOR)); | |
| curdata = &D88_BUF[16]; | |
| lastflag = FALSE; | |
| return(FALSE); | |
| } | } |
| static D88SEC sectorseek(const _D88TRK *trk, REG8 r) { | |
| void drvflush(short drv) { | const _D88SEC *sec; |
| UINT sectors; | |
| UINT size; | |
| if (curdrv == drv) { | sec = (D88SEC)trk->buf; |
| curdataflush(); | sectors = trk->sectors; |
| curdrv = -1; | while(sectors) { |
| curtrk = -1; | sectors--; |
| cursct = -1; | if (sec->r == r) { |
| return((D88SEC)sec); | |
| } | |
| size = LOADINTELWORD(sec->size); | |
| size += sizeof(_D88SEC); | |
| sec = (D88SEC)(((UINT8 *)sec) + size); | |
| } | } |
| return(NULL); | |
| } | } |
| //********************************************************************** | // ---- |
| BRESULT fdd_eject_d88(REG8 drv) { | |
| FDDFILE fdd; | static REG8 fddd88_seek(FDDFILE fdd, REG8 media, UINT track) { |
| drvflush(drv); | if (trackseek(fdd, media, track) != NULL) { |
| fdd = fddfile + drv; | return(0x00); |
| ZeroMemory(&d88head[drv], sizeof(D88_HEADER)); | } |
| fdd->fname[0] = '\0'; | else { |
| DISKNUM[drv] = 0; | return(FDDSTAT_SEEKERR); |
| return(0); | } |
| } | } |
| BRESULT fdd_set_d88(REG8 drv, const OEMCHAR *fname) { | static REG8 fddd88_read(FDDFILE fdd, REG8 media, UINT track, REG8 sc, |
| UINT8 *ptr, UINT *size) { | |
| FDDFILE fdd; | const _D88TRK *trk; |
| WORD attr; | const _D88SEC *sec; |
| FILEH hdr; | UINT secsize; |
| short rsize; | REG8 ret; |
| fdd_eject_d88(drv); | TRACEOUT(("d88 read %d:%.2x", track, sc)); |
| fdd = fddfile + drv; | trk = trackseek(fdd, media, track); |
| if ((drv < 0 || drv > 3) || | if (trk == NULL) { |
| ((attr = file_attr(fname)) & 0x18)) { // エラー・ディレクトリ・ラベル | goto fd8r_err; |
| return(1); | |
| } | } |
| if ((hdr = file_open(fname)) == FILEH_INVALID) { | sec = sectorseek(trk, sc); |
| return(1); | if (sec == NULL) { |
| goto fd8r_err; | |
| } | } |
| rsize = file_read(hdr, &d88head[drv], sizeof(D88_HEADER)); | ret = 0x00; |
| file_close(hdr); | if (sec->del_flg) { |
| if (rsize != sizeof(D88_HEADER)) { | ret |= FDDSTAT_RECTYPE; |
| fdd_eject_d88(drv); | |
| return(1); | |
| } | } |
| if (attr & 1) { | if (sec->stat) { |
| d88head[drv].protect |= (WORD)0x10; | ret |= FDDSTAT_CRCERR; |
| } | } |
| milstr_ncpy(fdd->fname, fname, NELEMENTS(fdd->fname)); | secsize = LOADINTELWORD(sec->size); |
| DISKNUM[drv] = 1; | secsize = min(secsize, *size); |
| return(0); | if ((ptr) && (secsize)) { |
| } | CopyMemory(ptr, sec + 1, secsize); |
| } | |
| *size = secsize; | |
| return(ret); | |
| fd8r_err: | |
| return(FDDSTAT_RECNFND); | |
| } | |
| //********************************************************************** | static REG8 fddd88_write(FDDFILE fdd, REG8 media, UINT track, REG8 sc, |
| const UINT8 *ptr, UINT size) { | |
| short fdd_crc_d88(void) { | D88TRK trk; |
| D88SEC sec; | |
| UINT secsize; | |
| WORD track; | TRACEOUT(("d88 write %d:%.2x", track, sc)); |
| BYTE *p; | trk = trackseek(fdd, media, track); |
| WORD sec; | if (trk == NULL) { |
| goto fd8w_err; | |
| ZeroMemory(FDC.crc_dat, 6); | |
| if ((track = (WORD)(FDC.c << 1) + (WORD)FDC.h) > 163) { | |
| goto crcerror_d88; | |
| } | |
| seeksector(FDC.drv, track, FDC.r); | |
| if (curtrkerr) { | |
| goto crcerror_d88; | |
| } | |
| p = D88_BUF; | |
| for (sec=0; sec<crcnum;) { | |
| if (++sec >= ((D88_SECTOR *)p)->sectors) { | |
| goto crcerror_d88; | |
| } | |
| p += ((D88_SECTOR *)p)->size; | |
| p += sizeof(D88_SECTOR); | |
| } | } |
| *(long *)FDC.crc_dat = *(long *)p; | sec = sectorseek(trk, sc); |
| FDC.rreg = ((D88_SECTOR *)p)->c; // ??? メルヘンヴェール | if (sec == NULL) { |
| crcnum++; | goto fd8w_err; |
| if (((D88_SECTOR *)p)->stat) { | |
| crcerror = TRUE; | |
| } | } |
| else { | secsize = LOADINTELWORD(sec->size); |
| crcerror = FALSE; | size = min(size, secsize); |
| if (size) { | |
| CopyMemory(sec + 1, ptr, size); | |
| trk->write = TRUE; | |
| } | } |
| return(0); | return(0x00); |
| crcerror_d88:; | fd8w_err: |
| crcerror = TRUE; | return(FDDSTAT_RECNFND | FDDSTAT_WRITEFAULT); |
| return(1); | |
| } | } |
| static REG8 fddd88_crc(FDDFILE fdd, REG8 media, UINT track, UINT num, | |
| UINT8 *ptr) { | |
| BYTE fdd_stat_d88(void) { | const _D88TRK *trk; |
| const _D88SEC *sec; | |
| UINT sectors; | |
| UINT size; | |
| BYTE type, cmnd; | trk = trackseek(fdd, media, track); |
| BYTE ans = 0; | if (trk == NULL) { |
| int seekable; | return(FDDSTAT_RECNFND); |
| WORD trk; | |
| if (DISKNUM[FDC.drv] == DRV_EMPTY) { | |
| return(0x80); // NOT READY | |
| } | } |
| type = FDC.type; | sec = (D88SEC)trk->buf; |
| cmnd = (BYTE)(FDC.cmnd >> 4); | sectors = trk->sectors; |
| trk = (FDC.c << 1) + (WORD)FDC.h; | if (num >= sectors) { |
| seekable = seeksector(FDC.drv, trk, FDC.r); | return(FDDSTAT_RECNFND); |
| if (!FDC.r) { | |
| seekable = TRUE; | |
| } | } |
| while(num) { | |
| if (type == 0 || type == 1 || type == 4 || | num--; |
| cmnd == 0x0a || cmnd == 0x0b || cmnd == 0x0f) { | size = LOADINTELWORD(sec->size); |
| if (d88head[FDC.drv].protect & 0x10) { // WRITE PROTECT | size += sizeof(_D88SEC); |
| ans |= 0x40; | sec = (D88SEC)(((UINT8 *)sec) + size); |
| } | |
| } | } |
| if (type == 2 || cmnd == 0x0f) { | ptr[0] = sec->c; |
| if (FDC.r && cursec.del_flg) { | ptr[1] = sec->h; |
| ans |= 0x20; // RECODE TYPE / WRITE FAULT | ptr[2] = sec->r; |
| } | ptr[3] = sec->n; |
| ptr[4] = 0; | |
| ptr[5] = 0; | |
| // fdc.s.rreg = sec->c; // メルヘンヴェール | |
| if (sec->stat) { | |
| return(FDDSTAT_CRCERR); | |
| } | } |
| if (type == 1 || type == 2) { | return(0x00); |
| if ((trk > 163) || (!seekable)) { | } |
| ans |= 0x10; // SEEK ERROR / RECORD NOT FOUND | |
| } | #if defined(SUPPORT_DISKEXT) |
| if ((!(ans & 0xf0)) && FDC.r && (cursec.stat)) { | static UINT32 fddd88_sec(FDDFILE fdd, REG8 media, UINT track, REG8 sc) { |
| ans |= 0x08; // CRC ERROR | |
| } | const _D88TRK *trk; |
| const _D88SEC *sec; | |
| UINT sectors; | |
| UINT num; | |
| UINT size; | |
| trk = trackseek(fdd, media, track); | |
| if (trk == NULL) { | |
| return(0); | |
| } | } |
| if (cmnd == 0x0c) { | sec = (D88SEC)trk->buf; |
| if (curtrkerr) { | sectors = trk->sectors; |
| ans |= 0x10; | num = 0; |
| } | while(num < sectors) { |
| if (crcerror) { | if (sec->r == sc) { |
| ans |= 0x08; // CRC ERROR | break; |
| } | } |
| size = LOADINTELWORD(sec->size); | |
| size += sizeof(_D88SEC); | |
| sec = (D88SEC)(((UINT8 *)sec) + size); | |
| num++; | |
| } | } |
| if (type == 1 || type == 4) { | return((UINT32)(sectors << 16) + num); |
| if (type == 1) { // ver0.25 | } |
| ans |= 0x20; // HEAD ENGAGED (X1 デハ ツネニ 1) | #endif |
| if (!FDC.c) { // TRACK00 | |
| ans |= 0x04; | |
| } | // ---- |
| } | |
| if (++hole < 8) { // ver0.25 | BRESULT fddd88_set(FDDFILE fdd, const OEMCHAR *fname) { |
| ans |= 0x02; // INDEX | |
| } | short attr; |
| FILEH fh; | |
| BOOL r; | |
| UINT8 ptr[D88_TRACKMAX][4]; | |
| UINT i; | |
| attr = file_attr(fname); | |
| if (attr & 0x18) { | |
| goto fdst_err; | |
| } | } |
| else if (!(ans & 0xf0)) { | fh = file_open_rb(fname); |
| if ((type != 4) && (FDDMTR_BUSY)) { | if (fh == FILEH_INVALID) { |
| ans |= 0x01; | goto fdst_err; |
| } | |
| if ((type == 2) && ((WORD)FDC.off < cursec.size)) { | |
| ans |= 0x03; // DATA REQUEST / BUSY | |
| } | |
| else if ((cmnd == 0x0e) && (readdiag < 0x1a00)) { | |
| ans |= 0x03; | |
| } | |
| else if ((cmnd == 0x0c) && (FDC.crc_off < 6)) { // ver0.25 | |
| ans |= 0x03; | |
| } | |
| else if (cmnd == 0x0f) { | |
| if (tao.flag == 3) { | |
| if (++tao.lostdatacnt > LOSTDATA_COUNT) { | |
| tao.flag = 4; | |
| } | |
| } | |
| ans |= tao.flag; | |
| } | |
| } | } |
| return(ans); | 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 (r) { | |
| goto fdst_err; | |
| } | |
| fdd->inf.d88.fd_size = LOADINTELDWORD(fdd->inf.d88.head.fd_size); | |
| for (i=0; i<D88_TRACKMAX; i++) { | |
| fdd->inf.d88.ptr[i] = LOADINTELDWORD(ptr[i]); | |
| } | |
| if (fdd->inf.d88.head.protect & 0x10) { | |
| attr |= 1; | |
| } | |
| fdd->type = DISKTYPE_D88; | |
| fdd->protect = (UINT8)(attr & 1); | |
| fdd->seek = fddd88_seek; | |
| fdd->read = fddd88_read; | |
| fdd->write = fddd88_write; | |
| fdd->crc = fddd88_crc; | |
| #if defined(SUPPORT_DISKEXT) | |
| fdd->sec = fddd88_sec; | |
| #endif | |
| return(SUCCESS); | |
| fdst_err: | |
| return(FAILURE); | |
| } | } |
| //********************************************************************** | void fddd88_eject(FDDFILE fdd) { |
| void fdd_read_d88(void) { | drvflush(fdd); |
| // POCO:読めなかったらレジスタを変更させない | |
| if ((fdd_stat_d88() & 0xf3) == 3) { | |
| FDC.data = curdata[FDC.off]; | |
| #if 0 //def TRACE | |
| { | |
| char buf[256]; | |
| wsprintf(buf, "%3d %2d %02x -> %04x/%04x", | |
| (FDC.c << 1) + FDC.h, FDC.r, FDC.off, R.HL.W, | |
| dma.CNT_B.w); | |
| TRACE_(buf, FDC.data); | |
| } | |
| #endif | |
| } | |
| } | } |
| void fdd_write_d88(void) { | |
| if ((fdd_stat_d88() & 0xf3) == 3) { | |
| curdata[FDC.off] = FDC.data; | |
| curwrite = 1; | |
| } | |
| } | |
| BYTE fdd_incoff_d88(void) { | |
| BYTE cmnd; | |
| WORD trk; | |
| cmnd = (BYTE)(FDC.cmnd >> 4); | |
| trk = (FDC.c << 1) + (WORD)FDC.h; | |
| seeksector(FDC.drv, trk, FDC.r); | |
| if ((WORD)(++FDC.off) < cursec.size) { | |
| return(0); | |
| } | |
| FDC.off = cursec.size; | |
| if (cmnd == 0x09 || cmnd == 0x0b) { | |
| FDC.rreg = FDC.r + 1; // ver0.25 | |
| if (seeksector(FDC.drv, trk, FDC.rreg)) { | |
| FDC.r++; | |
| FDC.off = 0; | |
| return(0); | |
| } | |
| } | |
| return(1); | |
| } | |
| // --------------------------------------------------------------------------- | // --------------------------------------------------------------------------- |
| #if 0 | |
| // ---- | |
| 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 | |
| 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]; | |
| // ---- | |
| void init_tao_d88(void) { | void init_tao_d88(void) { |
| if ((FDC.media == 0) && (d88head[FDC.drv].fd_type != 0x20)) { | FDDFILE fdd; |
| fdd = fddfile + fdc.s.drv; | |
| if (fdc.s.media != (fdd->inf.d88.head.fd_type >> 4)) { | |
| tao = WID_ERR; | |
| } | |
| if (fdc.s.media == DISKTYPE_2D) { | |
| tao = WID_2D; | tao = WID_2D; |
| } | } |
| else if ((FDC.media == 1) && (d88head[FDC.drv].fd_type == 0x20)) { | else if (fdc.s.media == DISKTYPE_2HD) { |
| tao = WID_2HD; | tao = WID_2HD; |
| } | } |
| else { | else { |
| Line 458 void init_tao_d88(void) { | Line 474 void init_tao_d88(void) { |
| } | } |
| } | } |
| static int fileappend(FILEH hdl, FDDFILE fdd, | |
| int fileappend(FILEH hdr, D88_HEADER *head, | UINT32 ptr, long last, long apsize) { |
| long ptr, long last, long apsize) { | |
| long length; | long length; |
| WORD size; | UINT size; |
| WORD rsize; | UINT rsize; |
| int t; | UINT t; |
| long *trkp; | BYTE tmp[0x400]; |
| UINT32 cur; | |
| if ((length = last - ptr) <= 0) { // 書き換える必要なし | length = last - ptr; |
| if (length <= 0) { // 書き換える必要なし | |
| return(0); | return(0); |
| } | } |
| while(length) { | while(length) { |
| if (length >= 0x4000) { | if (length >= (long)(sizeof(tmp))) { |
| size = 0x4000; | size = sizeof(tmp); |
| } | } |
| else { | else { |
| size = (WORD)length; | size = length; |
| } | } |
| length -= (long)size; | length -= size; |
| file_seek(hdr, ptr+length, 0); | file_seek(hdl, ptr + length, FSEEK_SET); |
| rsize = file_read(hdr, D88_BUF, size); | rsize = file_read(hdl, tmp, size); |
| file_seek(hdr, ptr+length+apsize, 0); | file_seek(hdl, ptr + length + apsize, FSEEK_SET); |
| file_write(hdr, D88_BUF, rsize); | file_write(hdl, tmp, rsize); |
| } | } |
| for (t=0; t<164; t++) { | |
| trkp = head->trackp; | cur = fdd->inf.d88.ptr[t]; |
| for (t=0; t<164; t++, trkp++) { | if ((cur) && (cur >= ptr)) { |
| if ((*trkp) && (*trkp >= ptr)) { | fdd->inf.d88.ptr[t] = cur + apsize; |
| (*trkp) += apsize; | |
| } | } |
| } | } |
| return(0); | return(0); |
| } | } |
| static void endoftrack(void) { | |
| FDDFILE fdd; | |
| void endoftrack(void) { | FILEH hdr; |
| int i; | |
| FDDFILE fdd; | UINT trk; |
| FILEH hdr; | long fpointer; |
| int i; | long endpointer; |
| WORD trk; | long lastpointer; |
| D88_HEADER *head; | long trksize; |
| long fpointer; | long apsize; |
| long endpointer; | D88SEC p; |
| long lastpointer; | UINT secsize; |
| long trksize; | UINT8 ptr[D88_TRACKMAX][4]; |
| int ptr; | |
| long apsize; | |
| if (!tao.sector) { | if (!tao.sector) { |
| tao.flag = 4; | tao.flag = 4; |
| Line 517 void endoftrack(void) { | Line 532 void endoftrack(void) { |
| tao.flag = 0; | tao.flag = 0; |
| curdataflush(); // write cache flush & | curdataflush(); // write cache flush & |
| curdrv = -1; // use D88_BUF[] for temp | curdrv = (REG8)-1; // use D88_BUF[] for temp |
| head = &d88head[FDC.drv]; | fdd = fddfile + fdc.s.drv; |
| trk = (FDC.c << 1) + (WORD)FDC.h; | trk = (fdc.s.c << 1) + fdc.s.h; |
| ptr = 0; | p = (D88SEC)TAO_BUF; |
| for (i=0; i<(int)tao.sector; i++) { | for (i=0; i<(int)tao.sector; i++) { |
| ((D88_SECTOR *)&TAO_BUF[ptr])->sectors = tao.sector; | STOREINTELWORD(p->sectors, tao.sector); |
| ptr += ((D88_SECTOR *)&TAO_BUF[ptr])->size + 16; | secsize = LOADINTELWORD(p->size); |
| p = (D88SEC)(((UINT8 *)(p + 1)) + secsize); | |
| } | } |
| fdd = fddfile + FDC.drv; | |
| if ((hdr = file_open(fdd->fname)) == FILEH_INVALID) { | if ((hdr = file_open(fdd->fname)) == FILEH_INVALID) { |
| return; | return; |
| } | } |
| lastpointer = file_seek(hdr, 0, 2); | lastpointer = file_seek(hdr, 0, 2); |
| if ((fpointer = head->trackp[trk]) == 0) { | fpointer = fdd->inf.d88.ptr[trk]; |
| fpointer = 0; // 新規トラック | if (fpointer == 0) { |
| for (i=trk; i>=0; i--) { | for (i=trk; i>=0; i--) { // 新規トラック |
| if (head->trackp[i]) { | fpointer = fdd->inf.d88.ptr[i]; |
| fpointer = head->trackp[i]; | if (fpointer) { |
| break; | break; |
| } | } |
| } | } |
| if (fpointer) { // ヒットした | if (fpointer) { // ヒットした |
| fpointer = nexttrackp(head, fpointer, lastpointer); | fpointer = nexttrackptr(fdd, fpointer, lastpointer); |
| } | } |
| else { | else { |
| fpointer = sizeof(D88_HEADER); | fpointer = D88_HEADERSIZE; |
| } | } |
| endpointer = fpointer; | endpointer = fpointer; |
| } | } |
| else { // トラックデータは既にある | else { // トラックデータは既にある |
| endpointer = nexttrackp(head, fpointer, lastpointer); | endpointer = nexttrackptr(fdd, fpointer, lastpointer); |
| } | } |
| trksize = endpointer - fpointer; | trksize = endpointer - fpointer; |
| if ((apsize = (long)tao.size - trksize) > 0) { | if ((apsize = (long)tao.size - trksize) > 0) { |
| // 書き込むデータのほーが大きい | // 書き込むデータのほーが大きい |
| fileappend(hdr, head, endpointer, lastpointer, apsize); | fileappend(hdr, fdd, endpointer, lastpointer, apsize); |
| head->fd_size += apsize; | fdd->inf.d88.fd_size += apsize; |
| } | } |
| head->trackp[trk] = fpointer; | STOREINTELDWORD(fdd->inf.d88.head.fd_size, fdd->inf.d88.fd_size); |
| file_seek(hdr, fpointer, 0); | fdd->inf.d88.ptr[trk] = fpointer; |
| for (i=0; i<D88_TRACKMAX; i++) { | |
| STOREINTELDWORD(ptr[i], fdd->inf.d88.ptr[i]); | |
| } | |
| file_seek(hdr, 0, FSEEK_SET); | |
| file_write(hdr, &fdd->inf.d88.head, sizeof(fdd->inf.d88.head)); | |
| file_write(hdr, ptr, sizeof(ptr)); | |
| file_seek(hdr, fpointer, FSEEK_SET); | |
| file_write(hdr, TAO_BUF, tao.size); | file_write(hdr, TAO_BUF, tao.size); |
| file_seek(hdr, 0, 0); | |
| file_write(hdr, head, sizeof(D88_HEADER)); | |
| file_close(hdr); | file_close(hdr); |
| } | } |
| void fdd_wtao_d88(BYTE data) { | void fdd_wtao_d88(BYTE data) { |
| D88SEC p; | |
| if (tao.flag != 3) { | if (tao.flag != 3) { |
| return; | return; |
| } | } |
| Line 585 void fdd_wtao_d88(BYTE data) { | Line 606 void fdd_wtao_d88(BYTE data) { |
| tao.gap = 0; | tao.gap = 0; |
| } | } |
| break; | break; |
| case TAO_MODE_GAP: | case TAO_MODE_GAP: |
| if (data == TAO_MODE_GAP) { | if (data == TAO_MODE_GAP) { |
| if (tao.gap++ > 256) { | if (tao.gap++ > 256) { |
| Line 603 void fdd_wtao_d88(BYTE data) { | Line 625 void fdd_wtao_d88(BYTE data) { |
| tao.flag = 4; | tao.flag = 4; |
| } | } |
| break; | break; |
| case TAO_MODE_SYNC: | case TAO_MODE_SYNC: |
| // tao.cnt--; // ver0.26 Zeliard | // tao.cnt--; // ver0.26 Zeliard |
| if (data == TAO_CMD_AM_IN) { | if (data == TAO_CMD_AM_IN) { |
| Line 615 void fdd_wtao_d88(BYTE data) { | Line 638 void fdd_wtao_d88(BYTE data) { |
| tao.flag = 4; | tao.flag = 4; |
| } | } |
| break; | break; |
| case TAO_MODE_IM: | case TAO_MODE_IM: |
| if (data == TAO_CMD_IM) { | if (data == TAO_CMD_IM) { |
| tao.mode = TAO_ENDOFDATA; | tao.mode = TAO_ENDOFDATA; |
| Line 623 void fdd_wtao_d88(BYTE data) { | Line 647 void fdd_wtao_d88(BYTE data) { |
| tao.flag = 4; | tao.flag = 4; |
| } | } |
| break; | break; |
| case TAO_MODE_AM: | case TAO_MODE_AM: |
| if (data == TAO_CMD_IAM) { | if (data == TAO_CMD_IAM) { |
| tao.mode = TAO_MODE_ID; | tao.mode = TAO_MODE_ID; |
| Line 636 void fdd_wtao_d88(BYTE data) { | Line 661 void fdd_wtao_d88(BYTE data) { |
| else if (data == TAO_CMD_DDAM) { | else if (data == TAO_CMD_DDAM) { |
| tao.mode = TAO_MODE_DATA; | tao.mode = TAO_MODE_DATA; |
| tao.ptr = 0; | tao.ptr = 0; |
| ((D88_SECTOR *)&TAO_BUF[tao.top])->del_flg = 1; | p = (D88SEC)(TAO_BUF + tao.top); |
| p->del_flg = 1; | |
| } | } |
| break; | break; |
| case TAO_MODE_ID: | case TAO_MODE_ID: |
| if ((data == TAO_CMD_IAM) && (!tao.ptr)) { | if ((data == TAO_CMD_IAM) && (!tao.ptr)) { |
| break; | break; |
| Line 649 void fdd_wtao_d88(BYTE data) { | Line 676 void fdd_wtao_d88(BYTE data) { |
| } | } |
| else if (data == TAO_CMD_CRC) { | else if (data == TAO_CMD_CRC) { |
| tao.mode = TAO_ENDOFDATA; | tao.mode = TAO_ENDOFDATA; |
| ZeroMemory(&TAO_BUF[tao.size], 12); | ZeroMemory(TAO_BUF + tao.size, 12); |
| tao.size += 12; | tao.size += 12; |
| } | } |
| break; | break; |
| case TAO_MODE_DATA: // DATA WRITE | case TAO_MODE_DATA: // DATA WRITE |
| if ((!tao.ptr) && | if ((!tao.ptr) && |
| ((data == TAO_CMD_DAM) || (data == TAO_CMD_DDAM))) { | ((data == TAO_CMD_DAM) || (data == TAO_CMD_DDAM))) { |
| Line 660 void fdd_wtao_d88(BYTE data) { | Line 688 void fdd_wtao_d88(BYTE data) { |
| } | } |
| else if (data == TAO_CMD_CRC) { // nで判定した方が無難か? | else if (data == TAO_CMD_CRC) { // nで判定した方が無難か? |
| tao.mode = TAO_ENDOFDATA; | tao.mode = TAO_ENDOFDATA; |
| ((D88_SECTOR *)&TAO_BUF[tao.top])->size = tao.ptr; | p = (D88SEC)(TAO_BUF + tao.top); |
| STOREINTELWORD(p->size, tao.ptr); | |
| if (tao.sector++ > tao.maxsector) { | if (tao.sector++ > tao.maxsector) { |
| tao.flag = 4; | tao.flag = 4; |
| } | } |
| Line 672 void fdd_wtao_d88(BYTE data) { | Line 701 void fdd_wtao_d88(BYTE data) { |
| break; | break; |
| } | } |
| } | } |
| #endif | |