original_kernel/arch/arm/mach-davinci/io.c

/*
 * DaVinci I/O mapping code
 *
 * Copyright (C) 2005-2006 Texas Instruments
 *
 * 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/module.h>
#include <linux/io.h>

#include <asm/tlb.h>
#include <asm/mach/map.h>

#include <mach/common.h>

/*
 * Intercept ioremap() requests for addresses in our fixed mapping regions.
 */
void __iomem *davinci_ioremap(unsigned long p, size_t size, unsigned int type)
{
	struct map_desc *desc = davinci_soc_info.io_desc;
	int desc_num = davinci_soc_info.io_desc_num;
	int i;

	for (i = 0; i < desc_num; i++, desc++) {
		unsigned long iophys = __pfn_to_phys(desc->pfn);
		unsigned long iosize = desc->length;

		if (p >= iophys && (p + size) <= (iophys + iosize))
			return __io(desc->virtual + p - iophys);
	}

	return __arm_ioremap_caller(p, size, type,
					__builtin_return_address(0));
}
EXPORT_SYMBOL(davinci_ioremap);

void davinci_iounmap(volatile void __iomem *addr)
{
	unsigned long virt = (unsigned long)addr;

	if (virt >= VMALLOC_START && virt < VMALLOC_END)
		__iounmap(addr);
}
EXPORT_SYMBOL(davinci_iounmap);