arch/unicore32/mm/proc-macros.S

   1 /*
   2  * linux/arch/unicore32/mm/proc-macros.S
   3  *
   4  * Code specific to PKUnity SoC and UniCore ISA
   5  *
   6  * Copyright (C) 2001-2010 GUAN Xue-tao
   7  *
   8  * This program is free software; you can redistribute it and/or modify
   9  * it under the terms of the GNU General Public License version 2 as
  10  * published by the Free Software Foundation.
  11  *
  12  * We need constants.h for:
  13  *  VMA_VM_MM
  14  *  VMA_VM_FLAGS
  15  *  VM_EXEC
  16  */
  17 #include <generated/asm-offsets.h>
  18 #include <asm/thread_info.h>
  19 #include <asm/memory.h>
  20
  21 /*
  22  * the cache line sizes of the I and D cache are the same
  23  */
  24 #define CACHE_LINESIZE  32
  25
  26 /*
  27  * This is the maximum size of an area which will be invalidated
  28  * using the single invalidate entry instructions.  Anything larger
  29  * than this, and we go for the whole cache.
  30  *
  31  * This value should be chosen such that we choose the cheapest
  32  * alternative.
  33  */
  34 #ifdef CONFIG_CPU_UCV2
  35 #define MAX_AREA_SIZE   0x800           /* 64 cache line */
  36 #endif
  37
  38 /*
  39  * vma_vm_mm - get mm pointer from vma pointer (vma->vm_mm)
  40  */
  41         .macro  vma_vm_mm, rd, rn
  42         ldw     \rd, [\rn+], #VMA_VM_MM
  43         .endm
  44
  45 /*
  46  * vma_vm_flags - get vma->vm_flags
  47  */
  48         .macro  vma_vm_flags, rd, rn
  49         ldw     \rd, [\rn+], #VMA_VM_FLAGS
  50         .endm
  51
  52         .macro  tsk_mm, rd, rn
  53         ldw     \rd, [\rn+], #TI_TASK
  54         ldw     \rd, [\rd+], #TSK_ACTIVE_MM
  55         .endm
  56
  57 /*
  58  * act_mm - get current->active_mm
  59  */
  60         .macro  act_mm, rd
  61         andn    \rd, sp, #8128
  62         andn    \rd, \rd, #63
  63         ldw     \rd, [\rd+], #TI_TASK
  64         ldw     \rd, [\rd+], #TSK_ACTIVE_MM
  65         .endm
  66
  67 /*
  68  * mmid - get context id from mm pointer (mm->context.id)
  69  */
  70         .macro  mmid, rd, rn
  71         ldw     \rd, [\rn+], #MM_CONTEXT_ID
  72         .endm
  73
  74 /*
  75  * mask_asid - mask the ASID from the context ID
  76  */
  77         .macro  asid, rd, rn
  78         and     \rd, \rn, #255
  79         .endm
  80
  81         .macro  crval, clear, mmuset, ucset
  82         .word   \clear
  83         .word   \mmuset
  84         .endm
  85
  86 #ifndef CONFIG_CPU_DCACHE_LINE_DISABLE
  87 /*
  88  * va2pa va, pa, tbl, msk, off, err
  89  *      This macro is used to translate virtual address to its physical address.
  90  *
  91  *      va: virtual address
  92  *      pa: physical address, result is stored in this register
  93  *      tbl, msk, off:  temp registers, will be destroyed
  94  *      err: jump to error label if the physical address not exist
  95  * NOTE: all regs must be different
  96  */
  97         .macro  va2pa, va, pa, tbl, msk, off, err=990f
  98         movc    \pa, p0.c2, #0
  99         mov     \off, \va >> #22                @ off <- index of 1st page table
 100         adr     \tbl, 910f                      @ tbl <- table of 1st page table
 101 900:                                            @ ---- handle 1, 2 page table
 102         add     \pa, \pa, #PAGE_OFFSET          @ pa <- virt addr of page table
 103         ldw     \pa, [\pa+], \off << #2         @ pa <- the content of pt
 104         cand.a  \pa, #4                         @ test exist bit
 105         beq     \err                            @ if not exist
 106         and     \off, \pa, #3                   @ off <- the last 2 bits
 107         add     \tbl, \tbl, \off << #3          @ cmove table pointer
 108         ldw     \msk, [\tbl+], #0               @ get the mask
 109         ldw     pc, [\tbl+], #4
 110 930:                                            @ ---- handle 2nd page table
 111         and     \pa, \pa, \msk                  @ pa <- phys addr of 2nd pt
 112         mov     \off, \va << #10
 113         cntlo   \tbl, \msk                      @ use tbl as temp reg
 114         mov     \off, \off >> \tbl
 115         mov     \off, \off >> #2                @ off <- index of 2nd pt
 116         adr     \tbl, 920f                      @ tbl <- table of 2nd pt
 117         b       900b
 118 910:                                            @ 1st level page table
 119         .word   0xfffff000, 930b                @ second level page table
 120         .word   0xfffffc00, 930b                @ second level large page table
 121         .word   0x00000000, \err                @ invalid
 122         .word   0xffc00000, 980f                @ super page
 123
 124 920:                                            @ 2nd level page table
 125         .word   0xfffff000, 980f                @ page
 126         .word   0xffffc000, 980f                @ middle page
 127         .word   0xffff0000, 980f                @ large page
 128         .word   0x00000000, \err                @ invalid
 129 980:
 130         andn    \tbl, \va, \msk
 131         and     \pa, \pa, \msk
 132         or      \pa, \pa, \tbl
 133 990:
 134         .endm
 135 #endif
 136
 137         .macro dcacheline_flush, addr, t1, t2
 138         mov     \t1, \addr << #20
 139         ldw     \t2, =_stext                    @ _stext must ALIGN(4096)
 140         add     \t2, \t2, \t1 >> #20
 141         ldw     \t1, [\t2+], #0x0000
 142         ldw     \t1, [\t2+], #0x1000
 143         ldw     \t1, [\t2+], #0x2000
 144         ldw     \t1, [\t2+], #0x3000
 145         .endm