[BACK]Return to ideio.c CVS log [TXT] [DIR] Up to [RetroPC.NET] / np2 / cbus

Diff for /np2/cbus/ideio.c between versions 1.1 and 1.7

version 1.1, 2004/03/19 03:36:52 version 1.7, 2004/08/07 19:06:59
Line 1 Line 1
 #include        "compiler.h"  #include        "compiler.h"
   
   // winでidentifyまでは取得に行くんだけどな…ってAnex86も同じか
   
 #if defined(SUPPORT_IDEIO)  #if defined(SUPPORT_IDEIO)
   
 #include        "dosio.h"  #include        "dosio.h"
Line 9 Line 11
 #include        "ideio.h"  #include        "ideio.h"
 #include        "atapicmd.h"  #include        "atapicmd.h"
 #include        "sxsi.h"  #include        "sxsi.h"
   #include        "idebios.res"
   
   
         IDEIO   ideio;          IDEIO   ideio;
Line 16 Line 19
   
 static IDEDEV getidedev(void) {  static IDEDEV getidedev(void) {
   
         IDEDEV  ret;          UINT    bank;
   
         ret = ideio.dev + (ideio.bank[1] & 1);          bank = ideio.bank[1] & 0x7f;
         return(ret);          if (bank < 2) {
                   return(ideio.dev + bank);
           }
           else {
                   return(NULL);
           }
 }  }
   
 static IDEDRV getidedrv(void) {  static IDEDRV getidedrv(void) {
   
         IDEDEV  dev;          IDEDEV  dev;
           IDEDRV  drv;
   
         dev = ideio.dev + (ideio.bank[1] & 1);          dev = getidedev();
         return(dev->drv + dev->drivesel);          if (dev) {
                   drv = dev->drv + dev->drivesel;
                   if (drv->device != IDETYPE_NONE) {
                           return(drv);
                   }
           }
           return(NULL);
 }  }
   
   static const char serial[] = "824919341192        ";
   static const char firm[] = "A5U.1200";
   static const char model[] = "QUANTUM FIREBALL CR                     ";
   
 static BOOL setidentify(IDEDRV drv) {  static BOOL setidentify(IDEDRV drv) {
   
         SXSIDEV sxsi;          SXSIDEV sxsi;
         UINT16  tmp[256];          UINT16  tmp[256];
         BYTE    *p;          BYTE    *p;
         UINT    i;          UINT    i;
           UINT32  size;
   
         sxsi = sxsi_getptr(drv->sxsidrv);          sxsi = sxsi_getptr(drv->sxsidrv);
         if ((sxsi == NULL) || (sxsi->fname[0] == '\0')) {          if ((sxsi == NULL) || (sxsi->fname[0] == '\0')) {
Line 44  static BOOL setidentify(IDEDRV drv) { Line 64  static BOOL setidentify(IDEDRV drv) {
   
         ZeroMemory(tmp, sizeof(tmp));          ZeroMemory(tmp, sizeof(tmp));
         // とりあえず使ってる部分だけ          // とりあえず使ってる部分だけ
           tmp[0] = 0x0040;
         tmp[1] = sxsi->cylinders;          tmp[1] = sxsi->cylinders;
         tmp[3] = sxsi->surfaces;          tmp[3] = sxsi->surfaces;
           tmp[4] = sxsi->sectors * 512;
         tmp[6] = sxsi->sectors;          tmp[6] = sxsi->sectors;
           for (i=0; i<10; i++) {
                   tmp[10+i] = (serial[i*2] << 8) + serial[i*2+1];
           }
           tmp[22] = 4;
           for (i=0; i<4; i++) {
                   tmp[23+i] = (firm[i*2] << 8) + firm[i*2+1];
           }
           for (i=0; i<20; i++) {
                   tmp[27+i] = (model[i*2] << 8) + model[i*2+1];
           }
   #if IDEIO_MULTIPLE_MAX > 0
           tmp[47] = 0x8000 | IDEIO_MULTIPLE_MAX;  // multiple
   #endif
           tmp[49] = 0x0000;                       // LBA(1 << 9)
           tmp[51] = 0x0200;
           tmp[53] = 0x0001;
           tmp[54] = sxsi->cylinders;
           tmp[55] = sxsi->surfaces;
           tmp[56] = sxsi->sectors;
           size = sxsi->cylinders * sxsi->surfaces * sxsi->sectors;
           tmp[57] = (UINT16)size;
           tmp[58] = (UINT16)(size >> 16);
   #if IDEIO_MULTIPLE_MAX > 0
           tmp[59] = 0x0100 | drv->mulmode;        // current multiple mode
   #endif
           tmp[60] = (UINT16)size;
           tmp[61] = (UINT16)(size >> 16);
           tmp[63] = 0x0000;                       // no support multiword DMA
   
           tmp[80] = 0x0006;                       // only support ATA-1/2
           tmp[81] = 0;
           tmp[82] = 0x0000;                       // DEVICE RESET(1 << 9)
   
         p = drv->buf;          p = drv->buf;
         for (i=0; i<256; i++) {          for (i=0; i<256; i++) {
Line 54  static BOOL setidentify(IDEDRV drv) { Line 108  static BOOL setidentify(IDEDRV drv) {
                 p[1] = (BYTE)(tmp[i] >> 8);                  p[1] = (BYTE)(tmp[i] >> 8);
                 p += 2;                  p += 2;
         }          }
           drv->bufdir = IDEDIR_IN;
         drv->bufpos = 0;          drv->bufpos = 0;
         drv->bufsize = 512;          drv->bufsize = 512;
         return(SUCCESS);          return(SUCCESS);
Line 61  static BOOL setidentify(IDEDRV drv) { Line 116  static BOOL setidentify(IDEDRV drv) {
   
 static void setintr(IDEDRV drv) {  static void setintr(IDEDRV drv) {
   
         ideio.bank[0] = ideio.bank[1] | 0x80;                   // ????          if (!(drv->ctrl & IDECTRL_NIEN)) {
         pic_setirq(IDE_IRQ);                  TRACEOUT(("ideio: setintr()"));
                   ideio.bank[0] = ideio.bank[1] | 0x80;                   // ????
                   pic_setirq(IDE_IRQ);
           }
 }  }
   
 static void cmdabort(IDEDRV drv) {  static void cmdabort(IDEDRV drv) {
   
           TRACEOUT(("ideio: cmdabort()"));
         drv->status = IDESTAT_DRDY | IDESTAT_ERR;          drv->status = IDESTAT_DRDY | IDESTAT_ERR;
         drv->error = IDEERR_ABRT;          drv->error = IDEERR_ABRT;
         ideio.bank[0] = ideio.bank[1] | 0x80;                   // ????          setintr(drv);
         pic_setirq(IDE_IRQ);  }
   
   static void panic(const char *str, ...) {
   
           char    buf[2048];
           va_list ap;
   
           va_start(ap, str);
           vsnprintf(buf, sizeof(buf), str, ap);
           va_end(ap);
   
           msgbox("ide_panic", buf);
           exit(1);
 }  }
   
   
Line 78  static void cmdabort(IDEDRV drv) { Line 149  static void cmdabort(IDEDRV drv) {
   
 static void incsec(IDEDRV drv) {  static void incsec(IDEDRV drv) {
   
         if (drv->dr & IDEDEV_LBA) {          if (!(drv->dr & IDEDEV_LBA)) {
                 TRACEOUT(("ideio: incsec() LBA mode?"));                  drv->sn++;
                 return;                  if (drv->sn <= drv->sectors) {
         }                          return;
         drv->sn++;                  }
         if (drv->sn <= drv->sectors) {                  drv->sn = 1;
                 return;                  drv->hd++;
                   if (drv->hd < drv->surfaces) {
                           return;
                   }
                   drv->hd = 0;
                   drv->cy++;
         }          }
         drv->sn = 1;          else {
         drv->hd++;                  TRACEOUT(("ideio: incsec() LBA mode?"));
         if (drv->hd < drv->surfaces) {                  drv->sn++;
                 return;                  if (drv->sn) {
                           return;
                   }
                   drv->cy++;
                   if (drv->cy) {
                           return;
                   }
                   drv->hd++;
         }          }
         drv->hd = 0;  
         drv->cy++;  
 }  }
   
 static long getcursec(const _IDEDRV *drv) {  static long getcursec(const IDEDRV drv) {
   
         long    ret;          long    ret;
   
         if (drv->dr & IDEDEV_LBA) {          if (!(drv->dr & IDEDEV_LBA)) {
                   ret = drv->cy;
                   ret *= drv->surfaces;
                   ret += drv->hd;
                   ret *= drv->sectors;
                   ret += (drv->sn - 1);
           }
           else {
                 TRACEOUT(("ideio: getcursec() LBA mode?"));                  TRACEOUT(("ideio: getcursec() LBA mode?"));
                 return(-1);                  ret = drv->sn;
                   ret |= (drv->cy << 8);
                   ret |= (drv->hd << 24);
         }          }
         ret = drv->cy;  
         ret *= drv->surfaces;  
         ret += drv->hd;  
         ret *= drv->sectors;  
         ret += (drv->sn - 1);  
         return(ret);          return(ret);
 }  }
   
Line 119  static void readsec(IDEDRV drv) { Line 204  static void readsec(IDEDRV drv) {
                 goto read_err;                  goto read_err;
         }          }
         sec = getcursec(drv);          sec = getcursec(drv);
         TRACEOUT(("readsec->drv %d sec %x", drv->sxsidrv, sec));          TRACEOUT(("readsec->drv %d sec %x cnt %d thr %d",
                                                                   drv->sxsidrv, sec, drv->mulcnt, drv->multhr));
         if (sxsi_read(drv->sxsidrv, sec, drv->buf, 512)) {          if (sxsi_read(drv->sxsidrv, sec, drv->buf, 512)) {
                 TRACEOUT(("readerror!"));                  TRACEOUT(("read error!"));
                 goto read_err;                  goto read_err;
         }          }
         drv->bufdir = IDEDIR_IN;          drv->bufdir = IDEDIR_IN;
         drv->bufpos = 0;          drv->bufpos = 0;
         drv->bufsize = 512;          drv->bufsize = 512;
   
         drv->status = IDESTAT_DRDY | IDESTAT_DSC | IDESTAT_DRQ;          if ((drv->mulcnt & (drv->multhr - 1)) == 0) {
         drv->error = 0;                  drv->status = IDESTAT_DRDY | IDESTAT_DSC | IDESTAT_DRQ;
         setintr(drv);                  drv->error = 0;
                   setintr(drv);
           }
           drv->mulcnt++;
         return;          return;
   
 read_err:  read_err:
Line 142  read_err: Line 231  read_err:
   
 static void IOOUTCALL ideio_o430(UINT port, REG8 dat) {  static void IOOUTCALL ideio_o430(UINT port, REG8 dat) {
   
         TRACEOUT(("ideio setbank%d %.2x [%.4x:%.4x]",          TRACEOUT(("ideio setbank%d %.2x [%.4x:%.8x]",
                                                                         (port >> 1) & 1, dat, CPU_CS, CPU_IP));                                                                          (port >> 1) & 1, dat, CPU_CS, CPU_EIP));
         if ((dat == 0) || (dat == 1)) {          if (!(dat & 0x80)) {
                 ideio.bank[(port >> 1) & 1] = dat;                  ideio.bank[(port >> 1) & 1] = dat;
         }          }
 }  }
Line 157  static REG8 IOINPCALL ideio_i430(UINT po Line 246  static REG8 IOINPCALL ideio_i430(UINT po
         bank = (port >> 1) & 1;          bank = (port >> 1) & 1;
         ret = ideio.bank[bank];          ret = ideio.bank[bank];
         ideio.bank[bank] = ret & (~0x80);          ideio.bank[bank] = ret & (~0x80);
         TRACEOUT(("ideio getbank%d %.2x [%.4x:%.4x]",          TRACEOUT(("ideio getbank%d %.2x [%.4x:%.8x]",
                                                                         (port >> 1) & 1, ret, CPU_CS, CPU_IP));                                                                          (port >> 1) & 1, ret, CPU_CS, CPU_EIP));
         return(ret);          return(ret & 0x81);
 }  }
   
   
Line 170  static void IOOUTCALL ideio_o642(UINT po Line 259  static void IOOUTCALL ideio_o642(UINT po
         IDEDRV  drv;          IDEDRV  drv;
   
         drv = getidedrv();          drv = getidedrv();
         drv->wp = dat;          if (drv) {
         TRACEOUT(("ideio set WP %.2x [%.4x:%.4x]", dat, CPU_CS, CPU_IP));                  drv->wp = dat;
                   TRACEOUT(("ideio set WP %.2x [%.4x:%.8x]", dat, CPU_CS, CPU_EIP));
           }
           (void)port;
 }  }
   
 static void IOOUTCALL ideio_o644(UINT port, REG8 dat) {  static void IOOUTCALL ideio_o644(UINT port, REG8 dat) {
   
         IDEDRV  drv;          IDEDRV  drv;
   
           (void)port;
         drv = getidedrv();          drv = getidedrv();
         drv->sc = dat;          if (drv) {
         TRACEOUT(("ideio set SC %.2x [%.4x:%.4x]", dat, CPU_CS, CPU_IP));                  drv->sc = dat;
                   TRACEOUT(("ideio set SC %.2x [%.4x:%.8x]", dat, CPU_CS, CPU_EIP));
           }
           (void)port;
 }  }
   
 static void IOOUTCALL ideio_o646(UINT port, REG8 dat) {  static void IOOUTCALL ideio_o646(UINT port, REG8 dat) {
Line 188  static void IOOUTCALL ideio_o646(UINT po Line 284  static void IOOUTCALL ideio_o646(UINT po
         IDEDRV  drv;          IDEDRV  drv;
   
         drv = getidedrv();          drv = getidedrv();
         drv->sn = dat;          if (drv) {
         TRACEOUT(("ideio set SN %.2x [%.4x:%.4x]", dat, CPU_CS, CPU_IP));                  drv->sn = dat;
                   TRACEOUT(("ideio set SN %.2x [%.4x:%.8x]", dat, CPU_CS, CPU_EIP));
           }
           (void)port;
 }  }
   
 static void IOOUTCALL ideio_o648(UINT port, REG8 dat) {  static void IOOUTCALL ideio_o648(UINT port, REG8 dat) {
Line 197  static void IOOUTCALL ideio_o648(UINT po Line 296  static void IOOUTCALL ideio_o648(UINT po
         IDEDRV  drv;          IDEDRV  drv;
   
         drv = getidedrv();          drv = getidedrv();
         drv->cy &= 0xff00;          if (drv) {
         drv->cy |= dat;                  drv->cy &= 0xff00;
         TRACEOUT(("ideio set CYL %.2x [%.4x:%.4x]", dat, CPU_CS, CPU_IP));                  drv->cy |= dat;
                   TRACEOUT(("ideio set CYL %.2x [%.4x:%.8x]", dat, CPU_CS, CPU_EIP));
           }
           (void)port;
 }  }
   
 static void IOOUTCALL ideio_o64a(UINT port, REG8 dat) {  static void IOOUTCALL ideio_o64a(UINT port, REG8 dat) {
Line 207  static void IOOUTCALL ideio_o64a(UINT po Line 309  static void IOOUTCALL ideio_o64a(UINT po
         IDEDRV  drv;          IDEDRV  drv;
   
         drv = getidedrv();          drv = getidedrv();
         drv->cy &= 0x00ff;          if (drv) {
         drv->cy |= dat << 8;                  drv->cy &= 0x00ff;
         TRACEOUT(("ideio set CYH %.2x [%.4x:%.4x]", dat, CPU_CS, CPU_IP));                  drv->cy |= dat << 8;
                   TRACEOUT(("ideio set CYH %.2x [%.4x:%.8x]", dat, CPU_CS, CPU_EIP));
           }
           (void)port;
 }  }
   
 static void IOOUTCALL ideio_o64c(UINT port, REG8 dat) {  static void IOOUTCALL ideio_o64c(UINT port, REG8 dat) {
Line 217  static void IOOUTCALL ideio_o64c(UINT po Line 322  static void IOOUTCALL ideio_o64c(UINT po
         IDEDEV  dev;          IDEDEV  dev;
         UINT    drvnum;          UINT    drvnum;
   
           dev = getidedev();
           if (dev == NULL) {
                   return;
           }
 #if defined(TRACE)  #if defined(TRACE)
         if ((dat & 0xf0) != 0xa0) {          if ((dat & 0xf0) != 0xa0) {
                 TRACEOUT(("ideio set SDH illegal param? (%.2x)", dat));                  TRACEOUT(("ideio set SDH illegal param? (%.2x)", dat));
         }          }
 #endif  #endif
         drvnum = (dat >> 4) & 1;          drvnum = (dat >> 4) & 1;
         dev = getidedev();  
         dev->drivesel = drvnum;          dev->drivesel = drvnum;
         dev->drv[drvnum].dr = dat & 0xf0;          dev->drv[drvnum].dr = dat & 0xf0;
         dev->drv[drvnum].hd = dat & 0x0f;          dev->drv[drvnum].hd = dat & 0x0f;
         TRACEOUT(("ideio set DRHD %.2x [%.4x:%.4x]", dat, CPU_CS, CPU_IP));          TRACEOUT(("ideio set DRHD %.2x [%.4x:%.8x]", dat, CPU_CS, CPU_EIP));
           (void)port;
 }  }
   
 static void IOOUTCALL ideio_o64e(UINT port, REG8 dat) {  static void IOOUTCALL ideio_o64e(UINT port, REG8 dat) {
   
         IDEDRV  drv;          IDEDRV  drv;
           IDEDEV  dev;
   
           // execute device diagnostic
           if (dat == 0x90) {
                   TRACEOUT(("ideio set cmd %.2x [%.4x:%.8x]", dat, CPU_CS, CPU_EIP));
                   TRACEOUT(("ideio: execute device diagnostic"));
                   dev = getidedev();
                   if (dev) {
                           IDEDRV d;
                           int i;
   
                           for (i = 0; i < 2; i++) {
                                   d = dev->drv + i;
                                   d->hd = 0x00;
                                   d->sc = 0x01;
                                   d->sn = 0x01;
                                   d->cy = 0x0000;
                                   d->status = IDESTAT_DRDY;
                                   d->error = 0x01;
                                   if (i == 0) {
                                           if (dev->drv[0].device == IDETYPE_NONE) {
                                                   d->error = 0x00;
                                           }
                                           if (dev->drv[1].device == IDETYPE_NONE) {
                                                   d->error |= 0x80;
                                           }
                                   }
                                   else {
                                           if (dev->drv[1].device == IDETYPE_NONE) {
                                                   d->error = 0x00;
                                           }
                                   }
                           }
                   }
                   return;
           }
   
         drv = getidedrv();          drv = getidedrv();
           if (drv == NULL) {
                   return;
           }
         drv->cmd = dat;          drv->cmd = dat;
         TRACEOUT(("ideio set cmd %.2x [%.4x:%.4x]", dat, CPU_CS, CPU_IP));          TRACEOUT(("ideio set cmd %.2x [%.4x:%.8x]", dat, CPU_CS, CPU_EIP));
         switch(dat) {          switch(dat) {
                 case 0x08:              // atapi reset                  case 0x08:              // device reset
                         if (drv->device == IDETYPE_CDROM) {                          TRACEOUT(("ideio: device reset"));
                                 drv->hd = 0;                          if (drv->device == IDETYPE_NONE) {
                                 drv->sc = 1;                                  cmdabort(drv);
                                 drv->sn = 1;                                  break;
                           }
                           else if (drv->device == IDETYPE_HDD) {
                                   drv->hd = 0x00;
                                   drv->sc = 0x01;
                                   drv->sn = 0x01;
                                   drv->cy = 0x0000;
                           }
                           else if (drv->device == IDETYPE_CDROM) {
                                   drv->hd = 0x10;
                                   drv->sc = 0x01;
                                   drv->sn = 0x01;
                                 drv->cy = 0xeb14;                                  drv->cy = 0xeb14;
                                 drv->status = 0;  
                                 drv->error = 0;  
                         }                          }
                           drv->status = 0x00;
                           drv->error = 0x01;
                           dev = getidedev();
                           if (dev) {
                                   if (dev->drivesel == 0) {
                                           if (dev->drv[0].device == IDETYPE_NONE) {
                                                   drv->error = 0x00;
                                           }
                                           if (dev->drv[1].device == IDETYPE_NONE) {
                                                   drv->error |= 0x80;
                                           }
                                   }
                                   else {
                                           if (dev->drv[1].device == IDETYPE_NONE) {
                                                   drv->error = 0x00;
                                           }
                                   }
                           }
                           setintr(drv);
                         break;                          break;
   
                 case 0x10:              // calibrate                  case 0x10:              // calibrate
 //              case 0x11: case 0x12: case 0x13: case 0x14: case 0x15:  //              case 0x11: case 0x12: case 0x13: case 0x14: case 0x15:
 //              case 0x16: case 0x17: case 0x18: case 0x19: case 0x1a:  //              case 0x16: case 0x17: case 0x18: case 0x19: case 0x1a:
 //              case 0x1b: case 0x1c: case 0x1d: case 0x1e: case 0x1f:  //              case 0x1b: case 0x1c: case 0x1d: case 0x1e: case 0x1f:
                           TRACEOUT(("ideio: calibrate"));
                         if (drv->device) {                          if (drv->device) {
                                 drv->status = IDESTAT_DRDY | IDESTAT_DSC;                                  drv->status = IDESTAT_DRDY | IDESTAT_DSC;
                                 drv->error = 0;                                  drv->error = 0;
Line 266  static void IOOUTCALL ideio_o64e(UINT po Line 443  static void IOOUTCALL ideio_o64e(UINT po
   
                 case 0x20:              // read (with retry)                  case 0x20:              // read (with retry)
                 case 0x21:              // read                  case 0x21:              // read
                           TRACEOUT(("ideio: read sector"));
                           drv->mulcnt = 0;
                           drv->multhr = 1;
                         readsec(drv);                          readsec(drv);
                         break;                          break;
   
                 case 0x91:              // set parameters                  case 0x91:              // set parameters
                         TRACEOUT(("ideio: set parameters dh=%x sec=%x",                          TRACEOUT(("ideio: set parameters dh=%x sec=%x",
                                                                                         drv->dr | drv->hd, drv->sc));                                                                                          drv->dr | drv->hd, drv->sc));
                         if (drv->device) {                          if (drv->device != IDETYPE_NONE) {
                                 drv->surfaces = drv->hd + 1;                                  drv->surfaces = drv->hd + 1;
                                 drv->sectors = drv->sc;                                  drv->sectors = drv->sc;
                                 drv->status &= ~(IDESTAT_BSY | IDESTAT_DRQ | IDESTAT_ERR);                                  drv->status &= ~(IDESTAT_BSY | IDESTAT_DRQ | IDESTAT_ERR);
Line 298  static void IOOUTCALL ideio_o64e(UINT po Line 478  static void IOOUTCALL ideio_o64e(UINT po
                         }                          }
                         break;                          break;
   
                 case 0xec:              // indentify                  case 0xa1:              // identify
                         TRACEOUT(("ideio: indentify"));                  case 0xec:              // identify
                           TRACEOUT(("ideio: identify"));
                         if (setidentify(drv) == SUCCESS) {                          if (setidentify(drv) == SUCCESS) {
                                 drv->status = IDESTAT_DRDY | IDESTAT_DSC | IDESTAT_DRQ;                                  drv->status = IDESTAT_DRDY | IDESTAT_DSC | IDESTAT_DRQ;
                                 drv->error = 0;                                  drv->error = 0;
Line 310  static void IOOUTCALL ideio_o64e(UINT po Line 491  static void IOOUTCALL ideio_o64e(UINT po
                         }                          }
                         break;                          break;
   
                   case 0xc4:              // read multiple
   #if IDEIO_MULTIPLE_MAX > 0
                           TRACEOUT(("ideio: read multiple"));
                           drv->mulcnt = 0;
                           drv->multhr = drv->mulmode;
                           readsec(drv);
   #else
                           cmdabort(drv);
   #endif
                           break;
   
                   case 0xc6:              // set multiple mode
                           TRACEOUT(("ideio: set multiple mode"));
                           switch(drv->sc) {
   #if IDEIO_MULTIPLE_MAX > 0
                                   case 2: case 4: case 8: case 16: case 32: case 64: case 128:
                                           if (drv->sc <= IDEIO_MULTIPLE_MAX) {
                                                   drv->mulmode = drv->sc;
                                                   setintr(drv);
                                                   break;
                                           }
                                           /*FALLTHROUGH*/
   #endif
                                   default:
                                           cmdabort(drv);
                                           break;
                           }
                           break;
   
                   case 0xef:              // set features
                           TRACEOUT(("ideio: set features reg = %.2x", drv->wp));
                           cmdabort(drv);
                           break;
   
                 default:                  default:
                           panic("ideio: unknown command %.2x", dat);
                         break;                          break;
         }          }
           (void)port;
 }  }
   
 static void IOOUTCALL ideio_o74c(UINT port, REG8 dat) {  static void IOOUTCALL ideio_o74c(UINT port, REG8 dat) {
Line 321  static void IOOUTCALL ideio_o74c(UINT po Line 538  static void IOOUTCALL ideio_o74c(UINT po
         REG8    modify;          REG8    modify;
   
         dev = getidedev();          dev = getidedev();
           if (dev == NULL) {
                   return;
           }
         modify = dev->drv[0].ctrl ^ dat;          modify = dev->drv[0].ctrl ^ dat;
         dev->drv[0].ctrl = dat;          dev->drv[0].ctrl = dat;
         dev->drv[1].ctrl = dat;          dev->drv[1].ctrl = dat;
Line 342  static void IOOUTCALL ideio_o74c(UINT po Line 562  static void IOOUTCALL ideio_o74c(UINT po
                         }                          }
                 }                  }
         }          }
         TRACEOUT(("ideio %.4x,%.2x [%.4x:%.4x]", port, dat, CPU_CS, CPU_IP));          TRACEOUT(("ideio interrupt %sable", (dat & IDECTRL_NIEN) ? "dis" : "en"));
           TRACEOUT(("ideio devctrl %.2x [%.4x:%.8x]", dat, CPU_CS, CPU_EIP));
           (void)port;
 }  }
   
 static void IOOUTCALL ideio_o74e(UINT port, REG8 dat) {  static void IOOUTCALL ideio_o74e(UINT port, REG8 dat) {
   
         TRACEOUT(("ideio %.4x,%.2x [%.4x:%.4x]", port, dat, CPU_CS, CPU_IP));          TRACEOUT(("ideio %.4x,%.2x [%.4x:%.8x]", port, dat, CPU_CS, CPU_EIP));
           (void)port;
           (void)dat;
 }  }
   
   
Line 357  static REG8 IOINPCALL ideio_i642(UINT po Line 581  static REG8 IOINPCALL ideio_i642(UINT po
   
         IDEDRV  drv;          IDEDRV  drv;
   
           (void)port;
   
         drv = getidedrv();          drv = getidedrv();
         drv->status &= ~IDESTAT_ERR;          if (drv) {
         TRACEOUT(("ideio get error %.2x [%.4x:%.4x]", drv->error, CPU_CS, CPU_IP));                  drv->status &= ~IDESTAT_ERR;
         return(drv->error);                  TRACEOUT(("ideio get error %.2x [%.4x:%.8x]",
                                                                                                   drv->error, CPU_CS, CPU_EIP));
                   return(drv->error);
           }
           else {
                   return(0xff);
           }
 }  }
   
 static REG8 IOINPCALL ideio_i644(UINT port) {  static REG8 IOINPCALL ideio_i644(UINT port) {
   
         IDEDRV  drv;          IDEDRV  drv;
   
           (void)port;
   
         drv = getidedrv();          drv = getidedrv();
         TRACEOUT(("ideio get SC %.2x [%.4x:%.4x]", drv->sc, CPU_CS, CPU_IP));          if (drv) {
         return(drv->sc);                  TRACEOUT(("ideio get SC %.2x [%.4x:%.8x]", drv->sc, CPU_CS, CPU_EIP));
                   return(drv->sc);
           }
           else {
                   return(0xff);
           }
 }  }
   
 static REG8 IOINPCALL ideio_i646(UINT port) {  static REG8 IOINPCALL ideio_i646(UINT port) {
   
         IDEDRV  drv;          IDEDRV  drv;
   
           (void)port;
   
         drv = getidedrv();          drv = getidedrv();
         TRACEOUT(("ideio get SN %.2x [%.4x:%.4x]", drv->sn, CPU_CS, CPU_IP));          if (drv) {
         return(drv->sn);                  TRACEOUT(("ideio get SN %.2x [%.4x:%.8x]", drv->sn, CPU_CS, CPU_EIP));
                   return(drv->sn);
           }
           else {
                   return(0xff);
           }
 }  }
   
 static REG8 IOINPCALL ideio_i648(UINT port) {  static REG8 IOINPCALL ideio_i648(UINT port) {
   
         IDEDRV  drv;          IDEDRV  drv;
   
           (void)port;
   
         drv = getidedrv();          drv = getidedrv();
         TRACEOUT(("ideio get CYL %.4x [%.4x:%.4x]", drv->cy, CPU_CS, CPU_IP));          if (drv) {
         return((UINT8)drv->cy);                  TRACEOUT(("ideio get CYL %.4x [%.4x:%.8x]", drv->cy, CPU_CS, CPU_EIP));
                   return((UINT8)drv->cy);
           }
           else {
                   return(0xff);
           }
 }  }
   
 static REG8 IOINPCALL ideio_i64a(UINT port) {  static REG8 IOINPCALL ideio_i64a(UINT port) {
   
         IDEDRV  drv;          IDEDRV  drv;
   
           (void)port;
   
         drv = getidedrv();          drv = getidedrv();
         TRACEOUT(("ideio get CYH %.4x [%.4x:%.4x]", drv->cy, CPU_CS, CPU_IP));          if (drv) {
         return((REG8)(drv->cy >> 8));                  TRACEOUT(("ideio get CYH %.4x [%.4x:%.8x]", drv->cy, CPU_CS, CPU_EIP));
                   return((REG8)(drv->cy >> 8));
           }
           else {
                   return(0xff);
           }
 }  }
   
 static REG8 IOINPCALL ideio_i64c(UINT port) {  static REG8 IOINPCALL ideio_i64c(UINT port) {
Line 404  static REG8 IOINPCALL ideio_i64c(UINT po Line 664  static REG8 IOINPCALL ideio_i64c(UINT po
         IDEDRV  drv;          IDEDRV  drv;
         REG8    ret;          REG8    ret;
   
           (void)port;
   
         drv = getidedrv();          drv = getidedrv();
         ret = drv->dr | drv->hd;          if (drv) {
         TRACEOUT(("ideio get DRHD %.2x [%.4x:%.4x]", ret, CPU_CS, CPU_IP));                  ret = drv->dr | drv->hd;
         return(ret);                  TRACEOUT(("ideio get DRHD %.2x [%.4x:%.8x]", ret, CPU_CS, CPU_EIP));
                   return(ret);
           }
           else {
                   return(0xff);
           }
 }  }
   
 static REG8 IOINPCALL ideio_i64e(UINT port) {  static REG8 IOINPCALL ideio_i64e(UINT port) {
   
         IDEDRV  drv;          IDEDRV  drv;
   
           (void)port;
   
         drv = getidedrv();          drv = getidedrv();
         TRACEOUT(("ideio status %.2x [%.4x:%.4x]", drv->status, CPU_CS, CPU_IP));          if (drv) {
         return(drv->status);                  TRACEOUT(("ideio status %.2x [%.4x:%.8x]",
                                                                                           drv->status, CPU_CS, CPU_EIP));
                   if (!(drv->ctrl & IDECTRL_NIEN)) {
                           TRACEOUT(("ideio: resetirq"));
                           pic_resetirq(IDE_IRQ);
                   }
                   return(drv->status);
           }
           else {
                   return(0xff);
           }
 }  }
   
 static REG8 IOINPCALL ideio_i74c(UINT port) {  static REG8 IOINPCALL ideio_i74c(UINT port) {
   
         TRACEOUT(("ideio %.4x [%.4x:%.4x]", port, CPU_CS, CPU_IP));          IDEDRV  drv;
         return(0xff);  
           (void)port;
   
           drv = getidedrv();
           if (drv) {
                   TRACEOUT(("ideio alt status %.2x [%.4x:%.8x]",
                                                                                           drv->status, CPU_CS, CPU_EIP));
                   return(drv->status);
           }
           else {
                   return(0xff);
           }
 }  }
   
   
Line 434  void IOOUTCALL ideio_w16(UINT port, REG1 Line 724  void IOOUTCALL ideio_w16(UINT port, REG1
         BYTE    *p;          BYTE    *p;
   
         drv = getidedrv();          drv = getidedrv();
         if ((drv->status & IDESTAT_DRQ) && (drv->bufdir == IDEDIR_OUT)) {          if ((drv != NULL) &&
                   (drv->status & IDESTAT_DRQ) && (drv->bufdir == IDEDIR_OUT)) {
                 p = drv->buf + drv->bufpos;                  p = drv->buf + drv->bufpos;
                 p[0] = (BYTE)value;                  p[0] = (BYTE)value;
                 p[1] = (BYTE)(value >> 8);                  p[1] = (BYTE)(value >> 8);
                 TRACEOUT(("ide-data send %4x (%.4x) [%.4x:%.4x]",                  TRACEOUT(("ide-data send %4x (%.4x) [%.4x:%.8x]",
                                                                                 value, drv->bufpos, CPU_CS, CPU_IP));                                                                                  value, drv->bufpos, CPU_CS, CPU_EIP));
                 drv->bufpos += 2;                  drv->bufpos += 2;
                 if (drv->bufpos >= drv->bufsize) {                  if (drv->bufpos >= drv->bufsize) {
                         drv->status &= ~IDESTAT_DRQ;                          drv->status &= ~IDESTAT_DRQ;
Line 450  void IOOUTCALL ideio_w16(UINT port, REG1 Line 741  void IOOUTCALL ideio_w16(UINT port, REG1
                         }                          }
                 }                  }
         }          }
           (void)port;
 }  }
   
 REG16 IOOUTCALL ideio_r16(UINT port) {  REG16 IOINPCALL ideio_r16(UINT port) {
   
         REG16   ret;  
         IDEDRV  drv;          IDEDRV  drv;
           REG16   ret;
         BYTE    *p;          BYTE    *p;
   
         ret = 0;          (void)port;
   
         drv = getidedrv();          drv = getidedrv();
           if (drv == NULL) {
                   return(0xff);
           }
           ret = 0;
         if ((drv->status & IDESTAT_DRQ) && (drv->bufdir == IDEDIR_IN)) {          if ((drv->status & IDESTAT_DRQ) && (drv->bufdir == IDEDIR_IN)) {
                 p = drv->buf + drv->bufpos;                  p = drv->buf + drv->bufpos;
                 ret = p[0] + (p[1] << 8);                  ret = p[0] + (p[1] << 8);
                 TRACEOUT(("ide-data recv %4x (%.4x) [%.4x:%.4x]",                  TRACEOUT(("ide-data recv %.4x (%.4x) [%.4x:%.8x]",
                                                                                 ret, drv->bufpos, CPU_CS, CPU_IP));                                                                                  ret, drv->bufpos, CPU_CS, CPU_EIP));
                 drv->bufpos += 2;                  drv->bufpos += 2;
                 if (drv->bufpos >= drv->bufsize) {                  if (drv->bufpos >= drv->bufsize) {
                         drv->status &= ~IDESTAT_DRQ;                          drv->status &= ~IDESTAT_DRQ;
                         switch(drv->cmd) {                          switch(drv->cmd) {
                                 case 0x20:                                  case 0x20:
                                 case 0x21:                                  case 0x21:
                                   case 0xc4:
                                         incsec(drv);                                          incsec(drv);
                                         drv->sc--;                                          drv->sc--;
                                         if (drv->sc) {                                          if (drv->sc) {
Line 507  static void devinit(IDEDRV drv, REG8 sxs Line 805  static void devinit(IDEDRV drv, REG8 sxs
                 drv->device = IDETYPE_HDD;                  drv->device = IDETYPE_HDD;
                 drv->surfaces = sxsi->surfaces;                  drv->surfaces = sxsi->surfaces;
                 drv->sectors = sxsi->sectors;                  drv->sectors = sxsi->sectors;
                   drv->mulmode = 1;
         }          }
         else {          else {
                 drv->status = IDESTAT_ERR;                  drv->status = IDESTAT_ERR;
                 drv->error = IDEERR_TR0;                  drv->error = IDEERR_TR0;
                   drv->device = IDETYPE_NONE;
         }          }
 }  }
   
Line 525  void ideio_reset(void) { Line 825  void ideio_reset(void) {
                 devinit(drv, i);                  devinit(drv, i);
         }          }
   
 #if 1           // CD-ROM test  #if 0           // CD-ROM test
         drv = ideio.dev[1].drv;          drv = ideio.dev[1].drv;
         drv->hd = 0;          drv->hd = 0;
         drv->sc = 1;          drv->sc = 1;
Line 547  void ideio_reset(void) { Line 847  void ideio_reset(void) {
         ideio.dev[1].drv[0].sxsidrv = 0x02;          ideio.dev[1].drv[0].sxsidrv = 0x02;
         ideio.dev[1].drv[1].sxsidrv = 0x03;          ideio.dev[1].drv[1].sxsidrv = 0x03;
 #endif  #endif
   
           CopyMemory(mem + 0xd0000, idebios, sizeof(idebios));
           TRACEOUT(("use simulate ide.rom"));
 }  }
   
 void ideio_bind(void) {  void ideio_bind(void) {
Line 577  void ideio_bind(void) { Line 880  void ideio_bind(void) {
                 iocore_attachinp(0x074c, ideio_i74c);                  iocore_attachinp(0x074c, ideio_i74c);
         }          }
 }  }
 #endif  
   
   #endif  /* SUPPORT_IDEIO */
Removed from v.1.1  
changed lines
  Added in v.1.7

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