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