GuanXuetao | 79725df | 2011-01-15 18:15:01 +0800 | [diff] [blame] | 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 |