11da177e4SLinus Torvalds /*
21da177e4SLinus Torvalds * linux/arch/m68k/mm/sun3kmap.c
31da177e4SLinus Torvalds *
41da177e4SLinus Torvalds * Copyright (C) 2002 Sam Creasey <sammy@sammy.net>
51da177e4SLinus Torvalds *
61da177e4SLinus Torvalds * This file is subject to the terms and conditions of the GNU General Public
71da177e4SLinus Torvalds * License. See the file COPYING in the main directory of this archive
81da177e4SLinus Torvalds * for more details.
91da177e4SLinus Torvalds */
101da177e4SLinus Torvalds
112e811488SAl Viro #include <linux/module.h>
121da177e4SLinus Torvalds #include <linux/types.h>
131da177e4SLinus Torvalds #include <linux/kernel.h>
141da177e4SLinus Torvalds #include <linux/mm.h>
151da177e4SLinus Torvalds #include <linux/vmalloc.h>
161da177e4SLinus Torvalds
171da177e4SLinus Torvalds #include <asm/page.h>
181da177e4SLinus Torvalds #include <asm/io.h>
191da177e4SLinus Torvalds #include <asm/sun3mmu.h>
201da177e4SLinus Torvalds
211da177e4SLinus Torvalds #undef SUN3_KMAP_DEBUG
221da177e4SLinus Torvalds
231da177e4SLinus Torvalds #ifdef SUN3_KMAP_DEBUG
241da177e4SLinus Torvalds extern void print_pte_vaddr(unsigned long vaddr);
251da177e4SLinus Torvalds #endif
261da177e4SLinus Torvalds
271da177e4SLinus Torvalds extern void mmu_emu_map_pmeg (int context, int vaddr);
281da177e4SLinus Torvalds
do_page_mapin(unsigned long phys,unsigned long virt,unsigned long type)291da177e4SLinus Torvalds static inline void do_page_mapin(unsigned long phys, unsigned long virt,
301da177e4SLinus Torvalds unsigned long type)
311da177e4SLinus Torvalds {
321da177e4SLinus Torvalds unsigned long pte;
331da177e4SLinus Torvalds pte_t ptep;
341da177e4SLinus Torvalds
351da177e4SLinus Torvalds ptep = pfn_pte(phys >> PAGE_SHIFT, PAGE_KERNEL);
361da177e4SLinus Torvalds pte = pte_val(ptep);
371da177e4SLinus Torvalds pte |= type;
381da177e4SLinus Torvalds
391da177e4SLinus Torvalds sun3_put_pte(virt, pte);
401da177e4SLinus Torvalds
411da177e4SLinus Torvalds #ifdef SUN3_KMAP_DEBUG
4205b70ff6SGeert Uytterhoeven pr_info("mapin:");
431da177e4SLinus Torvalds print_pte_vaddr(virt);
441da177e4SLinus Torvalds #endif
451da177e4SLinus Torvalds
461da177e4SLinus Torvalds }
471da177e4SLinus Torvalds
do_pmeg_mapin(unsigned long phys,unsigned long virt,unsigned long type,int pages)481da177e4SLinus Torvalds static inline void do_pmeg_mapin(unsigned long phys, unsigned long virt,
491da177e4SLinus Torvalds unsigned long type, int pages)
501da177e4SLinus Torvalds {
511da177e4SLinus Torvalds
521da177e4SLinus Torvalds if(sun3_get_segmap(virt & ~SUN3_PMEG_MASK) == SUN3_INVALID_PMEG)
531da177e4SLinus Torvalds mmu_emu_map_pmeg(sun3_get_context(), virt);
541da177e4SLinus Torvalds
551da177e4SLinus Torvalds while(pages) {
561da177e4SLinus Torvalds do_page_mapin(phys, virt, type);
571da177e4SLinus Torvalds phys += PAGE_SIZE;
581da177e4SLinus Torvalds virt += PAGE_SIZE;
591da177e4SLinus Torvalds pages--;
601da177e4SLinus Torvalds }
611da177e4SLinus Torvalds }
621da177e4SLinus Torvalds
sun3_ioremap(unsigned long phys,unsigned long size,unsigned long type)63437111caSAl Viro void __iomem *sun3_ioremap(unsigned long phys, unsigned long size,
641da177e4SLinus Torvalds unsigned long type)
651da177e4SLinus Torvalds {
661da177e4SLinus Torvalds struct vm_struct *area;
671da177e4SLinus Torvalds unsigned long offset, virt, ret;
681da177e4SLinus Torvalds int pages;
691da177e4SLinus Torvalds
701da177e4SLinus Torvalds if(!size)
711da177e4SLinus Torvalds return NULL;
721da177e4SLinus Torvalds
731da177e4SLinus Torvalds /* page align */
741da177e4SLinus Torvalds offset = phys & (PAGE_SIZE-1);
751da177e4SLinus Torvalds phys &= ~(PAGE_SIZE-1);
761da177e4SLinus Torvalds
771da177e4SLinus Torvalds size += offset;
781da177e4SLinus Torvalds size = PAGE_ALIGN(size);
791da177e4SLinus Torvalds if((area = get_vm_area(size, VM_IOREMAP)) == NULL)
801da177e4SLinus Torvalds return NULL;
811da177e4SLinus Torvalds
821da177e4SLinus Torvalds #ifdef SUN3_KMAP_DEBUG
8305b70ff6SGeert Uytterhoeven pr_info("ioremap: got virt %p size %lx(%lx)\n", area->addr, size,
8405b70ff6SGeert Uytterhoeven area->size);
851da177e4SLinus Torvalds #endif
861da177e4SLinus Torvalds
871da177e4SLinus Torvalds pages = size / PAGE_SIZE;
881da177e4SLinus Torvalds virt = (unsigned long)area->addr;
891da177e4SLinus Torvalds ret = virt + offset;
901da177e4SLinus Torvalds
911da177e4SLinus Torvalds while(pages) {
921da177e4SLinus Torvalds int seg_pages;
931da177e4SLinus Torvalds
941da177e4SLinus Torvalds seg_pages = (SUN3_PMEG_SIZE - (virt & SUN3_PMEG_MASK)) / PAGE_SIZE;
951da177e4SLinus Torvalds if(seg_pages > pages)
961da177e4SLinus Torvalds seg_pages = pages;
971da177e4SLinus Torvalds
981da177e4SLinus Torvalds do_pmeg_mapin(phys, virt, type, seg_pages);
991da177e4SLinus Torvalds
1001da177e4SLinus Torvalds pages -= seg_pages;
1011da177e4SLinus Torvalds phys += seg_pages * PAGE_SIZE;
1021da177e4SLinus Torvalds virt += seg_pages * PAGE_SIZE;
1031da177e4SLinus Torvalds }
1041da177e4SLinus Torvalds
105437111caSAl Viro return (void __iomem *)ret;
1061da177e4SLinus Torvalds
1071da177e4SLinus Torvalds }
10888f8bb78SAl Viro EXPORT_SYMBOL(sun3_ioremap);
1091da177e4SLinus Torvalds
1101da177e4SLinus Torvalds
__ioremap(unsigned long phys,unsigned long size,int cache)111437111caSAl Viro void __iomem *__ioremap(unsigned long phys, unsigned long size, int cache)
1121da177e4SLinus Torvalds {
1131da177e4SLinus Torvalds
1141da177e4SLinus Torvalds return sun3_ioremap(phys, size, SUN3_PAGE_TYPE_IO);
1151da177e4SLinus Torvalds
1161da177e4SLinus Torvalds }
1172e811488SAl Viro EXPORT_SYMBOL(__ioremap);
1181da177e4SLinus Torvalds
iounmap(void __iomem * addr)119437111caSAl Viro void iounmap(void __iomem *addr)
1201da177e4SLinus Torvalds {
1211da177e4SLinus Torvalds vfree((void *)(PAGE_MASK & (unsigned long)addr));
1221da177e4SLinus Torvalds }
1232e811488SAl Viro EXPORT_SYMBOL(iounmap);
1241da177e4SLinus Torvalds
1251da177e4SLinus Torvalds /* sun3_map_test(addr, val) -- Reads a byte from addr, storing to val,
1261da177e4SLinus Torvalds * trapping the potential read fault. Returns 0 if the access faulted,
1271da177e4SLinus Torvalds * 1 on success.
1281da177e4SLinus Torvalds *
1291da177e4SLinus Torvalds * This function is primarily used to check addresses on the VME bus.
1301da177e4SLinus Torvalds *
1311da177e4SLinus Torvalds * Mucking with the page fault handler seems a little hackish to me, but
1321da177e4SLinus Torvalds * SunOS, NetBSD, and Mach all implemented this check in such a manner,
1331da177e4SLinus Torvalds * so I figure we're allowed.
1341da177e4SLinus Torvalds */
sun3_map_test(unsigned long addr,char * val)1351da177e4SLinus Torvalds int sun3_map_test(unsigned long addr, char *val)
1361da177e4SLinus Torvalds {
1371da177e4SLinus Torvalds int ret = 0;
1381da177e4SLinus Torvalds
1391da177e4SLinus Torvalds __asm__ __volatile__
1401da177e4SLinus Torvalds (".globl _sun3_map_test_start\n"
1411da177e4SLinus Torvalds "_sun3_map_test_start:\n"
1421da177e4SLinus Torvalds "1: moveb (%2), (%0)\n"
1431da177e4SLinus Torvalds " moveq #1, %1\n"
1441da177e4SLinus Torvalds "2:\n"
1451da177e4SLinus Torvalds ".section .fixup,\"ax\"\n"
1461da177e4SLinus Torvalds ".even\n"
1471da177e4SLinus Torvalds "3: moveq #0, %1\n"
1481da177e4SLinus Torvalds " jmp 2b\n"
1491da177e4SLinus Torvalds ".previous\n"
1501da177e4SLinus Torvalds ".section __ex_table,\"a\"\n"
1511da177e4SLinus Torvalds ".align 4\n"
1521da177e4SLinus Torvalds ".long 1b,3b\n"
1531da177e4SLinus Torvalds ".previous\n"
1541da177e4SLinus Torvalds ".globl _sun3_map_test_end\n"
1551da177e4SLinus Torvalds "_sun3_map_test_end:\n"
1561da177e4SLinus Torvalds : "=a"(val), "=r"(ret)
1571da177e4SLinus Torvalds : "a"(addr));
1581da177e4SLinus Torvalds
1591da177e4SLinus Torvalds return ret;
1601da177e4SLinus Torvalds }
16188f8bb78SAl Viro EXPORT_SYMBOL(sun3_map_test);
162