Commit | Line | Data |
---|---|---|
1da177e4 LT |
1 | /* |
2 | * linux/arch/m68k/mm/sun3kmap.c | |
3 | * | |
4 | * Copyright (C) 2002 Sam Creasey <sammy@sammy.net> | |
5 | * | |
6 | * This file is subject to the terms and conditions of the GNU General Public | |
7 | * License. See the file COPYING in the main directory of this archive | |
8 | * for more details. | |
9 | */ | |
10 | ||
2e811488 | 11 | #include <linux/module.h> |
1da177e4 LT |
12 | #include <linux/types.h> |
13 | #include <linux/kernel.h> | |
14 | #include <linux/mm.h> | |
15 | #include <linux/vmalloc.h> | |
16 | ||
17 | #include <asm/page.h> | |
18 | #include <asm/pgtable.h> | |
19 | #include <asm/io.h> | |
20 | #include <asm/sun3mmu.h> | |
21 | ||
22 | #undef SUN3_KMAP_DEBUG | |
23 | ||
24 | #ifdef SUN3_KMAP_DEBUG | |
25 | extern void print_pte_vaddr(unsigned long vaddr); | |
26 | #endif | |
27 | ||
28 | extern void mmu_emu_map_pmeg (int context, int vaddr); | |
29 | ||
30 | static inline void do_page_mapin(unsigned long phys, unsigned long virt, | |
31 | unsigned long type) | |
32 | { | |
33 | unsigned long pte; | |
34 | pte_t ptep; | |
35 | ||
36 | ptep = pfn_pte(phys >> PAGE_SHIFT, PAGE_KERNEL); | |
37 | pte = pte_val(ptep); | |
38 | pte |= type; | |
39 | ||
40 | sun3_put_pte(virt, pte); | |
41 | ||
42 | #ifdef SUN3_KMAP_DEBUG | |
43 | print_pte_vaddr(virt); | |
44 | #endif | |
45 | ||
46 | } | |
47 | ||
48 | static inline void do_pmeg_mapin(unsigned long phys, unsigned long virt, | |
49 | unsigned long type, int pages) | |
50 | { | |
51 | ||
52 | if(sun3_get_segmap(virt & ~SUN3_PMEG_MASK) == SUN3_INVALID_PMEG) | |
53 | mmu_emu_map_pmeg(sun3_get_context(), virt); | |
54 | ||
55 | while(pages) { | |
56 | do_page_mapin(phys, virt, type); | |
57 | phys += PAGE_SIZE; | |
58 | virt += PAGE_SIZE; | |
59 | pages--; | |
60 | } | |
61 | } | |
62 | ||
437111ca | 63 | void __iomem *sun3_ioremap(unsigned long phys, unsigned long size, |
1da177e4 LT |
64 | unsigned long type) |
65 | { | |
66 | struct vm_struct *area; | |
67 | unsigned long offset, virt, ret; | |
68 | int pages; | |
69 | ||
70 | if(!size) | |
71 | return NULL; | |
72 | ||
73 | /* page align */ | |
74 | offset = phys & (PAGE_SIZE-1); | |
75 | phys &= ~(PAGE_SIZE-1); | |
76 | ||
77 | size += offset; | |
78 | size = PAGE_ALIGN(size); | |
79 | if((area = get_vm_area(size, VM_IOREMAP)) == NULL) | |
80 | return NULL; | |
81 | ||
82 | #ifdef SUN3_KMAP_DEBUG | |
83 | printk("ioremap: got virt %p size %lx(%lx)\n", | |
84 | area->addr, size, area->size); | |
85 | #endif | |
86 | ||
87 | pages = size / PAGE_SIZE; | |
88 | virt = (unsigned long)area->addr; | |
89 | ret = virt + offset; | |
90 | ||
91 | while(pages) { | |
92 | int seg_pages; | |
93 | ||
94 | seg_pages = (SUN3_PMEG_SIZE - (virt & SUN3_PMEG_MASK)) / PAGE_SIZE; | |
95 | if(seg_pages > pages) | |
96 | seg_pages = pages; | |
97 | ||
98 | do_pmeg_mapin(phys, virt, type, seg_pages); | |
99 | ||
100 | pages -= seg_pages; | |
101 | phys += seg_pages * PAGE_SIZE; | |
102 | virt += seg_pages * PAGE_SIZE; | |
103 | } | |
104 | ||
437111ca | 105 | return (void __iomem *)ret; |
1da177e4 LT |
106 | |
107 | } | |
88f8bb78 | 108 | EXPORT_SYMBOL(sun3_ioremap); |
1da177e4 LT |
109 | |
110 | ||
437111ca | 111 | void __iomem *__ioremap(unsigned long phys, unsigned long size, int cache) |
1da177e4 LT |
112 | { |
113 | ||
114 | return sun3_ioremap(phys, size, SUN3_PAGE_TYPE_IO); | |
115 | ||
116 | } | |
2e811488 | 117 | EXPORT_SYMBOL(__ioremap); |
1da177e4 | 118 | |
437111ca | 119 | void iounmap(void __iomem *addr) |
1da177e4 LT |
120 | { |
121 | vfree((void *)(PAGE_MASK & (unsigned long)addr)); | |
122 | } | |
2e811488 | 123 | EXPORT_SYMBOL(iounmap); |
1da177e4 LT |
124 | |
125 | /* sun3_map_test(addr, val) -- Reads a byte from addr, storing to val, | |
126 | * trapping the potential read fault. Returns 0 if the access faulted, | |
127 | * 1 on success. | |
128 | * | |
129 | * This function is primarily used to check addresses on the VME bus. | |
130 | * | |
131 | * Mucking with the page fault handler seems a little hackish to me, but | |
132 | * SunOS, NetBSD, and Mach all implemented this check in such a manner, | |
133 | * so I figure we're allowed. | |
134 | */ | |
135 | int sun3_map_test(unsigned long addr, char *val) | |
136 | { | |
137 | int ret = 0; | |
138 | ||
139 | __asm__ __volatile__ | |
140 | (".globl _sun3_map_test_start\n" | |
141 | "_sun3_map_test_start:\n" | |
142 | "1: moveb (%2), (%0)\n" | |
143 | " moveq #1, %1\n" | |
144 | "2:\n" | |
145 | ".section .fixup,\"ax\"\n" | |
146 | ".even\n" | |
147 | "3: moveq #0, %1\n" | |
148 | " jmp 2b\n" | |
149 | ".previous\n" | |
150 | ".section __ex_table,\"a\"\n" | |
151 | ".align 4\n" | |
152 | ".long 1b,3b\n" | |
153 | ".previous\n" | |
154 | ".globl _sun3_map_test_end\n" | |
155 | "_sun3_map_test_end:\n" | |
156 | : "=a"(val), "=r"(ret) | |
157 | : "a"(addr)); | |
158 | ||
159 | return ret; | |
160 | } | |
88f8bb78 | 161 | EXPORT_SYMBOL(sun3_map_test); |