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