1 files changed, 156 insertions, 0 deletions

diff --git a/arch/m68k/mm/sun3kmap.c b/arch/m68k/mm/sun3kmap.c
new file mode 100644
index 000000000000..7f0d86f3fe73
--- /dev/null
+++ b/arch/m68k/mm/sun3kmap.c
@@ -0,0 +1,156 @@
+/*
+ * linux/arch/m68k/mm/sun3kmap.c
+ *
+ * Copyright (C) 2002 Sam Creasey <sammy@sammy.net>
+ *
+ * This file is subject to the terms and conditions of the GNU General Public
+ * License.  See the file COPYING in the main directory of this archive
+ * for more details.
+ */
+
+#include <linux/types.h>
+#include <linux/kernel.h>
+#include <linux/mm.h>
+#include <linux/vmalloc.h>
+
+#include <asm/page.h>
+#include <asm/pgtable.h>
+#include <asm/io.h>
+#include <asm/sun3mmu.h>
+
+#undef SUN3_KMAP_DEBUG
+
+#ifdef SUN3_KMAP_DEBUG
+extern void print_pte_vaddr(unsigned long vaddr);
+#endif
+
+extern void mmu_emu_map_pmeg (int context, int vaddr);
+
+static inline void do_page_mapin(unsigned long phys, unsigned long virt,
+                                 unsigned long type)
+{
+        unsigned long pte;
+        pte_t ptep;
+
+        ptep = pfn_pte(phys >> PAGE_SHIFT, PAGE_KERNEL);
+        pte = pte_val(ptep);
+        pte |= type;
+
+        sun3_put_pte(virt, pte);
+
+#ifdef SUN3_KMAP_DEBUG
+        print_pte_vaddr(virt);
+#endif
+
+}
+
+static inline void do_pmeg_mapin(unsigned long phys, unsigned long virt,
+                                 unsigned long type, int pages)
+{
+
+        if(sun3_get_segmap(virt & ~SUN3_PMEG_MASK) == SUN3_INVALID_PMEG)
+                mmu_emu_map_pmeg(sun3_get_context(), virt);
+
+        while(pages) {
+                do_page_mapin(phys, virt, type);
+                phys += PAGE_SIZE;
+                virt += PAGE_SIZE;
+                pages--;
+        }
+}
+
+void *sun3_ioremap(unsigned long phys, unsigned long size,
+                   unsigned long type)
+{
+        struct vm_struct *area;
+        unsigned long offset, virt, ret;
+        int pages;
+
+        if(!size)
+                return NULL;
+
+        /* page align */
+        offset = phys & (PAGE_SIZE-1);
+        phys &= ~(PAGE_SIZE-1);
+
+        size += offset;
+        size = PAGE_ALIGN(size);
+        if((area = get_vm_area(size, VM_IOREMAP)) == NULL)
+                return NULL;
+
+#ifdef SUN3_KMAP_DEBUG
+        printk("ioremap: got virt %p size %lx(%lx)\n",
+               area->addr, size, area->size);
+#endif
+
+        pages = size / PAGE_SIZE;
+        virt = (unsigned long)area->addr;
+        ret = virt + offset;
+
+        while(pages) {
+                int seg_pages;
+
+                seg_pages = (SUN3_PMEG_SIZE - (virt & SUN3_PMEG_MASK)) / PAGE_SIZE;
+                if(seg_pages > pages)
+                        seg_pages = pages;
+
+                do_pmeg_mapin(phys, virt, type, seg_pages);
+
+                pages -= seg_pages;
+                phys += seg_pages * PAGE_SIZE;
+                virt += seg_pages * PAGE_SIZE;
+        }
+
+        return (void *)ret;
+
+}
+
+
+void *__ioremap(unsigned long phys, unsigned long size, int cache)
+{
+
+        return sun3_ioremap(phys, size, SUN3_PAGE_TYPE_IO);
+
+}
+
+void iounmap(void *addr)
+{
+        vfree((void *)(PAGE_MASK & (unsigned long)addr));
+}
+
+/* sun3_map_test(addr, val) -- Reads a byte from addr, storing to val,
+ * trapping the potential read fault.  Returns 0 if the access faulted,
+ * 1 on success.
+ *
+ * This function is primarily used to check addresses on the VME bus.
+ *
+ * Mucking with the page fault handler seems a little hackish to me, but
+ * SunOS, NetBSD, and Mach all implemented this check in such a manner,
+ * so I figure we're allowed.
+ */
+int sun3_map_test(unsigned long addr, char *val)
+{
+        int ret = 0;
+
+        __asm__ __volatile__
+                (".globl _sun3_map_test_start\n"
+                 "_sun3_map_test_start:\n"
+                 "1: moveb (%2), (%0)\n"
+                 "   moveq #1, %1\n"
+                 "2:\n"
+                 ".section .fixup,\"ax\"\n"
+                 ".even\n"
+                 "3: moveq #0, %1\n"
+                 "   jmp 2b\n"
+                 ".previous\n"
+                 ".section __ex_table,\"a\"\n"
+                 ".align 4\n"
+                 ".long 1b,3b\n"
+                 ".previous\n"
+                 ".globl _sun3_map_test_end\n"
+                 "_sun3_map_test_end:\n"
+                 : "=a"(val), "=r"(ret)
+                 : "a"(addr));
+
+        return ret;
+}