c-r4k.c 38.0 KB
Newer Older
L
Linus Torvalds 已提交
1 2 3 4 5
/*
 * This file is subject to the terms and conditions of the GNU General Public
 * License.  See the file "COPYING" in the main directory of this archive
 * for more details.
 *
6
 * Copyright (C) 1996 David S. Miller (davem@davemloft.net)
L
Linus Torvalds 已提交
7 8 9
 * Copyright (C) 1997, 1998, 1999, 2000, 2001, 2002 Ralf Baechle (ralf@gnu.org)
 * Copyright (C) 1999, 2000 Silicon Graphics, Inc.
 */
10
#include <linux/hardirq.h>
L
Linus Torvalds 已提交
11
#include <linux/init.h>
R
Ralf Baechle 已提交
12
#include <linux/highmem.h>
L
Linus Torvalds 已提交
13
#include <linux/kernel.h>
14
#include <linux/linkage.h>
L
Linus Torvalds 已提交
15
#include <linux/sched.h>
16
#include <linux/smp.h>
L
Linus Torvalds 已提交
17
#include <linux/mm.h>
18
#include <linux/module.h>
L
Linus Torvalds 已提交
19 20 21 22
#include <linux/bitops.h>

#include <asm/bcache.h>
#include <asm/bootinfo.h>
R
Ralf Baechle 已提交
23
#include <asm/cache.h>
L
Linus Torvalds 已提交
24 25 26 27 28 29 30
#include <asm/cacheops.h>
#include <asm/cpu.h>
#include <asm/cpu-features.h>
#include <asm/io.h>
#include <asm/page.h>
#include <asm/pgtable.h>
#include <asm/r4kcache.h>
31
#include <asm/sections.h>
L
Linus Torvalds 已提交
32 33
#include <asm/mmu_context.h>
#include <asm/war.h>
34
#include <asm/cacheflush.h> /* for run_uncached() */
35
#include <asm/traps.h>
36 37 38 39 40 41 42 43

/*
 * Special Variant of smp_call_function for use by cache functions:
 *
 *  o No return value
 *  o collapses to normal function call on UP kernels
 *  o collapses to normal function call on systems with a single shared
 *    primary cache.
44
 *  o doesn't disable interrupts on the local CPU
45
 */
46
static inline void r4k_on_each_cpu(void (*func) (void *info), void *info)
47 48 49 50
{
	preempt_disable();

#if !defined(CONFIG_MIPS_MT_SMP) && !defined(CONFIG_MIPS_MT_SMTC)
51
	smp_call_function(func, info, 1);
52 53 54 55 56
#endif
	func(info);
	preempt_enable();
}

57 58 59 60 61 62
#if defined(CONFIG_MIPS_CMP)
#define cpu_has_safe_index_cacheops 0
#else
#define cpu_has_safe_index_cacheops 1
#endif

R
Ralf Baechle 已提交
63 64 65 66 67 68
/*
 * Must die.
 */
static unsigned long icache_size __read_mostly;
static unsigned long dcache_size __read_mostly;
static unsigned long scache_size __read_mostly;
L
Linus Torvalds 已提交
69 70 71 72

/*
 * Dummy cache handling routines for machines without boardcaches
 */
73
static void cache_noop(void) {}
L
Linus Torvalds 已提交
74 75

static struct bcache_ops no_sc_ops = {
76 77 78 79
	.bc_enable = (void *)cache_noop,
	.bc_disable = (void *)cache_noop,
	.bc_wback_inv = (void *)cache_noop,
	.bc_inv = (void *)cache_noop
L
Linus Torvalds 已提交
80 81 82 83
};

struct bcache_ops *bcops = &no_sc_ops;

84 85
#define cpu_is_r4600_v1_x()	((read_c0_prid() & 0xfffffff0) == 0x00002010)
#define cpu_is_r4600_v2_x()	((read_c0_prid() & 0xfffffff0) == 0x00002020)
L
Linus Torvalds 已提交
86 87 88 89 90 91 92 93 94 95 96 97 98 99 100 101 102

#define R4600_HIT_CACHEOP_WAR_IMPL					\
do {									\
	if (R4600_V2_HIT_CACHEOP_WAR && cpu_is_r4600_v2_x())		\
		*(volatile unsigned long *)CKSEG1;			\
	if (R4600_V1_HIT_CACHEOP_WAR)					\
		__asm__ __volatile__("nop;nop;nop;nop");		\
} while (0)

static void (*r4k_blast_dcache_page)(unsigned long addr);

static inline void r4k_blast_dcache_page_dc32(unsigned long addr)
{
	R4600_HIT_CACHEOP_WAR_IMPL;
	blast_dcache32_page(addr);
}

103 104 105 106 107 108
static inline void r4k_blast_dcache_page_dc64(unsigned long addr)
{
	R4600_HIT_CACHEOP_WAR_IMPL;
	blast_dcache64_page(addr);
}

109
static void __cpuinit r4k_blast_dcache_page_setup(void)
L
Linus Torvalds 已提交
110 111 112
{
	unsigned long  dc_lsize = cpu_dcache_line_size();

113 114 115
	if (dc_lsize == 0)
		r4k_blast_dcache_page = (void *)cache_noop;
	else if (dc_lsize == 16)
L
Linus Torvalds 已提交
116 117 118
		r4k_blast_dcache_page = blast_dcache16_page;
	else if (dc_lsize == 32)
		r4k_blast_dcache_page = r4k_blast_dcache_page_dc32;
119 120
	else if (dc_lsize == 64)
		r4k_blast_dcache_page = r4k_blast_dcache_page_dc64;
L
Linus Torvalds 已提交
121 122 123 124
}

static void (* r4k_blast_dcache_page_indexed)(unsigned long addr);

125
static void __cpuinit r4k_blast_dcache_page_indexed_setup(void)
L
Linus Torvalds 已提交
126 127 128
{
	unsigned long dc_lsize = cpu_dcache_line_size();

129 130 131
	if (dc_lsize == 0)
		r4k_blast_dcache_page_indexed = (void *)cache_noop;
	else if (dc_lsize == 16)
L
Linus Torvalds 已提交
132 133 134
		r4k_blast_dcache_page_indexed = blast_dcache16_page_indexed;
	else if (dc_lsize == 32)
		r4k_blast_dcache_page_indexed = blast_dcache32_page_indexed;
135 136
	else if (dc_lsize == 64)
		r4k_blast_dcache_page_indexed = blast_dcache64_page_indexed;
L
Linus Torvalds 已提交
137 138 139 140
}

static void (* r4k_blast_dcache)(void);

141
static void __cpuinit r4k_blast_dcache_setup(void)
L
Linus Torvalds 已提交
142 143 144
{
	unsigned long dc_lsize = cpu_dcache_line_size();

145 146 147
	if (dc_lsize == 0)
		r4k_blast_dcache = (void *)cache_noop;
	else if (dc_lsize == 16)
L
Linus Torvalds 已提交
148 149 150
		r4k_blast_dcache = blast_dcache16;
	else if (dc_lsize == 32)
		r4k_blast_dcache = blast_dcache32;
151 152
	else if (dc_lsize == 64)
		r4k_blast_dcache = blast_dcache64;
L
Linus Torvalds 已提交
153 154 155 156 157 158 159 160 161 162
}

/* force code alignment (used for TX49XX_ICACHE_INDEX_INV_WAR) */
#define JUMP_TO_ALIGN(order) \
	__asm__ __volatile__( \
		"b\t1f\n\t" \
		".align\t" #order "\n\t" \
		"1:\n\t" \
		)
#define CACHE32_UNROLL32_ALIGN	JUMP_TO_ALIGN(10) /* 32 * 32 = 1024 */
R
Ralf Baechle 已提交
163
#define CACHE32_UNROLL32_ALIGN2 JUMP_TO_ALIGN(11)
L
Linus Torvalds 已提交
164 165 166 167 168 169 170 171 172 173 174 175 176 177 178 179

static inline void blast_r4600_v1_icache32(void)
{
	unsigned long flags;

	local_irq_save(flags);
	blast_icache32();
	local_irq_restore(flags);
}

static inline void tx49_blast_icache32(void)
{
	unsigned long start = INDEX_BASE;
	unsigned long end = start + current_cpu_data.icache.waysize;
	unsigned long ws_inc = 1UL << current_cpu_data.icache.waybit;
	unsigned long ws_end = current_cpu_data.icache.ways <<
R
Ralf Baechle 已提交
180
			       current_cpu_data.icache.waybit;
L
Linus Torvalds 已提交
181 182 183 184
	unsigned long ws, addr;

	CACHE32_UNROLL32_ALIGN2;
	/* I'm in even chunk.  blast odd chunks */
185 186
	for (ws = 0; ws < ws_end; ws += ws_inc)
		for (addr = start + 0x400; addr < end; addr += 0x400 * 2)
187
			cache32_unroll32(addr|ws, Index_Invalidate_I);
L
Linus Torvalds 已提交
188 189
	CACHE32_UNROLL32_ALIGN;
	/* I'm in odd chunk.  blast even chunks */
190 191
	for (ws = 0; ws < ws_end; ws += ws_inc)
		for (addr = start; addr < end; addr += 0x400 * 2)
192
			cache32_unroll32(addr|ws, Index_Invalidate_I);
L
Linus Torvalds 已提交
193 194 195 196 197 198 199 200 201 202 203 204 205
}

static inline void blast_icache32_r4600_v1_page_indexed(unsigned long page)
{
	unsigned long flags;

	local_irq_save(flags);
	blast_icache32_page_indexed(page);
	local_irq_restore(flags);
}

static inline void tx49_blast_icache32_page_indexed(unsigned long page)
{
206 207
	unsigned long indexmask = current_cpu_data.icache.waysize - 1;
	unsigned long start = INDEX_BASE + (page & indexmask);
L
Linus Torvalds 已提交
208 209 210
	unsigned long end = start + PAGE_SIZE;
	unsigned long ws_inc = 1UL << current_cpu_data.icache.waybit;
	unsigned long ws_end = current_cpu_data.icache.ways <<
R
Ralf Baechle 已提交
211
			       current_cpu_data.icache.waybit;
L
Linus Torvalds 已提交
212 213 214 215
	unsigned long ws, addr;

	CACHE32_UNROLL32_ALIGN2;
	/* I'm in even chunk.  blast odd chunks */
216 217
	for (ws = 0; ws < ws_end; ws += ws_inc)
		for (addr = start + 0x400; addr < end; addr += 0x400 * 2)
218
			cache32_unroll32(addr|ws, Index_Invalidate_I);
L
Linus Torvalds 已提交
219 220
	CACHE32_UNROLL32_ALIGN;
	/* I'm in odd chunk.  blast even chunks */
221 222
	for (ws = 0; ws < ws_end; ws += ws_inc)
		for (addr = start; addr < end; addr += 0x400 * 2)
223
			cache32_unroll32(addr|ws, Index_Invalidate_I);
L
Linus Torvalds 已提交
224 225 226 227
}

static void (* r4k_blast_icache_page)(unsigned long addr);

228
static void __cpuinit r4k_blast_icache_page_setup(void)
L
Linus Torvalds 已提交
229 230 231
{
	unsigned long ic_lsize = cpu_icache_line_size();

232 233 234
	if (ic_lsize == 0)
		r4k_blast_icache_page = (void *)cache_noop;
	else if (ic_lsize == 16)
L
Linus Torvalds 已提交
235 236 237 238 239 240 241 242 243 244
		r4k_blast_icache_page = blast_icache16_page;
	else if (ic_lsize == 32)
		r4k_blast_icache_page = blast_icache32_page;
	else if (ic_lsize == 64)
		r4k_blast_icache_page = blast_icache64_page;
}


static void (* r4k_blast_icache_page_indexed)(unsigned long addr);

245
static void __cpuinit r4k_blast_icache_page_indexed_setup(void)
L
Linus Torvalds 已提交
246 247 248
{
	unsigned long ic_lsize = cpu_icache_line_size();

249 250 251
	if (ic_lsize == 0)
		r4k_blast_icache_page_indexed = (void *)cache_noop;
	else if (ic_lsize == 16)
L
Linus Torvalds 已提交
252 253
		r4k_blast_icache_page_indexed = blast_icache16_page_indexed;
	else if (ic_lsize == 32) {
T
Thiemo Seufer 已提交
254
		if (R4600_V1_INDEX_ICACHEOP_WAR && cpu_is_r4600_v1_x())
L
Linus Torvalds 已提交
255 256
			r4k_blast_icache_page_indexed =
				blast_icache32_r4600_v1_page_indexed;
T
Thiemo Seufer 已提交
257 258 259
		else if (TX49XX_ICACHE_INDEX_INV_WAR)
			r4k_blast_icache_page_indexed =
				tx49_blast_icache32_page_indexed;
L
Linus Torvalds 已提交
260 261 262 263 264 265 266 267 268
		else
			r4k_blast_icache_page_indexed =
				blast_icache32_page_indexed;
	} else if (ic_lsize == 64)
		r4k_blast_icache_page_indexed = blast_icache64_page_indexed;
}

static void (* r4k_blast_icache)(void);

269
static void __cpuinit r4k_blast_icache_setup(void)
L
Linus Torvalds 已提交
270 271 272
{
	unsigned long ic_lsize = cpu_icache_line_size();

273 274 275
	if (ic_lsize == 0)
		r4k_blast_icache = (void *)cache_noop;
	else if (ic_lsize == 16)
L
Linus Torvalds 已提交
276 277 278 279 280 281 282 283 284 285 286 287 288 289
		r4k_blast_icache = blast_icache16;
	else if (ic_lsize == 32) {
		if (R4600_V1_INDEX_ICACHEOP_WAR && cpu_is_r4600_v1_x())
			r4k_blast_icache = blast_r4600_v1_icache32;
		else if (TX49XX_ICACHE_INDEX_INV_WAR)
			r4k_blast_icache = tx49_blast_icache32;
		else
			r4k_blast_icache = blast_icache32;
	} else if (ic_lsize == 64)
		r4k_blast_icache = blast_icache64;
}

static void (* r4k_blast_scache_page)(unsigned long addr);

290
static void __cpuinit r4k_blast_scache_page_setup(void)
L
Linus Torvalds 已提交
291 292 293
{
	unsigned long sc_lsize = cpu_scache_line_size();

294
	if (scache_size == 0)
295
		r4k_blast_scache_page = (void *)cache_noop;
296
	else if (sc_lsize == 16)
L
Linus Torvalds 已提交
297 298 299 300 301 302 303 304 305 306 307
		r4k_blast_scache_page = blast_scache16_page;
	else if (sc_lsize == 32)
		r4k_blast_scache_page = blast_scache32_page;
	else if (sc_lsize == 64)
		r4k_blast_scache_page = blast_scache64_page;
	else if (sc_lsize == 128)
		r4k_blast_scache_page = blast_scache128_page;
}

static void (* r4k_blast_scache_page_indexed)(unsigned long addr);

308
static void __cpuinit r4k_blast_scache_page_indexed_setup(void)
L
Linus Torvalds 已提交
309 310 311
{
	unsigned long sc_lsize = cpu_scache_line_size();

312
	if (scache_size == 0)
313
		r4k_blast_scache_page_indexed = (void *)cache_noop;
314
	else if (sc_lsize == 16)
L
Linus Torvalds 已提交
315 316 317 318 319 320 321 322 323 324 325
		r4k_blast_scache_page_indexed = blast_scache16_page_indexed;
	else if (sc_lsize == 32)
		r4k_blast_scache_page_indexed = blast_scache32_page_indexed;
	else if (sc_lsize == 64)
		r4k_blast_scache_page_indexed = blast_scache64_page_indexed;
	else if (sc_lsize == 128)
		r4k_blast_scache_page_indexed = blast_scache128_page_indexed;
}

static void (* r4k_blast_scache)(void);

326
static void __cpuinit r4k_blast_scache_setup(void)
L
Linus Torvalds 已提交
327 328 329
{
	unsigned long sc_lsize = cpu_scache_line_size();

330
	if (scache_size == 0)
331
		r4k_blast_scache = (void *)cache_noop;
332
	else if (sc_lsize == 16)
L
Linus Torvalds 已提交
333 334 335 336 337 338 339 340 341 342 343
		r4k_blast_scache = blast_scache16;
	else if (sc_lsize == 32)
		r4k_blast_scache = blast_scache32;
	else if (sc_lsize == 64)
		r4k_blast_scache = blast_scache64;
	else if (sc_lsize == 128)
		r4k_blast_scache = blast_scache128;
}

static inline void local_r4k___flush_cache_all(void * args)
{
344 345 346 347
#if defined(CONFIG_CPU_LOONGSON2)
	r4k_blast_scache();
	return;
#endif
L
Linus Torvalds 已提交
348 349 350
	r4k_blast_dcache();
	r4k_blast_icache();

351
	switch (current_cpu_type()) {
L
Linus Torvalds 已提交
352 353 354 355 356 357
	case CPU_R4000SC:
	case CPU_R4000MC:
	case CPU_R4400SC:
	case CPU_R4400MC:
	case CPU_R10000:
	case CPU_R12000:
K
Kumba 已提交
358
	case CPU_R14000:
L
Linus Torvalds 已提交
359 360 361 362 363 364
		r4k_blast_scache();
	}
}

static void r4k___flush_cache_all(void)
{
365
	r4k_on_each_cpu(local_r4k___flush_cache_all, NULL);
L
Linus Torvalds 已提交
366 367
}

368 369 370 371 372 373 374 375 376 377 378 379 380 381 382
static inline int has_valid_asid(const struct mm_struct *mm)
{
#if defined(CONFIG_MIPS_MT_SMP) || defined(CONFIG_MIPS_MT_SMTC)
	int i;

	for_each_online_cpu(i)
		if (cpu_context(i, mm))
			return 1;

	return 0;
#else
	return cpu_context(smp_processor_id(), mm);
#endif
}

383 384 385 386 387 388 389 390 391 392
static void r4k__flush_cache_vmap(void)
{
	r4k_blast_dcache();
}

static void r4k__flush_cache_vunmap(void)
{
	r4k_blast_dcache();
}

L
Linus Torvalds 已提交
393 394 395
static inline void local_r4k_flush_cache_range(void * args)
{
	struct vm_area_struct *vma = args;
396
	int exec = vma->vm_flags & VM_EXEC;
L
Linus Torvalds 已提交
397

398
	if (!(has_valid_asid(vma->vm_mm)))
L
Linus Torvalds 已提交
399 400
		return;

401
	r4k_blast_dcache();
402 403
	if (exec)
		r4k_blast_icache();
L
Linus Torvalds 已提交
404 405 406 407 408
}

static void r4k_flush_cache_range(struct vm_area_struct *vma,
	unsigned long start, unsigned long end)
{
409
	int exec = vma->vm_flags & VM_EXEC;
410

411
	if (cpu_has_dc_aliases || (exec && !cpu_has_ic_fills_f_dc))
412
		r4k_on_each_cpu(local_r4k_flush_cache_range, vma);
L
Linus Torvalds 已提交
413 414 415 416 417 418
}

static inline void local_r4k_flush_cache_mm(void * args)
{
	struct mm_struct *mm = args;

419
	if (!has_valid_asid(mm))
L
Linus Torvalds 已提交
420 421 422 423 424
		return;

	/*
	 * Kludge alert.  For obscure reasons R4000SC and R4400SC go nuts if we
	 * only flush the primary caches but R10000 and R12000 behave sane ...
425 426
	 * R4000SC and R4400SC indexed S-cache ops also invalidate primary
	 * caches, so we can bail out early.
L
Linus Torvalds 已提交
427
	 */
428 429 430 431
	if (current_cpu_type() == CPU_R4000SC ||
	    current_cpu_type() == CPU_R4000MC ||
	    current_cpu_type() == CPU_R4400SC ||
	    current_cpu_type() == CPU_R4400MC) {
L
Linus Torvalds 已提交
432
		r4k_blast_scache();
433 434 435 436
		return;
	}

	r4k_blast_dcache();
L
Linus Torvalds 已提交
437 438 439 440 441 442 443
}

static void r4k_flush_cache_mm(struct mm_struct *mm)
{
	if (!cpu_has_dc_aliases)
		return;

444
	r4k_on_each_cpu(local_r4k_flush_cache_mm, mm);
L
Linus Torvalds 已提交
445 446 447 448
}

struct flush_cache_page_args {
	struct vm_area_struct *vma;
449
	unsigned long addr;
450
	unsigned long pfn;
L
Linus Torvalds 已提交
451 452 453 454 455 456
};

static inline void local_r4k_flush_cache_page(void *args)
{
	struct flush_cache_page_args *fcp_args = args;
	struct vm_area_struct *vma = fcp_args->vma;
457
	unsigned long addr = fcp_args->addr;
R
Ralf Baechle 已提交
458
	struct page *page = pfn_to_page(fcp_args->pfn);
L
Linus Torvalds 已提交
459 460
	int exec = vma->vm_flags & VM_EXEC;
	struct mm_struct *mm = vma->vm_mm;
461
	int map_coherent = 0;
L
Linus Torvalds 已提交
462
	pgd_t *pgdp;
463
	pud_t *pudp;
L
Linus Torvalds 已提交
464 465
	pmd_t *pmdp;
	pte_t *ptep;
R
Ralf Baechle 已提交
466
	void *vaddr;
L
Linus Torvalds 已提交
467

468 469 470 471
	/*
	 * If ownes no valid ASID yet, cannot possibly have gotten
	 * this page into the cache.
	 */
472
	if (!has_valid_asid(mm))
473 474
		return;

475 476 477 478 479
	addr &= PAGE_MASK;
	pgdp = pgd_offset(mm, addr);
	pudp = pud_offset(pgdp, addr);
	pmdp = pmd_offset(pudp, addr);
	ptep = pte_offset(pmdp, addr);
L
Linus Torvalds 已提交
480 481 482 483 484

	/*
	 * If the page isn't marked valid, the page cannot possibly be
	 * in the cache.
	 */
485
	if (!(pte_present(*ptep)))
L
Linus Torvalds 已提交
486 487
		return;

R
Ralf Baechle 已提交
488 489 490 491 492 493 494
	if ((mm == current->active_mm) && (pte_val(*ptep) & _PAGE_VALID))
		vaddr = NULL;
	else {
		/*
		 * Use kmap_coherent or kmap_atomic to do flushes for
		 * another ASID than the current one.
		 */
495 496 497
		map_coherent = (cpu_has_dc_aliases &&
				page_mapped(page) && !Page_dcache_dirty(page));
		if (map_coherent)
R
Ralf Baechle 已提交
498 499
			vaddr = kmap_coherent(page, addr);
		else
500
			vaddr = kmap_atomic(page);
R
Ralf Baechle 已提交
501
		addr = (unsigned long)vaddr;
L
Linus Torvalds 已提交
502 503 504
	}

	if (cpu_has_dc_aliases || (exec && !cpu_has_ic_fills_f_dc)) {
R
Ralf Baechle 已提交
505
		r4k_blast_dcache_page(addr);
506 507
		if (exec && !cpu_icache_snoops_remote_store)
			r4k_blast_scache_page(addr);
L
Linus Torvalds 已提交
508 509
	}
	if (exec) {
R
Ralf Baechle 已提交
510
		if (vaddr && cpu_has_vtag_icache && mm == current->active_mm) {
L
Linus Torvalds 已提交
511 512
			int cpu = smp_processor_id();

T
Thiemo Seufer 已提交
513 514
			if (cpu_context(cpu, mm) != 0)
				drop_mmu_context(mm, cpu);
L
Linus Torvalds 已提交
515
		} else
R
Ralf Baechle 已提交
516 517 518 519
			r4k_blast_icache_page(addr);
	}

	if (vaddr) {
520
		if (map_coherent)
R
Ralf Baechle 已提交
521 522
			kunmap_coherent();
		else
523
			kunmap_atomic(vaddr);
L
Linus Torvalds 已提交
524 525 526
	}
}

527 528
static void r4k_flush_cache_page(struct vm_area_struct *vma,
	unsigned long addr, unsigned long pfn)
L
Linus Torvalds 已提交
529 530 531 532
{
	struct flush_cache_page_args args;

	args.vma = vma;
533
	args.addr = addr;
534
	args.pfn = pfn;
L
Linus Torvalds 已提交
535

536
	r4k_on_each_cpu(local_r4k_flush_cache_page, &args);
L
Linus Torvalds 已提交
537 538 539 540 541 542 543 544 545
}

static inline void local_r4k_flush_data_cache_page(void * addr)
{
	r4k_blast_dcache_page((unsigned long) addr);
}

static void r4k_flush_data_cache_page(unsigned long addr)
{
546 547 548
	if (in_atomic())
		local_r4k_flush_data_cache_page((void *)addr);
	else
549
		r4k_on_each_cpu(local_r4k_flush_data_cache_page, (void *) addr);
L
Linus Torvalds 已提交
550 551 552
}

struct flush_icache_range_args {
553 554
	unsigned long start;
	unsigned long end;
L
Linus Torvalds 已提交
555 556
};

557
static inline void local_r4k_flush_icache_range(unsigned long start, unsigned long end)
L
Linus Torvalds 已提交
558 559
{
	if (!cpu_has_ic_fills_f_dc) {
560
		if (end - start >= dcache_size) {
L
Linus Torvalds 已提交
561 562
			r4k_blast_dcache();
		} else {
563
			R4600_HIT_CACHEOP_WAR_IMPL;
564
			protected_blast_dcache_range(start, end);
L
Linus Torvalds 已提交
565 566 567 568 569
		}
	}

	if (end - start > icache_size)
		r4k_blast_icache();
570 571
	else
		protected_blast_icache_range(start, end);
L
Linus Torvalds 已提交
572 573
}

574 575 576 577 578 579 580 581 582
static inline void local_r4k_flush_icache_range_ipi(void *args)
{
	struct flush_icache_range_args *fir_args = args;
	unsigned long start = fir_args->start;
	unsigned long end = fir_args->end;

	local_r4k_flush_icache_range(start, end);
}

583
static void r4k_flush_icache_range(unsigned long start, unsigned long end)
L
Linus Torvalds 已提交
584 585 586 587 588 589
{
	struct flush_icache_range_args args;

	args.start = start;
	args.end = end;

590
	r4k_on_each_cpu(local_r4k_flush_icache_range_ipi, &args);
591
	instruction_hazard();
L
Linus Torvalds 已提交
592 593 594 595 596 597 598 599 600
}

#ifdef CONFIG_DMA_NONCOHERENT

static void r4k_dma_cache_wback_inv(unsigned long addr, unsigned long size)
{
	/* Catch bad driver code */
	BUG_ON(size == 0);

601
	if (cpu_has_inclusive_pcaches) {
602
		if (size >= scache_size)
L
Linus Torvalds 已提交
603
			r4k_blast_scache();
604 605
		else
			blast_scache_range(addr, addr + size);
K
Kevin Cernekee 已提交
606
		__sync();
L
Linus Torvalds 已提交
607 608 609 610 611 612 613 614
		return;
	}

	/*
	 * Either no secondary cache or the available caches don't have the
	 * subset property so we have to flush the primary caches
	 * explicitly
	 */
615
	if (cpu_has_safe_index_cacheops && size >= dcache_size) {
L
Linus Torvalds 已提交
616 617 618
		r4k_blast_dcache();
	} else {
		R4600_HIT_CACHEOP_WAR_IMPL;
619
		blast_dcache_range(addr, addr + size);
L
Linus Torvalds 已提交
620 621 622
	}

	bc_wback_inv(addr, size);
K
Kevin Cernekee 已提交
623
	__sync();
L
Linus Torvalds 已提交
624 625 626 627 628 629 630
}

static void r4k_dma_cache_inv(unsigned long addr, unsigned long size)
{
	/* Catch bad driver code */
	BUG_ON(size == 0);

631
	if (cpu_has_inclusive_pcaches) {
632
		if (size >= scache_size)
L
Linus Torvalds 已提交
633
			r4k_blast_scache();
634 635 636 637 638 639
		else {
			/*
			 * There is no clearly documented alignment requirement
			 * for the cache instruction on MIPS processors and
			 * some processors, among them the RM5200 and RM7000
			 * QED processors will throw an address error for cache
R
Ralf Baechle 已提交
640
			 * hit ops with insufficient alignment.	 Solved by
641 642
			 * aligning the address to cache line size.
			 */
643
			blast_inv_scache_range(addr, addr + size);
644
		}
K
Kevin Cernekee 已提交
645
		__sync();
L
Linus Torvalds 已提交
646 647 648
		return;
	}

649
	if (cpu_has_safe_index_cacheops && size >= dcache_size) {
L
Linus Torvalds 已提交
650 651 652
		r4k_blast_dcache();
	} else {
		R4600_HIT_CACHEOP_WAR_IMPL;
653
		blast_inv_dcache_range(addr, addr + size);
L
Linus Torvalds 已提交
654 655 656
	}

	bc_inv(addr, size);
K
Kevin Cernekee 已提交
657
	__sync();
L
Linus Torvalds 已提交
658 659 660 661 662 663 664 665 666 667
}
#endif /* CONFIG_DMA_NONCOHERENT */

/*
 * While we're protected against bad userland addresses we don't care
 * very much about what happens in that case.  Usually a segmentation
 * fault will dump the process later on anyway ...
 */
static void local_r4k_flush_cache_sigtramp(void * arg)
{
T
Thiemo Seufer 已提交
668 669 670
	unsigned long ic_lsize = cpu_icache_line_size();
	unsigned long dc_lsize = cpu_dcache_line_size();
	unsigned long sc_lsize = cpu_scache_line_size();
L
Linus Torvalds 已提交
671 672 673
	unsigned long addr = (unsigned long) arg;

	R4600_HIT_CACHEOP_WAR_IMPL;
674 675
	if (dc_lsize)
		protected_writeback_dcache_line(addr & ~(dc_lsize - 1));
676
	if (!cpu_icache_snoops_remote_store && scache_size)
L
Linus Torvalds 已提交
677
		protected_writeback_scache_line(addr & ~(sc_lsize - 1));
678 679
	if (ic_lsize)
		protected_flush_icache_line(addr & ~(ic_lsize - 1));
L
Linus Torvalds 已提交
680 681 682 683 684
	if (MIPS4K_ICACHE_REFILL_WAR) {
		__asm__ __volatile__ (
			".set push\n\t"
			".set noat\n\t"
			".set mips3\n\t"
685
#ifdef CONFIG_32BIT
L
Linus Torvalds 已提交
686 687
			"la	$at,1f\n\t"
#endif
688
#ifdef CONFIG_64BIT
L
Linus Torvalds 已提交
689 690 691 692 693 694 695 696 697 698 699 700 701 702 703
			"dla	$at,1f\n\t"
#endif
			"cache	%0,($at)\n\t"
			"nop; nop; nop\n"
			"1:\n\t"
			".set pop"
			:
			: "i" (Hit_Invalidate_I));
	}
	if (MIPS_CACHE_SYNC_WAR)
		__asm__ __volatile__ ("sync");
}

static void r4k_flush_cache_sigtramp(unsigned long addr)
{
704
	r4k_on_each_cpu(local_r4k_flush_cache_sigtramp, (void *) addr);
L
Linus Torvalds 已提交
705 706 707 708 709 710 711 712
}

static void r4k_flush_icache_all(void)
{
	if (cpu_has_vtag_icache)
		r4k_blast_icache();
}

713 714 715 716 717 718 719 720 721 722 723 724 725 726 727 728 729 730 731 732 733 734 735 736 737 738 739 740 741 742 743 744 745
struct flush_kernel_vmap_range_args {
	unsigned long	vaddr;
	int		size;
};

static inline void local_r4k_flush_kernel_vmap_range(void *args)
{
	struct flush_kernel_vmap_range_args *vmra = args;
	unsigned long vaddr = vmra->vaddr;
	int size = vmra->size;

	/*
	 * Aliases only affect the primary caches so don't bother with
	 * S-caches or T-caches.
	 */
	if (cpu_has_safe_index_cacheops && size >= dcache_size)
		r4k_blast_dcache();
	else {
		R4600_HIT_CACHEOP_WAR_IMPL;
		blast_dcache_range(vaddr, vaddr + size);
	}
}

static void r4k_flush_kernel_vmap_range(unsigned long vaddr, int size)
{
	struct flush_kernel_vmap_range_args args;

	args.vaddr = (unsigned long) vaddr;
	args.size = size;

	r4k_on_each_cpu(local_r4k_flush_kernel_vmap_range, &args);
}

L
Linus Torvalds 已提交
746 747 748 749 750 751 752 753 754 755 756
static inline void rm7k_erratum31(void)
{
	const unsigned long ic_lsize = 32;
	unsigned long addr;

	/* RM7000 erratum #31. The icache is screwed at startup. */
	write_c0_taglo(0);
	write_c0_taghi(0);

	for (addr = INDEX_BASE; addr <= INDEX_BASE + 4096; addr += ic_lsize) {
		__asm__ __volatile__ (
T
Thiemo Seufer 已提交
757
			".set push\n\t"
L
Linus Torvalds 已提交
758 759 760 761 762 763 764 765 766 767 768 769 770 771
			".set noreorder\n\t"
			".set mips3\n\t"
			"cache\t%1, 0(%0)\n\t"
			"cache\t%1, 0x1000(%0)\n\t"
			"cache\t%1, 0x2000(%0)\n\t"
			"cache\t%1, 0x3000(%0)\n\t"
			"cache\t%2, 0(%0)\n\t"
			"cache\t%2, 0x1000(%0)\n\t"
			"cache\t%2, 0x2000(%0)\n\t"
			"cache\t%2, 0x3000(%0)\n\t"
			"cache\t%1, 0(%0)\n\t"
			"cache\t%1, 0x1000(%0)\n\t"
			"cache\t%1, 0x2000(%0)\n\t"
			"cache\t%1, 0x3000(%0)\n\t"
T
Thiemo Seufer 已提交
772
			".set pop\n"
L
Linus Torvalds 已提交
773 774 775 776 777
			:
			: "r" (addr), "i" (Index_Store_Tag_I), "i" (Fill));
	}
}

778 779 780 781 782 783 784 785 786 787 788 789 790 791 792 793 794 795 796
static inline void alias_74k_erratum(struct cpuinfo_mips *c)
{
	/*
	 * Early versions of the 74K do not update the cache tags on a
	 * vtag miss/ptag hit which can occur in the case of KSEG0/KUSEG
	 * aliases. In this case it is better to treat the cache as always
	 * having aliases.
	 */
	if ((c->processor_id & 0xff) <= PRID_REV_ENCODE_332(2, 4, 0))
		c->dcache.flags |= MIPS_CACHE_VTAG;
	if ((c->processor_id & 0xff) == PRID_REV_ENCODE_332(2, 4, 0))
		write_c0_config6(read_c0_config6() | MIPS_CONF6_SYND);
	if (((c->processor_id & 0xff00) == PRID_IMP_1074K) &&
	    ((c->processor_id & 0xff) <= PRID_REV_ENCODE_332(1, 1, 0))) {
		c->dcache.flags |= MIPS_CACHE_VTAG;
		write_c0_config6(read_c0_config6() | MIPS_CONF6_SYND);
	}
}

797
static char *way_string[] __cpuinitdata = { NULL, "direct mapped", "2-way",
L
Linus Torvalds 已提交
798 799 800
	"3-way", "4-way", "5-way", "6-way", "7-way", "8-way"
};

801
static void __cpuinit probe_pcache(void)
L
Linus Torvalds 已提交
802 803 804 805 806 807 808 809 810 811 812 813 814 815 816
{
	struct cpuinfo_mips *c = &current_cpu_data;
	unsigned int config = read_c0_config();
	unsigned int prid = read_c0_prid();
	unsigned long config1;
	unsigned int lsize;

	switch (c->cputype) {
	case CPU_R4600:			/* QED style two way caches? */
	case CPU_R4700:
	case CPU_R5000:
	case CPU_NEVADA:
		icache_size = 1 << (12 + ((config & CONF_IC) >> 9));
		c->icache.linesz = 16 << ((config & CONF_IB) >> 5);
		c->icache.ways = 2;
817
		c->icache.waybit = __ffs(icache_size/2);
L
Linus Torvalds 已提交
818 819 820 821

		dcache_size = 1 << (12 + ((config & CONF_DC) >> 6));
		c->dcache.linesz = 16 << ((config & CONF_DB) >> 4);
		c->dcache.ways = 2;
822
		c->dcache.waybit= __ffs(dcache_size/2);
L
Linus Torvalds 已提交
823 824 825 826 827 828 829 830 831 832 833 834 835 836 837 838

		c->options |= MIPS_CPU_CACHE_CDEX_P;
		break;

	case CPU_R5432:
	case CPU_R5500:
		icache_size = 1 << (12 + ((config & CONF_IC) >> 9));
		c->icache.linesz = 16 << ((config & CONF_IB) >> 5);
		c->icache.ways = 2;
		c->icache.waybit= 0;

		dcache_size = 1 << (12 + ((config & CONF_DC) >> 6));
		c->dcache.linesz = 16 << ((config & CONF_DB) >> 4);
		c->dcache.ways = 2;
		c->dcache.waybit = 0;

839
		c->options |= MIPS_CPU_CACHE_CDEX_P | MIPS_CPU_PREFETCH;
L
Linus Torvalds 已提交
840 841 842 843 844 845 846 847 848 849 850 851 852 853
		break;

	case CPU_TX49XX:
		icache_size = 1 << (12 + ((config & CONF_IC) >> 9));
		c->icache.linesz = 16 << ((config & CONF_IB) >> 5);
		c->icache.ways = 4;
		c->icache.waybit= 0;

		dcache_size = 1 << (12 + ((config & CONF_DC) >> 6));
		c->dcache.linesz = 16 << ((config & CONF_DB) >> 4);
		c->dcache.ways = 4;
		c->dcache.waybit = 0;

		c->options |= MIPS_CPU_CACHE_CDEX_P;
A
Atsushi Nemoto 已提交
854
		c->options |= MIPS_CPU_PREFETCH;
L
Linus Torvalds 已提交
855 856 857 858 859 860 861 862 863 864 865 866
		break;

	case CPU_R4000PC:
	case CPU_R4000SC:
	case CPU_R4000MC:
	case CPU_R4400PC:
	case CPU_R4400SC:
	case CPU_R4400MC:
	case CPU_R4300:
		icache_size = 1 << (12 + ((config & CONF_IC) >> 9));
		c->icache.linesz = 16 << ((config & CONF_IB) >> 5);
		c->icache.ways = 1;
R
Ralf Baechle 已提交
867
		c->icache.waybit = 0;	/* doesn't matter */
L
Linus Torvalds 已提交
868 869 870 871 872 873 874 875 876 877 878

		dcache_size = 1 << (12 + ((config & CONF_DC) >> 6));
		c->dcache.linesz = 16 << ((config & CONF_DB) >> 4);
		c->dcache.ways = 1;
		c->dcache.waybit = 0;	/* does not matter */

		c->options |= MIPS_CPU_CACHE_CDEX_P;
		break;

	case CPU_R10000:
	case CPU_R12000:
K
Kumba 已提交
879
	case CPU_R14000:
L
Linus Torvalds 已提交
880 881 882 883 884 885 886 887 888 889 890 891 892 893
		icache_size = 1 << (12 + ((config & R10K_CONF_IC) >> 29));
		c->icache.linesz = 64;
		c->icache.ways = 2;
		c->icache.waybit = 0;

		dcache_size = 1 << (12 + ((config & R10K_CONF_DC) >> 26));
		c->dcache.linesz = 32;
		c->dcache.ways = 2;
		c->dcache.waybit = 0;

		c->options |= MIPS_CPU_PREFETCH;
		break;

	case CPU_VR4133:
894
		write_c0_config(config & ~VR41_CONF_P4K);
L
Linus Torvalds 已提交
895 896 897 898
	case CPU_VR4131:
		/* Workaround for cache instruction bug of VR4131 */
		if (c->processor_id == 0x0c80U || c->processor_id == 0x0c81U ||
		    c->processor_id == 0x0c82U) {
899 900 901
			config |= 0x00400000U;
			if (c->processor_id == 0x0c80U)
				config |= VR41_CONF_BP;
L
Linus Torvalds 已提交
902
			write_c0_config(config);
903 904 905
		} else
			c->options |= MIPS_CPU_CACHE_CDEX_P;

L
Linus Torvalds 已提交
906 907 908
		icache_size = 1 << (10 + ((config & CONF_IC) >> 9));
		c->icache.linesz = 16 << ((config & CONF_IB) >> 5);
		c->icache.ways = 2;
909
		c->icache.waybit = __ffs(icache_size/2);
L
Linus Torvalds 已提交
910 911 912 913

		dcache_size = 1 << (10 + ((config & CONF_DC) >> 6));
		c->dcache.linesz = 16 << ((config & CONF_DB) >> 4);
		c->dcache.ways = 2;
914
		c->dcache.waybit = __ffs(dcache_size/2);
L
Linus Torvalds 已提交
915 916 917 918 919 920 921 922 923 924 925
		break;

	case CPU_VR41XX:
	case CPU_VR4111:
	case CPU_VR4121:
	case CPU_VR4122:
	case CPU_VR4181:
	case CPU_VR4181A:
		icache_size = 1 << (10 + ((config & CONF_IC) >> 9));
		c->icache.linesz = 16 << ((config & CONF_IB) >> 5);
		c->icache.ways = 1;
R
Ralf Baechle 已提交
926
		c->icache.waybit = 0;	/* doesn't matter */
L
Linus Torvalds 已提交
927 928 929 930 931 932 933 934 935 936 937 938 939 940 941

		dcache_size = 1 << (10 + ((config & CONF_DC) >> 6));
		c->dcache.linesz = 16 << ((config & CONF_DB) >> 4);
		c->dcache.ways = 1;
		c->dcache.waybit = 0;	/* does not matter */

		c->options |= MIPS_CPU_CACHE_CDEX_P;
		break;

	case CPU_RM7000:
		rm7k_erratum31();

		icache_size = 1 << (12 + ((config & CONF_IC) >> 9));
		c->icache.linesz = 16 << ((config & CONF_IB) >> 5);
		c->icache.ways = 4;
942
		c->icache.waybit = __ffs(icache_size / c->icache.ways);
L
Linus Torvalds 已提交
943 944 945 946

		dcache_size = 1 << (12 + ((config & CONF_DC) >> 6));
		c->dcache.linesz = 16 << ((config & CONF_DB) >> 4);
		c->dcache.ways = 4;
947
		c->dcache.waybit = __ffs(dcache_size / c->dcache.ways);
L
Linus Torvalds 已提交
948 949 950 951 952

		c->options |= MIPS_CPU_CACHE_CDEX_P;
		c->options |= MIPS_CPU_PREFETCH;
		break;

953 954 955 956 957 958 959 960 961 962 963 964 965 966 967 968 969 970
	case CPU_LOONGSON2:
		icache_size = 1 << (12 + ((config & CONF_IC) >> 9));
		c->icache.linesz = 16 << ((config & CONF_IB) >> 5);
		if (prid & 0x3)
			c->icache.ways = 4;
		else
			c->icache.ways = 2;
		c->icache.waybit = 0;

		dcache_size = 1 << (12 + ((config & CONF_DC) >> 6));
		c->dcache.linesz = 16 << ((config & CONF_DB) >> 4);
		if (prid & 0x3)
			c->dcache.ways = 4;
		else
			c->dcache.ways = 2;
		c->dcache.waybit = 0;
		break;

L
Linus Torvalds 已提交
971 972 973 974 975 976 977 978 979 980 981 982 983 984
	default:
		if (!(config & MIPS_CONF_M))
			panic("Don't know how to probe P-caches on this cpu.");

		/*
		 * So we seem to be a MIPS32 or MIPS64 CPU
		 * So let's probe the I-cache ...
		 */
		config1 = read_c0_config1();

		if ((lsize = ((config1 >> 19) & 7)))
			c->icache.linesz = 2 << lsize;
		else
			c->icache.linesz = lsize;
985
		c->icache.sets = 32 << (((config1 >> 22) + 1) & 7);
L
Linus Torvalds 已提交
986 987 988
		c->icache.ways = 1 + ((config1 >> 16) & 7);

		icache_size = c->icache.sets *
R
Ralf Baechle 已提交
989 990
			      c->icache.ways *
			      c->icache.linesz;
991
		c->icache.waybit = __ffs(icache_size/c->icache.ways);
L
Linus Torvalds 已提交
992 993 994 995 996 997 998 999 1000 1001 1002 1003 1004

		if (config & 0x8)		/* VI bit */
			c->icache.flags |= MIPS_CACHE_VTAG;

		/*
		 * Now probe the MIPS32 / MIPS64 data cache.
		 */
		c->dcache.flags = 0;

		if ((lsize = ((config1 >> 10) & 7)))
			c->dcache.linesz = 2 << lsize;
		else
			c->dcache.linesz= lsize;
1005
		c->dcache.sets = 32 << (((config1 >> 13) + 1) & 7);
L
Linus Torvalds 已提交
1006 1007 1008
		c->dcache.ways = 1 + ((config1 >> 7) & 7);

		dcache_size = c->dcache.sets *
R
Ralf Baechle 已提交
1009 1010
			      c->dcache.ways *
			      c->dcache.linesz;
1011
		c->dcache.waybit = __ffs(dcache_size/c->dcache.ways);
L
Linus Torvalds 已提交
1012 1013 1014 1015 1016 1017 1018

		c->options |= MIPS_CPU_PREFETCH;
		break;
	}

	/*
	 * Processor configuration sanity check for the R4000SC erratum
R
Ralf Baechle 已提交
1019
	 * #5.	With page sizes larger than 32kB there is no possibility
L
Linus Torvalds 已提交
1020 1021 1022 1023 1024 1025 1026 1027 1028 1029 1030 1031 1032 1033
	 * to get a VCE exception anymore so we don't care about this
	 * misconfiguration.  The case is rather theoretical anyway;
	 * presumably no vendor is shipping his hardware in the "bad"
	 * configuration.
	 */
	if ((prid & 0xff00) == PRID_IMP_R4000 && (prid & 0xff) < 0x40 &&
	    !(config & CONF_SC) && c->icache.linesz != 16 &&
	    PAGE_SIZE <= 0x8000)
		panic("Improper R4000SC processor configuration detected");

	/* compute a couple of other cache variables */
	c->icache.waysize = icache_size / c->icache.ways;
	c->dcache.waysize = dcache_size / c->dcache.ways;

1034 1035 1036 1037
	c->icache.sets = c->icache.linesz ?
		icache_size / (c->icache.linesz * c->icache.ways) : 0;
	c->dcache.sets = c->dcache.linesz ?
		dcache_size / (c->dcache.linesz * c->dcache.ways) : 0;
L
Linus Torvalds 已提交
1038 1039 1040 1041 1042 1043 1044

	/*
	 * R10000 and R12000 P-caches are odd in a positive way.  They're 32kB
	 * 2-way virtually indexed so normally would suffer from aliases.  So
	 * normally they'd suffer from aliases but magic in the hardware deals
	 * with that for us so we don't need to take care ourselves.
	 */
1045
	switch (c->cputype) {
1046
	case CPU_20KC:
R
Ralf Baechle 已提交
1047
	case CPU_25KF:
1048 1049
	case CPU_SB1:
	case CPU_SB1A:
1050
	case CPU_XLR:
1051
		c->dcache.flags |= MIPS_CACHE_PINDEX;
1052 1053
		break;

1054 1055
	case CPU_R10000:
	case CPU_R12000:
K
Kumba 已提交
1056
	case CPU_R14000:
1057
		break;
1058

1059
	case CPU_M14KC:
1060
	case CPU_M14KEC:
1061
	case CPU_24K:
1062
	case CPU_34K:
1063
	case CPU_74K:
1064
	case CPU_1004K:
1065 1066
		if (c->cputype == CPU_74K)
			alias_74k_erratum(c);
1067 1068 1069 1070 1071 1072
		if ((read_c0_config7() & (1 << 16))) {
			/* effectively physically indexed dcache,
			   thus no virtual aliases. */
			c->dcache.flags |= MIPS_CACHE_PINDEX;
			break;
		}
1073
	default:
1074 1075
		if (c->dcache.waysize > PAGE_SIZE)
			c->dcache.flags |= MIPS_CACHE_ALIASES;
1076
	}
L
Linus Torvalds 已提交
1077 1078 1079 1080 1081 1082 1083 1084 1085 1086

	switch (c->cputype) {
	case CPU_20KC:
		/*
		 * Some older 20Kc chips doesn't have the 'VI' bit in
		 * the config register.
		 */
		c->icache.flags |= MIPS_CACHE_VTAG;
		break;

1087
	case CPU_ALCHEMY:
L
Linus Torvalds 已提交
1088 1089 1090 1091
		c->icache.flags |= MIPS_CACHE_IC_F_DC;
		break;
	}

R
Ralf Baechle 已提交
1092
#ifdef	CONFIG_CPU_LOONGSON2
1093 1094 1095 1096 1097 1098 1099
	/*
	 * LOONGSON2 has 4 way icache, but when using indexed cache op,
	 * one op will act on all 4 ways
	 */
	c->icache.ways = 1;
#endif

L
Linus Torvalds 已提交
1100 1101
	printk("Primary instruction cache %ldkB, %s, %s, linesize %d bytes.\n",
	       icache_size >> 10,
1102
	       c->icache.flags & MIPS_CACHE_VTAG ? "VIVT" : "VIPT",
L
Linus Torvalds 已提交
1103 1104
	       way_string[c->icache.ways], c->icache.linesz);

1105 1106 1107 1108 1109 1110
	printk("Primary data cache %ldkB, %s, %s, %s, linesize %d bytes\n",
	       dcache_size >> 10, way_string[c->dcache.ways],
	       (c->dcache.flags & MIPS_CACHE_PINDEX) ? "PIPT" : "VIPT",
	       (c->dcache.flags & MIPS_CACHE_ALIASES) ?
			"cache aliases" : "no aliases",
	       c->dcache.linesz);
L
Linus Torvalds 已提交
1111 1112 1113 1114 1115 1116 1117 1118
}

/*
 * If you even _breathe_ on this function, look at the gcc output and make sure
 * it does not pop things on and off the stack for the cache sizing loop that
 * executes in KSEG1 space or else you will crash and burn badly.  You have
 * been warned.
 */
1119
static int __cpuinit probe_scache(void)
L
Linus Torvalds 已提交
1120 1121 1122 1123 1124 1125 1126 1127
{
	unsigned long flags, addr, begin, end, pow2;
	unsigned int config = read_c0_config();
	struct cpuinfo_mips *c = &current_cpu_data;

	if (config & CONF_SC)
		return 0;

1128
	begin = (unsigned long) &_stext;
L
Linus Torvalds 已提交
1129 1130 1131 1132 1133 1134 1135 1136 1137 1138 1139 1140 1141 1142 1143 1144 1145 1146 1147 1148 1149 1150 1151 1152 1153 1154 1155 1156 1157 1158 1159 1160 1161 1162 1163 1164 1165 1166 1167 1168 1169 1170 1171 1172 1173
	begin &= ~((4 * 1024 * 1024) - 1);
	end = begin + (4 * 1024 * 1024);

	/*
	 * This is such a bitch, you'd think they would make it easy to do
	 * this.  Away you daemons of stupidity!
	 */
	local_irq_save(flags);

	/* Fill each size-multiple cache line with a valid tag. */
	pow2 = (64 * 1024);
	for (addr = begin; addr < end; addr = (begin + pow2)) {
		unsigned long *p = (unsigned long *) addr;
		__asm__ __volatile__("nop" : : "r" (*p)); /* whee... */
		pow2 <<= 1;
	}

	/* Load first line with zero (therefore invalid) tag. */
	write_c0_taglo(0);
	write_c0_taghi(0);
	__asm__ __volatile__("nop; nop; nop; nop;"); /* avoid the hazard */
	cache_op(Index_Store_Tag_I, begin);
	cache_op(Index_Store_Tag_D, begin);
	cache_op(Index_Store_Tag_SD, begin);

	/* Now search for the wrap around point. */
	pow2 = (128 * 1024);
	for (addr = begin + (128 * 1024); addr < end; addr = begin + pow2) {
		cache_op(Index_Load_Tag_SD, addr);
		__asm__ __volatile__("nop; nop; nop; nop;"); /* hazard... */
		if (!read_c0_taglo())
			break;
		pow2 <<= 1;
	}
	local_irq_restore(flags);
	addr -= begin;

	scache_size = addr;
	c->scache.linesz = 16 << ((config & R4K_CONF_SB) >> 22);
	c->scache.ways = 1;
	c->dcache.waybit = 0;		/* does not matter */

	return 1;
}

1174 1175 1176 1177 1178 1179 1180 1181 1182 1183 1184 1185 1186 1187 1188 1189 1190 1191
#if defined(CONFIG_CPU_LOONGSON2)
static void __init loongson2_sc_init(void)
{
	struct cpuinfo_mips *c = &current_cpu_data;

	scache_size = 512*1024;
	c->scache.linesz = 32;
	c->scache.ways = 4;
	c->scache.waybit = 0;
	c->scache.waysize = scache_size / (c->scache.ways);
	c->scache.sets = scache_size / (c->scache.linesz * c->scache.ways);
	pr_info("Unified secondary cache %ldkB %s, linesize %d bytes.\n",
	       scache_size >> 10, way_string[c->scache.ways], c->scache.linesz);

	c->options |= MIPS_CPU_INCLUSIVE_CACHES;
}
#endif

L
Linus Torvalds 已提交
1192 1193
extern int r5k_sc_init(void);
extern int rm7k_sc_init(void);
1194
extern int mips_sc_init(void);
L
Linus Torvalds 已提交
1195

1196
static void __cpuinit setup_scache(void)
L
Linus Torvalds 已提交
1197 1198 1199 1200 1201 1202 1203 1204
{
	struct cpuinfo_mips *c = &current_cpu_data;
	unsigned int config = read_c0_config();
	int sc_present = 0;

	/*
	 * Do the probing thing on R4000SC and R4400SC processors.  Other
	 * processors don't have a S-cache that would be relevant to the
J
Joe Perches 已提交
1205
	 * Linux memory management.
L
Linus Torvalds 已提交
1206 1207 1208 1209 1210 1211
	 */
	switch (c->cputype) {
	case CPU_R4000SC:
	case CPU_R4000MC:
	case CPU_R4400SC:
	case CPU_R4400MC:
1212
		sc_present = run_uncached(probe_scache);
L
Linus Torvalds 已提交
1213 1214 1215 1216 1217 1218
		if (sc_present)
			c->options |= MIPS_CPU_CACHE_CDEX_S;
		break;

	case CPU_R10000:
	case CPU_R12000:
K
Kumba 已提交
1219
	case CPU_R14000:
L
Linus Torvalds 已提交
1220 1221 1222 1223 1224 1225 1226 1227 1228 1229 1230 1231
		scache_size = 0x80000 << ((config & R10K_CONF_SS) >> 16);
		c->scache.linesz = 64 << ((config >> 13) & 1);
		c->scache.ways = 2;
		c->scache.waybit= 0;
		sc_present = 1;
		break;

	case CPU_R5000:
	case CPU_NEVADA:
#ifdef CONFIG_R5000_CPU_SCACHE
		r5k_sc_init();
#endif
R
Ralf Baechle 已提交
1232
		return;
L
Linus Torvalds 已提交
1233 1234 1235 1236 1237 1238 1239

	case CPU_RM7000:
#ifdef CONFIG_RM7000_CPU_SCACHE
		rm7k_sc_init();
#endif
		return;

1240 1241 1242 1243 1244
#if defined(CONFIG_CPU_LOONGSON2)
	case CPU_LOONGSON2:
		loongson2_sc_init();
		return;
#endif
J
Jayachandran C 已提交
1245 1246 1247
	case CPU_XLP:
		/* don't need to worry about L2, fully coherent */
		return;
1248

L
Linus Torvalds 已提交
1249
	default:
1250 1251
		if (c->isa_level & (MIPS_CPU_ISA_M32R1 | MIPS_CPU_ISA_M32R2 |
				    MIPS_CPU_ISA_M64R1 | MIPS_CPU_ISA_M64R2)) {
1252 1253 1254 1255 1256 1257 1258 1259 1260 1261 1262 1263 1264
#ifdef CONFIG_MIPS_CPU_SCACHE
			if (mips_sc_init ()) {
				scache_size = c->scache.ways * c->scache.sets * c->scache.linesz;
				printk("MIPS secondary cache %ldkB, %s, linesize %d bytes.\n",
				       scache_size >> 10,
				       way_string[c->scache.ways], c->scache.linesz);
			}
#else
			if (!(c->scache.flags & MIPS_CACHE_NOT_PRESENT))
				panic("Dunno how to handle MIPS32 / MIPS64 second level cache");
#endif
			return;
		}
L
Linus Torvalds 已提交
1265 1266 1267 1268 1269 1270 1271 1272 1273 1274 1275 1276 1277 1278
		sc_present = 0;
	}

	if (!sc_present)
		return;

	/* compute a couple of other cache variables */
	c->scache.waysize = scache_size / c->scache.ways;

	c->scache.sets = scache_size / (c->scache.linesz * c->scache.ways);

	printk("Unified secondary cache %ldkB %s, linesize %d bytes.\n",
	       scache_size >> 10, way_string[c->scache.ways], c->scache.linesz);

1279
	c->options |= MIPS_CPU_INCLUSIVE_CACHES;
L
Linus Torvalds 已提交
1280 1281
}

1282 1283 1284 1285 1286 1287 1288 1289 1290 1291 1292 1293 1294 1295 1296
void au1x00_fixup_config_od(void)
{
	/*
	 * c0_config.od (bit 19) was write only (and read as 0)
	 * on the early revisions of Alchemy SOCs.  It disables the bus
	 * transaction overlapping and needs to be set to fix various errata.
	 */
	switch (read_c0_prid()) {
	case 0x00030100: /* Au1000 DA */
	case 0x00030201: /* Au1000 HA */
	case 0x00030202: /* Au1000 HB */
	case 0x01030200: /* Au1500 AB */
	/*
	 * Au1100 errata actually keeps silence about this bit, so we set it
	 * just in case for those revisions that require it to be set according
1297
	 * to the (now gone) cpu table.
1298 1299 1300 1301 1302 1303 1304 1305 1306
	 */
	case 0x02030200: /* Au1100 AB */
	case 0x02030201: /* Au1100 BA */
	case 0x02030202: /* Au1100 BC */
		set_c0_config(1 << 19);
		break;
	}
}

1307 1308 1309 1310 1311 1312 1313 1314 1315 1316 1317 1318 1319 1320 1321 1322 1323 1324 1325 1326 1327 1328
/* CP0 hazard avoidance. */
#define NXP_BARRIER()							\
	 __asm__ __volatile__(						\
	".set noreorder\n\t"						\
	"nop; nop; nop; nop; nop; nop;\n\t"				\
	".set reorder\n\t")

static void nxp_pr4450_fixup_config(void)
{
	unsigned long config0;

	config0 = read_c0_config();

	/* clear all three cache coherency fields */
	config0 &= ~(0x7 | (7 << 25) | (7 << 28));
	config0 |= (((_page_cachable_default >> _CACHE_SHIFT) <<  0) |
		    ((_page_cachable_default >> _CACHE_SHIFT) << 25) |
		    ((_page_cachable_default >> _CACHE_SHIFT) << 28));
	write_c0_config(config0);
	NXP_BARRIER();
}

1329 1330 1331 1332 1333 1334
static int __cpuinitdata cca = -1;

static int __init cca_setup(char *str)
{
	get_option(&str, &cca);

1335
	return 0;
1336 1337
}

1338
early_param("cca", cca_setup);
1339

1340
static void __cpuinit coherency_setup(void)
L
Linus Torvalds 已提交
1341
{
1342 1343 1344 1345 1346 1347
	if (cca < 0 || cca > 7)
		cca = read_c0_config() & CONF_CM_CMASK;
	_page_cachable_default = cca << _CACHE_SHIFT;

	pr_debug("Using cache attribute %d\n", cca);
	change_c0_config(CONF_CM_CMASK, cca);
L
Linus Torvalds 已提交
1348 1349 1350 1351 1352 1353 1354 1355

	/*
	 * c0_status.cu=0 specifies that updates by the sc instruction use
	 * the coherency mode specified by the TLB; 1 means cachable
	 * coherent update on write will be used.  Not all processors have
	 * this bit and; some wire it to zero, others like Toshiba had the
	 * silly idea of putting something else there ...
	 */
1356
	switch (current_cpu_type()) {
L
Linus Torvalds 已提交
1357 1358 1359 1360 1361 1362 1363 1364
	case CPU_R4000PC:
	case CPU_R4000SC:
	case CPU_R4000MC:
	case CPU_R4400PC:
	case CPU_R4400SC:
	case CPU_R4400MC:
		clear_c0_config(CONF_CU);
		break;
1365
	/*
R
Ralf Baechle 已提交
1366
	 * We need to catch the early Alchemy SOCs with
1367 1368
	 * the write-only co_config.od bit and set it back to one on:
	 * Au1000 rev DA, HA, HB;  Au1100 AB, BA, BC, Au1500 AB
1369
	 */
1370
	case CPU_ALCHEMY:
1371 1372
		au1x00_fixup_config_od();
		break;
1373 1374 1375 1376

	case PRID_IMP_PR4450:
		nxp_pr4450_fixup_config();
		break;
L
Linus Torvalds 已提交
1377 1378 1379
	}
}

1380 1381 1382 1383 1384 1385 1386 1387
#if defined(CONFIG_DMA_NONCOHERENT)

static int __cpuinitdata coherentio;

static int __init setcoherentio(char *str)
{
	coherentio = 1;

1388
	return 0;
1389 1390
}

1391
early_param("coherentio", setcoherentio);
1392 1393
#endif

1394
static void __cpuinit r4k_cache_error_setup(void)
L
Linus Torvalds 已提交
1395
{
1396 1397
	extern char __weak except_vec2_generic;
	extern char __weak except_vec2_sb1;
L
Linus Torvalds 已提交
1398 1399
	struct cpuinfo_mips *c = &current_cpu_data;

1400 1401 1402 1403 1404 1405 1406 1407 1408 1409
	switch (c->cputype) {
	case CPU_SB1:
	case CPU_SB1A:
		set_uncached_handler(0x100, &except_vec2_sb1, 0x80);
		break;

	default:
		set_uncached_handler(0x100, &except_vec2_generic, 0x80);
		break;
	}
1410 1411 1412 1413 1414 1415 1416
}

void __cpuinit r4k_cache_init(void)
{
	extern void build_clear_page(void);
	extern void build_copy_page(void);
	struct cpuinfo_mips *c = &current_cpu_data;
L
Linus Torvalds 已提交
1417 1418 1419 1420 1421 1422 1423 1424 1425 1426 1427 1428 1429 1430 1431 1432 1433 1434 1435

	probe_pcache();
	setup_scache();

	r4k_blast_dcache_page_setup();
	r4k_blast_dcache_page_indexed_setup();
	r4k_blast_dcache_setup();
	r4k_blast_icache_page_setup();
	r4k_blast_icache_page_indexed_setup();
	r4k_blast_icache_setup();
	r4k_blast_scache_page_setup();
	r4k_blast_scache_page_indexed_setup();
	r4k_blast_scache_setup();

	/*
	 * Some MIPS32 and MIPS64 processors have physically indexed caches.
	 * This code supports virtually indexed processors and will be
	 * unnecessarily inefficient on physically indexed processors.
	 */
1436 1437 1438 1439 1440 1441
	if (c->dcache.linesz)
		shm_align_mask = max_t( unsigned long,
					c->dcache.sets * c->dcache.linesz - 1,
					PAGE_SIZE - 1);
	else
		shm_align_mask = PAGE_SIZE-1;
1442 1443 1444 1445

	__flush_cache_vmap	= r4k__flush_cache_vmap;
	__flush_cache_vunmap	= r4k__flush_cache_vunmap;

R
Ralf Baechle 已提交
1446
	flush_cache_all		= cache_noop;
L
Linus Torvalds 已提交
1447 1448 1449 1450 1451
	__flush_cache_all	= r4k___flush_cache_all;
	flush_cache_mm		= r4k_flush_cache_mm;
	flush_cache_page	= r4k_flush_cache_page;
	flush_cache_range	= r4k_flush_cache_range;

1452 1453
	__flush_kernel_vmap_range = r4k_flush_kernel_vmap_range;

L
Linus Torvalds 已提交
1454 1455
	flush_cache_sigtramp	= r4k_flush_cache_sigtramp;
	flush_icache_all	= r4k_flush_icache_all;
1456
	local_flush_data_cache_page	= local_r4k_flush_data_cache_page;
L
Linus Torvalds 已提交
1457 1458
	flush_data_cache_page	= r4k_flush_data_cache_page;
	flush_icache_range	= r4k_flush_icache_range;
1459
	local_flush_icache_range	= local_r4k_flush_icache_range;
L
Linus Torvalds 已提交
1460

1461 1462 1463 1464 1465 1466 1467 1468 1469 1470
#if defined(CONFIG_DMA_NONCOHERENT)
	if (coherentio) {
		_dma_cache_wback_inv	= (void *)cache_noop;
		_dma_cache_wback	= (void *)cache_noop;
		_dma_cache_inv		= (void *)cache_noop;
	} else {
		_dma_cache_wback_inv	= r4k_dma_cache_wback_inv;
		_dma_cache_wback	= r4k_dma_cache_wback_inv;
		_dma_cache_inv		= r4k_dma_cache_inv;
	}
L
Linus Torvalds 已提交
1471 1472 1473 1474
#endif

	build_clear_page();
	build_copy_page();
1475
#if !defined(CONFIG_MIPS_CMP)
1476
	local_r4k___flush_cache_all(NULL);
1477
#endif
1478
	coherency_setup();
1479
	board_cache_error_setup = r4k_cache_error_setup;
L
Linus Torvalds 已提交
1480
}