2 * Copyright (C) 2004-2006 Atmel Corporation
4 * This program is free software; you can redistribute it and/or modify
5 * it under the terms of the GNU General Public License version 2 as
6 * published by the Free Software Foundation.
8 #include <linux/vmalloc.h>
10 #include <linux/module.h>
12 #include <linux/slab.h>
14 #include <asm/pgtable.h>
15 #include <asm/addrspace.h>
18 * Re-map an arbitrary physical address space into the kernel virtual
19 * address space. Needed when the kernel wants to access physical
22 void __iomem
*__ioremap(unsigned long phys_addr
, size_t size
,
26 struct vm_struct
*area
;
27 unsigned long offset
, last_addr
;
31 * Check if we can simply use the P4 segment. This area is
32 * uncacheable, so if caching/buffering is requested, we can't
35 if ((phys_addr
>= P4SEG
) && (flags
== 0))
36 return (void __iomem
*)phys_addr
;
38 /* Don't allow wraparound or zero size */
39 last_addr
= phys_addr
+ size
- 1;
40 if (!size
|| last_addr
< phys_addr
)
43 if (PHYSADDR(P2SEGADDR(phys_addr
)) == phys_addr
)
44 return (void __iomem
*)P2SEGADDR(phys_addr
);
46 /* Mappings have to be page-aligned */
47 offset
= phys_addr
& ~PAGE_MASK
;
48 phys_addr
&= PAGE_MASK
;
49 size
= PAGE_ALIGN(last_addr
+ 1) - phys_addr
;
51 prot
= __pgprot(_PAGE_PRESENT
| _PAGE_GLOBAL
| _PAGE_RW
| _PAGE_DIRTY
52 | _PAGE_ACCESSED
| _PAGE_TYPE_SMALL
| flags
);
57 area
= get_vm_area(size
, VM_IOREMAP
);
60 area
->phys_addr
= phys_addr
;
61 addr
= (unsigned long )area
->addr
;
62 if (ioremap_page_range(addr
, addr
+ size
, phys_addr
, prot
)) {
67 return (void __iomem
*)(offset
+ (char *)addr
);
69 EXPORT_SYMBOL(__ioremap
);
71 void __iounmap(void __iomem
*addr
)
75 if ((unsigned long)addr
>= P4SEG
)
77 if (PXSEG(addr
) == P2SEG
)
80 p
= remove_vm_area((void *)(PAGE_MASK
& (unsigned long __force
)addr
));
82 printk (KERN_ERR
"iounmap: bad address %p\n", addr
);
88 EXPORT_SYMBOL(__iounmap
);