From: AKASHI Takahiro <[email protected]>

Signed-off-by: AKASHI Takahiro <[email protected]>
---
 arm64.c | 120 ++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++----
 defs.h  |  25 +++++++++++++-
 2 files changed, 137 insertions(+), 8 deletions(-)

diff --git a/arm64.c b/arm64.c
index c16ea67..b6bfbf3 100644
--- a/arm64.c
+++ b/arm64.c
@@ -36,6 +36,7 @@ static int arm64_uvtop(struct task_context *, ulong, 
physaddr_t *, int);
 static int arm64_vtop_2level_64k(ulong, ulong, physaddr_t *, int);
 static int arm64_vtop_3level_64k(ulong, ulong, physaddr_t *, int);
 static int arm64_vtop_3level_4k(ulong, ulong, physaddr_t *, int);
+static int arm64_vtop_4level_4k(ulong, ulong, physaddr_t *, int);
 static ulong arm64_get_task_pgd(ulong);
 static void arm64_irq_stack_init(void);
 static void arm64_stackframe_init(void);
@@ -233,18 +234,26 @@ arm64_init(int when)
                switch (machdep->pagesize)
                {
                case 4096:
-                       machdep->flags |= VM_L3_4K;
                        machdep->ptrs_per_pgd = PTRS_PER_PGD_L3_4K;
                        if ((machdep->pgd = 
                            (char *)malloc(PTRS_PER_PGD_L3_4K * 8)) == NULL)
                                error(FATAL, "cannot malloc pgd space.");
+                       if (machdep->machspec->VA_BITS > PGDIR_SHIFT_L4_4K) {
+                               machdep->flags |= VM_L4_4K;
+                               if ((machdep->pud =
+                                   (char *)malloc(PTRS_PER_PUD_L4_4K * 8))
+                                   == NULL)
+                                       error(FATAL, "cannot malloc pud 
space.");
+                       } else {
+                               machdep->flags |= VM_L3_4K;
+                               machdep->pud = NULL;  /* not used */
+                       }
                        if ((machdep->pmd = 
                            (char *)malloc(PTRS_PER_PMD_L3_4K * 8)) == NULL)
                                error(FATAL, "cannot malloc pmd space.");
                        if ((machdep->ptbl = 
                            (char *)malloc(PTRS_PER_PTE_L3_4K * 8)) == NULL)
                                error(FATAL, "cannot malloc ptbl space.");
-                       machdep->pud = NULL;  /* not used */
                        break;
 
                case 65536:
@@ -282,8 +291,8 @@ arm64_init(int when)
                                error(FATAL, "cannot determine page size\n");
                }
 
-               machdep->last_pud_read = 0;  /* not used */
                machdep->last_pgd_read = 0;
+               machdep->last_pud_read = 0;
                machdep->last_pmd_read = 0;
                machdep->last_ptbl_read = 0;
                machdep->clear_machdep_cache = arm64_clear_machdep_cache;
@@ -462,6 +471,8 @@ arm64_dump_machdep_table(ulong arg)
                fprintf(fp, "%sVM_L3_64K", others++ ? "|" : "");
        if (machdep->flags & VM_L3_4K)
                fprintf(fp, "%sVM_L3_4K", others++ ? "|" : "");
+       if (machdep->flags & VM_L4_4K)
+               fprintf(fp, "%sVM_L4_4K", others++ ? "|" : "");
        if (machdep->flags & VMEMMAP)
                fprintf(fp, "%sVMEMMAP", others++ ? "|" : "");
        if (machdep->flags & KDUMP_ENABLED)
@@ -494,11 +505,15 @@ arm64_dump_machdep_table(ulong arg)
        fprintf(fp, "               uvtop: arm64_uvtop()->%s()\n",
                machdep->flags & VM_L3_4K ? 
                "arm64_vtop_3level_4k" :
+               machdep->flags & VM_L4_4K ?
+               "arm64_vtop_4level_4k" :
                machdep->flags & VM_L3_64K ?
                "arm64_vtop_3level_64k" : "arm64_vtop_2level_64k");
        fprintf(fp, "               kvtop: arm64_kvtop()->%s()\n",
                machdep->flags & VM_L3_4K ? 
                "arm64_vtop_3level_4k" :
+               machdep->flags & VM_L4_4K ?
+               "arm64_vtop_4level_4k" :
                machdep->flags & VM_L3_64K ?
                "arm64_vtop_3level_64k" : "arm64_vtop_2level_64k");
        fprintf(fp, "        get_task_pgd: arm64_get_task_pgd()\n");
@@ -531,8 +546,13 @@ arm64_dump_machdep_table(ulong arg)
         fprintf(fp, "  xendump_panic_task: (n/a)\n");
         fprintf(fp, "    get_xendump_regs: (n/a)\n");
        fprintf(fp, "   line_number_hooks: (not used)\n");
-       fprintf(fp, "       last_pud_read: (not used)\n");
        fprintf(fp, "       last_pgd_read: %lx\n", machdep->last_pgd_read);
+       fprintf(fp, "       last_pud_read: ");
+       if ((PAGESIZE() == 65536) ||
+           ((PAGESIZE() == 4096) && !(machdep->flags & VM_L4_4K)))
+               fprintf(fp, "(not used)\n");
+       else
+               fprintf(fp, "%lx\n", machdep->last_pud_read);
        fprintf(fp, "       last_pmd_read: ");
        if (PAGESIZE() == 65536)
                fprintf(fp, "(not used)\n");
@@ -541,6 +561,7 @@ arm64_dump_machdep_table(ulong arg)
        fprintf(fp, "      last_ptbl_read: %lx\n", machdep->last_ptbl_read);
        fprintf(fp, " clear_machdep_cache: arm64_clear_machdep_cache()\n");
        fprintf(fp, "                 pgd: %lx\n", (ulong)machdep->pgd);
+       fprintf(fp, "                 pud: %lx\n", (ulong)machdep->pud);
        fprintf(fp, "                 pmd: %lx\n", (ulong)machdep->pmd);
        fprintf(fp, "                ptbl: %lx\n", (ulong)machdep->ptbl);
        fprintf(fp, "        ptrs_per_pgd: %d\n", machdep->ptrs_per_pgd);
@@ -843,7 +864,7 @@ arm64_kvtop(struct task_context *tc, ulong kvaddr, 
physaddr_t *paddr, int verbos
        kernel_pgd = vt->kernel_pgd[0];
        *paddr = 0;
 
-       switch (machdep->flags & (VM_L2_64K|VM_L3_64K|VM_L3_4K))
+       switch (machdep->flags & (VM_L2_64K|VM_L3_64K|VM_L3_4K|VM_L4_4K))
        {
        case VM_L2_64K:
                return arm64_vtop_2level_64k(kernel_pgd, kvaddr, paddr, 
verbose);
@@ -851,6 +872,8 @@ arm64_kvtop(struct task_context *tc, ulong kvaddr, 
physaddr_t *paddr, int verbos
                return arm64_vtop_3level_64k(kernel_pgd, kvaddr, paddr, 
verbose);
        case VM_L3_4K:
                return arm64_vtop_3level_4k(kernel_pgd, kvaddr, paddr, verbose);
+       case VM_L4_4K:
+               return arm64_vtop_4level_4k(kernel_pgd, kvaddr, paddr, verbose);
        default:
                return FALSE;
        }
@@ -866,7 +889,7 @@ arm64_uvtop(struct task_context *tc, ulong uvaddr, 
physaddr_t *paddr, int verbos
 
        *paddr = 0;
 
-       switch (machdep->flags & (VM_L2_64K|VM_L3_64K|VM_L3_4K))
+       switch (machdep->flags & (VM_L2_64K|VM_L3_64K|VM_L3_4K|VM_L4_4K))
        {
        case VM_L2_64K:
                return arm64_vtop_2level_64k(user_pgd, uvaddr, paddr, verbose);
@@ -874,6 +897,8 @@ arm64_uvtop(struct task_context *tc, ulong uvaddr, 
physaddr_t *paddr, int verbos
                return arm64_vtop_3level_64k(user_pgd, uvaddr, paddr, verbose);
        case VM_L3_4K:
                return arm64_vtop_3level_4k(user_pgd, uvaddr, paddr, verbose);
+       case VM_L4_4K:
+               return arm64_vtop_4level_4k(user_pgd, uvaddr, paddr, verbose);
        default:
                return FALSE;
        }
@@ -1092,6 +1117,85 @@ no_page:
        return FALSE;
 }
 
+static int
+arm64_vtop_4level_4k(ulong pgd, ulong vaddr, physaddr_t *paddr, int verbose)
+{
+       ulong *pgd_base, *pgd_ptr, pgd_val;
+       ulong *pud_base, *pud_ptr, pud_val;
+       ulong *pmd_base, *pmd_ptr, pmd_val;
+       ulong *pte_base, *pte_ptr, pte_val;
+
+        if (verbose)
+                fprintf(fp, "PAGE DIRECTORY: %lx\n", pgd);
+
+       pgd_base = (ulong *)pgd;
+       FILL_PGD(pgd_base, KVADDR, PTRS_PER_PGD_L4_4K * sizeof(ulong));
+       pgd_ptr = pgd_base + (((vaddr) >> PGDIR_SHIFT_L4_4K) & 
(PTRS_PER_PGD_L4_4K - 1));
+        pgd_val = ULONG(machdep->pgd + PGDIR_OFFSET(pgd_ptr));
+        if (verbose)
+                fprintf(fp, "   PGD: %lx => %lx\n", (ulong)pgd_ptr, pgd_val);
+       if (!pgd_val)
+               goto no_page;
+
+       pud_base = (ulong *)PTOV(pgd_val & PHYS_MASK & PGDIR_MASK);
+
+       FILL_PUD(pud_base, KVADDR, PTRS_PER_PUD_L4_4K * sizeof(ulong));
+       pud_ptr = pud_base + (((vaddr) >> PUD_SHIFT_L4_4K) & 
(PTRS_PER_PUD_L4_4K - 1));
+        pud_val = ULONG(machdep->pud + PAGEOFFSET(pud_ptr));
+        if (verbose)
+                fprintf(fp, "   PUD: %lx => %lx\n", (ulong)pud_ptr, pud_val);
+       if (!pud_val)
+               goto no_page;
+
+       pmd_base = (ulong *)PTOV(pud_val & PHYS_MASK & (s32)machdep->pagemask);
+       FILL_PMD(pmd_base, KVADDR, PTRS_PER_PMD_L4_4K * sizeof(ulong));
+       pmd_ptr = pmd_base + (((vaddr) >> PMD_SHIFT_L4_4K) & 
(PTRS_PER_PMD_L4_4K - 1));
+        pmd_val = ULONG(machdep->pmd + PAGEOFFSET(pmd_ptr));
+        if (verbose)
+                fprintf(fp, "   PMD: %lx => %lx\n", (ulong)pmd_ptr, pmd_val);
+       if (!pmd_val)
+               goto no_page;
+
+       if ((pmd_val & PMD_TYPE_MASK) == PMD_TYPE_SECT) {
+               ulong sectionbase = (pmd_val & SECTION_PAGE_MASK_2MB) & 
PHYS_MASK;
+               if (verbose) {
+                       fprintf(fp, "  PAGE: %lx  (2MB)\n\n", sectionbase);
+                       arm64_translate_pte(pmd_val, 0, 0);
+               }
+               *paddr = sectionbase + (vaddr & ~SECTION_PAGE_MASK_2MB);
+               return TRUE;
+       }
+
+       pte_base = (ulong *)PTOV(pmd_val & PHYS_MASK & (s32)machdep->pagemask);
+       FILL_PTBL(pte_base, KVADDR, PTRS_PER_PTE_L4_4K * sizeof(ulong));
+       pte_ptr = pte_base + (((vaddr) >> machdep->pageshift) & 
(PTRS_PER_PTE_L4_4K - 1));
+        pte_val = ULONG(machdep->ptbl + PAGEOFFSET(pte_ptr));
+        if (verbose)
+                fprintf(fp, "   PTE: %lx => %lx\n", (ulong)pte_ptr, pte_val);
+       if (!pte_val)
+               goto no_page;
+
+       if (pte_val & PTE_VALID) {
+               *paddr = (PAGEBASE(pte_val) & PHYS_MASK) + PAGEOFFSET(vaddr);
+               if (verbose) {
+                       fprintf(fp, "  PAGE: %lx\n\n", PAGEBASE(*paddr));
+                       arm64_translate_pte(pte_val, 0, 0);
+               }
+       } else {
+               if (IS_UVADDR(vaddr, NULL))
+                       *paddr = pte_val;
+               if (verbose) {
+                       fprintf(fp, "\n");
+                       arm64_translate_pte(pte_val, 0, 0);
+               }
+               goto no_page;
+       }
+
+       return TRUE;
+no_page:
+       return FALSE;
+}
+
 static ulong 
 arm64_get_task_pgd(ulong task)
 {
@@ -2556,7 +2660,7 @@ arm64_calc_virtual_memory_ranges(void)
 
        STRUCT_SIZE_INIT(page, "page");
 
-        switch (machdep->flags & (VM_L2_64K|VM_L3_64K|VM_L3_4K))
+        switch (machdep->flags & (VM_L2_64K|VM_L3_64K|VM_L3_4K|VM_L4_4K))
         {
         case VM_L2_64K:
         case VM_L3_64K:
@@ -2564,6 +2668,8 @@ arm64_calc_virtual_memory_ranges(void)
                break;
         case VM_L3_4K:
                PUD_SIZE = PGDIR_SIZE_L3_4K;
+        case VM_L4_4K:
+               PUD_SIZE = PUD_SIZE_L4_4K;
                break;
         }
 
diff --git a/defs.h b/defs.h
index 406a865..17a4fbd 100644
--- a/defs.h
+++ b/defs.h
@@ -1054,7 +1054,7 @@ extern struct machdep_table *machdep;
             readmem((ulonglong)((ulong)(PGD)), TYPE, machdep->pgd,          \
                     SIZE, "pgd page", FAULT_ON_ERROR);                      \
             machdep->last_pgd_read = (ulong)(PGD);                          \
-    }                                                                      
+    }
 
 #define FILL_PUD(PUD, TYPE, SIZE)                                          \
     if (!IS_LAST_PUD_READ(PUD)) {                                           \
@@ -2884,6 +2884,28 @@ typedef signed int s32;
 #define PMD_MASK_L3_4K       (~(PMD_SIZE_L3_4K-1))
 
 /*
+ * 4-levels / 4K pages
+ * 48-bit VA
+ */
+#define PTRS_PER_PGD_L4_4K   ((1UL) << (48 - 39))
+#define PTRS_PER_PUD_L4_4K   (512)
+#define PTRS_PER_PMD_L4_4K   (512)
+#define PTRS_PER_PTE_L4_4K   (512)
+#define PGDIR_SHIFT_L4_4K    (39)
+#define PGDIR_SIZE_L4_4K     ((1UL) << PGDIR_SHIFT_L4_4K)
+#define PGDIR_MASK_L4_4K     (~(PGDIR_SIZE_L4_4K-1))
+#define PUD_SHIFT_L4_4K      (30)
+#define PUD_SIZE_L4_4K       ((1UL) << PUD_SHIFT_L4_4K)
+#define PUD_MASK_L4_4K       (~(PUD_SIZE_L4_4K-1))
+#define PMD_SHIFT_L4_4K      (21)
+#define PMD_SIZE_L4_4K       (1UL << PMD_SHIFT_L4_4K)
+#define PMD_MASK_L4_4K       (~(PMD_SIZE_L4_4K-1))
+
+#define PGDIR_SIZE      (1UL << ((48 - 39) + 3))
+#define PGDIR_MASK      (~(PGDIR_SIZE - 1))
+#define PGDIR_OFFSET(X) (((ulong)(X)) & (PGDIR_SIZE - 1))
+
+/*
  * 3-levels / 64K pages
  */
 #define PTRS_PER_PGD_L3_64K  (64)
@@ -2941,6 +2963,7 @@ typedef signed int s32;
 #define KDUMP_ENABLED (0x20)
 #define IRQ_STACKS    (0x40)
 #define NEW_VMEMMAP   (0x80)
+#define VM_L4_4K      (0x100)
 
 /* 
  * sources: Documentation/arm64/memory.txt 
-- 
2.8.1

--
Crash-utility mailing list
[email protected]
https://www.redhat.com/mailman/listinfo/crash-utility

Reply via email to