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
24 extern void print_pte_vaddr(unsigned long vaddr);
25 #endif
26 
27 extern void mmu_emu_map_pmeg (int context, int vaddr);
28 
do_page_mapin(unsigned long phys,unsigned long virt,unsigned long type)29 static 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 
do_pmeg_mapin(unsigned long phys,unsigned long virt,unsigned long type,int pages)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 
sun3_ioremap(unsigned long phys,unsigned long size,unsigned long type)63 void __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 }
108 EXPORT_SYMBOL(sun3_ioremap);
109 
110 
__ioremap(unsigned long phys,unsigned long size,int cache)111 void __iomem *__ioremap(unsigned long phys, unsigned long size, int cache)
112 {
113 
114 	return sun3_ioremap(phys, size, SUN3_PAGE_TYPE_IO);
115 
116 }
117 EXPORT_SYMBOL(__ioremap);
118 
iounmap(void __iomem * addr)119 void iounmap(void __iomem *addr)
120 {
121 	vfree((void *)(PAGE_MASK & (unsigned long)addr));
122 }
123 EXPORT_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  */
sun3_map_test(unsigned long addr,char * val)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 }
161 EXPORT_SYMBOL(sun3_map_test);
162