1 
   2 
   3 
   4 
   5 
   6 
   7 
   8 
   9 
  10 #include <linux/init.h>
  11 #include <linux/linkage.h>
  12 #include <asm/asm-offsets.h>
  13 #include <asm/assembler.h>
  14 #include <asm/page.h>
  15 #include <asm/tlbflush.h>
  16 #include "proc-macros.S"
  17 
  18 #define HARVARD_TLB
  19 
  20 
  21 
  22 
  23 
  24 
  25 
  26 
  27 
  28 
  29 
  30 
  31 
  32 
  33 ENTRY(v6wbi_flush_user_tlb_range)
  34         vma_vm_mm r3, r2                        @ get vma->vm_mm
  35         mov     ip, #0
  36         mmid    r3, r3                          @ get vm_mm->context.id
  37         mcr     p15, 0, ip, c7, c10, 4          @ drain write buffer
  38         mov     r0, r0, lsr #PAGE_SHIFT         @ align address
  39         mov     r1, r1, lsr #PAGE_SHIFT
  40         asid    r3, r3                          @ mask ASID
  41         orr     r0, r3, r0, lsl #PAGE_SHIFT     @ Create initial MVA
  42         mov     r1, r1, lsl #PAGE_SHIFT
  43         vma_vm_flags r2, r2                     @ get vma->vm_flags
  44 1:
  45 #ifdef HARVARD_TLB
  46         mcr     p15, 0, r0, c8, c6, 1           @ TLB invalidate D MVA (was 1)
  47         tst     r2, #VM_EXEC                    @ Executable area ?
  48         mcrne   p15, 0, r0, c8, c5, 1           @ TLB invalidate I MVA (was 1)
  49 #else
  50         mcr     p15, 0, r0, c8, c7, 1           @ TLB invalidate MVA (was 1)
  51 #endif
  52         add     r0, r0, #PAGE_SZ
  53         cmp     r0, r1
  54         blo     1b
  55         mcr     p15, 0, ip, c7, c10, 4          @ data synchronization barrier
  56         ret     lr
  57 
  58 
  59 
  60 
  61 
  62 
  63 
  64 
  65 
  66 ENTRY(v6wbi_flush_kern_tlb_range)
  67         mov     r2, #0
  68         mcr     p15, 0, r2, c7, c10, 4          @ drain write buffer
  69         mov     r0, r0, lsr #PAGE_SHIFT         @ align address
  70         mov     r1, r1, lsr #PAGE_SHIFT
  71         mov     r0, r0, lsl #PAGE_SHIFT
  72         mov     r1, r1, lsl #PAGE_SHIFT
  73 1:
  74 #ifdef HARVARD_TLB
  75         mcr     p15, 0, r0, c8, c6, 1           @ TLB invalidate D MVA
  76         mcr     p15, 0, r0, c8, c5, 1           @ TLB invalidate I MVA
  77 #else
  78         mcr     p15, 0, r0, c8, c7, 1           @ TLB invalidate MVA
  79 #endif
  80         add     r0, r0, #PAGE_SZ
  81         cmp     r0, r1
  82         blo     1b
  83         mcr     p15, 0, r2, c7, c10, 4          @ data synchronization barrier
  84         mcr     p15, 0, r2, c7, c5, 4           @ prefetch flush (isb)
  85         ret     lr
  86 
  87         __INIT
  88 
  89         
  90         define_tlb_functions v6wbi, v6wbi_tlb_flags