blob: 4284cd59e21ad415116039162a3b844b23fbdeb1 [file] [log] [blame]
Andrew Scullb4b6d4a2019-01-02 15:54:55 +00001// SPDX-License-Identifier: GPL-2.0
2// Copyright (C) 2005-2017 Andes Technology Corporation
3
4#include <linux/export.h>
5#include <linux/highmem.h>
6#include <linux/sched.h>
7#include <linux/smp.h>
8#include <linux/interrupt.h>
David Brazdil0f672f62019-12-10 10:32:29 +00009#include <linux/memblock.h>
Andrew Scullb4b6d4a2019-01-02 15:54:55 +000010#include <asm/fixmap.h>
11#include <asm/tlbflush.h>
12
Olivier Deprez157378f2022-04-04 15:47:50 +020013void *kmap_atomic_high_prot(struct page *page, pgprot_t prot)
Andrew Scullb4b6d4a2019-01-02 15:54:55 +000014{
15 unsigned int idx;
16 unsigned long vaddr, pte;
17 int type;
18 pte_t *ptep;
19
Andrew Scullb4b6d4a2019-01-02 15:54:55 +000020 type = kmap_atomic_idx_push();
21
22 idx = type + KM_TYPE_NR * smp_processor_id();
23 vaddr = __fix_to_virt(FIX_KMAP_BEGIN + idx);
Olivier Deprez157378f2022-04-04 15:47:50 +020024 pte = (page_to_pfn(page) << PAGE_SHIFT) | prot;
Andrew Scullb4b6d4a2019-01-02 15:54:55 +000025 ptep = pte_offset_kernel(pmd_off_k(vaddr), vaddr);
26 set_pte(ptep, pte);
27
28 __nds32__tlbop_inv(vaddr);
29 __nds32__mtsr_dsb(vaddr, NDS32_SR_TLB_VPN);
30 __nds32__tlbop_rwr(pte);
31 __nds32__isb();
32 return (void *)vaddr;
33}
Olivier Deprez157378f2022-04-04 15:47:50 +020034EXPORT_SYMBOL(kmap_atomic_high_prot);
Andrew Scullb4b6d4a2019-01-02 15:54:55 +000035
Olivier Deprez157378f2022-04-04 15:47:50 +020036void kunmap_atomic_high(void *kvaddr)
Andrew Scullb4b6d4a2019-01-02 15:54:55 +000037{
38 if (kvaddr >= (void *)FIXADDR_START) {
39 unsigned long vaddr = (unsigned long)kvaddr;
40 pte_t *ptep;
41 kmap_atomic_idx_pop();
42 __nds32__tlbop_inv(vaddr);
43 __nds32__isb();
44 ptep = pte_offset_kernel(pmd_off_k(vaddr), vaddr);
45 set_pte(ptep, 0);
46 }
Andrew Scullb4b6d4a2019-01-02 15:54:55 +000047}
Olivier Deprez157378f2022-04-04 15:47:50 +020048EXPORT_SYMBOL(kunmap_atomic_high);