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

Diff for /xmil/fdd/fdd_2d.c between versions 1.5 and 1.6

version 1.5, 2004/08/09 04:47:53 version 1.6, 2004/08/10 08:28:48
Line 7 Line 7
 #include        "fdd_mtr.h"  #include        "fdd_mtr.h"
   
   
 static  WORD            sec_now[4] = {0, 0, 0, 0};  static REG8 fdd2d_seek(FDDFILE fdd, REG8 media, UINT track) {
 static  BYTE            sec_write[4] = {0, 0, 0, 0};  
 static  BYTE            sec_data[4][256];  
 static  BYTE            hole = 0;  
   
           if ((media != 0) || (track >= 80)) {
 static BYTE changesector2d(void) {                  return(FDDSTAT_SEEKERR);
   
         FDDFILE fdd;  
         FILEH   fh;  
         WORD    sec;  
         long    seekp;  
         short   drv = fdc.drv;  
   
         if (fdc.s.media != DISKTYPE_2D) {  
                 return(1);  
         }  
         fdd = fddfile + drv;  
   
         sec = (WORD)(((fdc.c) << 5) + (fdc.h << 4) + fdc.r - 1);  
         if (sec_now[drv] == sec) {  
                 return(0);  
         }  
         fh = file_open(fdd->fname);  
         if (fh == FILEH_INVALID) {  
                 sec_now[drv] = -1;  
                 return(1);  
         }  
         if ((sec_write[drv]) && (sec_now[drv] != -1)) {  
                 seekp = (long)sec_now[drv] << 8;  
                 if ((file_seek(fh, seekp, FSEEK_SET) != seekp) ||  
                         (file_write(fh, sec_data[drv], 256) != 256)) {  
                         file_close(fh);  
                         sec_now[drv] = -1;  
                         return(1);  
                 }  
         }  
         sec_write[drv] = 0;  
         sec_now[drv] = sec;  
         seekp = (long)sec << 8;  
         if ((file_seek(fh, seekp, FSEEK_SET) != seekp) ||  
                 (file_read(fh, sec_data[drv], 256) != 256)) {  
                 file_close(fh);  
                 sec_now[drv] = -1;  
                 return(1);  
         }          }
         file_close(fh);  
         return(0);  
 }  
   
   
   
   
 //**********************************************************************  
   
 BRESULT fdd2d_crc(FDDFILE fdd) {  
   
         fdc.s.buffer[0] = fdc.c;  
         fdc.s.buffer[1] = fdc.h;  
         fdc.s.buffer[2] = fdc.r;  
         fdc.s.buffer[3] = 1;  
         fdc.s.buffer[4] = 0;                    // CRC(Lo)  
         fdc.s.buffer[5] = 0;                    // CRC(Hi)  
         fdc.s.bufsize = 6;  
         fdc.rreg = fdc.c;                                                               // メルヘンヴェール  
         (void)fdd;          (void)fdd;
         return(SUCCESS);          return(0x00);
 }  }
   
   static REG8 fdd2d_read(FDDFILE fdd, REG8 media, UINT track, REG8 sc,
                                                                                                   UINT8 *ptr, UINT *size) {
   
 BYTE fdd_stat_2d(void) {          UINT    secsize;
           FILEH   fh;
         FDDFILE fdd;          long    pos;
         REG8    cmd;          BRESULT b;
         BYTE    type;  
         BYTE    ans = 0;  
   
         fdd = fddfile + fdc.drv;  
   
         // NOT READY  
         if (fdd->type != DISKTYPE_BETA) {  
                 return(0x80);  
         }  
         type = fdc.type;  
         cmd = (REG8)(fdc.cmd >> 4);  
   
         if (type == 0 || type == 1 || type == 4 ||                                      // !!!  
                 cmd == 0x0a || cmd == 0x0b || cmd == 0x0f) {  
                 if (fdd->protect) {                             // WRITE PROTECT  
                         ans |= 0x40;  
                 }  
         }  
         if ((type == 1 || type == 2) &&  
                 ((fdc.c >= 40) || (fdc.h > 1) || (fdc.r > 16) ||  
                 (fdc.s.media != DISKTYPE_2D))) {  
                 ans |= 0x10;                                    // SEEK ERROR / RECORD NOT FOUND  
         }  
   
         if (type == 1 || type == 4) {          if ((media != 0) || (track >= 80) || (sc == 0) || (sc > 16)) {
                 if (type == 1) {                  goto fd2r_err;
                         ans |= 0x20;                                    // HEAD ENGAGED (X1 デハ ツネニ 1)  
                         if (fdc.c == 0) {  
                                 ans |= 0x04;                                    // TRACK00  
                         }  
                 }  
                 if (++hole < 8) {  
                         ans |= 0x02;                                    // INDEX  
                 }  
         }          }
         else if (!(ans & 0xf0)) {          secsize = min(*size, 256);
                 if (FDDMTR_BUSY) {          if (ptr) {
                         ans |= 0x01;                  fh = file_open_rb(fdd->fname);
                 }                  if (fh == FILEH_INVALID) {
                 if ((type == 2) && (fdc.r) && (fdc.off < 256)) {                          goto fd2r_err;
                         ans |= 0x03;                                    // DATA REQUEST / BUSY  
                 }                  }
                 else if (cmd == 0x0f) {                  pos = ((track * 16) + (sc - 1)) * 256;
                         ans |= 0x04;                                    // error!                  b = (file_seek(fh, pos, FSEEK_SET) != pos) ||
                           (file_read(fh, ptr, secsize) != secsize);
                   file_close(fh);
                   if (b) {
                           goto fd2r_err;
                 }                  }
         }          }
         return(ans);          *size = secsize;
 }          return(0x00);
   
   
 //**********************************************************************  
   
 void fdd_read_2d(void) {  fd2r_err:
           return(FDDSTAT_RECNFND);
         if (((fdd_stat_2d() & 0xf3) == 3) && (!changesector2d())) {  
                 fdc.data = sec_data[fdc.drv][fdc.off];  
         }  
 }  }
   
   static REG8 fdd2d_write(FDDFILE fdd, REG8 media, UINT track, REG8 sc,
                                                                                                   const UINT8 *ptr, UINT size) {
   
 void fdd_write_2d(void) {          FILEH   fh;
           long    pos;
           BRESULT b;
   
         if (((fdd_stat_2d() & 0xf3) == 3) && (!changesector2d())) {          if ((media != 0) || (track >= 80) || (sc == 0) || (sc > 16)) {
                 sec_data[fdc.drv][fdc.off] = fdc.data;                  return(FDDSTAT_RECNFND | FDDSTAT_WRITEFAULT);
                 sec_write[fdc.drv] = 1;  
         }          }
 }          fh = file_open(fdd->fname);
           if (fh == FILEH_INVALID) {
                   goto fd2w_err;
           }
           pos = ((track * 16) + (sc - 1)) * 256;
           size = min(size, 256);
           b = (file_seek(fh, pos, FSEEK_SET) != pos) ||
                   (file_write(fh, ptr, size) != size);
           file_close(fh);
           if (b) {
                   goto fd2w_err;
           }
           return(0x00);
   
 BYTE fdd_incoff_2d(void) {  fd2w_err:
           return(FDDSTAT_WRITEFAULT);
   }
   
         REG8    cmd;  static REG8 fdd2d_crc(FDDFILE fdd, REG8 media, UINT track, UINT num,
                                                                                                   UINT8 *ptr) {
   
         if (++fdc.off < 256) {          if ((media != 0) || (track >= 80) || (num >= 16)) {
                 return(0);                  return(FDDSTAT_RECNFND);
         }  
         cmd = (REG8)(fdc.cmd >> 4);  
         if ((cmd == 0x09) || (cmd == 0x0b)) {  
                 if (fdc.r < 16) {  
                         fdc.r++;  
                         fdc.rreg++;  
                         fdc.off = 0;  
                         return(0);  
                 }  
                 fdc.rreg = fdc.r + 1;  
         }          }
         fdc.off = 256;          ptr[0] = (UINT8)(track >> 1);
         return(1);          ptr[1] = (UINT8)(track & 1);
           ptr[2] = (UINT8)(num + 1);
           ptr[3] = 1;
           ptr[4] = 0;                                                                             // CRC(Lo)
           ptr[5] = 0;                                                                             // CRC(Hi)
   //      fdc.s.rreg = fdc.s.c;                                                   // メルヘンヴェール
           (void)fdd;
           return(0x00);
 }  }
   
   
   
 // ----  // ----
   
 BRESULT fdd2d_set(FDDFILE fdd, REG8 drv, const OEMCHAR *fname) {  BRESULT fdd2d_set(FDDFILE fdd, const OEMCHAR *fname) {
   
         short   attr;          short   attr;
   
Line 185  BRESULT fdd2d_set(FDDFILE fdd, REG8 drv, Line 106  BRESULT fdd2d_set(FDDFILE fdd, REG8 drv,
         }          }
         fdd->type = DISKTYPE_BETA;          fdd->type = DISKTYPE_BETA;
         fdd->protect = (UINT8)(attr & 1);          fdd->protect = (UINT8)(attr & 1);
         sec_now[drv] = -1;          fdd->seek = fdd2d_seek;
         sec_write[drv] = 0;          fdd->read = fdd2d_read;
           fdd->write = fdd2d_write;
           fdd->crc = fdd2d_crc;
         return(SUCCESS);          return(SUCCESS);
 }  }
   
 BRESULT fdd2d_eject(FDDFILE fdd, REG8 drv) {  void fdd2d_eject(FDDFILE fdd) {
   
         FILEH   fh;  
         long    seekp;  
         BRESULT ret = 0;  
   
         while(1) {          (void)fdd;
                 if ((!sec_write[drv]) || (sec_now[drv] == -1)) {  
                         break;  
                 }  
                 seekp = (long)sec_now[drv] << 8;  
                 fh = file_open(fdd->fname);  
                 if (fh == FILEH_INVALID) {  
                         ret = 1;  
                         break;  
                 }  
                 if ((file_seek(fh, seekp, FSEEK_SET) != seekp) ||  
                         (file_write(fh, sec_data[drv], 256) != 256)) {  
                         ret = 1;  
                 }  
                 if (file_close(fh)) {  
                         ret = 1;  
                 }  
                 break;  
         }  
         fdd->fname[0] = '\0';  
         fdd->type = DISKTYPE_NOTREADY;  
         sec_now[drv] = -1;  
         sec_write[drv] = 0;  
         return(ret);  
 }  }
   
Removed from v.1.5  
changed lines
  Added in v.1.6

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