np2/i386c/ia32/paging.c - diff

Return to paging.c CVS log

Up to [RetroPC.NET] / np2 / i386c / ia32

Diff for /np2/i386c/ia32/paging.c between versions 1.12 and 1.37

-version 1.12, 2004/02/20 16:09:04
+version 1.37, 2012/01/08 19:15:40
  Line 1
- /*      $Id$    */
  /*
-  * Copyright (c) 2003 NONAKA Kimihiro
+  * Copyright (c) 2003-2004 NONAKA Kimihiro
   * All rights reserved.
   *
   * Redistribution and use in source and binary forms, with or without
- Line 12
+ Line 10
   * 2. Redistributions in binary form must reproduce the above copyright
   *    notice, this list of conditions and the following disclaimer in the
   *    documentation and/or other materials provided with the distribution.
-  * 3. The name of the author may not be used to endorse or promote products
-  *    derived from this software without specific prior written permission.
   *
   * THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR
   * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES
- Line 32
+ Line 28
  #include "ia32.mcr"
  /*
-  * ’伊﹝扑’弁’交’孕’鬺生石瘚□
+  * 樍婍汙槻弁樍忴井樍巧樍唳本嗥﹜  *
-  * 4-31: 芺沶碧心
+  * 4-31: 鈭碧心
   *    3: RSVD: 0 = 白巧伙玄及葆奢反芺沶申永玄啜�匹反卅井勻凶‘
   *             1 = 矢□斥’白巧伙玄及葆奢反﹞啜�午穴□弁今木凶 PTE 引凶反
   *                 PDE 及芺沶申永玄匏譆及丹切域勾匹﹞1 互腹請今木凶仇午匹丐月‘
   *    2: U/S:  0 = 白巧伙玄及葆奢午卅勻凶失弁本旦反皿伕本永扔互旦□由田奶扒’
   *                 乒□玉匹撢墊醱卞墊歹木凶‘
   *             1 = 白巧伙玄及葆奢午卅勻凶失弁本旦反皿伕本永扔互交□扒’乒□玉匹
   *                 撢墊醱卞墊歹木凶‘
   *    1: W/R:  0 = 白巧伙玄及葆奢午卅勻凶失弁本旦互厶心潸曰匹丐勻凶‘
   *             1 = 白巧伙玄及葆奢午卅勻凶失弁本旦互踏五慇心匹丐勻凶‘
   *    0: P:    0 = 白巧伙玄及葆奢互尕箕矢□斥匹丐勻凶‘
   *             1 = 白巧伙玄及葆奢互矢□斥’伊矛伙忡賃啜�匹丐勻凶‘
   */
  /*
-  * 票摒 4.12. 矢□斥忡賃午本弘丟件玄忡賃及賺心寧歹六
+  * 銝 4.12. 矢□斥忡賃午本弘丟件玄忡賃及賺心寧歹六
   * ＞刓 4-2. 矢□斥’犯奴伊弁玄伉午矢□斥’氾□皮伙及忡賃及賺心寧歹六＝
   *
   * +------------+------------+------------+
   * |    PDE     |    PTE     |   merge    |
- Line 75
+ Line 71
   * |  s  |  rw  |  s  |  rw  |  s  |  rw  |
   * +-----+------+-----+------+-----+------+
   *
-  * ＞奴 rw/p : CR0 ﹜石 WP ’乒’氾’生﹜乓 ON ﹜石本艭謢甲﹜穴 ro
+  * 蜬扔 rw/p : CR0 槦亦 WP 樍］乓樍啣∫ ON 槦亦磝巨潞啣╲槦永 ro
   */
  /*
-  * ’漰銣籈＞’永’扔’弗/PxE(本篞亙扔奶本生)/CPL/CR0 ﹜生’伊﹝扑’弁’＞’永’扔’弗弁＞﹜石巨伉平弁
+  * 樍﹝樍＞樍尼槻＞槻永槻扔槻弗/PxE(頨湊奴剚賤翴央)/CPL/CR0 槦奴樍婍汙槻弁槻＞槻永槻扔槻弗鴘孕槦亦壚＞餑  *
   * +-----+-----+-----+-----+-----+---+
   * | CR0 | CPL | PxE | PxE | ope |   |
- Line 159  static const UINT8 page_access_bit[32] =
+ Line 155  static const UINT8 page_access_bit[32] =
  /*
   *--
-  * 32bit 坁咥失玉伊旦 4k 矢□斥
+  * 32bit 臄孕艛砍中樍脣旨槻弗 4k 樍婍汙槻弁
   *
-  * ’籈甲’＞﹝仲’＞’用’孎弗
+  * 樍尼樍嗅中樍扔槻＞樍脣旨槻弗
   *  31                    22 21                  12 11                       0
   * +------------------------+----------------------+--------------------------+
-  * |  ’伊﹝扑’弁﹝仲’甘’＝’孎永’生’ |   矢□斥’氾□皮伙   |        左白本永玄        |
+  * |  樍婍汙槻弁樍扔樍桀丰樍乓槻永樍啣收  |   樍婍汙槻弁樍扔樍砍汙樍极早   |        槻尼樍忴公樍血亥        |
   * +------------------------+----------------------+--------------------------+
   *             |                        |                       |
   * +-----------+            +-----------+                       +----------+
   * |                        |                                              |
-  * |  ’伊﹝扑’弁﹝仲’甘’＝’孎永’生’ |   矢□斥’氾□皮伙            矢□斥         |
+  * |  矢□斥’犯奴伊弁玄伉  |   矢□斥’氾□皮伙            矢□斥         |
   * | +--------------------+ | +-------------------+   +------------------+ |
   * | |                    | | |                   |   |                  | |
   * | |                    | | +-------------------+   |                  | |
- Line 181  static const UINT8 page_access_bit[32] =
+ Line 177  static const UINT8 page_access_bit[32] =
   *   |                    | | |                   | | |                  |
   * +>+--------------------+ +>+-------------------+ +>+------------------+
   * |
-  * +- CR3()
+  * +- CR3(坁咥失玉伊旦)
   */
- static UINT32 paging(UINT32 laddr, int crw, int user_mode);
+ /* TLB */
- #if defined(IA32_SUPPORT_TLB)
+ struct tlb_entry {
- static BOOL tlb_lookup(UINT32 vaddr, int crw, UINT32 *paddr);
+         UINT32  tag;    /* linear address */
- static void tlb_update(UINT32 paddr, UINT entry, int crw);
+ #define TLB_ENTRY_TAG_VALID             (1 << 0)
- #endif
+ /*      pde & pte & CPU_PTE_WRITABLE    (1 << 1)        */
+ /*      pde & pte & CPU_PTE_USER_MODE   (1 << 2)        */
+ #define TLB_ENTRY_TAG_DIRTY             CPU_PTE_DIRTY           /* (1 << 6) */
+ #define TLB_ENTRY_TAG_GLOBAL            CPU_PTE_GLOBAL_PAGE     /* (1 << 8) */
+ #define TLB_ENTRY_TAG_MAX_SHIFT         12
+         UINT32  paddr;  /* physical address */
+ };
+ static void MEMCALL tlb_update(UINT32 laddr, UINT entry, int ucrw);
+ /* paging */
+ static UINT32 MEMCALL paging(UINT32 laddr, int ucrw);
+ /*
+  * linear memory access
+  */
+ /* RMW */
+ UINT8 MEMCALL
+ cpu_memory_access_la_RMW_b(UINT32 laddr, UINT32 (CPUCALL *func)(UINT32, void *), void *arg)
+ {
+         const int ucrw = CPU_PAGE_WRITE_DATA | CPU_STAT_USER_MODE;
+         struct tlb_entry *ep;
+         UINT32 paddr;
+         UINT32 result;
+         UINT8 value;
+         /* TLB */
+         ep = tlb_lookup(laddr, ucrw);
+         if (ep != NULL) {
+                 paddr = ep->paddr + (laddr & PAGE_MASK);
+                 goto onepage;
+         }
+         /* paging */
+         paddr = paging(laddr, ucrw);
+ onepage:
+         value = cpu_memoryread(paddr);
+         result = (*func)(value, arg);
+         cpu_memorywrite(paddr, (UINT8)result);
+         return value;
+ }
+ UINT16 MEMCALL
+ cpu_memory_access_la_RMW_w(UINT32 laddr, UINT32 (CPUCALL *func)(UINT32, void *), void *arg)
+ {
+         const int ucrw = CPU_PAGE_WRITE_DATA | CPU_STAT_USER_MODE;
+         struct tlb_entry *ep[2];
+         UINT32 paddr[2];
+         UINT32 result;
+         UINT16 value;
+         /* TLB */
+         ep[0] = tlb_lookup(laddr, ucrw);
+         if (ep[0] != NULL) {
+                 paddr[0] = ep[0]->paddr + (laddr & PAGE_MASK);
+                 if ((laddr + 1) & PAGE_MASK)
+                         goto onepage;
+                 ep[1] = tlb_lookup(laddr + 1, ucrw);
+                 if (ep[1] != NULL) {
+                         paddr[1] = ep[1]->paddr + (laddr & PAGE_MASK);
+                         goto separate;
+                 }
+         }
+         /* paging */
+         paddr[0] = paging(laddr, ucrw);
+         if ((laddr + 1) & PAGE_MASK) {
+ onepage:
+                 value = cpu_memoryread_w(paddr[0]);
+                 result = (*func)(value, arg);
+                 cpu_memorywrite_w(paddr[0], (UINT16)result);
+                 return value;
+         }
+         paddr[1] = paging(laddr + 1, ucrw);
+ separate:
+         value = cpu_memoryread_b(paddr[0]);
+         value += (UINT16)cpu_memoryread_b(paddr[1]) << 8;
+         result = (*func)(value, arg);
+         cpu_memorywrite(paddr[0], (UINT8)result);
+         cpu_memorywrite(paddr[1], (UINT8)(result >> 8));
+         return value;
+ }
  UINT32 MEMCALL
- cpu_linear_memory_read(UINT32 laddr, UINT length, int crw, int user_mode)
+ cpu_memory_access_la_RMW_d(UINT32 laddr, UINT32 (CPUCALL *func)(UINT32, void *), void *arg)
+ {
+         const int ucrw = CPU_PAGE_WRITE_DATA | CPU_STAT_USER_MODE;
+         struct tlb_entry *ep[2];
+         UINT32 paddr[2];
+         UINT32 result;
+         UINT32 value;
+         int remain;
+         /* TLB */
+         ep[0] = tlb_lookup(laddr, ucrw);
+         if (ep[0] != NULL) {
+                 paddr[0] = ep[0]->paddr + (laddr & PAGE_MASK);
+                 remain = PAGE_SIZE - (laddr & PAGE_MASK);
+                 if (remain >= 4)
+                         goto onepage;
+                 ep[1] = tlb_lookup(laddr + remain, ucrw);
+                 if (ep[1] != NULL) {
+                         paddr[1] = ep[1]->paddr + (laddr & PAGE_MASK);
+                         goto separate;
+                 }
+         }
+         /* paging */
+         paddr[0] = paging(laddr, ucrw);
+         remain = PAGE_SIZE - (laddr & PAGE_MASK);
+         if (remain >= 4) {
+ onepage:
+                 value = cpu_memoryread_d(paddr[0]);
+                 result = (*func)(value, arg);
+                 cpu_memorywrite_d(paddr[0], result);
+                 return value;
+         }
+         paddr[1] = paging(laddr + remain, ucrw);
+ separate:
+         switch (remain) {
+         case 3:
+                 value = cpu_memoryread(paddr[0]);
+                 value += (UINT32)cpu_memoryread_w(paddr[0] + 1) << 8;
+                 value += (UINT32)cpu_memoryread(paddr[1]) << 24;
+                 result = (*func)(value, arg);
+                 cpu_memorywrite(paddr[0], (UINT8)result);
+                 cpu_memorywrite_w(paddr[0] + 1, (UINT16)(result >> 8));
+                 cpu_memorywrite(paddr[1], (UINT8)(result >> 24));
+                 break;
+         case 2:
+                 value = cpu_memoryread_w(paddr[0]);
+                 value += (UINT32)cpu_memoryread_w(paddr[1]) << 16;
+                 result = (*func)(value, arg);
+                 cpu_memorywrite_w(paddr[0], (UINT16)result);
+                 cpu_memorywrite_w(paddr[1], (UINT16)(result >> 16));
+                 break;
+         case 1:
+                 value = cpu_memoryread(paddr[0]);
+                 value += (UINT32)cpu_memoryread_w(paddr[1]) << 8;
+                 value += (UINT32)cpu_memoryread(paddr[1] + 2) << 24;
+                 result = (*func)(value, arg);
+                 cpu_memorywrite(paddr[0], (UINT8)result);
+                 cpu_memorywrite_w(paddr[1], (UINT16)(result >> 8));
+                 cpu_memorywrite(paddr[1] + 2, (UINT8)(result >> 24));
+                 break;
+         default:
+                 ia32_panic("cpu_memory_access_la_RMW_d: out of range (remain=%d)\n", remain);
+                 value = 0;      /* XXX compiler happy */
+                 break;
+         }
+         return value;
+ }
+ /* read */
+ UINT8 MEMCALL
+ cpu_linear_memory_read_b(UINT32 laddr, int ucrw)
  {
-         UINT32 value = 0;
+         struct tlb_entry *ep;
          UINT32 paddr;
-         UINT remain;    /* page remain */
-         UINT r;
-         int shift = 0;
-         /* XXX: 4MB pages... */
+         /* TLB */
-         remain = 0x1000 - (laddr & 0x00000fff);
+         ep = tlb_lookup(laddr, ucrw);
-         for (;;) {
+         if (ep != NULL) {
-                 paddr = paging(laddr, crw, user_mode);
+                 paddr = ep->paddr + (laddr & PAGE_MASK);
+                 return cpu_memoryread(paddr);
+         }
-                 r = (remain > length) ? length : remain;
+         /* paging */
-                 switch (r) {
+         paddr = paging(laddr, ucrw);
-                 case 4:
+         return cpu_memoryread(paddr);
-                         value = cpu_memoryread_d(paddr);
+ }
-                         break;
-                 case 3:
+ UINT16 MEMCALL
-                         value += (UINT32)cpu_memoryread(paddr) << shift;
+ cpu_linear_memory_read_w(UINT32 laddr, int ucrw)
-                         shift += 8;
+ {
-                         paddr++;
+         struct tlb_entry *ep[2];
-                         /*FALLTHROUGH*/
+         UINT32 paddr[2];
-                 case 2:
+         UINT16 value;
-                         value += (UINT32)cpu_memoryread_w(paddr) << shift;
-                         shift += 16;
+         /* TLB */
-                         break;
+         ep[0] = tlb_lookup(laddr, ucrw);
+         if (ep[0] != NULL) {
+                 paddr[0] = ep[0]->paddr + (laddr & PAGE_MASK);
+                 if ((laddr + 1) & PAGE_MASK)
+                         return cpu_memoryread_w(paddr[0]);
+                 ep[1] = tlb_lookup(laddr + 1, ucrw);
+                 if (ep[1] != NULL) {
+                         paddr[1] = ep[1]->paddr;
+                         goto separate;
+                 }
+         }
-                 case 1:
+         /* paging */
-                         value += (UINT32)cpu_memoryread(paddr) << shift;
+         paddr[0] = paging(laddr, ucrw);
-                         shift += 8;
+         if ((laddr + 1) & PAGE_MASK)
-                         break;
+                 return cpu_memoryread_w(paddr[0]);
+         paddr[1] = paging(laddr + 1, ucrw);
+ separate:
+         value = cpu_memoryread_b(paddr[0]);
+         value += (UINT16)cpu_memoryread_b(paddr[1]) << 8;
+         return value;
+ }
-                 default:
+ UINT32 MEMCALL
-                         ia32_panic("cpu_linear_memory_read(): out of range (r = %d)\n", r);
+ cpu_linear_memory_read_d(UINT32 laddr, int ucrw)
-                         break;
+ {
+         struct tlb_entry *ep[2];
+         UINT32 paddr[2];
+         UINT32 value;
+         UINT remain;
+         /* TLB */
+         ep[0] = tlb_lookup(laddr, ucrw);
+         if (ep[0] != NULL) {
+                 paddr[0] = ep[0]->paddr + (laddr & PAGE_MASK);
+                 remain = PAGE_SIZE - (laddr & PAGE_MASK);
+                 if (remain >= sizeof(value))
+                         return cpu_memoryread_d(paddr[0]);
+                 ep[1] = tlb_lookup(laddr + remain, ucrw);
+                 if (ep[1] != NULL) {
+                         paddr[1] = ep[1]->paddr;
+                         goto separate;
                  }
+         }
-                 length -= r;
+         /* paging */
-                 if (length == 0)
+         paddr[0] = paging(laddr, ucrw);
-                         break;
+         remain = PAGE_SIZE - (laddr & PAGE_MASK);
+         if (remain >= sizeof(value))
+                 return cpu_memoryread_d(paddr[0]);
+         paddr[1] = paging(laddr + remain, ucrw);
+ separate:
+         switch (remain) {
+         case 3:
+                 value = cpu_memoryread(paddr[0]);
+                 value += (UINT32)cpu_memoryread_w(paddr[0] + 1) << 8;
+                 value += (UINT32)cpu_memoryread(paddr[1]) << 24;
+                 break;
+         case 2:
+                 value = cpu_memoryread_w(paddr[0]);
+                 value += (UINT32)cpu_memoryread_w(paddr[1]) << 16;
+                 break;
+         case 1:
+                 value = cpu_memoryread(paddr[0]);
+                 value += (UINT32)cpu_memoryread_w(paddr[1]) << 8;
+                 value += (UINT32)cpu_memoryread(paddr[1] + 2) << 24;
+                 break;
+         default:
+                 ia32_panic("cpu_linear_memory_read_d: out of range (remain=%d)\n", remain);
+                 value = 0;      /* XXX compiler happy */
+                 break;
+         }
+         return value;
+ }
-                 laddr += r;
+ UINT64 MEMCALL
-                 remain -= r;
+ cpu_linear_memory_read_q(UINT32 laddr, int ucrw)
-                 if (remain <= 0) {
+ {
-                         /* next page */
+         struct tlb_entry *ep[2];
-                         remain += 0x1000;
+         UINT32 paddr[2];
+         UINT64 value;
+         UINT remain;
+         /* TLB */
+         ep[0] = tlb_lookup(laddr, ucrw);
+         if (ep[0] != NULL) {
+                 paddr[0] = ep[0]->paddr + (laddr & PAGE_MASK);
+                 remain = PAGE_SIZE - (laddr & PAGE_MASK);
+                 if (remain >= sizeof(value))
+                         return cpu_memoryread_d(paddr[0]);
+                 ep[1] = tlb_lookup(laddr + remain, ucrw);
+                 if (ep[1] != NULL) {
+                         paddr[1] = ep[1]->paddr;
+                         goto separate;
+                 }
+         }
+         /* paging */
+         paddr[0] = paging(laddr, ucrw);
+         remain = PAGE_SIZE - (laddr & PAGE_MASK);
+         if (remain >= sizeof(value))
+                 return cpu_memoryread_q(paddr[0]);
+         paddr[1] = paging(laddr + remain, ucrw);
+ separate:
+         switch (remain) {
+         case 7:
+                 value = cpu_memoryread(paddr[0]);
+                 value += (UINT64)cpu_memoryread_w(paddr[0] + 1) << 8;
+                 value += (UINT64)cpu_memoryread_d(paddr[0] + 3) << 24;
+                 value += (UINT64)cpu_memoryread(paddr[1]) << 56;
+                 break;
+         case 6:
+                 value = cpu_memoryread_w(paddr[0]);
+                 value += (UINT64)cpu_memoryread_d(paddr[0] + 2) << 16;
+                 value += (UINT64)cpu_memoryread_w(paddr[1]) << 48;
+                 break;
+         case 5:
+                 value = cpu_memoryread(paddr[0]);
+                 value += (UINT64)cpu_memoryread_d(paddr[0] + 1) << 8;
+                 value += (UINT64)cpu_memoryread_w(paddr[1]) << 40;
+                 value += (UINT64)cpu_memoryread(paddr[1] + 2) << 56;
+                 break;
+         case 4:
+                 value = cpu_memoryread_d(paddr[0]);
+                 value += (UINT64)cpu_memoryread_d(paddr[1]) << 32;
+                 break;
+         case 3:
+                 value = cpu_memoryread(paddr[0]);
+                 value += (UINT64)cpu_memoryread_w(paddr[0] + 1) << 8;
+                 value += (UINT64)cpu_memoryread_d(paddr[1]) << 24;
+                 value += (UINT64)cpu_memoryread(paddr[1] + 4) << 56;
+                 break;
+         case 2:
+                 value = cpu_memoryread_w(paddr[0]);
+                 value += (UINT64)cpu_memoryread_d(paddr[1]) << 16;
+                 value += (UINT64)cpu_memoryread_w(paddr[1] + 4) << 48;
+                 break;
+         case 1:
+                 value = cpu_memoryread(paddr[0]);
+                 value += (UINT64)cpu_memoryread_d(paddr[1]) << 8;
+                 value += (UINT64)cpu_memoryread_w(paddr[1] + 4) << 40;
+                 value += (UINT64)cpu_memoryread(paddr[1] + 6) << 56;
+                 break;
+         default:
+                 ia32_panic("cpu_linear_memory_read_q: out of range (remain=%d)\n", remain);
+                 value = 0;      /* XXX compiler happy */
+                 break;
+         }
+         return value;
+ }
+ REG80 MEMCALL
+ cpu_linear_memory_read_f(UINT32 laddr, int ucrw)
+ {
+         struct tlb_entry *ep[2];
+         UINT32 paddr[2];
+         REG80 value;
+         UINT remain;
+         UINT i, j;
+         /* TLB */
+         ep[0] = tlb_lookup(laddr, ucrw);
+         if (ep[0] != NULL) {
+                 paddr[0] = ep[0]->paddr + (laddr & PAGE_MASK);
+                 remain = PAGE_SIZE - (laddr & PAGE_MASK);
+                 if (remain >= sizeof(value))
+                         return cpu_memoryread_f(paddr[0]);
+                 ep[1] = tlb_lookup(laddr + remain, ucrw);
+                 if (ep[1] != NULL) {
+                         paddr[1] = ep[1]->paddr;
+                         goto separate;
                  }
          }
+         /* paging */
+         paddr[0] = paging(laddr, ucrw);
+         remain = PAGE_SIZE - (laddr & PAGE_MASK);
+         if (remain >= sizeof(value))
+                 return cpu_memoryread_f(paddr[0]);
+         paddr[1] = paging(laddr + remain, ucrw);
+ separate:
+         for (i = 0; i < remain; ++i) {
+                 value.b[i] = cpu_memoryread(paddr[0] + i);
+         }
+         for (j = 0; i < 10; ++i, ++j) {
+                 value.b[i] = cpu_memoryread(paddr[1] + j);
+         }
          return value;
  }
+ /* write */
  void MEMCALL
- cpu_linear_memory_write(UINT32 laddr, UINT32 value, UINT length, int user_mode)
+ cpu_linear_memory_write_b(UINT32 laddr, UINT8 value, int ucrw)
  {
+         struct tlb_entry *ep;
          UINT32 paddr;
-         UINT remain;    /* page remain */
-         UINT r;
-         int crw = (CPU_PAGE_WRITE|CPU_PAGE_DATA);
-         /* XXX: 4MB pages... */
+         /* TLB */
-         remain = 0x1000 - (laddr & 0x00000fff);
+         ep = tlb_lookup(laddr, ucrw);
-         for (;;) {
+         if (ep != NULL) {
-                 paddr = paging(laddr, crw, user_mode);
+                 paddr = ep->paddr + (laddr & PAGE_MASK);
+                 cpu_memorywrite(paddr, value);
+                 return;
+         }
-                 r = (remain > length) ? length : remain;
+         /* paging */
-                 switch (r) {
+         paddr = paging(laddr, ucrw);
-                 case 4:
+         cpu_memorywrite(paddr, value);
-                         cpu_memorywrite_d(paddr, value);
+ }
-                         break;
-                 case 3:
+ void MEMCALL
-                         cpu_memorywrite(paddr, value & 0xff);
+ cpu_linear_memory_write_w(UINT32 laddr, UINT16 value, int ucrw)
-                         value >>= 8;
+ {
-                         paddr++;
+         struct tlb_entry *ep[2];
-                         /*FALLTHROUGH*/
+         UINT32 paddr[2];
-                 case 2:
-                         cpu_memorywrite_w(paddr, value & 0xffff);
-                         value >>= 16;
-                         break;
-                 case 1:
+         /* TLB */
-                         cpu_memorywrite(paddr, value & 0xff);
+         ep[0] = tlb_lookup(laddr, ucrw);
-                         value >>= 8;
+         if (ep[0] != NULL) {
-                         break;
+                 paddr[0] = ep[0]->paddr + (laddr & PAGE_MASK);
+                 if ((laddr + 1) & PAGE_MASK) {
+                         cpu_memorywrite_w(paddr[0], value);
+                         return;
+                 }
-                 default:
+                 ep[1] = tlb_lookup(laddr + 1, ucrw);
-                         ia32_panic("cpu_linear_memory_write(): out of range (r = %d)\n", r);
+                 if (ep[1] != NULL) {
-                         break;
+                         paddr[1] = ep[1]->paddr;
+                         goto separate;
                  }
+         }
-                 length -= r;
+         /* paging */
-                 if (length == 0)
+         paddr[0] = paging(laddr, ucrw);
-                         break;
+         if ((laddr + 1) & PAGE_MASK) {
+                 cpu_memorywrite_w(paddr[0], value);
+                 return;
+         }
-                 laddr += r;
+         paddr[1] = paging(laddr + 1, ucrw);
-                 remain -= r;
+ separate:
-                 if (remain <= 0) {
+         cpu_memorywrite(paddr[0], (UINT8)value);
-                         /* next page */
+         cpu_memorywrite(paddr[1], (UINT8)(value >> 8));
-                         remain += 0x1000;
+ }
+ void MEMCALL
+ cpu_linear_memory_write_d(UINT32 laddr, UINT32 value, int ucrw)
+ {
+         struct tlb_entry *ep[2];
+         UINT32 paddr[2];
+         UINT remain;
+         /* TLB */
+         ep[0] = tlb_lookup(laddr, ucrw);
+         if (ep[0] != NULL) {
+                 paddr[0] = ep[0]->paddr + (laddr & PAGE_MASK);
+                 remain = PAGE_SIZE - (laddr & PAGE_MASK);
+                 if (remain >= sizeof(value)) {
+                         cpu_memorywrite_d(paddr[0], value);
+                         return;
+                 }
+                 ep[1] = tlb_lookup(laddr + remain, ucrw);
+                 if (ep[1] != NULL) {
+                         paddr[1] = ep[1]->paddr;
+                         goto separate;
+                 }
+         }
+         /* paging */
+         paddr[0] = paging(laddr, ucrw);
+         remain = PAGE_SIZE - (laddr & PAGE_MASK);
+         if (remain >= sizeof(value)) {
+                 cpu_memorywrite_d(paddr[0], value);
+                 return;
+         }
+         paddr[1] = paging(laddr + remain, ucrw);
+ separate:
+         switch (remain) {
+         case 3:
+                 cpu_memorywrite(paddr[0], (UINT8)value);
+                 cpu_memorywrite_w(paddr[0] + 1, (UINT16)(value >> 8));
+                 cpu_memorywrite(paddr[1], (UINT8)(value >> 24));
+                 break;
+         case 2:
+                 cpu_memorywrite_w(paddr[0], (UINT16)value);
+                 cpu_memorywrite_w(paddr[1], (UINT16)(value >> 16));
+                 break;
+         case 1:
+                 cpu_memorywrite(paddr[0], (UINT8)value);
+                 cpu_memorywrite_w(paddr[1], (UINT16)(value >> 8));
+                 cpu_memorywrite(paddr[1] + 2, (UINT8)(value >> 24));
+                 break;
+         default:
+                 ia32_panic("cpu_linear_memory_write_d: out of range (remain=%d)\n", remain);
+                 break;
+         }
+ }
+ void MEMCALL
+ cpu_linear_memory_write_q(UINT32 laddr, UINT64 value, int ucrw)
+ {
+         struct tlb_entry *ep[2];
+         UINT32 paddr[2];
+         UINT remain;
+         /* TLB */
+         ep[0] = tlb_lookup(laddr, ucrw);
+         if (ep[0] != NULL) {
+                 paddr[0] = ep[0]->paddr + (laddr & PAGE_MASK);
+                 remain = PAGE_SIZE - (laddr & PAGE_MASK);
+                 if (remain >= sizeof(value)) {
+                         cpu_memorywrite_q(paddr[0], value);
+                         return;
+                 }
+                 ep[1] = tlb_lookup(laddr + remain, ucrw);
+                 if (ep[1] != NULL) {
+                         paddr[1] = ep[1]->paddr;
+                         goto separate;
+                 }
+         }
+         /* paging */
+         paddr[0] = paging(laddr, ucrw);
+         remain = PAGE_SIZE - (laddr & PAGE_MASK);
+         if (remain >= sizeof(value)) {
+                 cpu_memorywrite_q(paddr[0], value);
+                 return;
+         }
+         paddr[1] = paging(laddr + remain, ucrw);
+ separate:
+         switch (remain) {
+         case 7:
+                 cpu_memorywrite(paddr[0], (UINT8)value);
+                 cpu_memorywrite_w(paddr[0] + 1, (UINT16)(value >> 8));
+                 cpu_memorywrite_d(paddr[0] + 3, (UINT32)(value >> 24));
+                 cpu_memorywrite(paddr[1], (UINT8)(value >> 56));
+                 break;
+         case 6:
+                 cpu_memorywrite_w(paddr[0], (UINT16)value);
+                 cpu_memorywrite_d(paddr[0] + 2, (UINT32)(value >> 16));
+                 cpu_memorywrite_w(paddr[1], (UINT16)(value >> 48));
+                 break;
+         case 5:
+                 cpu_memorywrite(paddr[0], (UINT8)value);
+                 cpu_memorywrite_d(paddr[0] + 1, (UINT32)(value >> 8));
+                 cpu_memorywrite_w(paddr[1], (UINT16)(value >> 40));
+                 cpu_memorywrite(paddr[1] + 2, (UINT8)(value >> 56));
+                 break;
+         case 4:
+                 cpu_memorywrite_d(paddr[0], (UINT32)value);
+                 cpu_memorywrite_d(paddr[1], (UINT32)(value >> 32));
+                 break;
+         case 3:
+                 cpu_memorywrite(paddr[0], (UINT8)value);
+                 cpu_memorywrite_w(paddr[0] + 1, (UINT16)(value >> 8));
+                 cpu_memorywrite_d(paddr[1], (UINT32)(value >> 24));
+                 cpu_memorywrite(paddr[1] + 4, (UINT8)(value >> 56));
+                 break;
+         case 2:
+                 cpu_memorywrite_w(paddr[0], (UINT16)value);
+                 cpu_memorywrite_d(paddr[1], (UINT32)(value >> 16));
+                 cpu_memorywrite_w(paddr[1] + 4, (UINT16)(value >> 48));
+                 break;
+         case 1:
+                 cpu_memorywrite(paddr[0], (UINT8)value);
+                 cpu_memorywrite_d(paddr[1], (UINT32)(value >> 8));
+                 cpu_memorywrite_w(paddr[1] + 4, (UINT16)(value >> 40));
+                 cpu_memorywrite(paddr[1] + 6, (UINT8)(value >> 56));
+                 break;
+         default:
+                 ia32_panic("cpu_linear_memory_write_q: out of range (remain=%d)\n", remain);
+                 break;
+         }
+ }
+ void MEMCALL
+ cpu_linear_memory_write_f(UINT32 laddr, const REG80 *value, int ucrw)
+ {
+         struct tlb_entry *ep[2];
+         UINT32 paddr[2];
+         UINT remain;
+         UINT i, j;
+         /* TLB */
+         ep[0] = tlb_lookup(laddr, ucrw);
+         if (ep[0] != NULL) {
+                 paddr[0] = ep[0]->paddr + (laddr & PAGE_MASK);
+                 remain = PAGE_SIZE - (laddr & PAGE_MASK);
+                 if (remain >= sizeof(value)) {
+                         cpu_memorywrite_f(paddr[0], value);
+                         return;
+                 }
+                 ep[1] = tlb_lookup(laddr + remain, ucrw);
+                 if (ep[1] != NULL) {
+                         paddr[1] = ep[1]->paddr;
+                         goto separate;
                  }
          }
+         /* paging */
+         paddr[0] = paging(laddr, ucrw);
+         remain = PAGE_SIZE - (laddr & PAGE_MASK);
+         if (remain >= sizeof(value)) {
+                 cpu_memorywrite_f(paddr[0], value);
+                 return;
+         }
+         paddr[1] = paging(laddr + remain, ucrw);
+ separate:
+         for (i = 0; i < remain; ++i) {
+                 cpu_memorywrite(paddr[0] + i, value->b[i]);
+         }
+         for (j = 0; i < 10; ++i, ++j) {
+                 cpu_memorywrite(paddr[1] + j, value->b[i]);
+         }
  }
+ /*
+  * linear address memory access function
+  */
  void MEMCALL
- paging_check(UINT32 laddr, UINT length, int crw, int user_mode)
+ cpu_memory_access_la_region(UINT32 laddr, UINT length, int ucrw, UINT8 *data)
  {
          UINT32 paddr;
          UINT remain;    /* page remain */
          UINT r;
-         /* XXX: 4MB pages... */
+         if (length == 0)
-         remain = 0x1000 - (laddr & 0x00000fff);
+                 return;
+         remain = PAGE_SIZE - (laddr & PAGE_MASK);
          for (;;) {
-                 paddr = paging(laddr, crw, user_mode);
+                 if (!CPU_STAT_PAGING) {
+                         paddr = laddr;
+                 } else {
+                         paddr = paging(laddr, ucrw);
+                 }
                  r = (remain > length) ? length : remain;
+                 if (!(ucrw & CPU_PAGE_WRITE)) {
+                         cpu_memoryread_region(paddr, data, r);
+                 } else {
+                         cpu_memorywrite_region(paddr, data, r);
+                 }
                  length -= r;
                  if (length == 0)
                          break;
+                 data += r;
                  laddr += r;
                  remain -= r;
                  if (remain <= 0) {
                          /* next page */
-                         remain += 0x1000;
+                         remain += PAGE_SIZE;
                  }
          }
  }
- static UINT32
+ UINT32 MEMCALL
- paging(UINT32 laddr, int crw, int user_mode)
+ laddr2paddr(UINT32 laddr, int ucrw)
+ {
+         return paging(laddr, ucrw);
+ }
+ /*
+  * paging
+  */
+ static UINT32 MEMCALL
+ paging(UINT32 laddr, int ucrw)
  {
          UINT32 paddr;           /* physical address */
          UINT32 pde_addr;        /* page directory entry address */
- Line 335  paging(UINT32 laddr, int crw, int user_m
+ Line 882  paging(UINT32 laddr, int crw, int user_m
          UINT32 pte;             /* page table entry */
          UINT bit;
          UINT err;
+         struct tlb_entry *ep;
- #if defined(IA32_SUPPORT_TLB)
+         ep = tlb_lookup(laddr, ucrw);
-         if (tlb_lookup(laddr, crw, &paddr))
+         if (ep != NULL)
-                 return paddr;
+                 return ep->paddr + (laddr & PAGE_MASK);
- #endif  /* IA32_SUPPORT_TLB */
          pde_addr = CPU_STAT_PDE_BASE + ((laddr >> 20) & 0xffc);
          pde = cpu_memoryread_d(pde_addr);
- Line 355  paging(UINT32 laddr, int crw, int user_m
+ Line 902  paging(UINT32 laddr, int crw, int user_m
                  cpu_memorywrite_d(pde_addr, pde);
          }
- #if CPU_FAMILY >= 5
+         pte_addr = (pde & CPU_PDE_BASEADDR_MASK) + ((laddr >> 10) & 0xffc);
-         /* no support PAE */
+         pte = cpu_memoryread_d(pte_addr);
-         __ASSERT(!(CPU_CR4 & CPU_CR4_PAE));
+         if (!(pte & CPU_PTE_PRESENT)) {
+                 VERBOSE(("paging: page is not present"));
-         if ((CPU_CR4 & CPU_CR4_PSE) && (pde & CPU_PDE_PAGE_SIZE)) {
+                 VERBOSE(("paging: laddr = 0x%08x, pde_addr = 0x%08x, pde = 0x%08x", laddr, pde_addr, pde));
-                 /* 4MB page size */
+                 VERBOSE(("paging: pte_addr = 0x%08x, pte = 0x%08x", pte_addr, pte));
+                 err = 0;
-                 /* fake PTE bit */
+                 goto pf_exception;
-                 pte = pde | CPU_PTE_DIRTY;
+         }
-                 pte_addr = 0;   /* compiler happy */
+         if (!(pte & CPU_PTE_ACCESS)) {
+                 pte |= CPU_PTE_ACCESS;
-                 /* make physical address */
+                 cpu_memorywrite_d(pte_addr, pte);
-                 paddr = (pde & CPU_PDE_4M_BASEADDR_MASK) + (laddr & 0x003fffff);
-         } else
- #endif  /* CPU_FAMILY >= 5 */
-         {
-                 /* 4KB page size */
-                 pte_addr = (pde & CPU_PDE_BASEADDR_MASK) + ((laddr >> 10) & 0xffc);
-                 pte = cpu_memoryread_d(pte_addr);
-                 if (!(pte & CPU_PTE_PRESENT)) {
-                         VERBOSE(("paging: page 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;
-                         goto pf_exception;
-                 }
-                 if (!(pte & CPU_PTE_ACCESS)) {
-                         pte |= CPU_PTE_ACCESS;
-                         cpu_memorywrite_d(pte_addr, pte);
-                 }
-                 /* make physical address */
-                 paddr = (pte & CPU_PTE_BASEADDR_MASK) + (laddr & 0x00000fff);
          }
-         bit  = crw & CPU_PAGE_WRITE;
+         /* make physical address */
+         paddr = (pte & CPU_PTE_BASEADDR_MASK) + (laddr & PAGE_MASK);
+         bit  = ucrw & (CPU_PAGE_WRITE|CPU_PAGE_USER_MODE);
          bit |= (pde & pte & (CPU_PTE_WRITABLE|CPU_PTE_USER_MODE));
-         bit |= (user_mode << 3);
          bit |= CPU_STAT_WP;
  #if !defined(USE_PAGE_ACCESS_TABLE)
- Line 409  paging(UINT32 laddr, int crw, int user_m
+ Line 937  paging(UINT32 laddr, int crw, int user_m
                  goto pf_exception;
          }
-         if ((crw & CPU_PAGE_WRITE) && !(pte & CPU_PTE_DIRTY)) {
+         if ((ucrw & CPU_PAGE_WRITE) && !(pte & CPU_PTE_DIRTY)) {
                  pte |= CPU_PTE_DIRTY;
                  cpu_memorywrite_d(pte_addr, pte);
          }
- #if defined(IA32_SUPPORT_TLB)
+         tlb_update(laddr, pte, (bit & (CPU_PTE_WRITABLE|CPU_PTE_USER_MODE)) + ((ucrw & CPU_PAGE_CODE) ? 1 : 0));
-         tlb_update(paddr, pte, crw);
- #endif  /* IA32_SUPPORT_TLB */
          return paddr;
  pf_exception:
          CPU_CR2 = laddr;
-         err |= ((crw & CPU_PAGE_WRITE) << 1) | (user_mode << 2);
+         err |= (ucrw & CPU_PAGE_WRITE) << 1;
+         err |= (ucrw & CPU_PAGE_USER_MODE) >> 1;
          EXCEPTION(PF_EXCEPTION, err);
          return 0;       /* compiler happy */
  }
- #if defined(IA32_SUPPORT_TLB)
  /*
   * TLB
   */
- typedef struct {
+ #define TLB_TAG_SHIFT           TLB_ENTRY_TAG_MAX_SHIFT
-         UINT8   valid;  /* TLB entry is valid */
+ #define TLB_TAG_MASK            (~((1 << TLB_TAG_SHIFT) - 1))
-         UINT8   global; /* this TLB entry is global */
+ #define TLB_GET_TAG_ADDR(ep)    ((ep)->tag & TLB_TAG_MASK)
-         UINT8   score;
+ #define TLB_SET_TAG_ADDR(ep, addr) \
-         UINT8   pad;
+ do { \
+         (ep)->tag &= ~TLB_TAG_MASK; \
-         UINT32  tag;
+         (ep)->tag |= (addr) & TLB_TAG_MASK; \
-         UINT32  mask;   /* 4K or 2M or 4M */
+ } while (/*CONSTCOND(*/ 0)
+ #define TLB_IS_VALID(ep)        ((ep)->tag & TLB_ENTRY_TAG_VALID)
+ #define TLB_SET_VALID(ep)       ((ep)->tag = TLB_ENTRY_TAG_VALID)
+ #define TLB_SET_INVALID(ep)     ((ep)->tag = 0)
+ #define TLB_IS_WRITABLE(ep)     ((ep)->tag & CPU_PTE_WRITABLE)
+ #define TLB_IS_USERMODE(ep)     ((ep)->tag & CPU_PTE_USER_MODE)
+ #define TLB_IS_DIRTY(ep)        ((ep)->tag & TLB_ENTRY_TAG_DIRTY)
+ #if (CPU_FEATURES & CPU_FEATURE_PGE) == CPU_FEATURE_PGE
+ #define TLB_IS_GLOBAL(ep)       ((ep)->tag & TLB_ENTRY_TAG_GLOBAL)
+ #else
+ #define TLB_IS_GLOBAL(ep)       0
+ #endif
-         UINT32  paddr;  /* physical addr */
+ #define TLB_SET_TAG_FLAGS(ep, entry, bit) \
- } TLB_ENTRY_T;
+ do { \
+         (ep)->tag |= (entry) & (CPU_PTE_GLOBAL_PAGE|CPU_PTE_DIRTY); \
+         (ep)->tag |= (bit) & (CPU_PTE_WRITABLE|CPU_PTE_USER_MODE); \
+ } while (/*CONSTCOND*/ 0)
+ #define NTLB            2       /* 0: DTLB, 1: ITLB */
+ #define NENTRY          (1 << 6)
+ #define TLB_ENTRY_SHIFT 12
+ #define TLB_ENTRY_MASK  (NENTRY - 1)
  typedef struct {
-         UINT8           kind;
+         struct tlb_entry entry[NENTRY];
- #define TLB_KIND_INSTRUCTION    (1 << 1)
+ } tlb_t;
- #define TLB_KIND_DATA           (1 << 2)
+ static tlb_t tlb[NTLB];
- #define TLB_KIND_COMBINE        (TLB_KIND_INSTRUCTION|TLB_KIND_DATA)
- #define TLB_KIND_SMALL          (1 << 3)
- #define TLB_KIND_LARGE          (1 << 4)
- #define TLB_KIND_BOTH           (TLB_KIND_SMALL|TLB_KIND_LARGE)
-         UINT8           way;    /* n-way associative */
-         UINT8           idx;    /* number of TLB index */
-         UINT8           bpad;
-         UINT16          num;    /* number of TLB entry */
-         UINT16          wpad;
-         TLB_ENTRY_T     *entry; /* entry[assoc][idx] or entry[assoc] if idx == 1*/
- } TLB_T;
- static int ntlb;
- static TLB_T tlb[4];    /* i TLB, i (lp) TLB, d TLB, d (lp) TLB */
- #if defined(IA32_PROFILE_TLB)
- /* profiling */
- static UINT64 tlb_hits;
- static UINT64 tlb_misses;
- static UINT64 tlb_lookups;
- static UINT64 tlb_updates;
- static UINT64 tlb_flushes;
- static UINT64 tlb_global_flushes;
- static UINT64 tlb_entry_flushes;
- #define PROFILE_INC(v)  (v)++;
- #else   /* !IA32_PROFILE_TLB */
- #define PROFILE_INC(v)
- #endif  /* IA32_PROFILE_TLB */
  void
  tlb_init(void)
  {
-         int i;
-         for (i = 0; i < NELEMENTS(tlb); i++) {
-                 if (tlb[i].entry) {
-                         free(tlb[i].entry);
-                 }
-         }
          memset(tlb, 0, sizeof(tlb));
- #if defined(IA32_PROFILE_TLB)
-         tlb_hits = 0;
-         tlb_misses = 0;
-         tlb_lookups = 0;
-         tlb_updates = 0;
-         tlb_flushes = 0;
-         tlb_global_flushes = 0;
-         tlb_entry_flushes = 0;
- #endif  /* IA32_PROFILE_TLB */
- #if CPU_FAMILY == 4
-         /* ﹜生﹜籉＞﹜奴﹜戊 i486 平民扑□﹜甘﹝玄 */
-         /* combine (I/D) TLB: 4KB Pages, 4-way set associative 32 entries */
-         ntlb = 1;
-         tlb[0].kind = TLB_KIND_COMBINE | TLB_KIND_SMALL;
-         tlb[0].num = 32;
-         tlb[0].way = 4;
- #endif
-         for (i = 0; i < ntlb; i++) {
-                 tlb[i].idx = tlb[i].num / tlb[i].way;
-                 tlb[i].entry = (TLB_ENTRY_T*)calloc(sizeof(TLB_ENTRY_T), tlb[i].num);
-                 if (tlb[i].entry == 0) {
-                         ia32_panic("tlb_init(): can't alloc TLB entry\n");
-                 }
-         }
  }
- void
+ void MEMCALL
  tlb_flush(BOOL allflush)
  {
-         TLB_ENTRY_T *ep;
+         struct tlb_entry *ep;
-         int i, j;
+         int i;
+         int n;
          if (allflush) {
-                 PROFILE_INC(tlb_global_flushes);
+                 tlb_init();
-         } else {
+                 return;
-                 PROFILE_INC(tlb_flushes);
          }
-         for (i = 0; i < ntlb; i++) {
+         for (n = 0; n < NTLB; n++) {
-                 ep = tlb[i].entry;
+                 for (i = 0; i < NENTRY ; i++) {
-                 for (j = 0; j < tlb[i].num; j++, ep++) {
+                         ep = &tlb[n].entry[i];
-                         if (ep->valid && (allflush || !ep->global)) {
+                         if (TLB_IS_VALID(ep) && !TLB_IS_GLOBAL(ep)) {
-                                 ep->valid = 0;
+                                 TLB_SET_INVALID(ep);
-                                 PROFILE_INC(tlb_entry_flushes);
                          }
                  }
          }
  }
- void
+ void MEMCALL
- tlb_flush_page(UINT32 vaddr)
+ tlb_flush_page(UINT32 laddr)
  {
-         TLB_ENTRY_T *ep;
+         struct tlb_entry *ep;
          int idx;
-         int i;
+         int n;
-         for (i = 0; i < ntlb; i++) {
+         idx = (laddr >> TLB_ENTRY_SHIFT) & TLB_ENTRY_MASK;
-                 if (tlb[i].idx == 1) {
-                         /* fully set associative */
-                         idx = 0;
-                 } else {
-                         if (tlb[i].kind & TLB_KIND_SMALL) {
-                                 idx = (vaddr >> 12) & (tlb[i].idx - 1);
-                         } else {
-                                 idx = (vaddr >> 22) & (tlb[i].idx - 1);
-                         }
-                 }
-                 /* search */
+         for (n = 0; n < NTLB; n++) {
-                 ep = &tlb[i].entry[idx * tlb[i].way];
+                 ep = &tlb[n].entry[idx];
-                 for (i = 0; i < tlb[i].way; i++) {
+                 if (TLB_IS_VALID(ep)) {
-                         if (ep->valid) {
+                         if ((laddr & TLB_TAG_MASK) == TLB_GET_TAG_ADDR(ep)) {
-                                 if ((vaddr & ep->mask) == ep->tag) {
+                                 TLB_SET_INVALID(ep);
-                                         ep->valid = 0;
-                                         PROFILE_INC(tlb_entry_flushes);
-                                         break;
-                                 }
                          }
                  }
          }
  }
- static BOOL
+ struct tlb_entry * MEMCALL
- tlb_lookup(UINT32 laddr, int crw, UINT32 *paddr)
+ tlb_lookup(UINT32 laddr, int ucrw)
  {
-         TLB_ENTRY_T *ep;
+         struct tlb_entry *ep;
+         UINT bit;
          int idx;
-         int i;
+         int n;
-         PROFILE_INC(tlb_lookups);
-         crw &= CPU_PAGE_CODE | CPU_PAGE_DATA;
-         for (i = 0; i < ntlb; i++) {
-                 if (tlb[i].kind & crw) {
-                         if (tlb[i].idx == 1) {
-                                 /* fully set associative */
-                                 idx = 0;
-                         } else {
-                                 if (tlb[i].kind & TLB_KIND_SMALL) {
-                                         idx = (laddr >> 12) & (tlb[i].idx - 1);
-                                 } else {
-                                         idx = (laddr >> 22) & (tlb[i].idx - 1);
-                                 }
-                         }
-                         /* search */
+         n = (ucrw & CPU_PAGE_CODE) ? 1 : 0;
-                         ep = &tlb[i].entry[idx * tlb[i].way];
+         idx = (laddr >> TLB_ENTRY_SHIFT) & TLB_ENTRY_MASK;
-                         for (i = 0; i < tlb[i].way; i++) {
+         ep = &tlb[n].entry[idx];
-                                 if (ep->valid) {
-                                         if ((laddr & ep->mask) == ep->tag) {
+         if (TLB_IS_VALID(ep)) {
-                                                 if (ep->score != (UINT8)~0)
+                 if ((laddr & TLB_TAG_MASK) == TLB_GET_TAG_ADDR(ep)) {
-                                                         ep->score++;
+                         bit = ucrw & (CPU_PAGE_WRITE|CPU_PAGE_USER_MODE);
-                                                 *paddr = ep->paddr;
+                         bit |= ep->tag & (CPU_PTE_WRITABLE|CPU_PTE_USER_MODE);
-                                                 PROFILE_INC(tlb_hits);
+                         bit |= CPU_STAT_WP;
-                                                 return TRUE;
+ #if !defined(USE_PAGE_ACCESS_TABLE)
-                                         }
+                         if ((page_access & (1 << bit)))
+ #else
+                         if (page_access_bit[bit])
+ #endif
+                         {
+                                 if (!(ucrw & CPU_PAGE_WRITE) || TLB_IS_DIRTY(ep)) {
+                                         return ep;
                                  }
                          }
                  }
          }
-         PROFILE_INC(tlb_misses);
+         return NULL;
-         return FALSE;
  }
- static void
+ static void MEMCALL
- tlb_update(UINT32 paddr, UINT entry, int crw)
+ tlb_update(UINT32 laddr, UINT entry, int bit)
  {
-         TLB_ENTRY_T *ep;
+         struct tlb_entry *ep;
          int idx;
-         int i, j;
+         int n;
-         int min_way;
-         UINT16 min_score = ~0;
-         PROFILE_INC(tlb_updates);
-         crw &= CPU_PAGE_CODE | CPU_PAGE_DATA;
-         for (i = 0; i < ntlb; i++) {
-                 if (tlb[i].kind & crw) {
-                         if (tlb[i].idx == 1) {
-                                 /* fully set associative */
-                                 idx = 0;
-                         } else {
-                                 /* n-way set associative */
-                                 if (!(entry & CPU_PDE_PAGE_SIZE)) {
-                                         if (!(tlb[i].kind & TLB_KIND_SMALL))
-                                                 continue;
-                                         idx = (entry >> 12) & (tlb[i].idx - 1);
-                                 } else {
-                                         if (!(tlb[i].kind & TLB_KIND_LARGE))
-                                                 continue;
-                                         idx = (entry >> 22) & (tlb[i].idx - 1);
-                                 }
-                         }
-                         /* search */
+         n = bit & 1;
-                         ep = &tlb[i].entry[idx * tlb[i].way];
+         idx = (laddr >> TLB_ENTRY_SHIFT) & TLB_ENTRY_MASK;
-                         for (min_way = 0, j = 0; j < tlb[i].way; j++, ep++) {
+         ep = &tlb[n].entry[idx];
-                                 if (ep->valid) {
-                                         if (min_score >= ep->score) {
+         TLB_SET_VALID(ep);
-                                                 min_way = j;
+         TLB_SET_TAG_ADDR(ep, laddr);
-                                                 min_score = ep->score;
+         TLB_SET_TAG_FLAGS(ep, entry, bit);
-                                         }
+         ep->paddr = entry & CPU_PTE_BASEADDR_MASK;
-                                 } else {
-                                         min_way = j;
-                                         min_score = 0;
-                                         break;
-                                 }
-                         }
-                         /* replace */
-                         ep = &tlb[i].entry[idx * tlb[i].way + min_way];
-                         ep->valid = 1;
-                         ep->global = (entry & CPU_PTE_GLOBAL_PAGE) ? 1 : 0;
-                         ep->score = 0;
-                         ep->mask = (entry & CPU_PDE_PAGE_SIZE) ?  CPU_PDE_4M_BASEADDR_MASK : CPU_PTE_BASEADDR_MASK;
-                         ep->tag = entry & ep->mask;
-                         ep->paddr = paddr;
-                         break;
-                 }
-         }
-         __ASSERT(i != ntlb);
  }
- #endif  /* IA32_SUPPORT_TLB */

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

Removed from v.1.12
changed lines
	Added in v.1.37