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>
15
#include <linux/preempt.h>
L
Linus Torvalds 已提交
16
#include <linux/sched.h>
17
#include <linux/smp.h>
L
Linus Torvalds 已提交
18
#include <linux/mm.h>
19
#include <linux/module.h>
L
Linus Torvalds 已提交
20 21 22 23
#include <linux/bitops.h>

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

/*
 * 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.
47
 *  o doesn't disable interrupts on the local CPU
48
 */
49
static inline void r4k_on_each_cpu(void (*func) (void *info), void *info)
50 51 52 53
{
	preempt_disable();

#if !defined(CONFIG_MIPS_MT_SMP) && !defined(CONFIG_MIPS_MT_SMTC)
54
	smp_call_function(func, info, 1);
55 56 57 58 59
#endif
	func(info);
	preempt_enable();
}

60 61 62 63 64 65
#if defined(CONFIG_MIPS_CMP)
#define cpu_has_safe_index_cacheops 0
#else
#define cpu_has_safe_index_cacheops 1
#endif

R
Ralf Baechle 已提交
66 67 68 69 70 71
/*
 * 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 已提交
72 73 74 75

/*
 * Dummy cache handling routines for machines without boardcaches
 */
76
static void cache_noop(void) {}
L
Linus Torvalds 已提交
77 78

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

struct bcache_ops *bcops = &no_sc_ops;

87 88
#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 已提交
89 90 91 92 93 94 95 96 97 98 99 100 101 102 103 104 105

#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);
}

106 107 108 109 110 111
static inline void r4k_blast_dcache_page_dc64(unsigned long addr)
{
	R4600_HIT_CACHEOP_WAR_IMPL;
	blast_dcache64_page(addr);
}

112
static void r4k_blast_dcache_page_setup(void)
L
Linus Torvalds 已提交
113 114 115
{
	unsigned long  dc_lsize = cpu_dcache_line_size();

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

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

128
static void r4k_blast_dcache_page_indexed_setup(void)
L
Linus Torvalds 已提交
129 130 131
{
	unsigned long dc_lsize = cpu_dcache_line_size();

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

142 143
void (* r4k_blast_dcache)(void);
EXPORT_SYMBOL(r4k_blast_dcache);
L
Linus Torvalds 已提交
144

145
static void r4k_blast_dcache_setup(void)
L
Linus Torvalds 已提交
146 147 148
{
	unsigned long dc_lsize = cpu_dcache_line_size();

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

/* 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 已提交
167
#define CACHE32_UNROLL32_ALIGN2 JUMP_TO_ALIGN(11)
L
Linus Torvalds 已提交
168 169 170 171 172 173 174 175 176 177 178 179 180 181 182 183

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 已提交
184
			       current_cpu_data.icache.waybit;
L
Linus Torvalds 已提交
185 186 187 188
	unsigned long ws, addr;

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

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)
{
210 211
	unsigned long indexmask = current_cpu_data.icache.waysize - 1;
	unsigned long start = INDEX_BASE + (page & indexmask);
L
Linus Torvalds 已提交
212 213 214
	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 已提交
215
			       current_cpu_data.icache.waybit;
L
Linus Torvalds 已提交
216 217 218 219
	unsigned long ws, addr;

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

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

232
static void r4k_blast_icache_page_setup(void)
L
Linus Torvalds 已提交
233 234 235
{
	unsigned long ic_lsize = cpu_icache_line_size();

236 237 238
	if (ic_lsize == 0)
		r4k_blast_icache_page = (void *)cache_noop;
	else if (ic_lsize == 16)
L
Linus Torvalds 已提交
239 240 241 242 243 244 245 246 247 248
		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);

249
static void r4k_blast_icache_page_indexed_setup(void)
L
Linus Torvalds 已提交
250 251 252
{
	unsigned long ic_lsize = cpu_icache_line_size();

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

271 272
void (* r4k_blast_icache)(void);
EXPORT_SYMBOL(r4k_blast_icache);
L
Linus Torvalds 已提交
273

274
static void r4k_blast_icache_setup(void)
L
Linus Torvalds 已提交
275 276 277
{
	unsigned long ic_lsize = cpu_icache_line_size();

278 279 280
	if (ic_lsize == 0)
		r4k_blast_icache = (void *)cache_noop;
	else if (ic_lsize == 16)
L
Linus Torvalds 已提交
281 282 283 284 285 286 287 288 289 290 291 292 293 294
		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);

295
static void r4k_blast_scache_page_setup(void)
L
Linus Torvalds 已提交
296 297 298
{
	unsigned long sc_lsize = cpu_scache_line_size();

299
	if (scache_size == 0)
300
		r4k_blast_scache_page = (void *)cache_noop;
301
	else if (sc_lsize == 16)
L
Linus Torvalds 已提交
302 303 304 305 306 307 308 309 310 311 312
		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);

313
static void r4k_blast_scache_page_indexed_setup(void)
L
Linus Torvalds 已提交
314 315 316
{
	unsigned long sc_lsize = cpu_scache_line_size();

317
	if (scache_size == 0)
318
		r4k_blast_scache_page_indexed = (void *)cache_noop;
319
	else if (sc_lsize == 16)
L
Linus Torvalds 已提交
320 321 322 323 324 325 326 327 328 329 330
		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);

331
static void r4k_blast_scache_setup(void)
L
Linus Torvalds 已提交
332 333 334
{
	unsigned long sc_lsize = cpu_scache_line_size();

335
	if (scache_size == 0)
336
		r4k_blast_scache = (void *)cache_noop;
337
	else if (sc_lsize == 16)
L
Linus Torvalds 已提交
338 339 340 341 342 343 344 345 346 347 348
		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)
{
349 350 351 352
#if defined(CONFIG_CPU_LOONGSON2)
	r4k_blast_scache();
	return;
#endif
L
Linus Torvalds 已提交
353 354 355
	r4k_blast_dcache();
	r4k_blast_icache();

356
	switch (current_cpu_type()) {
L
Linus Torvalds 已提交
357 358 359 360 361 362
	case CPU_R4000SC:
	case CPU_R4000MC:
	case CPU_R4400SC:
	case CPU_R4400MC:
	case CPU_R10000:
	case CPU_R12000:
K
Kumba 已提交
363
	case CPU_R14000:
L
Linus Torvalds 已提交
364 365 366 367 368 369
		r4k_blast_scache();
	}
}

static void r4k___flush_cache_all(void)
{
370
	r4k_on_each_cpu(local_r4k___flush_cache_all, NULL);
L
Linus Torvalds 已提交
371 372
}

373 374 375 376 377 378 379 380 381 382 383 384 385 386 387
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
}

388 389 390 391 392 393 394 395 396 397
static void r4k__flush_cache_vmap(void)
{
	r4k_blast_dcache();
}

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

L
Linus Torvalds 已提交
398 399 400
static inline void local_r4k_flush_cache_range(void * args)
{
	struct vm_area_struct *vma = args;
401
	int exec = vma->vm_flags & VM_EXEC;
L
Linus Torvalds 已提交
402

403
	if (!(has_valid_asid(vma->vm_mm)))
L
Linus Torvalds 已提交
404 405
		return;

406
	r4k_blast_dcache();
407 408
	if (exec)
		r4k_blast_icache();
L
Linus Torvalds 已提交
409 410 411 412 413
}

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

416
	if (cpu_has_dc_aliases || (exec && !cpu_has_ic_fills_f_dc))
417
		r4k_on_each_cpu(local_r4k_flush_cache_range, vma);
L
Linus Torvalds 已提交
418 419 420 421 422 423
}

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

424
	if (!has_valid_asid(mm))
L
Linus Torvalds 已提交
425 426 427 428 429
		return;

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

	r4k_blast_dcache();
L
Linus Torvalds 已提交
442 443 444 445 446 447 448
}

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

449
	r4k_on_each_cpu(local_r4k_flush_cache_mm, mm);
L
Linus Torvalds 已提交
450 451 452 453
}

struct flush_cache_page_args {
	struct vm_area_struct *vma;
454
	unsigned long addr;
455
	unsigned long pfn;
L
Linus Torvalds 已提交
456 457 458 459 460 461
};

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;
462
	unsigned long addr = fcp_args->addr;
R
Ralf Baechle 已提交
463
	struct page *page = pfn_to_page(fcp_args->pfn);
L
Linus Torvalds 已提交
464 465
	int exec = vma->vm_flags & VM_EXEC;
	struct mm_struct *mm = vma->vm_mm;
466
	int map_coherent = 0;
L
Linus Torvalds 已提交
467
	pgd_t *pgdp;
468
	pud_t *pudp;
L
Linus Torvalds 已提交
469 470
	pmd_t *pmdp;
	pte_t *ptep;
R
Ralf Baechle 已提交
471
	void *vaddr;
L
Linus Torvalds 已提交
472

473 474 475 476
	/*
	 * If ownes no valid ASID yet, cannot possibly have gotten
	 * this page into the cache.
	 */
477
	if (!has_valid_asid(mm))
478 479
		return;

480 481 482 483 484
	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 已提交
485 486 487 488 489

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

R
Ralf Baechle 已提交
493 494 495 496 497 498 499
	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.
		 */
500 501 502
		map_coherent = (cpu_has_dc_aliases &&
				page_mapped(page) && !Page_dcache_dirty(page));
		if (map_coherent)
R
Ralf Baechle 已提交
503 504
			vaddr = kmap_coherent(page, addr);
		else
505
			vaddr = kmap_atomic(page);
R
Ralf Baechle 已提交
506
		addr = (unsigned long)vaddr;
L
Linus Torvalds 已提交
507 508 509
	}

	if (cpu_has_dc_aliases || (exec && !cpu_has_ic_fills_f_dc)) {
R
Ralf Baechle 已提交
510
		r4k_blast_dcache_page(addr);
511 512
		if (exec && !cpu_icache_snoops_remote_store)
			r4k_blast_scache_page(addr);
L
Linus Torvalds 已提交
513 514
	}
	if (exec) {
R
Ralf Baechle 已提交
515
		if (vaddr && cpu_has_vtag_icache && mm == current->active_mm) {
L
Linus Torvalds 已提交
516 517
			int cpu = smp_processor_id();

T
Thiemo Seufer 已提交
518 519
			if (cpu_context(cpu, mm) != 0)
				drop_mmu_context(mm, cpu);
L
Linus Torvalds 已提交
520
		} else
R
Ralf Baechle 已提交
521 522 523 524
			r4k_blast_icache_page(addr);
	}

	if (vaddr) {
525
		if (map_coherent)
R
Ralf Baechle 已提交
526 527
			kunmap_coherent();
		else
528
			kunmap_atomic(vaddr);
L
Linus Torvalds 已提交
529 530 531
	}
}

532 533
static void r4k_flush_cache_page(struct vm_area_struct *vma,
	unsigned long addr, unsigned long pfn)
L
Linus Torvalds 已提交
534 535 536 537
{
	struct flush_cache_page_args args;

	args.vma = vma;
538
	args.addr = addr;
539
	args.pfn = pfn;
L
Linus Torvalds 已提交
540

541
	r4k_on_each_cpu(local_r4k_flush_cache_page, &args);
L
Linus Torvalds 已提交
542 543 544 545 546 547 548 549 550
}

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)
{
551 552 553
	if (in_atomic())
		local_r4k_flush_data_cache_page((void *)addr);
	else
554
		r4k_on_each_cpu(local_r4k_flush_data_cache_page, (void *) addr);
L
Linus Torvalds 已提交
555 556 557
}

struct flush_icache_range_args {
558 559
	unsigned long start;
	unsigned long end;
L
Linus Torvalds 已提交
560 561
};

562
static inline void local_r4k_flush_icache_range(unsigned long start, unsigned long end)
L
Linus Torvalds 已提交
563 564
{
	if (!cpu_has_ic_fills_f_dc) {
565
		if (end - start >= dcache_size) {
L
Linus Torvalds 已提交
566 567
			r4k_blast_dcache();
		} else {
568
			R4600_HIT_CACHEOP_WAR_IMPL;
569
			protected_blast_dcache_range(start, end);
L
Linus Torvalds 已提交
570 571 572 573 574
		}
	}

	if (end - start > icache_size)
		r4k_blast_icache();
575 576
	else
		protected_blast_icache_range(start, end);
L
Linus Torvalds 已提交
577 578
}

579 580 581 582 583 584 585 586 587
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);
}

588
static void r4k_flush_icache_range(unsigned long start, unsigned long end)
L
Linus Torvalds 已提交
589 590 591 592 593 594
{
	struct flush_icache_range_args args;

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

595
	r4k_on_each_cpu(local_r4k_flush_icache_range_ipi, &args);
596
	instruction_hazard();
L
Linus Torvalds 已提交
597 598 599 600 601 602 603 604 605
}

#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);

606
	preempt_disable();
607
	if (cpu_has_inclusive_pcaches) {
608
		if (size >= scache_size)
L
Linus Torvalds 已提交
609
			r4k_blast_scache();
610 611
		else
			blast_scache_range(addr, addr + size);
K
Kevin Cernekee 已提交
612
		__sync();
L
Linus Torvalds 已提交
613 614 615 616 617 618 619 620
		return;
	}

	/*
	 * Either no secondary cache or the available caches don't have the
	 * subset property so we have to flush the primary caches
	 * explicitly
	 */
621
	if (cpu_has_safe_index_cacheops && size >= dcache_size) {
L
Linus Torvalds 已提交
622 623 624
		r4k_blast_dcache();
	} else {
		R4600_HIT_CACHEOP_WAR_IMPL;
625
		blast_dcache_range(addr, addr + size);
L
Linus Torvalds 已提交
626
	}
627
	preempt_enable();
L
Linus Torvalds 已提交
628 629

	bc_wback_inv(addr, size);
K
Kevin Cernekee 已提交
630
	__sync();
L
Linus Torvalds 已提交
631 632 633 634 635 636 637
}

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

638
	preempt_disable();
639
	if (cpu_has_inclusive_pcaches) {
640
		if (size >= scache_size)
L
Linus Torvalds 已提交
641
			r4k_blast_scache();
642 643 644 645 646 647
		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 已提交
648
			 * hit ops with insufficient alignment.	 Solved by
649 650
			 * aligning the address to cache line size.
			 */
651
			blast_inv_scache_range(addr, addr + size);
652
		}
K
Kevin Cernekee 已提交
653
		__sync();
L
Linus Torvalds 已提交
654 655 656
		return;
	}

657
	if (cpu_has_safe_index_cacheops && size >= dcache_size) {
L
Linus Torvalds 已提交
658 659 660
		r4k_blast_dcache();
	} else {
		R4600_HIT_CACHEOP_WAR_IMPL;
661
		blast_inv_dcache_range(addr, addr + size);
L
Linus Torvalds 已提交
662
	}
663
	preempt_enable();
L
Linus Torvalds 已提交
664 665

	bc_inv(addr, size);
K
Kevin Cernekee 已提交
666
	__sync();
L
Linus Torvalds 已提交
667 668 669 670 671 672 673 674 675 676
}
#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 已提交
677 678 679
	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 已提交
680 681 682
	unsigned long addr = (unsigned long) arg;

	R4600_HIT_CACHEOP_WAR_IMPL;
683 684
	if (dc_lsize)
		protected_writeback_dcache_line(addr & ~(dc_lsize - 1));
685
	if (!cpu_icache_snoops_remote_store && scache_size)
L
Linus Torvalds 已提交
686
		protected_writeback_scache_line(addr & ~(sc_lsize - 1));
687 688
	if (ic_lsize)
		protected_flush_icache_line(addr & ~(ic_lsize - 1));
L
Linus Torvalds 已提交
689 690 691 692 693
	if (MIPS4K_ICACHE_REFILL_WAR) {
		__asm__ __volatile__ (
			".set push\n\t"
			".set noat\n\t"
			".set mips3\n\t"
694
#ifdef CONFIG_32BIT
L
Linus Torvalds 已提交
695 696
			"la	$at,1f\n\t"
#endif
697
#ifdef CONFIG_64BIT
L
Linus Torvalds 已提交
698 699 700 701 702 703 704 705 706 707 708 709 710 711 712
			"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)
{
713
	r4k_on_each_cpu(local_r4k_flush_cache_sigtramp, (void *) addr);
L
Linus Torvalds 已提交
714 715 716 717 718 719 720 721
}

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

722 723 724 725 726 727 728 729 730 731 732 733 734 735 736 737 738 739 740 741 742 743 744 745 746 747 748 749 750 751 752 753 754
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 已提交
755 756 757 758 759 760 761 762 763 764 765
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 已提交
766
			".set push\n\t"
L
Linus Torvalds 已提交
767 768 769 770 771 772 773 774 775 776 777 778 779 780
			".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 已提交
781
			".set pop\n"
L
Linus Torvalds 已提交
782 783 784 785 786
			:
			: "r" (addr), "i" (Index_Store_Tag_I), "i" (Fill));
	}
}

787 788 789 790 791 792 793 794 795 796 797 798 799 800 801 802 803 804 805
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);
	}
}

806
static char *way_string[] = { NULL, "direct mapped", "2-way",
L
Linus Torvalds 已提交
807 808 809
	"3-way", "4-way", "5-way", "6-way", "7-way", "8-way"
};

810
static void probe_pcache(void)
L
Linus Torvalds 已提交
811 812 813 814 815 816 817
{
	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;

818
	switch (current_cpu_type()) {
L
Linus Torvalds 已提交
819 820 821 822 823 824 825
	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;
826
		c->icache.waybit = __ffs(icache_size/2);
L
Linus Torvalds 已提交
827 828 829 830

		dcache_size = 1 << (12 + ((config & CONF_DC) >> 6));
		c->dcache.linesz = 16 << ((config & CONF_DB) >> 4);
		c->dcache.ways = 2;
831
		c->dcache.waybit= __ffs(dcache_size/2);
L
Linus Torvalds 已提交
832 833 834 835 836 837 838 839 840 841 842 843 844 845 846 847

		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;

848
		c->options |= MIPS_CPU_CACHE_CDEX_P | MIPS_CPU_PREFETCH;
L
Linus Torvalds 已提交
849 850 851 852 853 854 855 856 857 858 859 860 861 862
		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 已提交
863
		c->options |= MIPS_CPU_PREFETCH;
L
Linus Torvalds 已提交
864 865 866 867 868 869 870 871 872 873 874 875
		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 已提交
876
		c->icache.waybit = 0;	/* doesn't matter */
L
Linus Torvalds 已提交
877 878 879 880 881 882 883 884 885 886 887

		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 已提交
888
	case CPU_R14000:
L
Linus Torvalds 已提交
889 890 891 892 893 894 895 896 897 898 899 900 901 902
		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:
903
		write_c0_config(config & ~VR41_CONF_P4K);
L
Linus Torvalds 已提交
904 905 906 907
	case CPU_VR4131:
		/* Workaround for cache instruction bug of VR4131 */
		if (c->processor_id == 0x0c80U || c->processor_id == 0x0c81U ||
		    c->processor_id == 0x0c82U) {
908 909 910
			config |= 0x00400000U;
			if (c->processor_id == 0x0c80U)
				config |= VR41_CONF_BP;
L
Linus Torvalds 已提交
911
			write_c0_config(config);
912 913 914
		} else
			c->options |= MIPS_CPU_CACHE_CDEX_P;

L
Linus Torvalds 已提交
915 916 917
		icache_size = 1 << (10 + ((config & CONF_IC) >> 9));
		c->icache.linesz = 16 << ((config & CONF_IB) >> 5);
		c->icache.ways = 2;
918
		c->icache.waybit = __ffs(icache_size/2);
L
Linus Torvalds 已提交
919 920 921 922

		dcache_size = 1 << (10 + ((config & CONF_DC) >> 6));
		c->dcache.linesz = 16 << ((config & CONF_DB) >> 4);
		c->dcache.ways = 2;
923
		c->dcache.waybit = __ffs(dcache_size/2);
L
Linus Torvalds 已提交
924 925 926 927 928 929 930 931 932 933 934
		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 已提交
935
		c->icache.waybit = 0;	/* doesn't matter */
L
Linus Torvalds 已提交
936 937 938 939 940 941 942 943 944 945 946 947 948 949 950

		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;
951
		c->icache.waybit = __ffs(icache_size / c->icache.ways);
L
Linus Torvalds 已提交
952 953 954 955

		dcache_size = 1 << (12 + ((config & CONF_DC) >> 6));
		c->dcache.linesz = 16 << ((config & CONF_DB) >> 4);
		c->dcache.ways = 4;
956
		c->dcache.waybit = __ffs(dcache_size / c->dcache.ways);
L
Linus Torvalds 已提交
957 958 959 960 961

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

962 963 964 965 966 967 968 969 970 971 972 973 974 975 976 977 978 979
	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 已提交
980 981 982 983 984 985 986 987 988 989 990 991 992 993
	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;
994
		c->icache.sets = 32 << (((config1 >> 22) + 1) & 7);
L
Linus Torvalds 已提交
995 996 997
		c->icache.ways = 1 + ((config1 >> 16) & 7);

		icache_size = c->icache.sets *
R
Ralf Baechle 已提交
998 999
			      c->icache.ways *
			      c->icache.linesz;
1000
		c->icache.waybit = __ffs(icache_size/c->icache.ways);
L
Linus Torvalds 已提交
1001 1002 1003 1004 1005 1006 1007 1008 1009 1010 1011 1012 1013

		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;
1014
		c->dcache.sets = 32 << (((config1 >> 13) + 1) & 7);
L
Linus Torvalds 已提交
1015 1016 1017
		c->dcache.ways = 1 + ((config1 >> 7) & 7);

		dcache_size = c->dcache.sets *
R
Ralf Baechle 已提交
1018 1019
			      c->dcache.ways *
			      c->dcache.linesz;
1020
		c->dcache.waybit = __ffs(dcache_size/c->dcache.ways);
L
Linus Torvalds 已提交
1021 1022 1023 1024 1025 1026 1027

		c->options |= MIPS_CPU_PREFETCH;
		break;
	}

	/*
	 * Processor configuration sanity check for the R4000SC erratum
R
Ralf Baechle 已提交
1028
	 * #5.	With page sizes larger than 32kB there is no possibility
L
Linus Torvalds 已提交
1029 1030 1031 1032 1033 1034 1035 1036 1037 1038 1039 1040 1041 1042
	 * 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;

1043 1044 1045 1046
	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 已提交
1047 1048 1049 1050 1051 1052 1053

	/*
	 * 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.
	 */
1054
	switch (current_cpu_type()) {
1055
	case CPU_20KC:
R
Ralf Baechle 已提交
1056
	case CPU_25KF:
1057 1058
	case CPU_SB1:
	case CPU_SB1A:
1059
	case CPU_XLR:
1060
		c->dcache.flags |= MIPS_CACHE_PINDEX;
1061 1062
		break;

1063 1064
	case CPU_R10000:
	case CPU_R12000:
K
Kumba 已提交
1065
	case CPU_R14000:
1066
		break;
1067

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

1087
	switch (current_cpu_type()) {
L
Linus Torvalds 已提交
1088 1089 1090 1091 1092 1093 1094 1095
	case CPU_20KC:
		/*
		 * Some older 20Kc chips doesn't have the 'VI' bit in
		 * the config register.
		 */
		c->icache.flags |= MIPS_CACHE_VTAG;
		break;

1096
	case CPU_ALCHEMY:
L
Linus Torvalds 已提交
1097 1098 1099 1100
		c->icache.flags |= MIPS_CACHE_IC_F_DC;
		break;
	}

R
Ralf Baechle 已提交
1101
#ifdef	CONFIG_CPU_LOONGSON2
1102 1103 1104 1105 1106 1107 1108
	/*
	 * 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 已提交
1109 1110
	printk("Primary instruction cache %ldkB, %s, %s, linesize %d bytes.\n",
	       icache_size >> 10,
1111
	       c->icache.flags & MIPS_CACHE_VTAG ? "VIVT" : "VIPT",
L
Linus Torvalds 已提交
1112 1113
	       way_string[c->icache.ways], c->icache.linesz);

1114 1115 1116 1117 1118 1119
	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 已提交
1120 1121 1122 1123 1124 1125 1126 1127
}

/*
 * 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.
 */
1128
static int probe_scache(void)
L
Linus Torvalds 已提交
1129 1130 1131 1132 1133 1134 1135 1136
{
	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;

1137
	begin = (unsigned long) &_stext;
L
Linus Torvalds 已提交
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 1174 1175 1176 1177 1178 1179 1180 1181 1182
	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;
}

1183 1184 1185 1186 1187 1188 1189 1190 1191 1192 1193 1194 1195 1196 1197 1198 1199 1200
#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 已提交
1201 1202
extern int r5k_sc_init(void);
extern int rm7k_sc_init(void);
1203
extern int mips_sc_init(void);
L
Linus Torvalds 已提交
1204

1205
static void setup_scache(void)
L
Linus Torvalds 已提交
1206 1207 1208 1209 1210 1211 1212 1213
{
	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 已提交
1214
	 * Linux memory management.
L
Linus Torvalds 已提交
1215
	 */
1216
	switch (current_cpu_type()) {
L
Linus Torvalds 已提交
1217 1218 1219 1220
	case CPU_R4000SC:
	case CPU_R4000MC:
	case CPU_R4400SC:
	case CPU_R4400MC:
1221
		sc_present = run_uncached(probe_scache);
L
Linus Torvalds 已提交
1222 1223 1224 1225 1226 1227
		if (sc_present)
			c->options |= MIPS_CPU_CACHE_CDEX_S;
		break;

	case CPU_R10000:
	case CPU_R12000:
K
Kumba 已提交
1228
	case CPU_R14000:
L
Linus Torvalds 已提交
1229 1230 1231 1232 1233 1234 1235 1236 1237 1238 1239 1240
		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 已提交
1241
		return;
L
Linus Torvalds 已提交
1242 1243 1244 1245 1246 1247 1248

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

1249 1250 1251 1252 1253
#if defined(CONFIG_CPU_LOONGSON2)
	case CPU_LOONGSON2:
		loongson2_sc_init();
		return;
#endif
J
Jayachandran C 已提交
1254 1255 1256
	case CPU_XLP:
		/* don't need to worry about L2, fully coherent */
		return;
1257

L
Linus Torvalds 已提交
1258
	default:
1259 1260
		if (c->isa_level & (MIPS_CPU_ISA_M32R1 | MIPS_CPU_ISA_M32R2 |
				    MIPS_CPU_ISA_M64R1 | MIPS_CPU_ISA_M64R2)) {
1261 1262 1263 1264 1265 1266 1267 1268 1269 1270 1271 1272 1273
#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 已提交
1274 1275 1276 1277 1278 1279 1280 1281 1282 1283 1284 1285 1286 1287
		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);

1288
	c->options |= MIPS_CPU_INCLUSIVE_CACHES;
L
Linus Torvalds 已提交
1289 1290
}

1291 1292 1293 1294 1295 1296 1297 1298 1299 1300 1301 1302 1303 1304 1305
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
1306
	 * to the (now gone) cpu table.
1307 1308 1309 1310 1311 1312 1313 1314 1315
	 */
	case 0x02030200: /* Au1100 AB */
	case 0x02030201: /* Au1100 BA */
	case 0x02030202: /* Au1100 BC */
		set_c0_config(1 << 19);
		break;
	}
}

1316 1317 1318 1319 1320 1321 1322 1323 1324 1325 1326 1327 1328 1329 1330 1331 1332 1333 1334 1335 1336 1337
/* 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();
}

1338
static int cca = -1;
1339 1340 1341 1342 1343

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

1344
	return 0;
1345 1346
}

1347
early_param("cca", cca_setup);
1348

1349
static void coherency_setup(void)
L
Linus Torvalds 已提交
1350
{
1351 1352 1353 1354 1355 1356
	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 已提交
1357 1358 1359 1360 1361 1362 1363 1364

	/*
	 * 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 ...
	 */
1365
	switch (current_cpu_type()) {
L
Linus Torvalds 已提交
1366 1367 1368 1369 1370 1371 1372 1373
	case CPU_R4000PC:
	case CPU_R4000SC:
	case CPU_R4000MC:
	case CPU_R4400PC:
	case CPU_R4400SC:
	case CPU_R4400MC:
		clear_c0_config(CONF_CU);
		break;
1374
	/*
R
Ralf Baechle 已提交
1375
	 * We need to catch the early Alchemy SOCs with
1376 1377
	 * 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
1378
	 */
1379
	case CPU_ALCHEMY:
1380 1381
		au1x00_fixup_config_od();
		break;
1382 1383 1384 1385

	case PRID_IMP_PR4450:
		nxp_pr4450_fixup_config();
		break;
L
Linus Torvalds 已提交
1386 1387 1388
	}
}

1389
static void r4k_cache_error_setup(void)
L
Linus Torvalds 已提交
1390
{
1391 1392
	extern char __weak except_vec2_generic;
	extern char __weak except_vec2_sb1;
L
Linus Torvalds 已提交
1393

1394
	switch (current_cpu_type()) {
1395 1396 1397 1398 1399 1400 1401 1402 1403
	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;
	}
1404 1405
}

1406
void r4k_cache_init(void)
1407 1408 1409 1410
{
	extern void build_clear_page(void);
	extern void build_copy_page(void);
	struct cpuinfo_mips *c = &current_cpu_data;
L
Linus Torvalds 已提交
1411 1412 1413 1414 1415 1416 1417 1418 1419 1420 1421 1422 1423 1424 1425 1426 1427 1428 1429

	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.
	 */
1430 1431 1432 1433 1434 1435
	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;
1436 1437 1438 1439

	__flush_cache_vmap	= r4k__flush_cache_vmap;
	__flush_cache_vunmap	= r4k__flush_cache_vunmap;

R
Ralf Baechle 已提交
1440
	flush_cache_all		= cache_noop;
L
Linus Torvalds 已提交
1441 1442 1443 1444 1445
	__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;

1446 1447
	__flush_kernel_vmap_range = r4k_flush_kernel_vmap_range;

L
Linus Torvalds 已提交
1448 1449
	flush_cache_sigtramp	= r4k_flush_cache_sigtramp;
	flush_icache_all	= r4k_flush_icache_all;
1450
	local_flush_data_cache_page	= local_r4k_flush_data_cache_page;
L
Linus Torvalds 已提交
1451 1452
	flush_data_cache_page	= r4k_flush_data_cache_page;
	flush_icache_range	= r4k_flush_icache_range;
1453
	local_flush_icache_range	= local_r4k_flush_icache_range;
L
Linus Torvalds 已提交
1454

1455 1456 1457 1458 1459 1460 1461 1462 1463 1464
#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 已提交
1465 1466 1467 1468
#endif

	build_clear_page();
	build_copy_page();
1469 1470 1471 1472 1473 1474

	/*
	 * We want to run CMP kernels on core with and without coherent
	 * caches. Therefore, do not use CONFIG_MIPS_CMP to decide whether
	 * or not to flush caches.
	 */
1475
	local_r4k___flush_cache_all(NULL);
1476

1477
	coherency_setup();
1478
	board_cache_error_setup = r4k_cache_error_setup;
L
Linus Torvalds 已提交
1479
}