1*4882a593Smuzhiyun // SPDX-License-Identifier: GPL-2.0-only
2*4882a593Smuzhiyun /*
3*4882a593Smuzhiyun * ioremap implementation.
4*4882a593Smuzhiyun *
5*4882a593Smuzhiyun * Copyright (C) 2015 Cadence Design Systems Inc.
6*4882a593Smuzhiyun */
7*4882a593Smuzhiyun
8*4882a593Smuzhiyun #include <linux/io.h>
9*4882a593Smuzhiyun #include <linux/vmalloc.h>
10*4882a593Smuzhiyun #include <linux/pgtable.h>
11*4882a593Smuzhiyun #include <asm/cacheflush.h>
12*4882a593Smuzhiyun #include <asm/io.h>
13*4882a593Smuzhiyun
xtensa_ioremap(unsigned long paddr,unsigned long size,pgprot_t prot)14*4882a593Smuzhiyun static void __iomem *xtensa_ioremap(unsigned long paddr, unsigned long size,
15*4882a593Smuzhiyun pgprot_t prot)
16*4882a593Smuzhiyun {
17*4882a593Smuzhiyun unsigned long offset = paddr & ~PAGE_MASK;
18*4882a593Smuzhiyun unsigned long pfn = __phys_to_pfn(paddr);
19*4882a593Smuzhiyun struct vm_struct *area;
20*4882a593Smuzhiyun unsigned long vaddr;
21*4882a593Smuzhiyun int err;
22*4882a593Smuzhiyun
23*4882a593Smuzhiyun paddr &= PAGE_MASK;
24*4882a593Smuzhiyun
25*4882a593Smuzhiyun WARN_ON(pfn_valid(pfn));
26*4882a593Smuzhiyun
27*4882a593Smuzhiyun size = PAGE_ALIGN(offset + size);
28*4882a593Smuzhiyun
29*4882a593Smuzhiyun area = get_vm_area(size, VM_IOREMAP);
30*4882a593Smuzhiyun if (!area)
31*4882a593Smuzhiyun return NULL;
32*4882a593Smuzhiyun
33*4882a593Smuzhiyun vaddr = (unsigned long)area->addr;
34*4882a593Smuzhiyun area->phys_addr = paddr;
35*4882a593Smuzhiyun
36*4882a593Smuzhiyun err = ioremap_page_range(vaddr, vaddr + size, paddr, prot);
37*4882a593Smuzhiyun
38*4882a593Smuzhiyun if (err) {
39*4882a593Smuzhiyun vunmap((void *)vaddr);
40*4882a593Smuzhiyun return NULL;
41*4882a593Smuzhiyun }
42*4882a593Smuzhiyun
43*4882a593Smuzhiyun flush_cache_vmap(vaddr, vaddr + size);
44*4882a593Smuzhiyun return (void __iomem *)(offset + vaddr);
45*4882a593Smuzhiyun }
46*4882a593Smuzhiyun
xtensa_ioremap_nocache(unsigned long addr,unsigned long size)47*4882a593Smuzhiyun void __iomem *xtensa_ioremap_nocache(unsigned long addr, unsigned long size)
48*4882a593Smuzhiyun {
49*4882a593Smuzhiyun return xtensa_ioremap(addr, size, pgprot_noncached(PAGE_KERNEL));
50*4882a593Smuzhiyun }
51*4882a593Smuzhiyun EXPORT_SYMBOL(xtensa_ioremap_nocache);
52*4882a593Smuzhiyun
xtensa_ioremap_cache(unsigned long addr,unsigned long size)53*4882a593Smuzhiyun void __iomem *xtensa_ioremap_cache(unsigned long addr, unsigned long size)
54*4882a593Smuzhiyun {
55*4882a593Smuzhiyun return xtensa_ioremap(addr, size, PAGE_KERNEL);
56*4882a593Smuzhiyun }
57*4882a593Smuzhiyun EXPORT_SYMBOL(xtensa_ioremap_cache);
58*4882a593Smuzhiyun
xtensa_iounmap(volatile void __iomem * io_addr)59*4882a593Smuzhiyun void xtensa_iounmap(volatile void __iomem *io_addr)
60*4882a593Smuzhiyun {
61*4882a593Smuzhiyun void *addr = (void *)(PAGE_MASK & (unsigned long)io_addr);
62*4882a593Smuzhiyun
63*4882a593Smuzhiyun vunmap(addr);
64*4882a593Smuzhiyun }
65*4882a593Smuzhiyun EXPORT_SYMBOL(xtensa_iounmap);
66