WebSVN – HelenOS – Diff – /trunk/kernel/arch/ppc32/src/mm/tlb.c

+ *
  * Try to find PTE for faulting address.
  * The as->lock must be held on entry to this function
  * if lock is true.
+ *
- * @param as       Address space.
+ * @param as        Address space.
- * @param lock     Lock/unlock the address space.
+ * @param lock      Lock/unlock the address space.
- * @param badvaddr Faulting virtual address.
+ * @param badvaddr  Faulting virtual address.
- * @param access   Access mode that caused the fault.
+ * @param access    Access mode that caused the fault.
- * @param istate   Pointer to interrupted state.
+ * @param istate    Pointer to interrupted state.
- * @param pfrc     Pointer to variable where as_page_fault() return code will be stored.
+ * @param pfrc      Pointer to variable where as_page_fault() return code
+ *          will be stored.
- * @return         PTE on success, NULL otherwise.
+ * @return      PTE on success, NULL otherwise.
+ *
  */
+static pte_t *
-static pte_t *find_mapping_and_check(as_t *as, bool lock, uintptr_t badvaddr, int access, istate_t *istate, int *pfrc)
+find_mapping_and_check(as_t *as, bool lock, uintptr_t badvaddr, int access,
+    istate_t *istate, int *pfrc)
+{
     /*
      * Check if the mapping exists in page tables.
      */
     pte_t *pte = page_mapping_find(as, badvaddr);
          * Mapping not found in page tables.
          * Resort to higher-level page fault handler.
          */
         page_table_unlock(as, lock);
         switch (rc = as_page_fault(badvaddr, access, istate)) {
-            case AS_PF_OK:
+        case AS_PF_OK:
-                /*
+            /*
-                 * The higher-level page fault handler succeeded,
+             * The higher-level page fault handler succeeded,
-                 * The mapping ought to be in place.
+             * The mapping ought to be in place.
-                 */
+             */
-                page_table_lock(as, lock);
+            page_table_lock(as, lock);
-                pte = page_mapping_find(as, badvaddr);
+            pte = page_mapping_find(as, badvaddr);
-                ASSERT((pte) && (pte->p));
+            ASSERT((pte) && (pte->p));
-                *pfrc = 0;
+            *pfrc = 0;
-                return pte;
+            return pte;
-            case AS_PF_DEFER:
+        case AS_PF_DEFER:
-                page_table_lock(as, lock);
+            page_table_lock(as, lock);
-                *pfrc = rc;
+            *pfrc = rc;
-                return NULL;
+            return NULL;
-            case AS_PF_FAULT:
+        case AS_PF_FAULT:
-                page_table_lock(as, lock);
+            page_table_lock(as, lock);
-                printf("Page fault.\n");
+            printf("Page fault.\n");
-                *pfrc = rc;
+            *pfrc = rc;
-                return NULL;
+            return NULL;
-            default:
+        default:
-                panic("unexpected rc (%d)\n", rc);
+            panic("unexpected rc (%d)\n", rc);
+        }
+    }
+}
     if (s)
         symbol = s;
     s = get_symtab_entry(istate->lr);
     if (s)
         sym2 = s;
-    panic("%p: PHT Refill Exception at %p (%s<-%s)\n", badvaddr, istate->pc, symbol, sym2);
+    panic("%p: PHT Refill Exception at %p (%s<-%s)\n", badvaddr,
+        istate->pc, symbol, sym2);
+}
 static void pht_insert(const uintptr_t vaddr, const pfn_t pfn)
+{
     bool found = false;
     /* Find unused or colliding
        PTE in PTEG */
     for (i = 0; i < 8; i++) {
-        if ((!phte[base + i].v) || ((phte[base + i].vsid == vsid) && (phte[base + i].api == api))) {
+        if ((!phte[base + i].v) || ((phte[base + i].vsid == vsid) &&
+            (phte[base + i].api == api))) {
             found = true;
             break;
+        }
+    }
         uint32_t base2 = (~hash & 0x3ff) << 3;
         /* Find unused or colliding
            PTE in PTEG */
         for (i = 0; i < 8; i++) {
+            if ((!phte[base2 + i].v) ||
-            if ((!phte[base2 + i].v) || ((phte[base2 + i].vsid == vsid) && (phte[base2 + i].api == api))) {
+                ((phte[base2 + i].vsid == vsid) &&
+                (phte[base2 + i].api == api))) {
                 found = true;
                 base = base2;
                 h = 1;
                 break;
+            }
     bool found = false;
     /* Find unused or colliding
        PTE in PTEG */
     for (i = 0; i < 8; i++) {
+        if ((!phte_physical[base + i].v) ||
-        if ((!phte_physical[base + i].v) || ((phte_physical[base + i].vsid == vsid) && (phte_physical[base + i].api == api))) {
+            ((phte_physical[base + i].vsid == vsid) &&
+            (phte_physical[base + i].api == api))) {
             found = true;
             break;
+        }
+    }
         uint32_t base2 = (~hash & 0x3ff) << 3;
         /* Find unused or colliding
            PTE in PTEG */
         for (i = 0; i < 8; i++) {
+            if ((!phte_physical[base2 + i].v) ||
-            if ((!phte_physical[base2 + i].v) || ((phte_physical[base2 + i].vsid == vsid) && (phte_physical[base2 + i].api == api))) {
+                ((phte_physical[base2 + i].vsid == vsid) &&
+                (phte_physical[base2 + i].api == api))) {
                 found = true;
                 base = base2;
                 h = 1;
                 break;
+            }
+}
 /** Process Instruction/Data Storage Interrupt
+ *
- * @param n Interrupt vector number.
+ * @param n     Interrupt vector number.
- * @param istate Interrupted register context.
+ * @param istate    Interrupted register context.
+ *
  */
 void pht_refill(int n, istate_t *istate)
+{
     uintptr_t badvaddr;
     } else
         badvaddr = istate->pc;
     page_table_lock(as, lock);
-    pte = find_mapping_and_check(as, lock, badvaddr, PF_ACCESS_READ /* FIXME */, istate, &pfrc);
+    pte = find_mapping_and_check(as, lock, badvaddr,
+        PF_ACCESS_READ /* FIXME */, istate, &pfrc);
     if (!pte) {
         switch (pfrc) {
-            case AS_PF_FAULT:
+        case AS_PF_FAULT:
-                goto fail;
+            goto fail;
-                break;
+            break;
-            case AS_PF_DEFER:
+        case AS_PF_DEFER:
-                /*
+            /*
-                 * The page fault came during copy_from_uspace()
+             * The page fault came during copy_from_uspace()
-                 * or copy_to_uspace().
+             * or copy_to_uspace().
-                 */
+             */
-                page_table_unlock(as, lock);
+            page_table_unlock(as, lock);
-                return;
+            return;
-            default:
+        default:
-                panic("Unexpected pfrc (%d)\n", pfrc);
+            panic("Unexpected pfrc (%d)\n", pfrc);
+        }
+    }
     pte->a = 1; /* Record access to PTE */
     pht_insert(badvaddr, pte->pfn);
+}
 /** Process Instruction/Data Storage Interrupt in Real Mode
+ *
- * @param n Interrupt vector number.
+ * @param n     Interrupt vector number.
- * @param istate Interrupted register context.
+ * @param istate    Interrupted register context.
+ *
  */
 bool pht_real_refill(int n, istate_t *istate)
+{
     uintptr_t badvaddr;
     );
     phte_t *phte = (phte_t *) PA2KA(sdr1 & 0xffff0000);
     uint32_t i;
     for (i = 0; i < 8192; i++) {
-        if ((phte[i].v) && (phte[i].vsid >= (asid << 4)) && (phte[i].vsid < ((asid << 4) + 16)))
+        if ((phte[i].v) && (phte[i].vsid >= (asid << 4)) &&
+            (phte[i].vsid < ((asid << 4) + 16)))
             phte[i].v = 0;
+    }
     tlb_invalidate_all();
+}
             length <<= 1; \
             tmp >>= 1; \
         } \
     } else \
         length = 0; \
-    printf(name ": page=%.*p frame=%.*p length=%d KB (mask=%#x)%s%s\n", sizeof(upper) * 2, upper & 0xffff0000, sizeof(lower) * 2, lower & 0xffff0000, length, mask, ((upper >> 1) & 1) ? " supervisor" : "", (upper & 1) ? " user" : "");
+    printf(name ": page=%.*p frame=%.*p length=%d KB (mask=%#x)%s%s\n", \
+        sizeof(upper) * 2, upper & 0xffff0000, sizeof(lower) * 2, \
+        lower & 0xffff0000, length, mask, \
+        ((upper >> 1) & 1) ? " supervisor" : "", \
+        (upper & 1) ? " user" : "");
 void tlb_print(void)
+{
     uint32_t sr;
         asm volatile (
             "mfsrin %0, %1\n"
             : "=r" (vsid)
             : "r" (sr << 28)
         );
+        printf("vsid[%d]: VSID=%.*p (ASID=%d)%s%s\n", sr,
-        printf("vsid[%d]: VSID=%.*p (ASID=%d)%s%s\n", sr, sizeof(vsid) * 2, vsid & 0xffffff, (vsid & 0xffffff) >> 4, ((vsid >> 30) & 1) ? " supervisor" : "", ((vsid >> 29) & 1) ? " user" : "");
+            sizeof(vsid) * 2, vsid & 0xffffff, (vsid & 0xffffff) >> 4,
+            ((vsid >> 30) & 1) ? " supervisor" : "",
+            ((vsid >> 29) & 1) ? " user" : "");
+    }
     uint32_t upper;
     uint32_t lower;
     uint32_t mask;

Subversion Repositories HelenOS

(root)/trunk/kernel/arch/ppc32/src/mm/tlb.c – Rev 2071 → 3193