Diff for /np2/i386c/ia32/paging.c between versions 1.29 and 1.31

version 1.29, 2007/02/06 14:20:57 version 1.31, 2011/01/15 17:17:23
Line 1 Line 1
 /*      $Id$    */  
   
 /*  /*
  * Copyright (c) 2003-2004 NONAKA Kimihiro   * Copyright (c) 2003-2004 NONAKA Kimihiro
  * All rights reserved.   * All rights reserved.
Line 187  static UINT32 MEMCALL paging(const UINT3 Line 185  static UINT32 MEMCALL paging(const UINT3
 static void MEMCALL tlb_update(const UINT32 laddr, const UINT entry, const int ucrw);  static void MEMCALL tlb_update(const UINT32 laddr, const UINT entry, const int ucrw);
 #endif  #endif
   
   #define PAGE_SIZE       0x1000
   #define PAGE_MASK       (PAGE_SIZE - 1)
   
 UINT8 MEMCALL  UINT8 MEMCALL
 cpu_memory_access_la_RMW_b(UINT32 laddr, UINT32 (*func)(UINT32, void *), void *arg)  cpu_memory_access_la_RMW_b(UINT32 laddr, UINT32 (*func)(UINT32, void *), void *arg)
 {  {
         const int ucrw = CPU_PAGE_WRITE|CPU_PAGE_DATA|CPU_STAT_USER_MODE;          const int ucrw = CPU_PAGE_WRITE_DATA|CPU_STAT_USER_MODE;
         UINT32 result, value;          UINT32 result, value;
         UINT32 paddr;          UINT32 paddr;
   
Line 205  cpu_memory_access_la_RMW_b(UINT32 laddr, Line 206  cpu_memory_access_la_RMW_b(UINT32 laddr,
 UINT16 MEMCALL  UINT16 MEMCALL
 cpu_memory_access_la_RMW_w(UINT32 laddr, UINT32 (*func)(UINT32, void *), void *arg)  cpu_memory_access_la_RMW_w(UINT32 laddr, UINT32 (*func)(UINT32, void *), void *arg)
 {  {
         const int ucrw = CPU_PAGE_WRITE|CPU_PAGE_DATA|CPU_STAT_USER_MODE;          const int ucrw = CPU_PAGE_WRITE_DATA|CPU_STAT_USER_MODE;
         UINT32 result, value;          UINT32 result, value;
         UINT32 paddr[2];          UINT32 paddr[2];
   
         paddr[0] = paging(laddr, ucrw);          paddr[0] = paging(laddr, ucrw);
         if ((laddr + 1) & 0x00000fff) {          if ((laddr + 1) & PAGE_MASK) {
                 value = cpu_memoryread_w(paddr[0]);                  value = cpu_memoryread_w(paddr[0]);
                 result = (*func)(value, arg);                  result = (*func)(value, arg);
                 cpu_memorywrite_w(paddr[0], (UINT16)result);                  cpu_memorywrite_w(paddr[0], (UINT16)result);
Line 228  cpu_memory_access_la_RMW_w(UINT32 laddr, Line 229  cpu_memory_access_la_RMW_w(UINT32 laddr,
 UINT32 MEMCALL  UINT32 MEMCALL
 cpu_memory_access_la_RMW_d(UINT32 laddr, UINT32 (*func)(UINT32, void *), void *arg)  cpu_memory_access_la_RMW_d(UINT32 laddr, UINT32 (*func)(UINT32, void *), void *arg)
 {  {
         const int ucrw = CPU_PAGE_WRITE|CPU_PAGE_DATA|CPU_STAT_USER_MODE;          const int ucrw = CPU_PAGE_WRITE_DATA|CPU_STAT_USER_MODE;
         UINT32 result, value;          UINT32 result, value;
         UINT32 paddr[2];          UINT32 paddr[2];
         UINT remain;          UINT remain;
   
         paddr[0] = paging(laddr, ucrw);          paddr[0] = paging(laddr, ucrw);
         remain = 0x1000 - (laddr & 0x00000fff);          remain = PAGE_SIZE - (laddr & PAGE_MASK);
         if (remain >= 4) {          if (remain >= 4) {
                 value = cpu_memoryread_d(paddr[0]);                  value = cpu_memoryread_d(paddr[0]);
                 result = (*func)(value, arg);                  result = (*func)(value, arg);
Line 294  cpu_linear_memory_read_w(UINT32 laddr, c Line 295  cpu_linear_memory_read_w(UINT32 laddr, c
         UINT16 value;          UINT16 value;
   
         paddr[0] = paging(laddr, ucrw);          paddr[0] = paging(laddr, ucrw);
         if ((laddr + 1) & 0x00000fff) {          if ((laddr + 1) & PAGE_MASK) {
                 return cpu_memoryread_w(paddr[0]);                  return cpu_memoryread_w(paddr[0]);
         } else {          } else {
                 paddr[1] = paging(laddr + 1, ucrw);                  paddr[1] = paging(laddr + 1, ucrw);
Line 312  cpu_linear_memory_read_d(UINT32 laddr, c Line 313  cpu_linear_memory_read_d(UINT32 laddr, c
         UINT remain;          UINT remain;
   
         paddr[0] = paging(laddr, ucrw);          paddr[0] = paging(laddr, ucrw);
         remain = 0x1000 - (laddr & 0x00000fff);          remain = PAGE_SIZE - (laddr & PAGE_MASK);
         if (remain >= 4) {          if (remain >= 4) {
                 return cpu_memoryread_d(paddr[0]);                  return cpu_memoryread_d(paddr[0]);
         } else {          } else {
Line 352  cpu_linear_memory_read_q(UINT32 laddr, c Line 353  cpu_linear_memory_read_q(UINT32 laddr, c
         UINT remain;          UINT remain;
   
         paddr[0] = paging(laddr, ucrw);          paddr[0] = paging(laddr, ucrw);
         remain = 0x1000 - (laddr & 0x00000fff);          remain = PAGE_SIZE - (laddr & PAGE_MASK);
         if (remain >= 8) {          if (remain >= 8) {
                 return cpu_memoryread_q(paddr[0]);                  return cpu_memoryread_q(paddr[0]);
         } else {          } else {
Line 375  cpu_linear_memory_read_q(UINT32 laddr, c Line 376  cpu_linear_memory_read_q(UINT32 laddr, c
                         value = cpu_memoryread(paddr[0]);                          value = cpu_memoryread(paddr[0]);
                         value += (UINT64)cpu_memoryread_d(paddr[0] + 1) << 8;                          value += (UINT64)cpu_memoryread_d(paddr[0] + 1) << 8;
                         value += (UINT64)cpu_memoryread_w(paddr[1]) << 40;                          value += (UINT64)cpu_memoryread_w(paddr[1]) << 40;
                         value += (UINT64)cpu_memoryread(paddr[1] + 1) << 56;                          value += (UINT64)cpu_memoryread(paddr[1] + 2) << 56;
                         break;                          break;
   
                 case 4:                  case 4:
Line 421  cpu_linear_memory_read_f(UINT32 laddr, c Line 422  cpu_linear_memory_read_f(UINT32 laddr, c
         UINT i, j;          UINT i, j;
   
         paddr[0] = paging(laddr, ucrw);          paddr[0] = paging(laddr, ucrw);
         remain = 0x1000 - (laddr & 0x00000fff);          remain = PAGE_SIZE - (laddr & PAGE_MASK);
         if (remain >= 10) {          if (remain >= 10) {
                 return cpu_memoryread_f(paddr[0]);                  return cpu_memoryread_f(paddr[0]);
         } else {          } else {
Line 439  cpu_linear_memory_read_f(UINT32 laddr, c Line 440  cpu_linear_memory_read_f(UINT32 laddr, c
 void MEMCALL  void MEMCALL
 cpu_linear_memory_write_b(UINT32 laddr, UINT8 value, const int user_mode)  cpu_linear_memory_write_b(UINT32 laddr, UINT8 value, const int user_mode)
 {  {
         const int ucrw = CPU_PAGE_WRITE|CPU_PAGE_DATA|user_mode;          const int ucrw = CPU_PAGE_WRITE_DATA|user_mode;
         UINT32 paddr;          UINT32 paddr;
   
         paddr = paging(laddr, ucrw);          paddr = paging(laddr, ucrw);
Line 449  cpu_linear_memory_write_b(UINT32 laddr,  Line 450  cpu_linear_memory_write_b(UINT32 laddr, 
 void MEMCALL  void MEMCALL
 cpu_linear_memory_write_w(UINT32 laddr, UINT16 value, const int user_mode)  cpu_linear_memory_write_w(UINT32 laddr, UINT16 value, const int user_mode)
 {  {
         const int ucrw = CPU_PAGE_WRITE|CPU_PAGE_DATA|user_mode;          const int ucrw = CPU_PAGE_WRITE_DATA|user_mode;
         UINT32 paddr[2];          UINT32 paddr[2];
   
         paddr[0] = paging(laddr, ucrw);          paddr[0] = paging(laddr, ucrw);
         if ((laddr + 1) & 0x00000fff) {          if ((laddr + 1) & PAGE_MASK) {
                 cpu_memorywrite_w(paddr[0], value);                  cpu_memorywrite_w(paddr[0], value);
         } else {          } else {
                 paddr[1] = paging(laddr + 1, ucrw);                  paddr[1] = paging(laddr + 1, ucrw);
Line 465  cpu_linear_memory_write_w(UINT32 laddr,  Line 466  cpu_linear_memory_write_w(UINT32 laddr, 
 void MEMCALL  void MEMCALL
 cpu_linear_memory_write_d(UINT32 laddr, UINT32 value, const int user_mode)  cpu_linear_memory_write_d(UINT32 laddr, UINT32 value, const int user_mode)
 {  {
         const int ucrw = CPU_PAGE_WRITE|CPU_PAGE_DATA|user_mode;          const int ucrw = CPU_PAGE_WRITE_DATA|user_mode;
         UINT32 paddr[2];          UINT32 paddr[2];
         UINT remain;          UINT remain;
   
         paddr[0] = paging(laddr, ucrw);          paddr[0] = paging(laddr, ucrw);
         remain = 0x1000 - (laddr & 0x00000fff);          remain = PAGE_SIZE - (laddr & PAGE_MASK);
         if (remain >= 4) {          if (remain >= 4) {
                 cpu_memorywrite_d(paddr[0], value);                  cpu_memorywrite_d(paddr[0], value);
         } else {          } else {
Line 499  cpu_linear_memory_write_d(UINT32 laddr,  Line 500  cpu_linear_memory_write_d(UINT32 laddr, 
 void MEMCALL  void MEMCALL
 cpu_linear_memory_write_q(UINT32 laddr, UINT64 value, const int user_mode)  cpu_linear_memory_write_q(UINT32 laddr, UINT64 value, const int user_mode)
 {  {
         const int ucrw = CPU_PAGE_WRITE|CPU_PAGE_DATA|user_mode;          const int ucrw = CPU_PAGE_WRITE_DATA|user_mode;
         UINT32 paddr[2];          UINT32 paddr[2];
         UINT remain;          UINT remain;
   
         paddr[0] = paging(laddr, ucrw);          paddr[0] = paging(laddr, ucrw);
         remain = 0x1000 - (laddr & 0x00000fff);          remain = PAGE_SIZE - (laddr & PAGE_MASK);
         if (remain >= 8) {          if (remain >= 8) {
                 cpu_memorywrite_q(paddr[0], value);                  cpu_memorywrite_q(paddr[0], value);
         } else {          } else {
Line 518  cpu_linear_memory_write_q(UINT32 laddr,  Line 519  cpu_linear_memory_write_q(UINT32 laddr, 
                         break;                          break;
   
                 case 6:                  case 6:
                           cpu_memorywrite_w(paddr[0], (UINT16)value);
                         cpu_memorywrite_d(paddr[0] + 2, (UINT32)(value >> 16));                          cpu_memorywrite_d(paddr[0] + 2, (UINT32)(value >> 16));
                         cpu_memorywrite_w(paddr[1], (UINT16)(value >> 48));                          cpu_memorywrite_w(paddr[1], (UINT16)(value >> 48));
                         break;                          break;
Line 560  cpu_linear_memory_write_q(UINT32 laddr,  Line 562  cpu_linear_memory_write_q(UINT32 laddr, 
 void MEMCALL  void MEMCALL
 cpu_linear_memory_write_f(UINT32 laddr, const REG80 *value, const int user_mode)  cpu_linear_memory_write_f(UINT32 laddr, const REG80 *value, const int user_mode)
 {  {
         const int ucrw = CPU_PAGE_WRITE|CPU_PAGE_DATA|user_mode;          const int ucrw = CPU_PAGE_WRITE_DATA|user_mode;
         UINT32 paddr[2];          UINT32 paddr[2];
         UINT remain;          UINT remain;
         UINT i, j;          UINT i, j;
   
         paddr[0] = paging(laddr, ucrw);          paddr[0] = paging(laddr, ucrw);
         remain = 0x1000 - (laddr & 0x00000fff);          remain = PAGE_SIZE - (laddr & PAGE_MASK);
         if (remain >= 10) {          if (remain >= 10) {
                 cpu_memorywrite_f(paddr[0], value);                  cpu_memorywrite_f(paddr[0], value);
         } else {          } else {
Line 582  cpu_linear_memory_write_f(UINT32 laddr,  Line 584  cpu_linear_memory_write_f(UINT32 laddr, 
   
   
 void MEMCALL  void MEMCALL
 cpu_memory_access_la_region(UINT32 laddr, UINT length, const int ucrw, BYTE *data)  cpu_memory_access_la_region(UINT32 laddr, UINT length, const int ucrw, UINT8 *data)
 {  {
         UINT32 paddr;          UINT32 paddr;
         UINT remain;    /* page remain */          UINT remain;    /* page remain */
Line 591  cpu_memory_access_la_region(UINT32 laddr Line 593  cpu_memory_access_la_region(UINT32 laddr
         if (length == 0)          if (length == 0)
                 return;                  return;
   
         remain = 0x1000 - (laddr & 0x00000fff);          remain = PAGE_SIZE - (laddr & PAGE_MASK);
         for (;;) {          for (;;) {
                 if (!CPU_STAT_PAGING) {                  if (!CPU_STAT_PAGING) {
                         paddr = laddr;                          paddr = laddr;
Line 615  cpu_memory_access_la_region(UINT32 laddr Line 617  cpu_memory_access_la_region(UINT32 laddr
                 remain -= r;                  remain -= r;
                 if (remain <= 0) {                  if (remain <= 0) {
                         /* next page */                          /* next page */
                         remain += 0x1000;                          remain += PAGE_SIZE;
                 }                  }
         }          }
 }  }
   
 void MEMCALL  UINT32 MEMCALL
 paging_check(UINT32 laddr, UINT length, const int ucrw)  laddr2paddr(const UINT32 laddr, const int ucrw)
 {  {
         UINT32 paddr;  
         UINT remain;    /* page remain */  
         UINT r;  
   
         remain = 0x1000 - (laddr & 0x00000fff);  
         for (;;) {  
                 paddr = paging(laddr, ucrw);  
   
                 r = (remain > length) ? length : remain;  
   
                 length -= r;  
                 if (length == 0)  
                         break;  
   
                 laddr += r;          return paging(laddr, ucrw);
                 remain -= r;  
                 if (remain <= 0) {  
                         /* next page */  
                         remain += 0x1000;  
                 }  
         }  
 }  }
   
 static UINT32 MEMCALL  static UINT32 MEMCALL
Line 661  paging(const UINT32 laddr, const int ucr Line 644  paging(const UINT32 laddr, const int ucr
   
         ep = tlb_lookup(laddr, ucrw);          ep = tlb_lookup(laddr, ucrw);
         if (ep != NULL)          if (ep != NULL)
                 return ep->paddr + (laddr & 0xfff);                  return ep->paddr + (laddr & PAGE_MASK);
 #endif  #endif
   
         pde_addr = CPU_STAT_PDE_BASE + ((laddr >> 20) & 0xffc);          pde_addr = CPU_STAT_PDE_BASE + ((laddr >> 20) & 0xffc);
Line 693  paging(const UINT32 laddr, const int ucr Line 676  paging(const UINT32 laddr, const int ucr
         }          }
   
         /* make physical address */          /* make physical address */
         paddr = (pte & CPU_PTE_BASEADDR_MASK) + (laddr & 0x00000fff);          paddr = (pte & CPU_PTE_BASEADDR_MASK) + (laddr & PAGE_MASK);
   
         bit  = ucrw & (CPU_PAGE_WRITE|CPU_PAGE_USER_MODE);          bit  = ucrw & (CPU_PAGE_WRITE|CPU_PAGE_USER_MODE);
         bit |= (pde & pte & (CPU_PTE_WRITABLE|CPU_PTE_USER_MODE));          bit |= (pde & pte & (CPU_PTE_WRITABLE|CPU_PTE_USER_MODE));
Line 758  do { \ Line 741  do { \
 #if (CPU_FEATURES & CPU_FEATURE_PGE) == CPU_FEATURE_PGE  #if (CPU_FEATURES & CPU_FEATURE_PGE) == CPU_FEATURE_PGE
 #define TLB_IS_GLOBAL(ep)       ((ep)->tag & TLB_ENTRY_TAG_GLOBAL)  #define TLB_IS_GLOBAL(ep)       ((ep)->tag & TLB_ENTRY_TAG_GLOBAL)
 #else  #else
 #define TLB_IS_GLOBAL(ep)       FALSE  #define TLB_IS_GLOBAL(ep)       0
 #endif  #endif
   
 #define TLB_SET_TAG_FLAGS(ep, entry, bit) \  #define TLB_SET_TAG_FLAGS(ep, entry, bit) \

Removed from v.1.29  
changed lines
  Added in v.1.31


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