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