static void ghes_iounmap_irq(void __iomem *vaddr_ptr)
{
unsigned long vaddr = (unsigned long __force)vaddr_ptr;
void *base = ghes_ioremap_area->addr;
BUG_ON(vaddr != (unsigned long)GHES_IOREMAP_IRQ_PAGE(base));
unmap_kernel_range_noflush(vaddr, PAGE_SIZE);
__flush_tlb_one(vaddr);
}
static void __pcpu_unmap_pages(unsigned long addr, int nr_pages)
{
unmap_kernel_range_noflush(addr, nr_pages << PAGE_SHIFT);
}
int init_module(void)
{
int i, ret = -ENOMEM;
struct vm_struct *vm;
struct page *pages[2] = { NULL, NULL };
unsigned char *buf;
pr_info("MyMapTest Begin\n");
vm = alloc_vm_area(2 * PAGE_SIZE);
if (!vm) {
pr_info("Failed to allocate vm area\n");
goto out;
}
pages[0] = alloc_page(GFP_KERNEL);
pages[1] = alloc_page(GFP_KERNEL);
if (!pages[0] || !pages[1]) {
pr_info("Page allocation failed\n");
goto out;
}
/* Fill pages with test pattern */
buf = kmap_atomic(pages[0]);
for (i = 0; i < PAGE_SIZE; i++)
buf[i] = 'a';
kunmap_atomic(buf);
buf = kmap_atomic(pages[1]);
for (i = 0; i < PAGE_SIZE; i++)
buf[i] = 'z';
kunmap_atomic(buf);
buf = NULL;
/*
* Now, map both pages *contiguously* using a different method
* and verify contents of each page.
*/
ret = map_kernel_range_noflush((unsigned long)vm->addr, 2 * PAGE_SIZE,
PAGE_KERNEL, pages);
pr_info("map_kernel_range_noflush returned: %d\n", ret);
buf = vm->addr;
for (i = 0; i < PAGE_SIZE; i++) {
if (buf[i] != 'a')
pr_info("mismatch in page-0 at location %d\n", i);
}
for (i = PAGE_SIZE; i <= PAGE_SIZE; i++) {
if (buf[i] != 'z')
pr_info("mismatch in page-1 at location %d\n", i);
}
unmap_kernel_range_noflush((unsigned long)vm->addr, 2 * PAGE_SIZE);
__flush_tlb_one((unsigned long)buf);
__flush_tlb_one((unsigned long)buf + PAGE_SIZE);
ret = 0; /* Success */
out:
if (vm)
free_vm_area(vm);
if (pages[0])
__free_page(pages[0]);
if (pages[1])
__free_page(pages[1]);
/*
* A non 0 return means init_module failed; module can't be loaded.
*/
return ret;
}
void plat_iounmap_ns(void __iomem *vaddr, unsigned long size)
{
unmap_kernel_range_noflush((unsigned long __force)vaddr, size);
flush_tlb_kernel_range((unsigned long __force)vaddr,
(unsigned long __force)vaddr + size);
}
