Diff for /np2/i386c/memory.c between versions 1.9 and 1.15

version 1.9, 2004/02/05 16:41:32 version 1.15, 2004/03/04 16:58:57
Line 5 Line 5
 #include        "cpucore.h"  #include        "cpucore.h"
 #include        "memory.h"  #include        "memory.h"
 #include        "egcmem.h"  #include        "egcmem.h"
   #include        "mem9821.h"
 #include        "pccore.h"  #include        "pccore.h"
 #include        "iocore.h"  #include        "iocore.h"
 #include        "vram.h"  #include        "vram.h"
Line 735  void MEMCALL i286_vram_dispatch(UINT fun Line 736  void MEMCALL i286_vram_dispatch(UINT fun
 const VACCTBL   *vacc;  const VACCTBL   *vacc;
   
         vacc = vacctbl + (func & 0x0f);          vacc = vacctbl + (func & 0x0f);
   #if defined(SUPPORT_PC9821)
         memfn.rd8[0xa8000 >> 15] = vacc->rd8;          if (!(func & 0x20)) {
         memfn.rd8[0xb0000 >> 15] = vacc->rd8;  #endif
         memfn.rd8[0xb8000 >> 15] = vacc->rd8;                  memfn.rd8[0xa8000 >> 15] = vacc->rd8;
         memfn.rd8[0xe0000 >> 15] = vacc->rd8;                  memfn.rd8[0xb0000 >> 15] = vacc->rd8;
                   memfn.rd8[0xb8000 >> 15] = vacc->rd8;
         memfn.wr8[0xa8000 >> 15] = vacc->wr8;                  memfn.rd8[0xe0000 >> 15] = vacc->rd8;
         memfn.wr8[0xb0000 >> 15] = vacc->wr8;  
         memfn.wr8[0xb8000 >> 15] = vacc->wr8;                  memfn.wr8[0xa8000 >> 15] = vacc->wr8;
         memfn.wr8[0xe0000 >> 15] = vacc->wr8;                  memfn.wr8[0xb0000 >> 15] = vacc->wr8;
                   memfn.wr8[0xb8000 >> 15] = vacc->wr8;
         memfn.rd16[0xa8000 >> 15] = vacc->rd16;                  memfn.wr8[0xe0000 >> 15] = vacc->wr8;
         memfn.rd16[0xb0000 >> 15] = vacc->rd16;  
         memfn.rd16[0xb8000 >> 15] = vacc->rd16;                  memfn.rd16[0xa8000 >> 15] = vacc->rd16;
         memfn.rd16[0xe0000 >> 15] = vacc->rd16;                  memfn.rd16[0xb0000 >> 15] = vacc->rd16;
                   memfn.rd16[0xb8000 >> 15] = vacc->rd16;
         memfn.wr16[0xa8000 >> 15] = vacc->wr16;                  memfn.rd16[0xe0000 >> 15] = vacc->rd16;
         memfn.wr16[0xb0000 >> 15] = vacc->wr16;  
         memfn.wr16[0xb8000 >> 15] = vacc->wr16;                  memfn.wr16[0xa8000 >> 15] = vacc->wr16;
         memfn.wr16[0xe0000 >> 15] = vacc->wr16;                  memfn.wr16[0xb0000 >> 15] = vacc->wr16;
                   memfn.wr16[0xb8000 >> 15] = vacc->wr16;
         if (!(func & 0x10)) {                                                   // digital                  memfn.wr16[0xe0000 >> 15] = vacc->wr16;
                 memfn.wr8[0xe0000 >> 15] = i286_wn;  
                 memfn.wr16[0xe0000 >> 15] = i286w_wn;                  if (!(func & 0x10)) {                                                   // digital
                 memfn.rd8[0xe0000 >> 15] = i286_nonram_r;                          memfn.wr8[0xe0000 >> 15] = i286_wn;
                 memfn.rd16[0xe0000 >> 15] = i286_nonram_rw;                          memfn.wr16[0xe0000 >> 15] = i286w_wn;
                           memfn.rd8[0xe0000 >> 15] = i286_nonram_r;
                           memfn.rd16[0xe0000 >> 15] = i286_nonram_rw;
                   }
   #if defined(SUPPORT_PC9821)
         }          }
           else {
                   memfn.rd8[0xa8000 >> 15] = mem9821_b0r;
                   memfn.rd8[0xb0000 >> 15] = mem9821_b0r;
                   memfn.rd8[0xb8000 >> 15] = vacc->rd8;
                   memfn.rd8[0xe0000 >> 15] = mem9821_b2r;
   
                   memfn.wr8[0xa8000 >> 15] = mem9821_b0w;
                   memfn.wr8[0xb0000 >> 15] = mem9821_b0w;
                   memfn.wr8[0xb8000 >> 15] = vacc->wr8;
                   memfn.wr8[0xe0000 >> 15] = mem9821_b2w;
   
                   memfn.rd16[0xa8000 >> 15] = mem9821_b0rw;
                   memfn.rd16[0xb0000 >> 15] = mem9821_b0rw;
                   memfn.rd16[0xb8000 >> 15] = vacc->rd16;
                   memfn.rd16[0xe0000 >> 15] = mem9821_b2rw;
   
                   memfn.wr16[0xa8000 >> 15] = mem9821_b0ww;
                   memfn.wr16[0xb0000 >> 15] = mem9821_b0ww;
                   memfn.wr16[0xb8000 >> 15] = vacc->wr16;
                   memfn.wr16[0xe0000 >> 15] = mem9821_b2ww;
           }
   #endif
 }  }
   
   
 REG8 MEMCALL i286_memoryread(UINT32 paddr) {  REG8 MEMCALL i286_memoryread(UINT32 addr) {
   
         UINT32  address = paddr & CPU_ADRSMASK;          UINT32  pos;
   
         if (address < I286_MEMREADMAX) {          if (addr < I286_MEMREADMAX) {
                 return(mem[address]);                  return(mem[addr]);
         }          }
         else if (address >= USE_HIMEM) {          else if (addr >= USE_HIMEM) {
                 address -= 0x100000;                  pos = (addr & CPU_ADRSMASK) - 0x100000;
                 if (address < CPU_EXTMEMSIZE) {                  if (pos < CPU_EXTMEMSIZE) {
                         return(CPU_EXTMEM[address]);                          return(CPU_EXTMEM[pos]);
                   }
                   else if ((addr >= 0x00fa0000) && (addr < 0x01000000)) {
                           return(memfn.rd8[(addr >> 15) & 0x1f](addr - 0x00f00000));
                   }
   #if defined(SUPPORT_PC9821)
                   else if (addr >= 0xfff00000) {
                           return(mem9821_r(addr));
                 }                  }
   #endif
                 else {                  else {
                         return(0xff);                          return(0xff);
                 }                  }
         }          }
         else {          else {
                 return(memfn.rd8[(address >> 15) & 0x1f](address));                  return(memfn.rd8[(addr >> 15) & 0x1f](addr));
         }          }
 }  }
   
 REG16 MEMCALL i286_memoryread_w(UINT32 paddr) {  REG16 MEMCALL i286_memoryread_w(UINT32 addr) {
   
         UINT32  address = paddr & CPU_ADRSMASK;          UINT32  pos;
         REG16   ret;          REG16   ret;
   
         if (address < (I286_MEMREADMAX - 1)) {          if (addr < (I286_MEMREADMAX - 1)) {
                 return(LOADINTELWORD(mem + address));                  return(LOADINTELWORD(mem + addr));
         }          }
         else if (address >= (USE_HIMEM - 1)) {          else if ((addr + 1) & 0x7fff) {                         // non 32kb boundary
                 address -= 0x100000;                  if (addr >= USE_HIMEM) {
                 if (address == (USE_HIMEM - 0x100000 - 1)) {                          pos = (addr & CPU_ADRSMASK) - 0x100000;
                         ret = mem[0x100000 + address];                          if (pos < CPU_EXTMEMSIZE) {
                 }                                  return(LOADINTELWORD(CPU_EXTMEM + pos));
                 else if (address < CPU_EXTMEMSIZE) {                          }
                         ret = CPU_EXTMEM[address];                          else if ((addr >= 0x00fa0000) && (addr < 0x01000000)) {
                 }                                  return(memfn.rd16[(addr >> 15) & 0x1f](addr - 0x00f00000));
                 else {                          }
                         ret = 0xff;  #if defined(SUPPORT_PC9821)
                 }                          else if (addr >= 0xfff00000) {
                 address++;                                  return(mem9821_rw(addr));
                 if (address < CPU_EXTMEMSIZE) {                          }
                         ret += CPU_EXTMEM[address] << 8;  #endif
                 }                          else {
                 else {                                  return(0xffff);
                         ret += 0xff00;                          }
                 }                  }
                 return(ret);                  return(memfn.rd16[(addr >> 15) & 0x1f](addr));
         }  
         else if ((address & 0x7fff) != 0x7fff) {  
                 return(memfn.rd16[(address >> 15) & 0x1f](address));  
         }          }
         else {          else {
                 ret = memfn.rd8[(address >> 15) & 0x1f](address);                  ret = i286_memoryread(addr);
                 address++;                  ret += (REG16)(i286_memoryread(addr + 1) << 8);
                 ret += (REG16)(memfn.rd8[(address >> 15) & 0x1f](address)) << 8;  
                 return(ret);                  return(ret);
         }          }
 }  }
   
 UINT32 MEMCALL i286_memoryread_d(UINT32 paddr) {  UINT32 MEMCALL i286_memoryread_d(UINT32 addr) {
   
         UINT32  address = paddr & CPU_ADRSMASK;          UINT32  pos;
         UINT32  adrs;  
         UINT32  ret;          UINT32  ret;
   
         if (address < (I286_MEMREADMAX - 3)) {          if (addr < (I286_MEMREADMAX - 3)) {
                 return(LOADINTELDWORD(mem + address));                  return(LOADINTELDWORD(mem + addr));
         }          }
         else if (address >= USE_HIMEM) {          else if (addr >= USE_HIMEM) {
                 adrs = address - 0x100000;                  pos = (addr & CPU_ADRSMASK) - 0x100000;
                 if (adrs + 3 < CPU_EXTMEMSIZE) {                  if ((pos + 3) < CPU_EXTMEMSIZE) {
                         return(LOADINTELDWORD(CPU_EXTMEM + adrs));                          return(LOADINTELDWORD(CPU_EXTMEM + pos));
                 }                  }
         }          }
         ret = i286_memoryread_w(address);          if (!(addr & 1)) {
         ret += (UINT32)i286_memoryread_w(address + 2) << 16;                  ret = i286_memoryread_w(addr);
         return ret;                  ret += (UINT32)i286_memoryread_w(addr + 2) << 16;
           }
           else {
                   ret = i286_memoryread(addr);
                   ret += (UINT32)i286_memoryread_w(addr + 1) << 8;
                   ret += (UINT32)i286_memoryread(addr + 3) << 24;
           }
           return(ret);
 }  }
   
 void MEMCALL i286_memorywrite(UINT32 paddr, REG8 value) {  void MEMCALL i286_memorywrite(UINT32 addr, REG8 value) {
   
         UINT32  address = paddr & CPU_ADRSMASK;          UINT32  pos;
   
         if (address < I286_MEMWRITEMAX) {          if (addr < I286_MEMWRITEMAX) {
                 mem[address] = (BYTE)value;                  mem[addr] = (BYTE)value;
         }          }
         else if (address >= USE_HIMEM) {          else if (addr >= USE_HIMEM) {
                 address -= 0x100000;                  pos = (addr & CPU_ADRSMASK) - 0x100000;
                 if (address < CPU_EXTMEMSIZE) {                  if (pos < CPU_EXTMEMSIZE) {
                         CPU_EXTMEM[address] = (BYTE)value;                          CPU_EXTMEM[pos] = (BYTE)value;
                   }
                   else if ((addr >= 0x00fa0000) && (addr < 0x01000000)) {
                           memfn.wr8[(addr >> 15) & 0x1f](addr - 0x00f00000, value);
                   }
   #if defined(SUPPORT_PC9821)
                   else if (addr >= 0xfff00000) {
                           mem9821_w(addr, value);
                   }
   #endif
                   else {
                           TRACEOUT(("mem_w %x %x", addr, value));
                 }                  }
         }          }
         else {          else {
                 memfn.wr8[(address >> 15) & 0x1f](address, value);                  memfn.wr8[(addr >> 15) & 0x1f](addr, value);
         }          }
 }  }
   
 void MEMCALL i286_memorywrite_w(UINT32 paddr, REG16 value) {  void MEMCALL i286_memorywrite_w(UINT32 addr, REG16 value) {
   
         UINT32  address = paddr & CPU_ADRSMASK;          UINT32  pos;
   
         if (address < (I286_MEMWRITEMAX - 1)) {          if (addr < (I286_MEMWRITEMAX - 1)) {
                 STOREINTELWORD(mem + address, value);                  STOREINTELWORD(mem + addr, value);
         }          }
         else if (address >= (USE_HIMEM - 1)) {          else if ((addr + 1) & 0x7fff) {                         // non 32kb boundary
                 address -= 0x100000;                  if (addr >= USE_HIMEM) {
                 if (address == (USE_HIMEM - 0x100000 - 1)) {                          pos = (addr & CPU_ADRSMASK) - 0x100000;
                         mem[address] = (BYTE)value;                          if (pos < CPU_EXTMEMSIZE) {
                 }                                  STOREINTELWORD(CPU_EXTMEM + pos, value);
                 else if (address < CPU_EXTMEMSIZE) {                          }
                         CPU_EXTMEM[address] = (BYTE)value;                          else if ((addr >= 0x00fa0000) && (addr < 0x01000000)) {
                                   memfn.wr16[(addr >> 15) & 0x1f](addr - 0x00f00000, value);
                           }
   #if defined(SUPPORT_PC9821)
                           else if (addr >= 0xfff00000) {
                                   mem9821_ww(addr, value);
                           }
   #endif
                 }                  }
                 address++;                  else {
                 if (address < CPU_EXTMEMSIZE) {                          memfn.wr16[(addr >> 15) & 0x1f](addr, value);
                         CPU_EXTMEM[address] = (BYTE)(value >> 8);  
                 }                  }
         }          }
         else if ((address & 0x7fff) != 0x7fff) {  
                 memfn.wr16[(address >> 15) & 0x1f](address, value);  
         }  
         else {          else {
                 memfn.wr8[(address >> 15) & 0x1f](address, (BYTE)value);                  i286_memorywrite(addr, (UINT8)value);
                 address++;                  i286_memorywrite(addr + 1, (UINT8)(value >> 8));
                 memfn.wr8[(address >> 15) & 0x1f](address, (BYTE)(value >> 8));  
         }          }
 }  }
   
 void MEMCALL i286_memorywrite_d(UINT32 paddr, UINT32 value) {  void MEMCALL i286_memorywrite_d(UINT32 addr, UINT32 value) {
   
         UINT32  address = paddr & CPU_ADRSMASK;          UINT32  pos;
         UINT32  adrs;  
   
         if (address < (I286_MEMWRITEMAX - 3)) {          if (addr < (I286_MEMWRITEMAX - 3)) {
                 STOREINTELDWORD(mem + address, value);                  STOREINTELDWORD(mem + addr, value);
                 return;                  return;
         }          }
         else if (address >= USE_HIMEM) {          else if (addr >= USE_HIMEM) {
                 adrs = address - 0x100000;                  pos = (addr & CPU_ADRSMASK) - 0x100000;
                 if (adrs + 3 < CPU_EXTMEMSIZE) {                  if ((pos + 3) < CPU_EXTMEMSIZE) {
                         STOREINTELDWORD(CPU_EXTMEM + adrs, value);                          STOREINTELDWORD(CPU_EXTMEM + pos, value);
                         return;                          return;
                 }                  }
         }          }
         i286_memorywrite_w(address, value & 0xffff);          if (!(addr & 1)) {
         i286_memorywrite_w(address + 2, (WORD)(value >> 16));                  i286_memorywrite_w(addr, (UINT16)value);
                   i286_memorywrite_w(addr + 2, (UINT16)(value >> 16));
           }
           else {
                   i286_memorywrite(addr, (UINT8)value);
                   i286_memorywrite_w(addr + 1, (UINT16)(value >> 8));
                   i286_memorywrite(addr + 3, (UINT8)(value >> 24));
           }
 }  }
   
 #if 0  #if 0
Line 967  void MEMCALL i286_memword_write(UINT seg Line 1023  void MEMCALL i286_memword_write(UINT seg
 }  }
 #endif  #endif
   
 void MEMCALL i286_memstr_read(UINT seg, UINT off, void *dat, UINT leng) {  void MEMCALL memp_read(UINT32 address, void *dat, UINT leng) {
   
         BYTE    *out;          BYTE *out = (BYTE *)dat;
         UINT32  adrs;          UINT pos;
         UINT    size;          UINT diff;
   
         out = (BYTE *)dat;          /* fast memory access */
         adrs = seg << 4;          if (address + leng < I286_MEMREADMAX) {
         off = LOW16(off);                  CopyMemory(dat, mem + address, leng);
         if ((I286_MEMREADMAX >= 0x10000) &&                  return;
                 (adrs < (I286_MEMREADMAX - 0x10000))) {          } else if (address >= USE_HIMEM) {
                 if (leng) {                  pos = (address & CPU_ADRSMASK) - 0x100000;
                         size = 0x10000 - off;                  if (pos + leng < CPU_EXTMEMSIZE) {
                         if (size >= leng) {                          CopyMemory(dat, CPU_EXTMEM + pos, leng);
                                 CopyMemory(out, mem + adrs + off, leng);                          return;
                                 return;  
                         }  
                         CopyMemory(out, mem + adrs + off, size);  
                         out += size;  
                         leng -= size;  
                 }  
                 while(leng >= 0x10000) {  
                         CopyMemory(out, mem + adrs, 0x10000);  
                         out += 0x10000;  
                         leng -= 0x10000;  
                 }                  }
                 if (leng) {                  if (pos < CPU_EXTMEMSIZE) {
                         CopyMemory(out, mem + adrs, leng);                          diff = CPU_EXTMEMSIZE - pos;
                           CopyMemory(out, CPU_EXTMEM + pos, diff);
                           out += diff;
                           leng -= diff;
                           address += diff;
                 }                  }
         }          }
         else {  
                 while(leng--) {          /* slow memory access */
                         *out++ = i286_memoryread(adrs + off);          while (leng-- > 0) {
                         off = LOW16(off + 1);                  *out++ = i286_memoryread(address++);
                 }  
         }          }
 }  }
   
 void MEMCALL i286_memstr_write(UINT seg, UINT off,  void MEMCALL memp_write(UINT32 address, const void *dat, UINT leng) {
                                                                                                 const void *dat, UINT leng) {  
   
         BYTE    *out;          const BYTE *out = (BYTE *)dat;
         UINT32  adrs;          UINT pos;
         UINT    size;          UINT diff;
   
         out = (BYTE *)dat;          /* fast memory access */
         adrs = seg << 4;          if (address + leng < I286_MEMREADMAX) {
         off = LOW16(off);                  CopyMemory(mem + address, dat, leng);
         if ((I286_MEMWRITEMAX >= 0x10000) &&                  return;
                 (adrs < (I286_MEMWRITEMAX - 0x10000))) {          } else if (address >= USE_HIMEM) {
                 if (leng) {                  pos = (address & CPU_ADRSMASK) - 0x100000;
                         size = 0x10000 - off;                  if (pos + leng < CPU_EXTMEMSIZE) {
                         if (size >= leng) {                          CopyMemory(CPU_EXTMEM + pos, dat, leng);
                                 CopyMemory(mem + adrs + off, out, leng);                          return;
                                 return;  
                         }  
                         CopyMemory(mem + adrs + off, out, size);  
                         out += size;  
                         leng -= size;  
                 }  
                 while(leng >= 0x10000) {  
                         CopyMemory(mem + adrs, out, 0x10000);  
                         out += 0x10000;  
                         leng -= 0x10000;  
                 }                  }
                 if (leng) {                  if (pos < CPU_EXTMEMSIZE) {
                         CopyMemory(mem + adrs, out, leng);                          diff = CPU_EXTMEMSIZE - pos;
                           CopyMemory(CPU_EXTMEM + pos, dat, diff);
                           out += diff;
                           leng -= diff;
                           address += diff;
                 }                  }
         }          }
         else {  
                 while(leng--) {          /* slow memory access */
                         i286_memorywrite(adrs + off, *out++);          while (leng-- > 0) {
                         off = LOW16(off + 1);                  i286_memorywrite(address++, *out++);
                 }  
         }          }
 }  }
   
 void MEMCALL i286_memx_read(UINT32 address, void *dat, UINT leng) {  
   
         if ((address + leng) < I286_MEMREADMAX) {  // ---- Logical Space (BIOS)
                 CopyMemory(dat, mem + address, leng);  
         }  static UINT32 realaddr(UINT32 addr) {
         else {  
                 BYTE *out = (BYTE *)dat;          UINT32  pde;
                 if (address < I286_MEMREADMAX) {          UINT32  pte;
                         CopyMemory(out, mem + address, I286_MEMREADMAX - address);  
                         out += I286_MEMREADMAX - address;          if (CPU_STAT_PAGING) {
                         leng -= I286_MEMREADMAX - address;                  pde = i286_memoryread_d(CPU_STAT_PDE_BASE + ((addr >> 20) & 0xffc));
                         address = I286_MEMREADMAX;                  if (!(pde & CPU_PDE_PRESENT)) {
                           goto retdummy;
                 }                  }
                 while(leng--) {                  pte = cpu_memoryread_d((pde & CPU_PDE_BASEADDR_MASK) + ((addr >> 10) & 0xffc));
                         *out++ = i286_memoryread(address++);                  if (!(pte & CPU_PTE_PRESENT)) {
                           goto retdummy;
                 }                  }
                   addr = (pte & CPU_PTE_BASEADDR_MASK) + (addr & 0x00000fff);
           }
           return(addr);
   
   retdummy:
           return(0x01000000);             // てきとーにメモリが存在しない場所
   }
   
   void MEMCALL i286_memstr_read(UINT seg, UINT off, void *dat, UINT leng) {
   
           UINT32  adrs;
           UINT    size;
   
           while(leng) {
                   off = LOW16(off);
                   adrs = (seg << 4) + off;
                   size = 0x1000 - (adrs & 0xfff);
                   size = min(size, leng);
                   size = min(size, 0x10000 - off);
                   memp_read(realaddr(adrs), dat, size);
                   off += size;
                   dat = ((BYTE *)dat) + size;
                   leng -= size;
         }          }
 }  }
   
 void MEMCALL i286_memx_write(UINT32 address, const void *dat, UINT leng) {  void MEMCALL i286_memstr_write(UINT seg, UINT off,
                                                                                                   const void *dat, UINT leng) {
   
 const BYTE      *out;          UINT32  adrs;
           UINT    size;
   
         if ((address + leng) < I286_MEMWRITEMAX) {          while(leng) {
                 CopyMemory(mem + address, dat, leng);                  off = LOW16(off);
                   adrs = (seg << 4) + off;
                   size = 0x1000 - (adrs & 0xfff);
                   size = min(size, leng);
                   size = min(size, 0x10000 - off);
                   memp_write(realaddr(adrs), dat, size);
                   off += size;
                   dat = ((BYTE *)dat) + size;
                   leng -= size;
         }          }
         else {  }
                 out = (BYTE *)dat;  
                 if (address < I286_MEMWRITEMAX) {  void MEMCALL meml_read(UINT32 address, void *dat, UINT leng) {
                         CopyMemory(mem + address, out, I286_MEMWRITEMAX - address);  
                         out += I286_MEMWRITEMAX - address;          UINT    size;
                         leng -= I286_MEMWRITEMAX - address;  
                         address = I286_MEMWRITEMAX;          while(leng) {
                 }                  size = 0x1000 - (address & 0xfff);
                 while(leng--) {                  size = min(size, leng);
                         i286_memorywrite(address++, *out++);                  memp_read(realaddr(address), dat, size);
                 }                  address += size;
                   dat = ((BYTE *)dat) + size;
                   leng -= size;
           }
   }
   
   void MEMCALL meml_write(UINT32 address, const void *dat, UINT leng) {
   
           UINT    size;
   
           while(leng) {
                   size = 0x1000 - (address & 0xfff);
                   size = min(size, leng);
                   memp_write(realaddr(address), dat, size);
                   address += size;
                   dat = ((BYTE *)dat) + size;
                   leng -= size;
         }          }
 }  }
   
 #endif  #endif
   

Removed from v.1.9  
changed lines
  Added in v.1.15


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