| 1 | |
| 2 | * This file is subject to the terms and conditions of the GNU General Public
|
| 3 | * License. See the file "COPYING" in the main directory of this archive
|
| 4 | * for more details.
|
| 5 | *
|
| 6 | * Inline assembly cache operations.
|
| 7 | *
|
| 8 | * Copyright (C) 1996 David S. Miller ([email protected])
|
| 9 | * Copyright (C) 1997 - 2002 Ralf Baechle ([email protected])
|
| 10 | * Copyright (C) 2004 Ralf Baechle ([email protected])
|
| 11 |
|
| 12 | #ifndef _ASM_R4KCACHE_H
|
| 13 | #define _ASM_R4KCACHE_H
|
| 14 |
|
| 15 | #include <linux/stringify.h>
|
| 16 |
|
| 17 | #include <asm/asm.h>
|
| 18 | #include <asm/asm-eva.h>
|
| 19 | #include <asm/cacheops.h>
|
| 20 | #include <asm/compiler.h>
|
| 21 | #include <asm/cpu-features.h>
|
| 22 | #include <asm/cpu-type.h>
|
| 23 | #include <asm/mipsmtregs.h>
|
| 24 | #include <asm/mmzone.h>
|
| 25 | #include <asm/unroll.h>
|
| 26 |
|
| 27 | extern void r5k_sc_init(void);
|
| 28 | extern void rm7k_sc_init(void);
|
| 29 | extern int mips_sc_init(void);
|
| 30 |
|
| 31 | extern void (*r4k_blast_dcache)(void);
|
| 32 | extern void (*r4k_blast_icache)(void);
|
| 33 |
|
| 34 | |
| 35 | * This macro return a properly sign-extended address suitable as base address
|
| 36 | * for indexed cache operations. Two issues here:
|
| 37 | *
|
| 38 | * - The MIPS32 and MIPS64 specs permit an implementation to directly derive
|
| 39 | * the index bits from the virtual address. This breaks with tradition
|
| 40 | * set by the R4000. To keep unpleasant surprises from happening we pick
|
| 41 | * an address in KSEG0 / CKSEG0.
|
| 42 | * - We need a properly sign extended address for 64-bit code. To get away
|
| 43 | * without ifdefs we let the compiler do it by a type cast.
|
| 44 |
|
| 45 | #define INDEX_BASE CKSEG0
|
| 46 |
|
| 47 | #define _cache_op(insn, op, addr) \
|
| 48 | __asm__ __volatile__( \
|
| 49 | " .set push \n" \
|
| 50 | " .set noreorder \n" \
|
| 51 | " .set "MIPS_ISA_ARCH_LEVEL" \n" \
|
| 52 | " " insn("%0", "%1") " \n" \
|
| 53 | " .set pop \n" \
|
| 54 | : \
|
| 55 | : "i" (op), "R" (*(unsigned char *)(addr)))
|
| 56 |
|
| 57 | #define cache_op(op, addr) \
|
| 58 | _cache_op(kernel_cache, op, addr)
|
| 59 |
|
| 60 | static inline void flush_icache_line_indexed(unsigned long addr)
|
| 61 | {
|
| 62 | cache_op(Index_Invalidate_I, addr);
|
| 63 | }
|
| 64 |
|
| 65 | static inline void flush_dcache_line_indexed(unsigned long addr)
|
| 66 | {
|
| 67 | cache_op(Index_Writeback_Inv_D, addr);
|
| 68 | }
|
| 69 |
|
| 70 | static inline void flush_scache_line_indexed(unsigned long addr)
|
| 71 | {
|
| 72 | cache_op(Index_Writeback_Inv_SD, addr);
|
| 73 | }
|
| 74 |
|
| 75 | static inline void flush_icache_line(unsigned long addr)
|
| 76 | {
|
| 77 | switch (boot_cpu_type()) {
|
| 78 | case CPU_LOONGSON2EF:
|
| 79 | cache_op(Hit_Invalidate_I_Loongson2, addr);
|
| 80 | break;
|
| 81 |
|
| 82 | default:
|
| 83 | cache_op(Hit_Invalidate_I, addr);
|
| 84 | break;
|
| 85 | }
|
| 86 | }
|
| 87 |
|
| 88 | static inline void flush_dcache_line(unsigned long addr)
|
| 89 | {
|
| 90 | cache_op(Hit_Writeback_Inv_D, addr);
|
| 91 | }
|
| 92 |
|
| 93 | static inline void invalidate_dcache_line(unsigned long addr)
|
| 94 | {
|
| 95 | cache_op(Hit_Invalidate_D, addr);
|
| 96 | }
|
| 97 |
|
| 98 | static inline void invalidate_scache_line(unsigned long addr)
|
| 99 | {
|
| 100 | cache_op(Hit_Invalidate_SD, addr);
|
| 101 | }
|
| 102 |
|
| 103 | static inline void flush_scache_line(unsigned long addr)
|
| 104 | {
|
| 105 | cache_op(Hit_Writeback_Inv_SD, addr);
|
| 106 | }
|
| 107 |
|
| 108 | #ifdef CONFIG_EVA
|
| 109 |
|
| 110 | #define protected_cache_op(op, addr) \
|
| 111 | ({ \
|
| 112 | int __err = 0; \
|
| 113 | __asm__ __volatile__( \
|
| 114 | " .set push \n" \
|
| 115 | " .set noreorder \n" \
|
| 116 | " .set mips0 \n" \
|
| 117 | " .set eva \n" \
|
| 118 | "1: cachee %1, (%2) \n" \
|
| 119 | "2: .insn \n" \
|
| 120 | " .set pop \n" \
|
| 121 | " .section .fixup,\"ax\" \n" \
|
| 122 | "3: li %0, %3 \n" \
|
| 123 | " j 2b \n" \
|
| 124 | " .previous \n" \
|
| 125 | " .section __ex_table,\"a\" \n" \
|
| 126 | " "STR(PTR_WD)" 1b, 3b \n" \
|
| 127 | " .previous" \
|
| 128 | : "+r" (__err) \
|
| 129 | : "i" (op), "r" (addr), "i" (-EFAULT)); \
|
| 130 | __err; \
|
| 131 | })
|
| 132 | #else
|
| 133 |
|
| 134 | #define protected_cache_op(op, addr) \
|
| 135 | ({ \
|
| 136 | int __err = 0; \
|
| 137 | __asm__ __volatile__( \
|
| 138 | " .set push \n" \
|
| 139 | " .set noreorder \n" \
|
| 140 | " .set "MIPS_ISA_ARCH_LEVEL" \n" \
|
| 141 | "1: cache %1, (%2) \n" \
|
| 142 | "2: .insn \n" \
|
| 143 | " .set pop \n" \
|
| 144 | " .section .fixup,\"ax\" \n" \
|
| 145 | "3: li %0, %3 \n" \
|
| 146 | " j 2b \n" \
|
| 147 | " .previous \n" \
|
| 148 | " .section __ex_table,\"a\" \n" \
|
| 149 | " "STR(PTR_WD)" 1b, 3b \n" \
|
| 150 | " .previous" \
|
| 151 | : "+r" (__err) \
|
| 152 | : "i" (op), "r" (addr), "i" (-EFAULT)); \
|
| 153 | __err; \
|
| 154 | })
|
| 155 | #endif
|
| 156 |
|
| 157 | |
| 158 | * The next two are for badland addresses like signal trampolines.
|
| 159 |
|
| 160 | static inline int protected_flush_icache_line(unsigned long addr)
|
| 161 | {
|
| 162 | switch (boot_cpu_type()) {
|
| 163 | case CPU_LOONGSON2EF:
|
| 164 | return protected_cache_op(Hit_Invalidate_I_Loongson2, addr);
|
| 165 |
|
| 166 | default:
|
| 167 | return protected_cache_op(Hit_Invalidate_I, addr);
|
| 168 | }
|
| 169 | }
|
| 170 |
|
| 171 | |
| 172 | * R10000 / R12000 hazard - these processors don't support the Hit_Writeback_D
|
| 173 | * cacheop so we use Hit_Writeback_Inv_D which is supported by all R4000-style
|
| 174 | * caches. We're talking about one cacheline unnecessarily getting invalidated
|
| 175 | * here so the penalty isn't overly hard.
|
| 176 |
|
| 177 | static inline int protected_writeback_dcache_line(unsigned long addr)
|
| 178 | {
|
| 179 | return protected_cache_op(Hit_Writeback_Inv_D, addr);
|
| 180 | }
|
| 181 |
|
| 182 | static inline int protected_writeback_scache_line(unsigned long addr)
|
| 183 | {
|
| 184 | return protected_cache_op(Hit_Writeback_Inv_SD, addr);
|
| 185 | }
|
| 186 |
|
| 187 | |
| 188 | * This one is RM7000-specific
|
| 189 |
|
| 190 | static inline void invalidate_tcache_page(unsigned long addr)
|
| 191 | {
|
| 192 | cache_op(Page_Invalidate_T, addr);
|
| 193 | }
|
| 194 |
|
| 195 | #define cache_unroll(times, insn, op, addr, lsize) do { \
|
| 196 | int i = 0; \
|
| 197 | unroll(times, _cache_op, insn, op, (addr) + (i++ * (lsize))); \
|
| 198 | } while (0)
|
| 199 |
|
| 200 |
|
| 201 | #define __BUILD_BLAST_CACHE(pfx, desc, indexop, hitop, lsize, extra) \
|
| 202 | static inline void extra##blast_##pfx##cache##lsize(void) \
|
| 203 | { \
|
| 204 | unsigned long start = INDEX_BASE; \
|
| 205 | unsigned long end = start + current_cpu_data.desc.waysize; \
|
| 206 | unsigned long ws_inc = 1UL << current_cpu_data.desc.waybit; \
|
| 207 | unsigned long ws_end = current_cpu_data.desc.ways << \
|
| 208 | current_cpu_data.desc.waybit; \
|
| 209 | unsigned long ws, addr; \
|
| 210 | \
|
| 211 | for (ws = 0; ws < ws_end; ws += ws_inc) \
|
| 212 | for (addr = start; addr < end; addr += lsize * 32) \
|
| 213 | cache_unroll(32, kernel_cache, indexop, \
|
| 214 | addr | ws, lsize); \
|
| 215 | } \
|
| 216 | \
|
| 217 | static inline void extra##blast_##pfx##cache##lsize##_page(unsigned long page) \
|
| 218 | { \
|
| 219 | unsigned long start = page; \
|
| 220 | unsigned long end = page + PAGE_SIZE; \
|
| 221 | \
|
| 222 | do { \
|
| 223 | cache_unroll(32, kernel_cache, hitop, start, lsize); \
|
| 224 | start += lsize * 32; \
|
| 225 | } while (start < end); \
|
| 226 | } \
|
| 227 | \
|
| 228 | static inline void extra##blast_##pfx##cache##lsize##_page_indexed(unsigned long page) \
|
| 229 | { \
|
| 230 | unsigned long indexmask = current_cpu_data.desc.waysize - 1; \
|
| 231 | unsigned long start = INDEX_BASE + (page & indexmask); \
|
| 232 | unsigned long end = start + PAGE_SIZE; \
|
| 233 | unsigned long ws_inc = 1UL << current_cpu_data.desc.waybit; \
|
| 234 | unsigned long ws_end = current_cpu_data.desc.ways << \
|
| 235 | current_cpu_data.desc.waybit; \
|
| 236 | unsigned long ws, addr; \
|
| 237 | \
|
| 238 | for (ws = 0; ws < ws_end; ws += ws_inc) \
|
| 239 | for (addr = start; addr < end; addr += lsize * 32) \
|
| 240 | cache_unroll(32, kernel_cache, indexop, \
|
| 241 | addr | ws, lsize); \
|
| 242 | }
|
| 243 |
|
| 244 | __BUILD_BLAST_CACHE(d, dcache, Index_Writeback_Inv_D, Hit_Writeback_Inv_D, 16, )
|
| 245 | __BUILD_BLAST_CACHE(i, icache, Index_Invalidate_I, Hit_Invalidate_I, 16, )
|
| 246 | __BUILD_BLAST_CACHE(s, scache, Index_Writeback_Inv_SD, Hit_Writeback_Inv_SD, 16, )
|
| 247 | __BUILD_BLAST_CACHE(d, dcache, Index_Writeback_Inv_D, Hit_Writeback_Inv_D, 32, )
|
| 248 | __BUILD_BLAST_CACHE(i, icache, Index_Invalidate_I, Hit_Invalidate_I, 32, )
|
| 249 | __BUILD_BLAST_CACHE(i, icache, Index_Invalidate_I, Hit_Invalidate_I_Loongson2, 32, loongson2_)
|
| 250 | __BUILD_BLAST_CACHE(s, scache, Index_Writeback_Inv_SD, Hit_Writeback_Inv_SD, 32, )
|
| 251 | __BUILD_BLAST_CACHE(d, dcache, Index_Writeback_Inv_D, Hit_Writeback_Inv_D, 64, )
|
| 252 | __BUILD_BLAST_CACHE(i, icache, Index_Invalidate_I, Hit_Invalidate_I, 64, )
|
| 253 | __BUILD_BLAST_CACHE(s, scache, Index_Writeback_Inv_SD, Hit_Writeback_Inv_SD, 64, )
|
| 254 | __BUILD_BLAST_CACHE(d, dcache, Index_Writeback_Inv_D, Hit_Writeback_Inv_D, 128, )
|
| 255 | __BUILD_BLAST_CACHE(i, icache, Index_Invalidate_I, Hit_Invalidate_I, 128, )
|
| 256 | __BUILD_BLAST_CACHE(s, scache, Index_Writeback_Inv_SD, Hit_Writeback_Inv_SD, 128, )
|
| 257 |
|
| 258 | __BUILD_BLAST_CACHE(inv_d, dcache, Index_Writeback_Inv_D, Hit_Invalidate_D, 16, )
|
| 259 | __BUILD_BLAST_CACHE(inv_d, dcache, Index_Writeback_Inv_D, Hit_Invalidate_D, 32, )
|
| 260 | __BUILD_BLAST_CACHE(inv_s, scache, Index_Writeback_Inv_SD, Hit_Invalidate_SD, 16, )
|
| 261 | __BUILD_BLAST_CACHE(inv_s, scache, Index_Writeback_Inv_SD, Hit_Invalidate_SD, 32, )
|
| 262 | __BUILD_BLAST_CACHE(inv_s, scache, Index_Writeback_Inv_SD, Hit_Invalidate_SD, 64, )
|
| 263 | __BUILD_BLAST_CACHE(inv_s, scache, Index_Writeback_Inv_SD, Hit_Invalidate_SD, 128, )
|
| 264 |
|
| 265 | #define __BUILD_BLAST_USER_CACHE(pfx, desc, indexop, hitop, lsize) \
|
| 266 | static inline void blast_##pfx##cache##lsize##_user_page(unsigned long page) \
|
| 267 | { \
|
| 268 | unsigned long start = page; \
|
| 269 | unsigned long end = page + PAGE_SIZE; \
|
| 270 | \
|
| 271 | do { \
|
| 272 | cache_unroll(32, user_cache, hitop, start, lsize); \
|
| 273 | start += lsize * 32; \
|
| 274 | } while (start < end); \
|
| 275 | }
|
| 276 |
|
| 277 | __BUILD_BLAST_USER_CACHE(d, dcache, Index_Writeback_Inv_D, Hit_Writeback_Inv_D,
|
| 278 | 16)
|
| 279 | __BUILD_BLAST_USER_CACHE(i, icache, Index_Invalidate_I, Hit_Invalidate_I, 16)
|
| 280 | __BUILD_BLAST_USER_CACHE(d, dcache, Index_Writeback_Inv_D, Hit_Writeback_Inv_D,
|
| 281 | 32)
|
| 282 | __BUILD_BLAST_USER_CACHE(i, icache, Index_Invalidate_I, Hit_Invalidate_I, 32)
|
| 283 | __BUILD_BLAST_USER_CACHE(d, dcache, Index_Writeback_Inv_D, Hit_Writeback_Inv_D,
|
| 284 | 64)
|
| 285 | __BUILD_BLAST_USER_CACHE(i, icache, Index_Invalidate_I, Hit_Invalidate_I, 64)
|
| 286 |
|
| 287 |
|
| 288 | #define __BUILD_BLAST_CACHE_RANGE(pfx, desc, hitop, prot, extra) \
|
| 289 | static inline void prot##extra##blast_##pfx##cache##_range(unsigned long start, \
|
| 290 | unsigned long end) \
|
| 291 | { \
|
| 292 | unsigned long lsize = cpu_##desc##_line_size(); \
|
| 293 | unsigned long addr = start & ~(lsize - 1); \
|
| 294 | unsigned long aend = (end - 1) & ~(lsize - 1); \
|
| 295 | \
|
| 296 | while (1) { \
|
| 297 | prot##cache_op(hitop, addr); \
|
| 298 | if (addr == aend) \
|
| 299 | break; \
|
| 300 | addr += lsize; \
|
| 301 | } \
|
| 302 | }
|
| 303 |
|
| 304 | __BUILD_BLAST_CACHE_RANGE(d, dcache, Hit_Writeback_Inv_D, protected_, )
|
| 305 | __BUILD_BLAST_CACHE_RANGE(i, icache, Hit_Invalidate_I, protected_, )
|
| 306 | __BUILD_BLAST_CACHE_RANGE(s, scache, Hit_Writeback_Inv_SD, protected_, )
|
| 307 | __BUILD_BLAST_CACHE_RANGE(i, icache, Hit_Invalidate_I_Loongson2, \
|
| 308 | protected_, loongson2_)
|
| 309 | __BUILD_BLAST_CACHE_RANGE(d, dcache, Hit_Writeback_Inv_D, , )
|
| 310 | __BUILD_BLAST_CACHE_RANGE(i, icache, Hit_Invalidate_I, , )
|
| 311 | __BUILD_BLAST_CACHE_RANGE(s, scache, Hit_Writeback_Inv_SD, , )
|
| 312 |
|
| 313 | __BUILD_BLAST_CACHE_RANGE(inv_d, dcache, Hit_Invalidate_D, , )
|
| 314 | __BUILD_BLAST_CACHE_RANGE(inv_s, scache, Hit_Invalidate_SD, , )
|
| 315 |
|
| 316 |
|
| 317 | #define __BUILD_BLAST_CACHE_NODE(pfx, desc, indexop, hitop, lsize) \
|
| 318 | static inline void blast_##pfx##cache##lsize##_node(long node) \
|
| 319 | { \
|
| 320 | unsigned long start = CAC_BASE | nid_to_addrbase(node); \
|
| 321 | unsigned long end = start + current_cpu_data.desc.waysize; \
|
| 322 | unsigned long ws_inc = 1UL << current_cpu_data.desc.waybit; \
|
| 323 | unsigned long ws_end = current_cpu_data.desc.ways << \
|
| 324 | current_cpu_data.desc.waybit; \
|
| 325 | unsigned long ws, addr; \
|
| 326 | \
|
| 327 | for (ws = 0; ws < ws_end; ws += ws_inc) \
|
| 328 | for (addr = start; addr < end; addr += lsize * 32) \
|
| 329 | cache_unroll(32, kernel_cache, indexop, \
|
| 330 | addr | ws, lsize); \
|
| 331 | }
|
| 332 |
|
| 333 | __BUILD_BLAST_CACHE_NODE(s, scache, Index_Writeback_Inv_SD, Hit_Writeback_Inv_SD, 16)
|
| 334 | __BUILD_BLAST_CACHE_NODE(s, scache, Index_Writeback_Inv_SD, Hit_Writeback_Inv_SD, 32)
|
| 335 | __BUILD_BLAST_CACHE_NODE(s, scache, Index_Writeback_Inv_SD, Hit_Writeback_Inv_SD, 64)
|
| 336 | __BUILD_BLAST_CACHE_NODE(s, scache, Index_Writeback_Inv_SD, Hit_Writeback_Inv_SD, 128)
|
| 337 |
|
| 338 | #endif
|