[linux-2.6-block.git] / arch / ia64 / mm / ioremap.c

/*
 * (c) Copyright 2006, 2007 Hewlett-Packard Development Company, L.P.
 *	Bjorn Helgaas <bjorn.helgaas@hp.com>
 *
 * This program is free software; you can redistribute it and/or modify
 * it under the terms of the GNU General Public License version 2 as
 * published by the Free Software Foundation.
 */

#include <linux/compiler.h>
#include <linux/module.h>
#include <linux/efi.h>
#include <linux/io.h>
#include <linux/vmalloc.h>
#include <asm/io.h>
#include <asm/meminit.h>

static inline void __iomem *
__ioremap_uc(unsigned long phys_addr)
{
	return (void __iomem *) (__IA64_UNCACHED_OFFSET | phys_addr);
}

void __iomem *
early_ioremap (unsigned long phys_addr, unsigned long size)
{
	u64 attr;
	attr = kern_mem_attribute(phys_addr, size);
	if (attr & EFI_MEMORY_WB)
		return (void __iomem *) phys_to_virt(phys_addr);
	return __ioremap_uc(phys_addr);
}

void __iomem *
ioremap (unsigned long phys_addr, unsigned long size)
{
	void __iomem *addr;
	struct vm_struct *area;
	unsigned long offset;
	pgprot_t prot;
	u64 attr;
	unsigned long gran_base, gran_size;
	unsigned long page_base;

	/*
	 * For things in kern_memmap, we must use the same attribute
	 * as the rest of the kernel.  For more details, see
	 * Documentation/ia64/aliasing.txt.
	 */
	attr = kern_mem_attribute(phys_addr, size);
	if (attr & EFI_MEMORY_WB)
		return (void __iomem *) phys_to_virt(phys_addr);
	else if (attr & EFI_MEMORY_UC)
		return __ioremap_uc(phys_addr);

	/*
	 * Some chipsets don't support UC access to memory.  If
	 * WB is supported for the whole granule, we prefer that.
	 */
	gran_base = GRANULEROUNDDOWN(phys_addr);
	gran_size = GRANULEROUNDUP(phys_addr + size) - gran_base;
	if (efi_mem_attribute(gran_base, gran_size) & EFI_MEMORY_WB)
		return (void __iomem *) phys_to_virt(phys_addr);

	/*
	 * WB is not supported for the whole granule, so we can't use
	 * the region 7 identity mapping.  If we can safely cover the
	 * area with kernel page table mappings, we can use those
	 * instead.
	 */
	page_base = phys_addr & PAGE_MASK;
	size = PAGE_ALIGN(phys_addr + size) - page_base;
	if (efi_mem_attribute(page_base, size) & EFI_MEMORY_WB) {
		prot = PAGE_KERNEL;

		/*
		 * Mappings have to be page-aligned
		 */
		offset = phys_addr & ~PAGE_MASK;
		phys_addr &= PAGE_MASK;

		/*
		 * Ok, go for it..
		 */
		area = get_vm_area(size, VM_IOREMAP);
		if (!area)
			return NULL;

		area->phys_addr = phys_addr;
		addr = (void __iomem *) area->addr;
		if (ioremap_page_range((unsigned long) addr,
				(unsigned long) addr + size, phys_addr, prot)) {
			vunmap((void __force *) addr);
			return NULL;
		}

		return (void __iomem *) (offset + (char __iomem *)addr);
	}

	return __ioremap_uc(phys_addr);
}
EXPORT_SYMBOL(ioremap);

void __iomem *
ioremap_nocache (unsigned long phys_addr, unsigned long size)
{
	if (kern_mem_attribute(phys_addr, size) & EFI_MEMORY_WB)
		return NULL;

	return __ioremap_uc(phys_addr);
}
EXPORT_SYMBOL(ioremap_nocache);

void
early_iounmap (volatile void __iomem *addr, unsigned long size)
{
}

void
iounmap (volatile void __iomem *addr)
{
	if (REGION_NUMBER(addr) == RGN_GATE)
		vunmap((void *) ((unsigned long) addr & PAGE_MASK));
}
EXPORT_SYMBOL(iounmap);
Commit	Line	Data
e9b0a071	1	/*
9b50ffb0	2	* (c) Copyright 2006, 2007 Hewlett-Packard Development Company, L.P.
e9b0a071 BH	3	* Bjorn Helgaas <bjorn.helgaas@hp.com>
	4	*
	5	* This program is free software; you can redistribute it and/or modify
	6	* it under the terms of the GNU General Public License version 2 as
	7	* published by the Free Software Foundation.
	8	*/
	9
	10	#include <linux/compiler.h>
	11	#include <linux/module.h>
	12	#include <linux/efi.h>
9b50ffb0 BH	13	#include <linux/io.h>
9b50ffb0 BH	14	#include <linux/vmalloc.h>
e9b0a071	15	#include <asm/io.h>
32e62c63	16	#include <asm/meminit.h>
e9b0a071 BH	17
e9b0a071 BH	18	static inline void __iomem *
a4279e62	19	__ioremap_uc(unsigned long phys_addr)
e9b0a071	20	{
c4add2e5	21	return (void __iomem *) (__IA64_UNCACHED_OFFSET \| phys_addr);
e9b0a071 BH	22	}
e9b0a071 BH	23
cd7bcf32 LT	24	void __iomem *
	25	early_ioremap (unsigned long phys_addr, unsigned long size)
	26	{
a4279e62 LZH	27	u64 attr;
	28	attr = kern_mem_attribute(phys_addr, size);
	29	if (attr & EFI_MEMORY_WB)
	30	return (void __iomem *) phys_to_virt(phys_addr);
	31	return __ioremap_uc(phys_addr);
cd7bcf32 LT	32	}
cd7bcf32 LT	33
e9b0a071	34	void __iomem *
c4add2e5	35	ioremap (unsigned long phys_addr, unsigned long size)
e9b0a071	36	{
9b50ffb0 BH	37	void __iomem *addr;
	38	struct vm_struct *area;
	39	unsigned long offset;
	40	pgprot_t prot;
32e62c63 BH	41	u64 attr;
32e62c63 BH	42	unsigned long gran_base, gran_size;
9b50ffb0	43	unsigned long page_base;
e9b0a071	44
32e62c63 BH	45	/*
	46	* For things in kern_memmap, we must use the same attribute
	47	* as the rest of the kernel. For more details, see
	48	* Documentation/ia64/aliasing.txt.
	49	*/
c4add2e5	50	attr = kern_mem_attribute(phys_addr, size);
32e62c63	51	if (attr & EFI_MEMORY_WB)
c4add2e5	52	return (void __iomem *) phys_to_virt(phys_addr);
32e62c63	53	else if (attr & EFI_MEMORY_UC)
a4279e62	54	return __ioremap_uc(phys_addr);
c1c57d76	55
e9b0a071	56	/*
32e62c63 BH	57	* Some chipsets don't support UC access to memory. If
32e62c63 BH	58	* WB is supported for the whole granule, we prefer that.
e9b0a071	59	*/
c4add2e5 BH	60	gran_base = GRANULEROUNDDOWN(phys_addr);
c4add2e5 BH	61	gran_size = GRANULEROUNDUP(phys_addr + size) - gran_base;
32e62c63	62	if (efi_mem_attribute(gran_base, gran_size) & EFI_MEMORY_WB)
c4add2e5	63	return (void __iomem *) phys_to_virt(phys_addr);
32e62c63	64
9b50ffb0 BH	65	/*
	66	* WB is not supported for the whole granule, so we can't use
	67	* the region 7 identity mapping. If we can safely cover the
	68	* area with kernel page table mappings, we can use those
	69	* instead.
	70	*/
	71	page_base = phys_addr & PAGE_MASK;
	72	size = PAGE_ALIGN(phys_addr + size) - page_base;
	73	if (efi_mem_attribute(page_base, size) & EFI_MEMORY_WB) {
	74	prot = PAGE_KERNEL;
	75
	76	/*
	77	* Mappings have to be page-aligned
	78	*/
	79	offset = phys_addr & ~PAGE_MASK;
	80	phys_addr &= PAGE_MASK;
	81
	82	/*
	83	* Ok, go for it..
	84	*/
	85	area = get_vm_area(size, VM_IOREMAP);
	86	if (!area)
	87	return NULL;
	88
	89	area->phys_addr = phys_addr;
	90	addr = (void __iomem *) area->addr;
	91	if (ioremap_page_range((unsigned long) addr,
	92	(unsigned long) addr + size, phys_addr, prot)) {
	93	vunmap((void __force *) addr);
	94	return NULL;
	95	}
	96
	97	return (void __iomem ) (offset + (char __iomem )addr);
	98	}
	99
a4279e62	100	return __ioremap_uc(phys_addr);
e9b0a071 BH	101	}
	102	EXPORT_SYMBOL(ioremap);
	103
	104	void __iomem *
c4add2e5	105	ioremap_nocache (unsigned long phys_addr, unsigned long size)
e9b0a071	106	{
c4add2e5	107	if (kern_mem_attribute(phys_addr, size) & EFI_MEMORY_WB)
e037cda5	108	return NULL;
32e62c63	109
a4279e62	110	return __ioremap_uc(phys_addr);
e9b0a071 BH	111	}
e9b0a071 BH	112	EXPORT_SYMBOL(ioremap_nocache);
9b50ffb0	113
cd7bcf32 LT	114	void
	115	early_iounmap (volatile void __iomem *addr, unsigned long size)
	116	{
	117	}
	118
9b50ffb0 BH	119	void
	120	iounmap (volatile void __iomem *addr)
	121	{
	122	if (REGION_NUMBER(addr) == RGN_GATE)
	123	vunmap((void *) ((unsigned long) addr & PAGE_MASK));
	124	}
	125	EXPORT_SYMBOL(iounmap);