Diff for /np2/i386c/ia32/paging.c between versions 1.1 and 1.7

version 1.1, 2003/12/08 00:55:31 version 1.7, 2004/01/27 15:56:57
Line 32 Line 32
 #include "ia32.mcr"  #include "ia32.mcr"
   
 /*  /*
  * ページ・ディレクトリ・エントリ (4K バイトページ使用時)  
  *  
  *  31                                    12 11   9 8  7 6 5  4   3   2   1  0   
  * +----------------------------------------+------+-+--+-+-+---+---+---+---+-+  
  * |   ページ・テーブルのベース・アドレス   |使用可|G|PS|0|A|PCD|PWT|U/S|R/W|P|  
  * +----------------------------------------+------+-+--+-+-+---+---+---+---+-+  
  *                                              |   |  | | |  |   |   |   |  |  
  * 9-11: システム・プログラマが使用可能 --------+   |  | | |  |   |   |   |  |  
  *    8: グローバル・ページ(無視される) ------------+  | | |  |   |   |   |  |  
  *    7: ページ・サイズ (0 = 4k バイトページ) ---------+ | |  |   |   |   |  |  
  *    6: 予約 (0) ---------------------------------------+ |  |   |   |   |  |  
  *    5: アクセス -----------------------------------------+  |   |   |   |  |  
  *    4: キャッシュ無効 --------------------------------------+   |   |   |  |  
  *    3: ライトスルー --------------------------------------------+   |   |  |  
  *    2: ユーザ/スーパバイザ (0 = スーパバイザ) ---------------------+   |  |  
  *    1: 読み取り/書き込み (0 = 読み取りのみ) ---------------------------+  |  
  *    0: ページ存在 ---------------------------------------------------------+  
  */  
 #define CPU_PDE_BASEADDR_MASK   0xfffff000  
 #define CPU_PDE_PAGE_SIZE       (1 << 7)  
 #define CPU_PDE_ACCESS          (1 << 5)  
 #define CPU_PDE_CACHE_DISABLE   (1 << 4)  
 #define CPU_PDE_WRITE_THROUGH   (1 << 3)  
 #define CPU_PDE_USER_MODE       (1 << 2)  
 #define CPU_PDE_WRITABLE        (1 << 1)  
 #define CPU_PDE_PRESENT         (1 << 0)  
   
 /*  
  * ページ・ディレクトリ・エントリ (4M バイトページ使用時)  
  *   
  *  31                        22 21       12 11   9 8  7 6 5  4   3   2   1  0   
  * +----------------------------+-----------+------+-+--+-+-+---+---+---+---+-+  
  * |ページテーブルの物理アドレス|  予約済み |使用可|G|PS|D|A|PCD|PWT|U/S|R/W|P|  
  * +----------------------------+-----------+------+-+--+-+-+---+---+---+---+-+  
  *                                              |   |  | | |  |   |   |   |  |  
  * 9-11: システム・プログラマが使用可能 --------+   |  | | |  |   |   |   |  |  
  *    8: グローバル・ページ ------------------------+  | | |  |   |   |   |  |  
  *    7: ページ・サイズ (1 = 4M バイトページ) ---------+ | |  |   |   |   |  |  
  *    6: ダーティ ---------------------------------------+ |  |   |   |   |  |  
  *    5: アクセス -----------------------------------------+  |   |   |   |  |  
  *    4: キャッシュ無効 --------------------------------------+   |   |   |  |  
  *    3: ライトスルー --------------------------------------------+   |   |  |  
  *    2: ユーザ/スーパバイザ (0 = スーパバイザ) ---------------------+   |  |  
  *    1: 読み取り/書き込み (0 = 読み取りのみ) ---------------------------+  |  
  *    0: ページ存在 ---------------------------------------------------------+  
  */  
 #define CPU_PDE_4M_BASEADDR_MASK        0xffc00000  
 #define CPU_PDE_4M_GLOBAL_PAGE          (1 << 8)  
 #define CPU_PDE_4M_PAGE_SIZE            (1 << 7)  
 #define CPU_PDE_4M_DIRTY                (1 << 6)  
 #define CPU_PDE_4M_ACCESS               (1 << 5)  
 #define CPU_PDE_4M_CACHE_DISABLE        (1 << 4)  
 #define CPU_PDE_4M_WRITE_THROUGH        (1 << 3)  
 #define CPU_PDE_4M_USER_MODE            (1 << 2)  
 #define CPU_PDE_4M_WRITABLE             (1 << 1)  
 #define CPU_PDE_4M_PRESENT              (1 << 0)  
   
 /*  
  * ページ・テーブル・エントリ (4k バイト・ページ)  
  *  
  *  31                                    12 11   9 8 7 6 5  4   3   2   1  0   
  * +----------------------------------------+------+-+-+-+-+---+---+---+---+-+  
  * |        ページのベース・アドレス        |使用可|G|0|D|A|PCD|PWT|U/S|R/W|P|  
  * +----------------------------------------+------+-+-+-+-+---+---+---+---+-+  
  *                                              |   | | | |  |   |   |   |  |  
  *  9-11: システム・プログラマが使用可能 -------+   | | | |  |   |   |   |  |  
  *     8: グローバル・ページ -----------------------+ | | |  |   |   |   |  |  
  *     7: 予約 (0) -----------------------------------+ | |  |   |   |   |  |  
  *     6: ダーティ -------------------------------------+ |  |   |   |   |  |  
  *     5: アクセス ---------------------------------------+  |   |   |   |  |  
  *     4: キャッシュ無効 ------------------------------------+   |   |   |  |  
  *     3: ライトスルー ------------------------------------------+   |   |  |  
  *     2: ユーザ/スーパバイザ (0 = スーパバイザ) -------------------+   |  |  
  *     1: 読み取り/書き込み (0 = 読み取りのみ) -------------------------+  |  
  *     0: ページ存在 -------------------------------------------------------+  
  */  
 #define CPU_PTE_BASEADDR_MASK   0xfffff000  
 #define CPU_PTE_GLOBAL_PAGE     (1 << 8)  
 #define CPU_PTE_DIRTY           (1 << 6)  
 #define CPU_PTE_ACCESS          (1 << 5)  
 #define CPU_PTE_CACHE_DISABLE   (1 << 4)  
 #define CPU_PTE_WRITE_THROUGH   (1 << 3)  
 #define CPU_PTE_USER_MODE       (1 << 2)  
 #define CPU_PTE_WRITABLE        (1 << 1)  
 #define CPU_PTE_PRESENT         (1 << 0)  
   
 /*  
  * ページフォルト例外   * ページフォルト例外
  *   *
  * 4-31: 予約済み   * 4-31: 予約済み
Line 272  static const BYTE page_access_bit[32] =  Line 185  static const BYTE page_access_bit[32] = 
  */   */
   
 static DWORD paging(DWORD laddr, int crw, int user_mode);  static DWORD paging(DWORD laddr, int crw, int user_mode);
   #if defined(IA32_SUPPORT_TLB)
 static BOOL tlb_lookup(DWORD vaddr, int crw, DWORD* paddr);  static BOOL tlb_lookup(DWORD vaddr, int crw, DWORD* paddr);
 static void tlb_update(DWORD paddr, DWORD entry, int crw);  static void tlb_update(DWORD paddr, DWORD entry, int crw);
   #endif
   
   
 DWORD MEMCALL  DWORD MEMCALL
Line 282  cpu_linear_memory_read(DWORD laddr, DWOR Line 197  cpu_linear_memory_read(DWORD laddr, DWOR
         DWORD paddr;          DWORD paddr;
         DWORD remain;   /* page remain */          DWORD remain;   /* page remain */
         DWORD r;          DWORD r;
           DWORD shift = 0;
         DWORD value = 0;          DWORD value = 0;
         int crw;          int crw;
         int pl;          int pl;
Line 298  cpu_linear_memory_read(DWORD laddr, DWOR Line 214  cpu_linear_memory_read(DWORD laddr, DWOR
                 r = (remain > length) ? length : remain;                  r = (remain > length) ? length : remain;
                 switch (r) {                  switch (r) {
                 case 1:                  case 1:
                         value = (value << 8) | cpu_memoryread(paddr);                          value |= (DWORD)cpu_memoryread(paddr) << shift;
                           shift += 8;
                         break;                          break;
   
                 case 2:                  case 2:
                         value = (value << 16) | cpu_memoryread_w(paddr);                          value |= (DWORD)cpu_memoryread_w(paddr) << shift;
                           shift += 16;
                         break;                          break;
   
                 case 3:                  case 3:
                         value <<= 24;                          value |= (DWORD)cpu_memoryread_w(paddr) << shift;
                         value |= cpu_memoryread_w(paddr) << 8;                          shift += 16;
                         value |= cpu_memoryread(paddr + 2);                          value |= (DWORD)cpu_memoryread(paddr + 2) << shift;
                           shift += 8;
                         break;                          break;
   
                 case 4:                  case 4:
Line 316  cpu_linear_memory_read(DWORD laddr, DWOR Line 235  cpu_linear_memory_read(DWORD laddr, DWOR
                         break;                          break;
   
                 default:                  default:
                         ia32_panic("cpu_linear_memory_read(): out of range\n");                          ia32_panic("cpu_linear_memory_read(): out of range (r = %d)\n", r);
                         break;                          break;
                 }                  }
   
                 if (length == r)                  length -= r;
                   if (length == 0)
                         break;                          break;
   
                 length -= r;  
                 remain -= r;  
                 laddr += r;                  laddr += r;
                   remain -= r;
                   if (remain <= 0) {
                           /* next page */
                           remain += 0x1000;
                   }
         }          }
   
         return value;          return value;
Line 337  cpu_linear_memory_write(DWORD laddr, DWO Line 260  cpu_linear_memory_write(DWORD laddr, DWO
         DWORD paddr;          DWORD paddr;
         DWORD remain;   /* page remain */          DWORD remain;   /* page remain */
         DWORD r;          DWORD r;
           int crw;
         int pl;          int pl;
   
           crw = CPU_PAGING_PAGE_WRITE;
           crw |= CPU_PAGING_PAGE_DATA;
         pl = (CPU_STAT_CPL == 3);          pl = (CPU_STAT_CPL == 3);
   
         /* XXX: 4MB pages... */          /* XXX: 4MB pages... */
         remain = 0x1000 - (laddr & 0x00000fff);          remain = 0x1000 - (laddr & 0x00000fff);
         for (;;) {          for (;;) {
                 paddr = paging(laddr, CPU_PAGING_PAGE_WRITE|CPU_PAGING_PAGE_DATA, pl);                  paddr = paging(laddr, crw, pl);
   
                 r = (remain > length) ? length : remain;                  r = (remain > length) ? length : remain;
                 switch (r) {                  switch (r) {
                 case 1:                  case 1:
                         cpu_memorywrite(paddr, value);                          cpu_memorywrite(paddr, value & 0xff);
                         value >>= 8;                          value >>= 8;
                         break;                          break;
   
                 case 2:                  case 2:
                         cpu_memorywrite_w(paddr, value);                          cpu_memorywrite_w(paddr, value & 0xffff);
                         value >>= 16;                          value >>= 16;
                         break;                          break;
   
                 case 3:                  case 3:
                         cpu_memorywrite_w(paddr, value);                          cpu_memorywrite_w(paddr, value & 0xffff);
                         cpu_memorywrite(paddr, value >> 16);                          value >>= 16;
                         value >>= 24;                          cpu_memorywrite(paddr + 2, value & 0xff);
                           value >>= 8;
                         break;                          break;
   
                 case 4:                  case 4:
Line 369  cpu_linear_memory_write(DWORD laddr, DWO Line 296  cpu_linear_memory_write(DWORD laddr, DWO
                         break;                          break;
   
                 default:                  default:
                         ia32_panic("cpu_linear_memory_write(): out of range\n");                          ia32_panic("cpu_linear_memory_write(): out of range (r = %d)\n", r);
                         break;                          break;
                 }                  }
   
                 if (length == r)                  length -= r;
                   if (length == 0)
                         break;                          break;
   
                 length -= r;  
                 remain -= r;  
                 laddr += r;                  laddr += r;
                   remain -= r;
                   if (remain <= 0) {
                           /* next page */
                           remain += 0x1000;
                   }
         }          }
 }  }
   
 void MEMCALL  void MEMCALL
 paging_check(DWORD laddr, DWORD length, int rw)  paging_check(DWORD laddr, DWORD length, int rw)
 {  {
         DWORD addr;          DWORD paddr;
         int n;          DWORD remain;   /* page remain */
           DWORD r;
           int crw;
         int pl;          int pl;
   
           crw = rw;
         pl = (CPU_STAT_CPL == 3);          pl = (CPU_STAT_CPL == 3);
   
         /* XXX: 4MB pages... */          /* XXX: 4MB pages... */
         n = ((laddr & 0xfff) + length) / 0x1000;          remain = 0x1000 - (laddr & 0x00000fff);
         addr = (laddr & ~0xfff);          for (;;) {
         do {                  paddr = paging(laddr, crw, pl);
                 (void)paging(addr, rw, pl);  
                 addr += 0x1000;                  r = (remain > length) ? length : remain;
         } while (--n > 0);  
                   length -= r;
                   if (length == 0)
                           break;
   
                   laddr += r;
                   remain -= r;
                   if (remain <= 0) {
                           /* next page */
                           remain += 0x1000;
                   }
           }
 }  }
   
 static DWORD  static DWORD
Line 409  paging(DWORD laddr, int crw, int user_mo Line 354  paging(DWORD laddr, int crw, int user_mo
         DWORD pte_addr; /* page table entry address */          DWORD pte_addr; /* page table entry address */
         DWORD pte;      /* page table entry */          DWORD pte;      /* page table entry */
         DWORD bit;          DWORD bit;
         DWORD err = 0;          DWORD err;
   
 #if defined(IA32_SUPPORT_TLB)  #if defined(IA32_SUPPORT_TLB)
         if (tlb_lookup(laddr, crw, &paddr))          if (tlb_lookup(laddr, crw, &paddr))
Line 419  paging(DWORD laddr, int crw, int user_mo Line 364  paging(DWORD laddr, int crw, int user_mo
         pde_addr = (CPU_CR3 & CPU_CR3_PD_MASK) | ((laddr >> 20) & 0xffc);          pde_addr = (CPU_CR3 & CPU_CR3_PD_MASK) | ((laddr >> 20) & 0xffc);
         pde = cpu_memoryread_d(pde_addr);          pde = cpu_memoryread_d(pde_addr);
         if (!(pde & CPU_PDE_PRESENT)) {          if (!(pde & CPU_PDE_PRESENT)) {
                   VERBOSE(("paging: PDE is not present"));
                   VERBOSE(("paging: CPU_CR3 = 0x%08x", CPU_CR3));
                   VERBOSE(("paging: laddr = 0x%08x, pde_addr = 0x%08x, pde = 0x%08x", laddr, pde_addr, pde));
                 err = 0;                  err = 0;
                 goto pf_exception;                  goto pf_exception;
         }          }
Line 444  paging(DWORD laddr, int crw, int user_mo Line 392  paging(DWORD laddr, int crw, int user_mo
                 pte_addr = (pde & CPU_PDE_BASEADDR_MASK) | ((laddr >> 10) & 0xffc);                  pte_addr = (pde & CPU_PDE_BASEADDR_MASK) | ((laddr >> 10) & 0xffc);
                 pte = cpu_memoryread_d(pte_addr);                  pte = cpu_memoryread_d(pte_addr);
                 if (!(pte & CPU_PTE_PRESENT)) {                  if (!(pte & CPU_PTE_PRESENT)) {
                           VERBOSE(("paging: PTE is not present"));
                           VERBOSE(("paging: laddr = 0x%08x, pde_addr = 0x%08x, pde = 0x%08x", laddr, pde_addr, pde));
                           VERBOSE(("paging: pte_addr = 0x%08x, pte = 0x%08x", pte_addr, pte));
                         err = 0;                          err = 0;
                         goto pf_exception;                          goto pf_exception;
                 }                  }
Line 456  paging(DWORD laddr, int crw, int user_mo Line 407  paging(DWORD laddr, int crw, int user_mo
                 paddr = (pte & CPU_PTE_BASEADDR_MASK) | (laddr & 0x00000fff);                  paddr = (pte & CPU_PTE_BASEADDR_MASK) | (laddr & 0x00000fff);
         }          }
   
         bit  = crw & 1;          bit  = crw & CPU_PAGING_PAGE_WRITE;
         bit |= (pde & pte & (CPU_PTE_WRITABLE|CPU_PTE_USER_MODE));          bit |= (pde & pte & (CPU_PTE_WRITABLE|CPU_PTE_USER_MODE));
         bit |= (user_mode << 3);          bit |= (user_mode << 3);
         bit |= (CPU_CR0 & CPU_CR0_WP) >> 12;          bit |= (CPU_CR0 & CPU_CR0_WP) >> 12;
Line 467  paging(DWORD laddr, int crw, int user_mo Line 418  paging(DWORD laddr, int crw, int user_mo
         if (!(page_access_bit[bit]))          if (!(page_access_bit[bit]))
 #endif  #endif
         {          {
                   VERBOSE(("paging: page access violation."));
                   VERBOSE(("paging: laddr = 0x%08x, pde_addr = 0x%08x, pde = 0x%08x", laddr, pde_addr, pde));
                   VERBOSE(("paging: pte_addr = 0x%08x, pte = 0x%08x", pte_addr, pte));
                   VERBOSE(("paging: paddr = 0x%08x, bit = 0x%08x", paddr, bit));
                 err = 1;                  err = 1;
                 goto pf_exception;                  goto pf_exception;
         }          }
   
         if ((crw & 1) && !(pte & CPU_PTE_DIRTY)) {          if ((crw & CPU_PAGING_PAGE_WRITE) && !(pte & CPU_PTE_DIRTY)) {
                 pte |= CPU_PTE_DIRTY;                  pte |= CPU_PTE_DIRTY;
                 cpu_memorywrite_d(pte_addr, pte);                  cpu_memorywrite_d(pte_addr, pte);
         }          }
Line 484  paging(DWORD laddr, int crw, int user_mo Line 439  paging(DWORD laddr, int crw, int user_mo
   
 pf_exception:  pf_exception:
         CPU_CR2 = laddr;          CPU_CR2 = laddr;
         err |= ((crw & 1) << 1) | (user_mode << 2);          err |= ((crw & CPU_PAGING_PAGE_WRITE) << 1) | (user_mode << 2);
         EXCEPTION(PF_EXCEPTION, err);          EXCEPTION(PF_EXCEPTION, err);
         return 0;       /* compiler happy */          return 0;       /* compiler happy */
 }  }
Line 638  tlb_flush_page(DWORD vaddr) Line 593  tlb_flush_page(DWORD vaddr)
         }          }
 }  }
   
 BOOL  static BOOL
 tlb_lookup(DWORD vaddr, int crw, DWORD* paddr)  tlb_lookup(DWORD laddr, int crw, DWORD* paddr)
 {  {
         TLB_ENTRY_T* ep;          TLB_ENTRY_T* ep;
         int idx;          int idx;
Line 655  tlb_lookup(DWORD vaddr, int crw, DWORD*  Line 610  tlb_lookup(DWORD vaddr, int crw, DWORD* 
                                 idx = 0;                                  idx = 0;
                         } else {                          } else {
                                 if (tlb[i].kind & TLB_KIND_SMALL) {                                  if (tlb[i].kind & TLB_KIND_SMALL) {
                                         idx = (vaddr >> 12) & (tlb[i].idx - 1);                                          idx = (laddr >> 12) & (tlb[i].idx - 1);
                                 } else {                                  } else {
                                         idx = (vaddr >> 22) & (tlb[i].idx - 1);                                          idx = (laddr >> 22) & (tlb[i].idx - 1);
                                 }                                  }
                         }                          }
   
Line 665  tlb_lookup(DWORD vaddr, int crw, DWORD*  Line 620  tlb_lookup(DWORD vaddr, int crw, DWORD* 
                         ep = &tlb[i].entry[idx * tlb[i].way];                          ep = &tlb[i].entry[idx * tlb[i].way];
                         for (i = 0; i < tlb[i].way; i++) {                          for (i = 0; i < tlb[i].way; i++) {
                                 if (ep->valid) {                                  if (ep->valid) {
                                         if ((vaddr & ep->mask) == ep->tag) {                                          if ((laddr & ep->mask) == ep->tag) {
                                                 if (ep->score != (BYTE)~0)                                                  if (ep->score != (BYTE)~0)
                                                         ep->score++;                                                          ep->score++;
                                                 *paddr = ep->paddr;                                                  *paddr = ep->paddr;
Line 680  tlb_lookup(DWORD vaddr, int crw, DWORD*  Line 635  tlb_lookup(DWORD vaddr, int crw, DWORD* 
         return FALSE;          return FALSE;
 }  }
   
 void  static void
 tlb_update(DWORD paddr, DWORD entry, int crw)  tlb_update(DWORD paddr, DWORD entry, int crw)
 {  {
         TLB_ENTRY_T* ep;          TLB_ENTRY_T* ep;
Line 750  void Line 705  void
 tlb_flush(BOOL allflush)  tlb_flush(BOOL allflush)
 {  {
   
 //      UNUSED(allflush);          (void)allflush;
 }  }
   
 void  void
 tlb_flush_page(DWORD vaddr)  tlb_flush_page(DWORD laddr)
 {  {
   
 //      UNUSED(vaddr);          (void)laddr;
 }  }
 #endif  /* IA32_SUPPORT_TLB */  #endif  /* IA32_SUPPORT_TLB */

Removed from v.1.1  
changed lines
  Added in v.1.7


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