Add the implementation for PMD translation in case of 3 level page tables.
Assign the kernel page size based on the page structure read from the kernel
ELF file.

Signed-off-by: Sameer Goel <[email protected]>
---
This change targets the arm64_support branch of Pratush Anand's repository at:
https://github.com/pratyushanand/makedumpfile.git

 arch/arm64.c | 36 ++++++++++++++++++++++++++++++------
 1 file changed, 30 insertions(+), 6 deletions(-)

diff --git a/arch/arm64.c b/arch/arm64.c
index a94a4ba..ab20389 100644
--- a/arch/arm64.c
+++ b/arch/arm64.c
@@ -36,7 +36,7 @@ typedef struct {
 } pmd_t;
 
 #define pud_offset(pgd, vaddr)         ((pud_t *)pgd)
-#define pmd_offset(pud, vaddr)         ((pmd_t *)pud)
+
 #define pgd_val(x)             ((x).pgd)
 #define pud_val(x)             (pgd_val((x).pgd))
 #define pmd_val(x)             (pud_val((x).pud))
@@ -68,6 +68,11 @@ typedef struct {
 */
 #define PHYS_MASK_SHIFT                48
 #define PHYS_MASK              ((1UL << PHYS_MASK_SHIFT) - 1)
+/*
+ * Remove the highest order bits that are not a part of the
+ * physical address in a section
+ */
+#define PMD_SECTION_MASK        ((1UL << 40) - 1)
 
 #define PMD_TYPE_MASK          3
 #define PMD_TYPE_SECT          1
@@ -83,10 +88,18 @@ typedef struct {
 #define pmd_page_vaddr(pmd)            (__va(pmd_val(pmd) & PHYS_MASK & 
(int32_t)PAGE_MASK))
 #define pte_offset(dir, vaddr)                 ((pte_t*)pmd_page_vaddr((*dir)) 
+ pte_index(vaddr))
 
+
+#define pmd_offset_pgtbl_lvl_2(pud, vaddr) ((pmd_t *)pud)
+
+#define pmd_index(vaddr)               (((vaddr) >> PMD_SHIFT) & (PTRS_PER_PMD 
- 1))
+#define pud_page_vaddr(pud)            (__va(pud_val(pud) & PHYS_MASK & 
(int32_t)PAGE_MASK))
+#define pmd_offset_pgtbl_lvl_3(pud, vaddr) ((pmd_t *)pud_page_vaddr((*pud)) + 
pmd_index(vaddr))
+
 /* kernel struct page size can be kernel version dependent, currently
  * keep it constant.
  */
-#define KERN_STRUCT_PAGE_SIZE          64
+#define KERN_STRUCT_PAGE_SIZE          get_structure_size("page", 
DWARF_INFO_GET_STRUCT_SIZE)
+
 #define ALIGN(x, a)                    (((x) + (a) - 1) & ~((a) - 1))
 #define PFN_DOWN(x)                    ((x) >> PAGE_SHIFT)
 #define VMEMMAP_SIZE                   ALIGN((1UL << (VA_BITS - PAGE_SHIFT)) * 
KERN_STRUCT_PAGE_SIZE, PUD_SIZE)
@@ -97,6 +110,15 @@ static int pgtable_level;
 static int va_bits;
 static int page_shift;
 
+pmd_t *
+pmd_offset(pud_t *pud, unsigned long vaddr)
+{
+       if (pgtable_level == 2) {
+               return pmd_offset_pgtbl_lvl_2(pud, vaddr);
+       } else {
+               return pmd_offset_pgtbl_lvl_3(pud, vaddr);
+       }
+}
 int
 get_pgtable_level_arm64(void)
 {
@@ -256,7 +278,7 @@ vtop_arm64(unsigned long vaddr)
 {
        unsigned long long paddr = NOT_PADDR;
        pgd_t   *pgda, pgdv;
-       pud_t   *puda;
+       pud_t   *puda, pudv;
        pmd_t   *pmda, pmdv;
        pte_t   *ptea, ptev;
 
@@ -271,8 +293,9 @@ vtop_arm64(unsigned long vaddr)
                return NOT_PADDR;
        }
 
-       puda = pud_offset(pgda, vaddr);
-       pmda = pmd_offset(puda, vaddr);
+       pudv.pgd = pgdv;
+
+       pmda = pmd_offset(&pudv, vaddr);
        if (!readmem(VADDR, (unsigned long long)pmda, &pmdv, sizeof(pmdv))) {
                ERRMSG("Can't read pmd\n");
                return NOT_PADDR;
@@ -298,7 +321,8 @@ vtop_arm64(unsigned long vaddr)
                break;
        case PMD_TYPE_SECT:
                /* 1GB section */
-               paddr = (pmd_val(pmdv) & PMD_MASK) + (vaddr & (PMD_SIZE - 1));
+               paddr = (pmd_val(pmdv) & (PMD_MASK & PMD_SECTION_MASK))
+                                       + (vaddr & (PMD_SIZE - 1));
                break;
        }
 
-- 
1.8.2.1


_______________________________________________
kexec mailing list
[email protected]
http://lists.infradead.org/mailman/listinfo/kexec

Reply via email to