arch/m68k/mm/cache.c

   1 // SPDX-License-Identifier: GPL-2.0
   2 /*
   3  *  linux/arch/m68k/mm/cache.c
   4  *
   5  *  Instruction cache handling
   6  *
   7  *  Copyright (C) 1995  Hamish Macdonald
   8  */
   9
  10 #include <linux/module.h>
  11 #include <asm/cacheflush.h>
  12 #include <asm/traps.h>
  13
  14
  15 static unsigned long virt_to_phys_slow(unsigned long vaddr)
  16 {
  17         if (CPU_IS_060) {
  18                 unsigned long paddr;
  19
  20                 /* The PLPAR instruction causes an access error if the translation
  21                  * is not possible. To catch this we use the same exception mechanism
  22                  * as for user space accesses in <asm/uaccess.h>. */
  23                 asm volatile (".chip 68060\n"
  24                               "1: plpar (%0)\n"
  25                               ".chip 68k\n"
  26                               "2:\n"
  27                               ".section .fixup,\"ax\"\n"
  28                               "   .even\n"
  29                               "3: sub.l %0,%0\n"
  30                               "   jra 2b\n"
  31                               ".previous\n"
  32                               ".section __ex_table,\"a\"\n"
  33                               "   .align 4\n"
  34                               "   .long 1b,3b\n"
  35                               ".previous"
  36                               : "=a" (paddr)
  37                               : "0" (vaddr));
  38                 return paddr;
  39         } else if (CPU_IS_040) {
  40                 unsigned long mmusr;
  41
  42                 asm volatile (".chip 68040\n\t"
  43                               "ptestr (%1)\n\t"
  44                               "movec %%mmusr, %0\n\t"
  45                               ".chip 68k"
  46                               : "=r" (mmusr)
  47                               : "a" (vaddr));
  48
  49                 if (mmusr & MMU_R_040)
  50                         return (mmusr & PAGE_MASK) | (vaddr & ~PAGE_MASK);
  51         } else {
  52                 WARN_ON_ONCE(!CPU_IS_040_OR_060);
  53         }
  54         return 0;
  55 }
  56
  57 /* Push n pages at kernel virtual address and clear the icache */
  58 /* RZ: use cpush %bc instead of cpush %dc, cinv %ic */
  59 void flush_icache_user_range(unsigned long address, unsigned long endaddr)
  60 {
  61         if (CPU_IS_COLDFIRE) {
  62                 unsigned long start, end;
  63                 start = address & ICACHE_SET_MASK;
  64                 end = endaddr & ICACHE_SET_MASK;
  65                 if (start > end) {
  66                         flush_cf_icache(0, end);
  67                         end = ICACHE_MAX_ADDR;
  68                 }
  69                 flush_cf_icache(start, end);
  70         } else if (CPU_IS_040_OR_060) {
  71                 address &= PAGE_MASK;
  72
  73                 do {
  74                         asm volatile ("nop\n\t"
  75                                       ".chip 68040\n\t"
  76                                       "cpushp %%bc,(%0)\n\t"
  77                                       ".chip 68k"
  78                                       : : "a" (virt_to_phys_slow(address)));
  79                         address += PAGE_SIZE;
  80                 } while (address < endaddr);
  81         } else {
  82                 unsigned long tmp;
  83                 asm volatile ("movec %%cacr,%0\n\t"
  84                               "orw %1,%0\n\t"
  85                               "movec %0,%%cacr"
  86                               : "=&d" (tmp)
  87                               : "di" (FLUSH_I));
  88         }
  89 }
  90
  91 void flush_icache_range(unsigned long address, unsigned long endaddr)
  92 {
  93         set_fc(SUPER_DATA);
  94         flush_icache_user_range(address, endaddr);
  95         set_fc(USER_DATA);
  96 }
  97 EXPORT_SYMBOL(flush_icache_range);
  98
  99 void flush_icache_user_page(struct vm_area_struct *vma, struct page *page,
 100                              unsigned long addr, int len)
 101 {
 102         if (CPU_IS_COLDFIRE) {
 103                 unsigned long start, end;
 104                 start = addr & ICACHE_SET_MASK;
 105                 end = (addr + len) & ICACHE_SET_MASK;
 106                 if (start > end) {
 107                         flush_cf_icache(0, end);
 108                         end = ICACHE_MAX_ADDR;
 109                 }
 110                 flush_cf_icache(start, end);
 111
 112         } else if (CPU_IS_040_OR_060) {
 113                 asm volatile ("nop\n\t"
 114                               ".chip 68040\n\t"
 115                               "cpushp %%bc,(%0)\n\t"
 116                               ".chip 68k"
 117                               : : "a" (page_to_phys(page)));
 118         } else {
 119                 unsigned long tmp;
 120                 asm volatile ("movec %%cacr,%0\n\t"
 121                               "orw %1,%0\n\t"
 122                               "movec %0,%%cacr"
 123                               : "=&d" (tmp)
 124                               : "di" (FLUSH_I));
 125         }
 126 }
 127