Kevin Hilman | 7c6337e | 2007-04-30 19:37:19 +0100 | [diff] [blame] | 1 | /* |
| 2 | * DaVinci I/O mapping code |
| 3 | * |
| 4 | * Copyright (C) 2005-2006 Texas Instruments |
| 5 | * |
| 6 | * This program is free software; you can redistribute it and/or modify |
| 7 | * it under the terms of the GNU General Public License version 2 as |
| 8 | * published by the Free Software Foundation. |
| 9 | */ |
| 10 | |
| 11 | #include <linux/module.h> |
| 12 | #include <linux/kernel.h> |
| 13 | #include <linux/init.h> |
Russell King | fced80c | 2008-09-06 12:10:45 +0100 | [diff] [blame] | 14 | #include <linux/io.h> |
Kevin Hilman | 7c6337e | 2007-04-30 19:37:19 +0100 | [diff] [blame] | 15 | |
| 16 | #include <asm/tlb.h> |
Kevin Hilman | 7c6337e | 2007-04-30 19:37:19 +0100 | [diff] [blame] | 17 | #include <asm/memory.h> |
| 18 | |
| 19 | #include <asm/mach/map.h> |
Russell King | a09e64f | 2008-08-05 16:14:15 +0100 | [diff] [blame] | 20 | #include <mach/clock.h> |
Kevin Hilman | 7c6337e | 2007-04-30 19:37:19 +0100 | [diff] [blame] | 21 | |
| 22 | extern void davinci_check_revision(void); |
| 23 | |
| 24 | /* |
| 25 | * The machine specific code may provide the extra mapping besides the |
| 26 | * default mapping provided here. |
| 27 | */ |
| 28 | static struct map_desc davinci_io_desc[] __initdata = { |
| 29 | { |
| 30 | .virtual = IO_VIRT, |
| 31 | .pfn = __phys_to_pfn(IO_PHYS), |
| 32 | .length = IO_SIZE, |
| 33 | .type = MT_DEVICE |
| 34 | }, |
| 35 | }; |
| 36 | |
| 37 | void __init davinci_map_common_io(void) |
| 38 | { |
| 39 | iotable_init(davinci_io_desc, ARRAY_SIZE(davinci_io_desc)); |
| 40 | |
| 41 | /* Normally devicemaps_init() would flush caches and tlb after |
| 42 | * mdesc->map_io(), but we must also do it here because of the CPU |
| 43 | * revision check below. |
| 44 | */ |
| 45 | local_flush_tlb_all(); |
| 46 | flush_cache_all(); |
| 47 | |
| 48 | /* We want to check CPU revision early for cpu_is_xxxx() macros. |
| 49 | * IO space mapping must be initialized before we can do that. |
| 50 | */ |
| 51 | davinci_check_revision(); |
| 52 | } |
Vladimir Barinov | 3e062b0 | 2007-06-05 16:36:55 +0100 | [diff] [blame] | 53 | |
Kevin Hilman | f5c122d | 2009-04-14 07:04:16 -0500 | [diff] [blame^] | 54 | #define BETWEEN(p, st, sz) ((p) >= (st) && (p) < ((st) + (sz))) |
| 55 | #define XLATE(p, pst, vst) ((void __iomem *)((p) - (pst) + (vst))) |
| 56 | |
| 57 | /* |
| 58 | * Intercept ioremap() requests for addresses in our fixed mapping regions. |
| 59 | */ |
| 60 | void __iomem *davinci_ioremap(unsigned long p, size_t size, unsigned int type) |
Vladimir Barinov | 3e062b0 | 2007-06-05 16:36:55 +0100 | [diff] [blame] | 61 | { |
Kevin Hilman | f5c122d | 2009-04-14 07:04:16 -0500 | [diff] [blame^] | 62 | if (BETWEEN(p, IO_PHYS, IO_SIZE)) |
| 63 | return XLATE(p, IO_PHYS, IO_VIRT); |
| 64 | |
| 65 | return __arm_ioremap(p, size, type); |
Vladimir Barinov | 3e062b0 | 2007-06-05 16:36:55 +0100 | [diff] [blame] | 66 | } |
Kevin Hilman | f5c122d | 2009-04-14 07:04:16 -0500 | [diff] [blame^] | 67 | EXPORT_SYMBOL(davinci_ioremap); |
| 68 | |
| 69 | void davinci_iounmap(volatile void __iomem *addr) |
| 70 | { |
| 71 | unsigned long virt = (unsigned long)addr; |
| 72 | |
| 73 | if (virt >= VMALLOC_START && virt < VMALLOC_END) |
| 74 | __iounmap(addr); |
| 75 | } |
| 76 | EXPORT_SYMBOL(davinci_iounmap); |