[BACK]Return to fdd_d88.c CVS log [TXT] [DIR] Up to [RetroPC.NET] / xmil / fdd

Diff for /xmil/fdd/fdd_d88.c between versions 1.4 and 1.14

version 1.4, 2004/08/04 15:18:26 version 1.14, 2004/08/18 15:42:32
Line 1 Line 1
 #include        "compiler.h"  #include        "compiler.h"
 #include        "dosio.h"  #include        "dosio.h"
 #include        "pccore.h"  #include        "pccore.h"
 #include        "iocore.h"  
 #include        "fddfile.h"  #include        "fddfile.h"
 #include        "fdd_d88.h"  #include        "fdd_d88.h"
 #include        "fdd_mtr.h"  #include        "fdd_mtr.h"
   
   
 static  D88_HEADER      d88head[4];  enum {
 static  _D88SEC         cursec;          D88BUFSIZE              = 0x4000
 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 {  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  BYTE            TAO_BUF[0x3000];  
   
   static  _D88TRK         d88trk;
   
 //----------------------------------------------------------------------  
   
 static UINT32 nexttrackp(D88_HEADER *head, UINT32 fptr, UINT32 last) {  static UINT32 nexttrackptr(FDDFILE fdd, UINT32 fptr, UINT32 last) {
   
         UINT    t;          UINT    t;
 const DWORD     *trkp;  
         UINT32  cur;          UINT32  cur;
   
         trkp = (DWORD *)head->trackp;  
         for (t=0; t<164; t++) {          for (t=0; t<164; t++) {
                 cur = trkp[t];                  cur = fdd->inf.d88.ptr[t];
                 if ((cur > fptr) && (cur < last)) {                  if ((cur > fptr) && (cur < last)) {
                         last = cur;                          last = cur;
                 }                  }
Line 85  const DWORD *trkp; Line 39  const DWORD *trkp;
         return(last);          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)) {
                   goto dtfd_exit;
         }          }
         if (!curwrite) {  
                 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) ||  
                 (file_write(fh, D88_BUF, cursize) != cursize)) {  
                 ret = -1;  
         }          }
         if (file_close(fh)) {          if ((file_seek(fh, trk->fptr, FSEEK_SET) != trk->fptr) ||
                 ret = -1;                  (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;  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 = (UINT)-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;          }
           fptr = fdd->inf.d88.ptr[track];
           if (fptr == 0) {
                   goto dtrd_err1;
         }          }
         if (file_read(hdr, D88_BUF, cursize) != cursize) {          size = nexttrackptr(fdd, fptr, fdd->inf.d88.fd_size) - fptr;
                 file_close(hdr);          if (size > D88BUFSIZE) {
                 goto readd88_err;                  size = D88BUFSIZE;
           }
           fh = file_open_rb(fdd->fname);
           if (fh == FILEH_INVALID) {
                   goto dtrd_err1;
         }          }
         if (file_close(hdr)) {          if ((file_seek(fh, (long)fptr, FSEEK_SET) != (long)fptr) ||
                 goto readd88_err;                  (file_read(fh, trk->buf, size) != size)) {
                   goto dtrd_err2;
         }          }
         return(TRUE);          file_close(fh);
   
 readd88_err:          trk->fdd = fdd;
         curfp = 0;          trk->media = media;
         cursize = 0;          trk->write = FALSE;
         curtrkerr = 1;          trk->track = track;
         return(FALSE);          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++;
           }
           trk->sectors = sectors;
           return(trk);
   
   dtrd_err2:
           file_close(fh);
   
   dtrd_err1:
           return(NULL);
   }
   
   static void drvflush(FDDFILE fdd) {
   
 static int seeksector(REG8 drv, UINT track, UINT r) {          D88TRK  trk;
   
 static  int             lastflag = FALSE;          trk = &d88trk;
           if (trk->fdd == fdd) {
                   trackflush(trk);
           }
   }
   
 const _D88SEC   *p;  static D88TRK trackseek(FDDFILE fdd, REG8 media, UINT track) {
         UINT            sec;  
         UINT            sectors;  
         UINT            secsize;  
   
         if ((curdrv != drv) || (curtrk != track) || (curtype != fdc.media)) {          D88TRK  trk;
                 read_d88track(drv, track, fdc.media);  
         }  
         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;  
                 }  
         }  
         return(lastflag);  
   
 seekerror:;          trk = &d88trk;
         ZeroMemory(&cursec, sizeof(_D88SEC));          if ((trk->fdd != fdd) || (trk->media != media) || (trk->track != track)) {
         curdata = &D88_BUF[16];                  trk = trackread(trk, fdd, media, track);
         lastflag = FALSE;          }
         return(FALSE);          return(trk);
 }  }
   
 static void drvflush(REG8 drv) {  static D88SEC sectorseek(const _D88TRK *trk, REG8 r) {
   
   const _D88SEC   *sec;
           UINT            sectors;
           UINT            size;
   
         if (curdrv == drv) {          sec = (D88SEC)trk->buf;
                 curdataflush();          sectors = trk->sectors;
                 curdrv = (REG8)-1;          while(sectors) {
                 curtrk = (UINT)-1;                  sectors--;
                 cursct = (UINT)-1;                  if (sec->r == r) {
                           return((D88SEC)sec);
                   }
                   size = LOADINTELWORD(sec->size);
                   size += sizeof(_D88SEC);
                   sec = (D88SEC)(((UINT8 *)sec) + size);
         }          }
           return(NULL);
 }  }
   
   
   // ----
   
   static REG8 fddd88_seek(FDDFILE fdd, REG8 media, UINT track) {
   
 //**********************************************************************          if (trackseek(fdd, media, track) != NULL) {
                   return(0x00);
           }
           else {
                   return(FDDSTAT_SEEKERR);
           }
   }
   
 short fdd_crc_d88(void) {  static REG8 fddd88_read(FDDFILE fdd, REG8 media, UINT track, REG8 sc,
                                                                                                   UINT8 *ptr, UINT *size) {
   
         UINT            track;  const _D88TRK   *trk;
 const _D88SEC   *p;  const _D88SEC   *sec;
         UINT            sec;  
         UINT            sectors;  
         UINT            secsize;          UINT            secsize;
           REG8            ret;
   
         ZeroMemory(fdc.crc_dat, 6);          TRACEOUT(("d88 read %d:%.2x", track, sc));
         track = (fdc.c << 1) + fdc.h;          trk = trackseek(fdd, media, track);
         if (track >= 164) {          if (trk == NULL) {
                 goto crcerror_d88;                  goto fd8r_err;
         }          }
         seeksector(fdc.drv, track, fdc.r);          sec = sectorseek(trk, sc);
         if (curtrkerr) {          if (sec == NULL) {
                 goto crcerror_d88;                  goto fd8r_err;
         }          }
         p = (D88SEC)D88_BUF;          ret = 0x00;
         for (sec=0; sec<crcnum;) {          if (sec->del_flg) {
                 sectors = LOADINTELWORD(p->sectors);                  ret |= FDDSTAT_RECTYPE;
                 secsize = LOADINTELWORD(p->size);          }
                 sec++;          if (sec->stat) {
                 if (sec >= sectors) {                  ret |= FDDSTAT_CRCERR;
                         goto crcerror_d88;          }
                 }          secsize = LOADINTELWORD(sec->size);
                 p = (D88SEC)(((UINT8 *)(p + 1)) + secsize);          secsize = min(secsize, *size);
         }          if ((ptr) && (secsize)) {
         fdc.rreg = p->c;                                                                // メルヘンヴェール                  CopyMemory(ptr, sec + 1, secsize);
         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;  
         }          }
         else {          *size = secsize;
                 crcerror = FALSE;          return(ret);
         }  
         return(0);  
   
 crcerror_d88:;  fd8r_err:
         crcerror = TRUE;          return(FDDSTAT_RECNFND);
         return(1);  
 }  }
   
   static REG8 fddd88_write(FDDFILE fdd, REG8 media, UINT track, REG8 sc,
                                                                                                   const UINT8 *ptr, UINT size) {
   
 BYTE fdd_stat_d88(void) {          D88TRK  trk;
           D88SEC  sec;
           UINT    secsize;
   
         FDDFILE         fdd;          TRACEOUT(("d88 write %d:%.2x", track, sc));
         BYTE            type;          trk = trackseek(fdd, media, track);
         REG8            cmd;          if (trk == NULL) {
         UINT            trk;                  goto fd8w_err;
         BYTE            ans = 0;  
         int                     seekable;  
   
         fdd = fddfile + fdc.drv;  
         if (fdd->type != DISKTYPE_D88) {  
                 return(0x80);                                           // NOT READY  
         }  
         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;  
         }  
   
         if (type == 0 || type == 1 || type == 4 ||  
                 cmd == 0x0a || cmd == 0x0b || cmd == 0x0f) {  
                 if (fdd->protect) {                                     // WRITE PROTECT  
                         ans |= 0x40;  
                 }  
         }  
         if (type == 2 || cmd == 0x0f) {  
                 if (fdc.r && cursec.del_flg) {  
                         ans |= 0x20;                                    // RECODE TYPE / WRITE FAULT  
                 }  
         }          }
         if (type == 1 || type == 2) {          sec = sectorseek(trk, sc);
                 if ((trk > 163) || (!seekable)) {          if (sec == NULL) {
                         ans |= 0x10;                                    // SEEK ERROR / RECORD NOT FOUND                  goto fd8w_err;
                 }  
                 if ((!(ans & 0xf0)) && fdc.r && (cursec.stat)) {  
                         ans |= 0x08;                                    // CRC ERROR  
                 }  
         }          }
         if (cmd == 0x0c) {          secsize = LOADINTELWORD(sec->size);
                 if (curtrkerr) {          size = min(size, secsize);
                         ans |= 0x10;          if (size) {
                 }                  CopyMemory(sec + 1, ptr, size);
                 if (crcerror) {                  trk->write = TRUE;
                         ans |= 0x08;                                    // CRC ERROR  
                 }  
         }  
         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 if (!(ans & 0xf0)) {          return(0x00);
                 if ((type != 4) && (FDDMTR_BUSY)) {  
                         ans |= 0x01;  fd8w_err:
                 }          return(FDDSTAT_RECNFND | FDDSTAT_WRITEFAULT);
                 if (type == 2) {  
                         UINT secsize = LOADINTELWORD(cursec.size);  
                         if ((UINT)fdc.off < secsize) {  
                                 ans |= 0x03;                                    // DATA REQUEST / BUSY  
                         }  
                 }  
                 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);  
 }  }
   
   static REG8 fddd88_crc(FDDFILE fdd, REG8 media, UINT track, UINT num,
                                                                                                   UINT8 *ptr) {
   
 //**********************************************************************  const _D88TRK   *trk;
   const _D88SEC   *sec;
           UINT            sectors;
           UINT            size;
   
 void fdd_read_d88(void) {          trk = trackseek(fdd, media, track);
                                                 // POCO:読めなかったらレジスタを変更させない          if (trk == NULL) {
         if ((fdd_stat_d88() & 0xf3) == 3) {                  return(FDDSTAT_RECNFND);
                 fdc.data = curdata[fdc.off];          }
           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;
   //      fdc.s.rreg = sec->c;                                                            // メルヘンヴェール
           if (sec->stat) {
                   return(FDDSTAT_CRCERR);
         }          }
           return(0x00);
 }  }
   
 void fdd_write_d88(void) {  #if defined(SUPPORT_DISKEXT)
   static UINT32 fddd88_sec(FDDFILE fdd, REG8 media, UINT track, REG8 sc) {
   
         if ((fdd_stat_d88() & 0xf3) == 3) {  const _D88TRK   *trk;
                 curdata[fdc.off] = fdc.data;  const _D88SEC   *sec;
                 curwrite = 1;          UINT            sectors;
           UINT            num;
           UINT            size;
   
           trk = trackseek(fdd, media, track);
           if (trk == NULL) {
                   return(0);
           }
           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
   
 BYTE fdd_incoff_d88(void) {  
   
         REG8    cmd;  // ----
         UINT    trk;  
         UINT    secsize;  
   
         cmd = (REG8)(fdc.cmd >> 4);  BRESULT fddd88_set(FDDFILE fdd, const OEMCHAR *fname) {
         trk = (fdc.c << 1) + fdc.h;  
         seeksector(fdc.drv, trk, fdc.r);          short   attr;
         fdc.off++;          FILEH   fh;
         secsize = LOADINTELWORD(cursec.size);          BRESULT r;
         if ((UINT)fdc.off < secsize) {          UINT8   ptr[D88_TRACKMAX][4];
                 return(0);          UINT    i;
   
           attr = file_attr(fname);
           if (attr & 0x18) {
                   goto fdst_err;
         }          }
         fdc.off = secsize;          fh = file_open_rb(fname);
         if ((cmd == 0x09) || (cmd == 0x0b)) {          if (fh == FILEH_INVALID) {
                 fdc.rreg = fdc.r + 1;                                           // ver0.25                  goto fdst_err;
                 if (seeksector(fdc.drv, trk, fdc.rreg)) {  
                         fdc.r++;  
                         fdc.off = 0;  
                         return(0);  
                 }  
         }          }
         return(1);          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) {
   
           drvflush(fdd);
 }  }
   
   
   
   
   
   
   
   
   
   
   
   
 // ---------------------------------------------------------------------------  // ---------------------------------------------------------------------------
   
   #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;
   
   
   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 422  void init_tao_d88(void) { Line 457  void init_tao_d88(void) {
         }          }
 }  }
   
 int fileappend(FILEH hdr, D88_HEADER *head,  static int fileappend(FILEH hdl, FDDFILE fdd,
                                                                         long ptr, long last, long apsize) {                                                                          UINT32 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];
         long            apsize;  
         D88SEC          p;  
         UINT            secsize;  
   
         if (!tao.sector) {          if (!tao.sector) {
                 tao.flag = 4;                  tao.flag = 4;
Line 483  void endoftrack(void) { Line 517  void endoftrack(void) {
         curdataflush();                                         // write cache flush &          curdataflush();                                         // write cache flush &
         curdrv = (REG8)-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) + fdc.h;          trk = (fdc.s.c << 1) + fdc.s.h;
   
         p = (D88SEC)TAO_BUF;          p = (D88SEC)TAO_BUF;
         for (i=0; i<(int)tao.sector; i++) {          for (i=0; i<(int)tao.sector; i++) {
Line 493  void endoftrack(void) { Line 527  void endoftrack(void) {
                 p = (D88SEC)(((UINT8 *)(p + 1)) + secsize);                  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;          D88SEC  p;
Line 647  void fdd_wtao_d88(BYTE data) { Line 684  void fdd_wtao_d88(BYTE data) {
                         break;                          break;
         }          }
 }  }
   #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) {  
   
         short   attr;  
         FILEH   fh;  
         UINT    rsize;  
   
         attr = file_attr(fname);  
         if (attr & 0x18) {  
                 goto fdst_err;  
         }  
         fh = file_open(fname);  
         if (fh == FILEH_INVALID) {  
                 goto fdst_err;  
         }  
         rsize = file_read(fh, &d88head[drv], sizeof(D88_HEADER));  
         file_close(fh);  
         if (rsize != sizeof(D88_HEADER)) {  
                 goto fdst_err;  
         }  
         if (d88head[drv].protect & 0x10) {  
                 attr |= 1;  
         }  
         milstr_ncpy(fdd->fname, fname, NELEMENTS(fdd->fname));  
         fdd->type = DISKTYPE_D88;  
         fdd->protect = (UINT8)(attr & 1);  
         return(SUCCESS);  
   
 fdst_err:  
         return(FAILURE);  
 }  
   
Removed from v.1.4  
changed lines
  Added in v.1.14

RetroPC.NET-CVS <cvs@retropc.net>