162306a36Sopenharmony_ci// SPDX-License-Identifier: GPL-2.0 262306a36Sopenharmony_ci/* 362306a36Sopenharmony_ci * Copyright (C) 2020-2022 Loongson Technology Corporation Limited 462306a36Sopenharmony_ci */ 562306a36Sopenharmony_ci 662306a36Sopenharmony_ci#include <linux/fs.h> 762306a36Sopenharmony_ci#include <linux/mm.h> 862306a36Sopenharmony_ci#include <linux/hugetlb.h> 962306a36Sopenharmony_ci#include <linux/pagemap.h> 1062306a36Sopenharmony_ci#include <linux/err.h> 1162306a36Sopenharmony_ci#include <linux/sysctl.h> 1262306a36Sopenharmony_ci#include <asm/mman.h> 1362306a36Sopenharmony_ci#include <asm/tlb.h> 1462306a36Sopenharmony_ci#include <asm/tlbflush.h> 1562306a36Sopenharmony_ci 1662306a36Sopenharmony_cipte_t *huge_pte_alloc(struct mm_struct *mm, struct vm_area_struct *vma, 1762306a36Sopenharmony_ci unsigned long addr, unsigned long sz) 1862306a36Sopenharmony_ci{ 1962306a36Sopenharmony_ci pgd_t *pgd; 2062306a36Sopenharmony_ci p4d_t *p4d; 2162306a36Sopenharmony_ci pud_t *pud; 2262306a36Sopenharmony_ci pte_t *pte = NULL; 2362306a36Sopenharmony_ci 2462306a36Sopenharmony_ci pgd = pgd_offset(mm, addr); 2562306a36Sopenharmony_ci p4d = p4d_alloc(mm, pgd, addr); 2662306a36Sopenharmony_ci pud = pud_alloc(mm, p4d, addr); 2762306a36Sopenharmony_ci if (pud) 2862306a36Sopenharmony_ci pte = (pte_t *)pmd_alloc(mm, pud, addr); 2962306a36Sopenharmony_ci 3062306a36Sopenharmony_ci return pte; 3162306a36Sopenharmony_ci} 3262306a36Sopenharmony_ci 3362306a36Sopenharmony_cipte_t *huge_pte_offset(struct mm_struct *mm, unsigned long addr, 3462306a36Sopenharmony_ci unsigned long sz) 3562306a36Sopenharmony_ci{ 3662306a36Sopenharmony_ci pgd_t *pgd; 3762306a36Sopenharmony_ci p4d_t *p4d; 3862306a36Sopenharmony_ci pud_t *pud; 3962306a36Sopenharmony_ci pmd_t *pmd = NULL; 4062306a36Sopenharmony_ci 4162306a36Sopenharmony_ci pgd = pgd_offset(mm, addr); 4262306a36Sopenharmony_ci if (pgd_present(*pgd)) { 4362306a36Sopenharmony_ci p4d = p4d_offset(pgd, addr); 4462306a36Sopenharmony_ci if (p4d_present(*p4d)) { 4562306a36Sopenharmony_ci pud = pud_offset(p4d, addr); 4662306a36Sopenharmony_ci if (pud_present(*pud)) 4762306a36Sopenharmony_ci pmd = pmd_offset(pud, addr); 4862306a36Sopenharmony_ci } 4962306a36Sopenharmony_ci } 5062306a36Sopenharmony_ci return (pte_t *) pmd; 5162306a36Sopenharmony_ci} 5262306a36Sopenharmony_ci 5362306a36Sopenharmony_ciint pmd_huge(pmd_t pmd) 5462306a36Sopenharmony_ci{ 5562306a36Sopenharmony_ci return (pmd_val(pmd) & _PAGE_HUGE) != 0; 5662306a36Sopenharmony_ci} 5762306a36Sopenharmony_ci 5862306a36Sopenharmony_ciint pud_huge(pud_t pud) 5962306a36Sopenharmony_ci{ 6062306a36Sopenharmony_ci return (pud_val(pud) & _PAGE_HUGE) != 0; 6162306a36Sopenharmony_ci} 6262306a36Sopenharmony_ci 6362306a36Sopenharmony_ciuint64_t pmd_to_entrylo(unsigned long pmd_val) 6462306a36Sopenharmony_ci{ 6562306a36Sopenharmony_ci uint64_t val; 6662306a36Sopenharmony_ci /* PMD as PTE. Must be huge page */ 6762306a36Sopenharmony_ci if (!pmd_huge(__pmd(pmd_val))) 6862306a36Sopenharmony_ci panic("%s", __func__); 6962306a36Sopenharmony_ci 7062306a36Sopenharmony_ci val = pmd_val ^ _PAGE_HUGE; 7162306a36Sopenharmony_ci val |= ((val & _PAGE_HGLOBAL) >> 7262306a36Sopenharmony_ci (_PAGE_HGLOBAL_SHIFT - _PAGE_GLOBAL_SHIFT)); 7362306a36Sopenharmony_ci 7462306a36Sopenharmony_ci return val; 7562306a36Sopenharmony_ci} 76