iomap_32.c 3.3 KB
Newer Older
1 2 3 4 5 6 7 8 9 10 11 12 13 14 15 16 17 18 19
/*
 * Copyright © 2008 Ingo Molnar
 *
 * This program is free software; you can redistribute it and/or modify
 * it under the terms of the GNU General Public License as published by
 * the Free Software Foundation; either version 2 of the License, or
 * (at your option) any later version.
 *
 * This program is distributed in the hope that it will be useful, but
 * WITHOUT ANY WARRANTY; without even the implied warranty of
 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the GNU
 * General Public License for more details.
 *
 * You should have received a copy of the GNU General Public License along
 * with this program; if not, write to the Free Software Foundation, Inc.,
 * 59 Temple Place, Suite 330, Boston, MA 02111-1307 USA.
 */

#include <asm/iomap.h>
20
#include <asm/pat.h>
21
#include <linux/module.h>
A
Akinobu Mita 已提交
22
#include <linux/highmem.h>
23

24
static int is_io_mapping_possible(resource_size_t base, unsigned long size)
25
{
26
#if !defined(CONFIG_X86_PAE) && defined(CONFIG_PHYS_ADDR_T_64BIT)
27 28 29
	/* There is no way to map greater than 1 << 32 address without PAE */
	if (base + size > 0x100000000ULL)
		return 0;
30
#endif
31 32
	return 1;
}
33 34 35 36 37 38 39 40 41 42 43 44 45 46 47 48 49 50

int iomap_create_wc(resource_size_t base, unsigned long size, pgprot_t *prot)
{
	unsigned long flag = _PAGE_CACHE_WC;
	int ret;

	if (!is_io_mapping_possible(base, size))
		return -EINVAL;

	ret = io_reserve_memtype(base, base + size, &flag);
	if (ret)
		return ret;

	*prot = __pgprot(__PAGE_KERNEL | flag);
	return 0;
}
EXPORT_SYMBOL_GPL(iomap_create_wc);

P
Peter Zijlstra 已提交
51
void iomap_free(resource_size_t base, unsigned long size)
52 53 54 55
{
	io_free_memtype(base, base + size);
}
EXPORT_SYMBOL_GPL(iomap_free);
56

P
Peter Zijlstra 已提交
57
void *kmap_atomic_prot_pfn(unsigned long pfn, pgprot_t prot)
58 59
{
	unsigned long vaddr;
P
Peter Zijlstra 已提交
60
	int idx, type;
61 62 63

	pagefault_disable();

P
Peter Zijlstra 已提交
64
	type = kmap_atomic_idx_push();
65 66 67 68 69 70 71 72 73
	idx = type + KM_TYPE_NR * smp_processor_id();
	vaddr = __fix_to_virt(FIX_KMAP_BEGIN + idx);
	set_pte(kmap_pte - idx, pfn_pte(pfn, prot));
	arch_flush_lazy_mmu_mode();

	return (void *)vaddr;
}

/*
P
Peter Zijlstra 已提交
74
 * Map 'pfn' using protections 'prot'
75
 */
76
void __iomem *
P
Peter Zijlstra 已提交
77
iomap_atomic_prot_pfn(unsigned long pfn, pgprot_t prot)
78
{
79 80 81 82 83 84 85 86 87
	/*
	 * For non-PAT systems, promote PAGE_KERNEL_WC to PAGE_KERNEL_UC_MINUS.
	 * PAGE_KERNEL_WC maps to PWT, which translates to uncached if the
	 * MTRR is UC or WC.  UC_MINUS gets the real intention, of the
	 * user, which is "WC if the MTRR is WC, UC if you can't do that."
	 */
	if (!pat_enabled && pgprot_val(prot) == pgprot_val(PAGE_KERNEL_WC))
		prot = PAGE_KERNEL_UC_MINUS;

P
Peter Zijlstra 已提交
88
	return (void __force __iomem *) kmap_atomic_prot_pfn(pfn, prot);
89 90 91 92
}
EXPORT_SYMBOL_GPL(iomap_atomic_prot_pfn);

void
P
Peter Zijlstra 已提交
93
iounmap_atomic(void __iomem *kvaddr)
94 95 96
{
	unsigned long vaddr = (unsigned long) kvaddr & PAGE_MASK;

P
Peter Zijlstra 已提交
97 98 99 100
	if (vaddr >= __fix_to_virt(FIX_KMAP_END) &&
	    vaddr <= __fix_to_virt(FIX_KMAP_BEGIN)) {
		int idx, type;

P
Peter Zijlstra 已提交
101
		type = kmap_atomic_idx();
P
Peter Zijlstra 已提交
102 103 104 105 106 107 108 109 110 111 112
		idx = type + KM_TYPE_NR * smp_processor_id();

#ifdef CONFIG_DEBUG_HIGHMEM
		WARN_ON_ONCE(vaddr != __fix_to_virt(FIX_KMAP_BEGIN + idx));
#endif
		/*
		 * Force other mappings to Oops if they'll try to access this
		 * pte without first remap it.  Keeping stale mappings around
		 * is a bad idea also, in case the page changes cacheability
		 * attributes or becomes a protected page in a hypervisor.
		 */
113
		kpte_clear_flush(kmap_pte-idx, vaddr);
P
Peter Zijlstra 已提交
114
		kmap_atomic_idx_pop();
P
Peter Zijlstra 已提交
115
	}
116 117 118 119

	pagefault_enable();
}
EXPORT_SYMBOL_GPL(iounmap_atomic);