cache.c 30.6 KB
Newer Older
V
Vineet Gupta 已提交
1
/*
2
 * ARC Cache Management
V
Vineet Gupta 已提交
3
 *
4
 * Copyright (C) 2014-15 Synopsys, Inc. (www.synopsys.com)
V
Vineet Gupta 已提交
5 6 7 8 9 10 11 12 13 14 15 16 17 18
 * Copyright (C) 2004, 2007-2010, 2011-2012 Synopsys, Inc. (www.synopsys.com)
 *
 * This program is free software; you can redistribute it and/or modify
 * it under the terms of the GNU General Public License version 2 as
 * published by the Free Software Foundation.
 */

#include <linux/module.h>
#include <linux/mm.h>
#include <linux/sched.h>
#include <linux/cache.h>
#include <linux/mmu_context.h>
#include <linux/syscalls.h>
#include <linux/uaccess.h>
19
#include <linux/pagemap.h>
V
Vineet Gupta 已提交
20 21 22 23
#include <asm/cacheflush.h>
#include <asm/cachectl.h>
#include <asm/setup.h>

24
static int l2_line_sz;
25
static int ioc_exists;
26
int slc_enable = 1, ioc_enable = 0;
27
unsigned long perip_base = ARC_UNCACHED_ADDR_SPACE; /* legacy value for boot */
28
unsigned long perip_end = 0xFFFFFFFF; /* legacy value */
29

30
void (*_cache_line_loop_ic_fn)(phys_addr_t paddr, unsigned long vaddr,
31 32
			       unsigned long sz, const int cacheop);

33 34 35
void (*__dma_cache_wback_inv)(phys_addr_t start, unsigned long sz);
void (*__dma_cache_inv)(phys_addr_t start, unsigned long sz);
void (*__dma_cache_wback)(phys_addr_t start, unsigned long sz);
36

V
Vineet Gupta 已提交
37
char *arc_cache_mumbojumbo(int c, char *buf, int len)
38 39
{
	int n = 0;
40
	struct cpuinfo_arc_cache *p;
41

V
Vineet Gupta 已提交
42
#define PR_CACHE(p, cfg, str)						\
43
	if (!(p)->line_len)						\
44 45 46
		n += scnprintf(buf + n, len - n, str"\t\t: N/A\n");	\
	else								\
		n += scnprintf(buf + n, len - n,			\
V
Vineet Gupta 已提交
47 48 49 50
			str"\t\t: %uK, %dway/set, %uB Line, %s%s%s\n",	\
			(p)->sz_k, (p)->assoc, (p)->line_len,		\
			(p)->vipt ? "VIPT" : "PIPT",			\
			(p)->alias ? " aliasing" : "",			\
51
			IS_USED_CFG(cfg));
52

V
Vineet Gupta 已提交
53 54
	PR_CACHE(&cpuinfo_arc700[c].icache, CONFIG_ARC_HAS_ICACHE, "I-Cache");
	PR_CACHE(&cpuinfo_arc700[c].dcache, CONFIG_ARC_HAS_DCACHE, "D-Cache");
55

56
	p = &cpuinfo_arc700[c].slc;
57
	if (p->line_len)
58
		n += scnprintf(buf + n, len - n,
59 60
			       "SLC\t\t: %uK, %uB Line%s\n",
			       p->sz_k, p->line_len, IS_USED_RUN(slc_enable));
61

62 63 64
	n += scnprintf(buf + n, len - n, "Peripherals\t: %#lx%s%s\n",
		       perip_base,
		       IS_AVAIL3(ioc_exists, ioc_enable, ", IO-Coherency "));
65

66 67 68
	return buf;
}

V
Vineet Gupta 已提交
69 70 71 72 73
/*
 * Read the Cache Build Confuration Registers, Decode them and save into
 * the cpuinfo structure for later use.
 * No Validation done here, simply read/convert the BCRs
 */
74
static void read_decode_cache_bcr_arcv2(int cpu)
V
Vineet Gupta 已提交
75
{
76
	struct cpuinfo_arc_cache *p_slc = &cpuinfo_arc700[cpu].slc;
77 78 79 80 81 82 83 84 85 86
	struct bcr_generic sbcr;

	struct bcr_slc_cfg {
#ifdef CONFIG_CPU_BIG_ENDIAN
		unsigned int pad:24, way:2, lsz:2, sz:4;
#else
		unsigned int sz:4, lsz:2, way:2, pad:24;
#endif
	} slc_cfg;

87 88 89 90 91 92 93 94
	struct bcr_clust_cfg {
#ifdef CONFIG_CPU_BIG_ENDIAN
		unsigned int pad:7, c:1, num_entries:8, num_cores:8, ver:8;
#else
		unsigned int ver:8, num_cores:8, num_entries:8, c:1, pad:7;
#endif
	} cbcr;

95 96 97 98 99 100 101 102 103
	struct bcr_volatile {
#ifdef CONFIG_CPU_BIG_ENDIAN
		unsigned int start:4, limit:4, pad:22, order:1, disable:1;
#else
		unsigned int disable:1, order:1, pad:22, limit:4, start:4;
#endif
	} vol;


104 105 106 107 108 109 110 111
	READ_BCR(ARC_REG_SLC_BCR, sbcr);
	if (sbcr.ver) {
		READ_BCR(ARC_REG_SLC_CFG, slc_cfg);
		p_slc->sz_k = 128 << slc_cfg.sz;
		l2_line_sz = p_slc->line_len = (slc_cfg.lsz == 0) ? 128 : 64;
	}

	READ_BCR(ARC_REG_CLUSTER_BCR, cbcr);
112
	if (cbcr.c)
113
		ioc_exists = 1;
114 115
	else
		ioc_enable = 0;
116

117 118 119 120 121 122 123 124
	/* HS 2.0 didn't have AUX_VOL */
	if (cpuinfo_arc700[cpu].core.family > 0x51) {
		READ_BCR(AUX_VOL, vol);
		perip_base = vol.start << 28;
		/* HS 3.0 has limit and strict-ordering fields */
		if (cpuinfo_arc700[cpu].core.family > 0x52)
			perip_end = (vol.limit << 28) - 1;
	}
125 126 127 128 129 130 131 132 133 134 135 136 137 138
}

void read_decode_cache_bcr(void)
{
	struct cpuinfo_arc_cache *p_ic, *p_dc;
	unsigned int cpu = smp_processor_id();
	struct bcr_cache {
#ifdef CONFIG_CPU_BIG_ENDIAN
		unsigned int pad:12, line_len:4, sz:4, config:4, ver:8;
#else
		unsigned int ver:8, config:4, sz:4, line_len:4, pad:12;
#endif
	} ibcr, dbcr;

V
Vineet Gupta 已提交
139 140 141
	p_ic = &cpuinfo_arc700[cpu].icache;
	READ_BCR(ARC_REG_IC_BCR, ibcr);

V
Vineet Gupta 已提交
142 143 144
	if (!ibcr.ver)
		goto dc_chk;

145 146 147 148 149 150 151
	if (ibcr.ver <= 3) {
		BUG_ON(ibcr.config != 3);
		p_ic->assoc = 2;		/* Fixed to 2w set assoc */
	} else if (ibcr.ver >= 4) {
		p_ic->assoc = 1 << ibcr.config;	/* 1,2,4,8 */
	}

V
Vineet Gupta 已提交
152
	p_ic->line_len = 8 << ibcr.line_len;
V
Vineet Gupta 已提交
153 154 155
	p_ic->sz_k = 1 << (ibcr.sz - 1);
	p_ic->vipt = 1;
	p_ic->alias = p_ic->sz_k/p_ic->assoc/TO_KB(PAGE_SIZE) > 1;
V
Vineet Gupta 已提交
156

V
Vineet Gupta 已提交
157
dc_chk:
V
Vineet Gupta 已提交
158 159 160
	p_dc = &cpuinfo_arc700[cpu].dcache;
	READ_BCR(ARC_REG_DC_BCR, dbcr);

V
Vineet Gupta 已提交
161
	if (!dbcr.ver)
162 163 164 165 166 167 168 169 170 171 172 173
		goto slc_chk;

	if (dbcr.ver <= 3) {
		BUG_ON(dbcr.config != 2);
		p_dc->assoc = 4;		/* Fixed to 4w set assoc */
		p_dc->vipt = 1;
		p_dc->alias = p_dc->sz_k/p_dc->assoc/TO_KB(PAGE_SIZE) > 1;
	} else if (dbcr.ver >= 4) {
		p_dc->assoc = 1 << dbcr.config;	/* 1,2,4,8 */
		p_dc->vipt = 0;
		p_dc->alias = 0;		/* PIPT so can't VIPT alias */
	}
V
Vineet Gupta 已提交
174

V
Vineet Gupta 已提交
175
	p_dc->line_len = 16 << dbcr.line_len;
V
Vineet Gupta 已提交
176
	p_dc->sz_k = 1 << (dbcr.sz - 1);
177 178

slc_chk:
179 180
	if (is_isa_arcv2())
                read_decode_cache_bcr_arcv2(cpu);
V
Vineet Gupta 已提交
181 182 183
}

/*
184
 * Line Operation on {I,D}-Cache
V
Vineet Gupta 已提交
185 186 187 188 189
 */

#define OP_INV		0x1
#define OP_FLUSH	0x2
#define OP_FLUSH_N_INV	0x3
190 191 192
#define OP_INV_IC	0x4

/*
193 194 195 196 197 198 199 200 201 202 203 204 205 206 207 208 209 210 211 212 213 214 215 216 217 218 219 220 221 222 223 224 225 226
 *		I-Cache Aliasing in ARC700 VIPT caches (MMU v1-v3)
 *
 * ARC VIPT I-cache uses vaddr to index into cache and paddr to match the tag.
 * The orig Cache Management Module "CDU" only required paddr to invalidate a
 * certain line since it sufficed as index in Non-Aliasing VIPT cache-geometry.
 * Infact for distinct V1,V2,P: all of {V1-P},{V2-P},{P-P} would end up fetching
 * the exact same line.
 *
 * However for larger Caches (way-size > page-size) - i.e. in Aliasing config,
 * paddr alone could not be used to correctly index the cache.
 *
 * ------------------
 * MMU v1/v2 (Fixed Page Size 8k)
 * ------------------
 * The solution was to provide CDU with these additonal vaddr bits. These
 * would be bits [x:13], x would depend on cache-geometry, 13 comes from
 * standard page size of 8k.
 * H/w folks chose [17:13] to be a future safe range, and moreso these 5 bits
 * of vaddr could easily be "stuffed" in the paddr as bits [4:0] since the
 * orig 5 bits of paddr were anyways ignored by CDU line ops, as they
 * represent the offset within cache-line. The adv of using this "clumsy"
 * interface for additional info was no new reg was needed in CDU programming
 * model.
 *
 * 17:13 represented the max num of bits passable, actual bits needed were
 * fewer, based on the num-of-aliases possible.
 * -for 2 alias possibility, only bit 13 needed (32K cache)
 * -for 4 alias possibility, bits 14:13 needed (64K cache)
 *
 * ------------------
 * MMU v3
 * ------------------
 * This ver of MMU supports variable page sizes (1k-16k): although Linux will
 * only support 8k (default), 16k and 4k.
A
Andrea Gelmini 已提交
227
 * However from hardware perspective, smaller page sizes aggravate aliasing
228 229 230 231
 * meaning more vaddr bits needed to disambiguate the cache-line-op ;
 * the existing scheme of piggybacking won't work for certain configurations.
 * Two new registers IC_PTAG and DC_PTAG inttoduced.
 * "tag" bits are provided in PTAG, index bits in existing IVIL/IVDL/FLDL regs
232
 */
233

V
Vineet Gupta 已提交
234
static inline
235
void __cache_line_loop_v2(phys_addr_t paddr, unsigned long vaddr,
V
Vineet Gupta 已提交
236
			  unsigned long sz, const int op)
237
{
V
Vineet Gupta 已提交
238
	unsigned int aux_cmd;
239
	int num_lines;
V
Vineet Gupta 已提交
240
	const int full_page = __builtin_constant_p(sz) && sz == PAGE_SIZE;
241

242
	if (op == OP_INV_IC) {
243
		aux_cmd = ARC_REG_IC_IVIL;
V
Vineet Gupta 已提交
244
	} else {
245
		/* d$ cmd: INV (discard or wback-n-discard) OR FLUSH (wback) */
246
		aux_cmd = op & OP_INV ? ARC_REG_DC_IVDL : ARC_REG_DC_FLDL;
247 248 249 250 251 252 253 254
	}

	/* Ensure we properly floor/ceil the non-line aligned/sized requests
	 * and have @paddr - aligned to cache line and integral @num_lines.
	 * This however can be avoided for page sized since:
	 *  -@paddr will be cache-line aligned already (being page aligned)
	 *  -@sz will be integral multiple of line size (being page sized).
	 */
V
Vineet Gupta 已提交
255
	if (!full_page) {
256 257 258 259 260 261 262 263 264
		sz += paddr & ~CACHE_LINE_MASK;
		paddr &= CACHE_LINE_MASK;
		vaddr &= CACHE_LINE_MASK;
	}

	num_lines = DIV_ROUND_UP(sz, L1_CACHE_BYTES);

	/* MMUv2 and before: paddr contains stuffed vaddrs bits */
	paddr |= (vaddr >> PAGE_SHIFT) & 0x1F;
V
Vineet Gupta 已提交
265 266 267 268 269 270 271

	while (num_lines-- > 0) {
		write_aux_reg(aux_cmd, paddr);
		paddr += L1_CACHE_BYTES;
	}
}

V
Vineet Gupta 已提交
272 273
/*
 * For ARC700 MMUv3 I-cache and D-cache flushes
274 275 276 277 278
 *  - ARC700 programming model requires paddr and vaddr be passed in seperate
 *    AUX registers (*_IV*L and *_PTAG respectively) irrespective of whether the
 *    caches actually alias or not.
 * -  For HS38, only the aliasing I-cache configuration uses the PTAG reg
 *    (non aliasing I-cache version doesn't; while D-cache can't possibly alias)
V
Vineet Gupta 已提交
279
 */
V
Vineet Gupta 已提交
280
static inline
281
void __cache_line_loop_v3(phys_addr_t paddr, unsigned long vaddr,
V
Vineet Gupta 已提交
282 283 284 285 286 287 288 289 290 291 292 293 294 295 296 297 298 299 300 301 302 303 304 305 306 307 308 309 310 311 312 313
			  unsigned long sz, const int op)
{
	unsigned int aux_cmd, aux_tag;
	int num_lines;
	const int full_page = __builtin_constant_p(sz) && sz == PAGE_SIZE;

	if (op == OP_INV_IC) {
		aux_cmd = ARC_REG_IC_IVIL;
		aux_tag = ARC_REG_IC_PTAG;
	} else {
		aux_cmd = op & OP_INV ? ARC_REG_DC_IVDL : ARC_REG_DC_FLDL;
		aux_tag = ARC_REG_DC_PTAG;
	}

	/* Ensure we properly floor/ceil the non-line aligned/sized requests
	 * and have @paddr - aligned to cache line and integral @num_lines.
	 * This however can be avoided for page sized since:
	 *  -@paddr will be cache-line aligned already (being page aligned)
	 *  -@sz will be integral multiple of line size (being page sized).
	 */
	if (!full_page) {
		sz += paddr & ~CACHE_LINE_MASK;
		paddr &= CACHE_LINE_MASK;
		vaddr &= CACHE_LINE_MASK;
	}
	num_lines = DIV_ROUND_UP(sz, L1_CACHE_BYTES);

	/*
	 * MMUv3, cache ops require paddr in PTAG reg
	 * if V-P const for loop, PTAG can be written once outside loop
	 */
	if (full_page)
314
		write_aux_reg(aux_tag, paddr);
315

V
Vineet Gupta 已提交
316 317
	/*
	 * This is technically for MMU v4, using the MMU v3 programming model
A
Andrea Gelmini 已提交
318
	 * Special work for HS38 aliasing I-cache configuration with PAE40
V
Vineet Gupta 已提交
319 320 321 322 323 324 325
	 *   - upper 8 bits of paddr need to be written into PTAG_HI
	 *   - (and needs to be written before the lower 32 bits)
	 * Note that PTAG_HI is hoisted outside the line loop
	 */
	if (is_pae40_enabled() && op == OP_INV_IC)
		write_aux_reg(ARC_REG_IC_PTAG_HI, (u64)paddr >> 32);

326
	while (num_lines-- > 0) {
V
Vineet Gupta 已提交
327
		if (!full_page) {
328 329 330
			write_aux_reg(aux_tag, paddr);
			paddr += L1_CACHE_BYTES;
		}
331 332 333 334 335

		write_aux_reg(aux_cmd, vaddr);
		vaddr += L1_CACHE_BYTES;
	}
}
V
Vineet Gupta 已提交
336

337
/*
V
Vineet Gupta 已提交
338 339
 * In HS38x (MMU v4), I-cache is VIPT (can alias), D-cache is PIPT
 * Here's how cache ops are implemented
340
 *
V
Vineet Gupta 已提交
341 342 343 344 345 346 347 348
 *  - D-cache: only paddr needed (in DC_IVDL/DC_FLDL)
 *  - I-cache Non Aliasing: Despite VIPT, only paddr needed (in IC_IVIL)
 *  - I-cache Aliasing: Both vaddr and paddr needed (in IC_IVIL, IC_PTAG
 *    respectively, similar to MMU v3 programming model, hence
 *    __cache_line_loop_v3() is used)
 *
 * If PAE40 is enabled, independent of aliasing considerations, the higher bits
 * needs to be written into PTAG_HI
349 350
 */
static inline
351
void __cache_line_loop_v4(phys_addr_t paddr, unsigned long vaddr,
352 353 354 355 356 357 358 359 360 361 362 363 364 365 366 367 368 369 370 371 372 373 374 375 376 377
			  unsigned long sz, const int cacheop)
{
	unsigned int aux_cmd;
	int num_lines;
	const int full_page_op = __builtin_constant_p(sz) && sz == PAGE_SIZE;

	if (cacheop == OP_INV_IC) {
		aux_cmd = ARC_REG_IC_IVIL;
	} else {
		/* d$ cmd: INV (discard or wback-n-discard) OR FLUSH (wback) */
		aux_cmd = cacheop & OP_INV ? ARC_REG_DC_IVDL : ARC_REG_DC_FLDL;
	}

	/* Ensure we properly floor/ceil the non-line aligned/sized requests
	 * and have @paddr - aligned to cache line and integral @num_lines.
	 * This however can be avoided for page sized since:
	 *  -@paddr will be cache-line aligned already (being page aligned)
	 *  -@sz will be integral multiple of line size (being page sized).
	 */
	if (!full_page_op) {
		sz += paddr & ~CACHE_LINE_MASK;
		paddr &= CACHE_LINE_MASK;
	}

	num_lines = DIV_ROUND_UP(sz, L1_CACHE_BYTES);

V
Vineet Gupta 已提交
378 379 380 381 382 383 384 385 386 387 388 389 390 391 392 393
	/*
	 * For HS38 PAE40 configuration
	 *   - upper 8 bits of paddr need to be written into PTAG_HI
	 *   - (and needs to be written before the lower 32 bits)
	 */
	if (is_pae40_enabled()) {
		if (cacheop == OP_INV_IC)
			/*
			 * Non aliasing I-cache in HS38,
			 * aliasing I-cache handled in __cache_line_loop_v3()
			 */
			write_aux_reg(ARC_REG_IC_PTAG_HI, (u64)paddr >> 32);
		else
			write_aux_reg(ARC_REG_DC_PTAG_HI, (u64)paddr >> 32);
	}

394 395 396 397 398 399
	while (num_lines-- > 0) {
		write_aux_reg(aux_cmd, paddr);
		paddr += L1_CACHE_BYTES;
	}
}

V
Vineet Gupta 已提交
400 401 402 403
#if (CONFIG_ARC_MMU_VER < 3)
#define __cache_line_loop	__cache_line_loop_v2
#elif (CONFIG_ARC_MMU_VER == 3)
#define __cache_line_loop	__cache_line_loop_v3
404 405
#elif (CONFIG_ARC_MMU_VER > 3)
#define __cache_line_loop	__cache_line_loop_v4
V
Vineet Gupta 已提交
406 407
#endif

V
Vineet Gupta 已提交
408 409 410 411 412 413
#ifdef CONFIG_ARC_HAS_DCACHE

/***************************************************************
 * Machine specific helpers for Entire D-Cache or Per Line ops
 */

414
static inline void __before_dc_op(const int op)
V
Vineet Gupta 已提交
415
{
416 417 418 419 420 421
	if (op == OP_FLUSH_N_INV) {
		/* Dcache provides 2 cmd: FLUSH or INV
		 * INV inturn has sub-modes: DISCARD or FLUSH-BEFORE
		 * flush-n-inv is achieved by INV cmd but with IM=1
		 * So toggle INV sub-mode depending on op request and default
		 */
422 423
		const unsigned int ctl = ARC_REG_DC_CTRL;
		write_aux_reg(ctl, read_aux_reg(ctl) | DC_CTRL_INV_MODE_FLUSH);
424 425 426
	}
}

427
static inline void __after_dc_op(const int op)
428
{
429 430 431
	if (op & OP_FLUSH) {
		const unsigned int ctl = ARC_REG_DC_CTRL;
		unsigned int reg;
432

433 434 435 436 437 438 439 440
		/* flush / flush-n-inv both wait */
		while ((reg = read_aux_reg(ctl)) & DC_CTRL_FLUSH_STATUS)
			;

		/* Switch back to default Invalidate mode */
		if (op == OP_FLUSH_N_INV)
			write_aux_reg(ctl, reg & ~DC_CTRL_INV_MODE_FLUSH);
	}
V
Vineet Gupta 已提交
441 442 443 444
}

/*
 * Operation on Entire D-Cache
445
 * @op = {OP_INV, OP_FLUSH, OP_FLUSH_N_INV}
V
Vineet Gupta 已提交
446 447 448
 * Note that constant propagation ensures all the checks are gone
 * in generated code
 */
449
static inline void __dc_entire_op(const int op)
V
Vineet Gupta 已提交
450 451 452
{
	int aux;

453
	__before_dc_op(op);
V
Vineet Gupta 已提交
454

455
	if (op & OP_INV)	/* Inv or flush-n-inv use same cmd reg */
V
Vineet Gupta 已提交
456 457 458 459 460 461
		aux = ARC_REG_DC_IVDC;
	else
		aux = ARC_REG_DC_FLSH;

	write_aux_reg(aux, 0x1);

462
	__after_dc_op(op);
V
Vineet Gupta 已提交
463 464
}

465 466 467 468 469 470 471 472 473 474 475 476 477 478 479
static inline void __dc_disable(void)
{
	const int r = ARC_REG_DC_CTRL;

	__dc_entire_op(OP_FLUSH_N_INV);
	write_aux_reg(r, read_aux_reg(r) | DC_CTRL_DIS);
}

static void __dc_enable(void)
{
	const int r = ARC_REG_DC_CTRL;

	write_aux_reg(r, read_aux_reg(r) & ~DC_CTRL_DIS);
}

480
/* For kernel mappings cache operation: index is same as paddr */
481 482
#define __dc_line_op_k(p, sz, op)	__dc_line_op(p, p, sz, op)

V
Vineet Gupta 已提交
483
/*
484
 * D-Cache Line ops: Per Line INV (discard or wback+discard) or FLUSH (wback)
V
Vineet Gupta 已提交
485
 */
486
static inline void __dc_line_op(phys_addr_t paddr, unsigned long vaddr,
487
				unsigned long sz, const int op)
V
Vineet Gupta 已提交
488
{
489
	unsigned long flags;
V
Vineet Gupta 已提交
490 491 492

	local_irq_save(flags);

493
	__before_dc_op(op);
V
Vineet Gupta 已提交
494

495
	__cache_line_loop(paddr, vaddr, sz, op);
V
Vineet Gupta 已提交
496

497
	__after_dc_op(op);
V
Vineet Gupta 已提交
498 499 500 501 502 503

	local_irq_restore(flags);
}

#else

504
#define __dc_entire_op(op)
505 506
#define __dc_disable()
#define __dc_enable()
507 508
#define __dc_line_op(paddr, vaddr, sz, op)
#define __dc_line_op_k(paddr, sz, op)
V
Vineet Gupta 已提交
509 510 511 512 513

#endif /* CONFIG_ARC_HAS_DCACHE */

#ifdef CONFIG_ARC_HAS_ICACHE

514 515 516 517 518 519 520
static inline void __ic_entire_inv(void)
{
	write_aux_reg(ARC_REG_IC_IVIC, 1);
	read_aux_reg(ARC_REG_IC_CTRL);	/* blocks */
}

static inline void
521
__ic_line_inv_vaddr_local(phys_addr_t paddr, unsigned long vaddr,
522
			  unsigned long sz)
V
Vineet Gupta 已提交
523 524 525 526
{
	unsigned long flags;

	local_irq_save(flags);
527
	(*_cache_line_loop_ic_fn)(paddr, vaddr, sz, OP_INV_IC);
V
Vineet Gupta 已提交
528 529 530
	local_irq_restore(flags);
}

531 532 533 534 535
#ifndef CONFIG_SMP

#define __ic_line_inv_vaddr(p, v, s)	__ic_line_inv_vaddr_local(p, v, s)

#else
536

537
struct ic_inv_args {
538
	phys_addr_t paddr, vaddr;
539 540 541 542 543
	int sz;
};

static void __ic_line_inv_vaddr_helper(void *info)
{
N
Noam Camus 已提交
544
        struct ic_inv_args *ic_inv = info;
545

546 547 548
        __ic_line_inv_vaddr_local(ic_inv->paddr, ic_inv->vaddr, ic_inv->sz);
}

549
static void __ic_line_inv_vaddr(phys_addr_t paddr, unsigned long vaddr,
550 551
				unsigned long sz)
{
552 553 554 555 556 557
	struct ic_inv_args ic_inv = {
		.paddr = paddr,
		.vaddr = vaddr,
		.sz    = sz
	};

558 559
	on_each_cpu(__ic_line_inv_vaddr_helper, &ic_inv, 1);
}
560 561 562 563

#endif	/* CONFIG_SMP */

#else	/* !CONFIG_ARC_HAS_ICACHE */
V
Vineet Gupta 已提交
564

565
#define __ic_entire_inv()
V
Vineet Gupta 已提交
566 567 568 569
#define __ic_line_inv_vaddr(pstart, vstart, sz)

#endif /* CONFIG_ARC_HAS_ICACHE */

570
noinline void slc_op(phys_addr_t paddr, unsigned long sz, const int op)
571 572
{
#ifdef CONFIG_ISA_ARCV2
573 574 575 576 577 578 579 580
	/*
	 * SLC is shared between all cores and concurrent aux operations from
	 * multiple cores need to be serialized using a spinlock
	 * A concurrent operation can be silently ignored and/or the old/new
	 * operation can remain incomplete forever (lockup in SLC_CTRL_BUSY loop
	 * below)
	 */
	static DEFINE_SPINLOCK(lock);
581 582 583
	unsigned long flags;
	unsigned int ctrl;

584
	spin_lock_irqsave(&lock, flags);
585 586 587 588 589 590 591 592 593 594 595 596 597 598 599 600 601 602 603 604 605 606 607 608 609 610 611 612 613 614 615 616

	/*
	 * The Region Flush operation is specified by CTRL.RGN_OP[11..9]
	 *  - b'000 (default) is Flush,
	 *  - b'001 is Invalidate if CTRL.IM == 0
	 *  - b'001 is Flush-n-Invalidate if CTRL.IM == 1
	 */
	ctrl = read_aux_reg(ARC_REG_SLC_CTRL);

	/* Don't rely on default value of IM bit */
	if (!(op & OP_FLUSH))		/* i.e. OP_INV */
		ctrl &= ~SLC_CTRL_IM;	/* clear IM: Disable flush before Inv */
	else
		ctrl |= SLC_CTRL_IM;

	if (op & OP_INV)
		ctrl |= SLC_CTRL_RGN_OP_INV;	/* Inv or flush-n-inv */
	else
		ctrl &= ~SLC_CTRL_RGN_OP_INV;

	write_aux_reg(ARC_REG_SLC_CTRL, ctrl);

	/*
	 * Lower bits are ignored, no need to clip
	 * END needs to be setup before START (latter triggers the operation)
	 * END can't be same as START, so add (l2_line_sz - 1) to sz
	 */
	write_aux_reg(ARC_REG_SLC_RGN_END, (paddr + sz + l2_line_sz - 1));
	write_aux_reg(ARC_REG_SLC_RGN_START, paddr);

	while (read_aux_reg(ARC_REG_SLC_CTRL) & SLC_CTRL_BUSY);

617
	spin_unlock_irqrestore(&lock, flags);
618 619 620
#endif
}

621 622 623 624 625 626 627 628 629 630 631 632 633 634 635 636 637 638 639 640 641 642 643 644 645 646 647 648 649 650 651 652 653 654
noinline static void slc_entire_op(const int op)
{
	unsigned int ctrl, r = ARC_REG_SLC_CTRL;

	ctrl = read_aux_reg(r);

	if (!(op & OP_FLUSH))		/* i.e. OP_INV */
		ctrl &= ~SLC_CTRL_IM;	/* clear IM: Disable flush before Inv */
	else
		ctrl |= SLC_CTRL_IM;

	write_aux_reg(r, ctrl);

	write_aux_reg(ARC_REG_SLC_INVALIDATE, 1);

	/* Important to wait for flush to complete */
	while (read_aux_reg(r) & SLC_CTRL_BUSY);
}

static inline void arc_slc_disable(void)
{
	const int r = ARC_REG_SLC_CTRL;

	slc_entire_op(OP_FLUSH_N_INV);
	write_aux_reg(r, read_aux_reg(r) | SLC_CTRL_DIS);
}

static inline void arc_slc_enable(void)
{
	const int r = ARC_REG_SLC_CTRL;

	write_aux_reg(r, read_aux_reg(r) & ~SLC_CTRL_DIS);
}

V
Vineet Gupta 已提交
655 656 657 658
/***********************************************************
 * Exported APIs
 */

659 660 661 662 663 664 665 666 667 668 669 670
/*
 * Handle cache congruency of kernel and userspace mappings of page when kernel
 * writes-to/reads-from
 *
 * The idea is to defer flushing of kernel mapping after a WRITE, possible if:
 *  -dcache is NOT aliasing, hence any U/K-mappings of page are congruent
 *  -U-mapping doesn't exist yet for page (finalised in update_mmu_cache)
 *  -In SMP, if hardware caches are coherent
 *
 * There's a corollary case, where kernel READs from a userspace mapped page.
 * If the U-mapping is not congruent to to K-mapping, former needs flushing.
 */
V
Vineet Gupta 已提交
671 672
void flush_dcache_page(struct page *page)
{
673 674 675
	struct address_space *mapping;

	if (!cache_is_vipt_aliasing()) {
676
		clear_bit(PG_dc_clean, &page->flags);
677 678 679 680 681 682 683 684 685 686 687 688 689
		return;
	}

	/* don't handle anon pages here */
	mapping = page_mapping(page);
	if (!mapping)
		return;

	/*
	 * pagecache page, file not yet mapped to userspace
	 * Make a note that K-mapping is dirty
	 */
	if (!mapping_mapped(mapping)) {
690
		clear_bit(PG_dc_clean, &page->flags);
691
	} else if (page_mapcount(page)) {
692 693

		/* kernel reading from page with U-mapping */
694
		phys_addr_t paddr = (unsigned long)page_address(page);
695
		unsigned long vaddr = page->index << PAGE_SHIFT;
696 697 698 699

		if (addr_not_cache_congruent(paddr, vaddr))
			__flush_dcache_page(paddr, vaddr);
	}
V
Vineet Gupta 已提交
700 701 702
}
EXPORT_SYMBOL(flush_dcache_page);

703 704 705 706
/*
 * DMA ops for systems with L1 cache only
 * Make memory coherent with L1 cache by flushing/invalidating L1 lines
 */
707
static void __dma_cache_wback_inv_l1(phys_addr_t start, unsigned long sz)
V
Vineet Gupta 已提交
708
{
709
	__dc_line_op_k(start, sz, OP_FLUSH_N_INV);
710
}
711

712
static void __dma_cache_inv_l1(phys_addr_t start, unsigned long sz)
713 714
{
	__dc_line_op_k(start, sz, OP_INV);
V
Vineet Gupta 已提交
715 716
}

717
static void __dma_cache_wback_l1(phys_addr_t start, unsigned long sz)
718 719 720 721 722 723
{
	__dc_line_op_k(start, sz, OP_FLUSH);
}

/*
 * DMA ops for systems with both L1 and L2 caches, but without IOC
724
 * Both L1 and L2 lines need to be explicitly flushed/invalidated
725
 */
726
static void __dma_cache_wback_inv_slc(phys_addr_t start, unsigned long sz)
727 728 729 730 731
{
	__dc_line_op_k(start, sz, OP_FLUSH_N_INV);
	slc_op(start, sz, OP_FLUSH_N_INV);
}

732
static void __dma_cache_inv_slc(phys_addr_t start, unsigned long sz)
V
Vineet Gupta 已提交
733
{
734
	__dc_line_op_k(start, sz, OP_INV);
735 736
	slc_op(start, sz, OP_INV);
}
737

738
static void __dma_cache_wback_slc(phys_addr_t start, unsigned long sz)
739 740 741 742 743 744 745 746 747 748
{
	__dc_line_op_k(start, sz, OP_FLUSH);
	slc_op(start, sz, OP_FLUSH);
}

/*
 * DMA ops for systems with IOC
 * IOC hardware snoops all DMA traffic keeping the caches consistent with
 * memory - eliding need for any explicit cache maintenance of DMA buffers
 */
749 750 751
static void __dma_cache_wback_inv_ioc(phys_addr_t start, unsigned long sz) {}
static void __dma_cache_inv_ioc(phys_addr_t start, unsigned long sz) {}
static void __dma_cache_wback_ioc(phys_addr_t start, unsigned long sz) {}
752 753 754 755

/*
 * Exported DMA API
 */
756
void dma_cache_wback_inv(phys_addr_t start, unsigned long sz)
757 758 759 760 761
{
	__dma_cache_wback_inv(start, sz);
}
EXPORT_SYMBOL(dma_cache_wback_inv);

762
void dma_cache_inv(phys_addr_t start, unsigned long sz)
763 764
{
	__dma_cache_inv(start, sz);
V
Vineet Gupta 已提交
765 766 767
}
EXPORT_SYMBOL(dma_cache_inv);

768
void dma_cache_wback(phys_addr_t start, unsigned long sz)
V
Vineet Gupta 已提交
769
{
770
	__dma_cache_wback(start, sz);
V
Vineet Gupta 已提交
771 772 773 774
}
EXPORT_SYMBOL(dma_cache_wback);

/*
775 776
 * This is API for making I/D Caches consistent when modifying
 * kernel code (loadable modules, kprobes, kgdb...)
V
Vineet Gupta 已提交
777 778 779 780 781 782
 * This is called on insmod, with kernel virtual address for CODE of
 * the module. ARC cache maintenance ops require PHY address thus we
 * need to convert vmalloc addr to PHY addr
 */
void flush_icache_range(unsigned long kstart, unsigned long kend)
{
783
	unsigned int tot_sz;
V
Vineet Gupta 已提交
784

785
	WARN(kstart < TASK_SIZE, "%s() can't handle user vaddr", __func__);
V
Vineet Gupta 已提交
786 787 788 789 790 791 792 793 794 795 796 797

	/* Shortcut for bigger flush ranges.
	 * Here we don't care if this was kernel virtual or phy addr
	 */
	tot_sz = kend - kstart;
	if (tot_sz > PAGE_SIZE) {
		flush_cache_all();
		return;
	}

	/* Case: Kernel Phy addr (0x8000_0000 onwards) */
	if (likely(kstart > PAGE_OFFSET)) {
798 799 800 801 802 803
		/*
		 * The 2nd arg despite being paddr will be used to index icache
		 * This is OK since no alternate virtual mappings will exist
		 * given the callers for this case: kprobe/kgdb in built-in
		 * kernel code only.
		 */
804
		__sync_icache_dcache(kstart, kstart, kend - kstart);
V
Vineet Gupta 已提交
805 806 807 808 809 810 811 812 813 814 815 816 817
		return;
	}

	/*
	 * Case: Kernel Vaddr (0x7000_0000 to 0x7fff_ffff)
	 * (1) ARC Cache Maintenance ops only take Phy addr, hence special
	 *     handling of kernel vaddr.
	 *
	 * (2) Despite @tot_sz being < PAGE_SIZE (bigger cases handled already),
	 *     it still needs to handle  a 2 page scenario, where the range
	 *     straddles across 2 virtual pages and hence need for loop
	 */
	while (tot_sz > 0) {
818 819 820
		unsigned int off, sz;
		unsigned long phy, pfn;

V
Vineet Gupta 已提交
821 822 823 824
		off = kstart % PAGE_SIZE;
		pfn = vmalloc_to_pfn((void *)kstart);
		phy = (pfn << PAGE_SHIFT) + off;
		sz = min_t(unsigned int, tot_sz, PAGE_SIZE - off);
825
		__sync_icache_dcache(phy, kstart, sz);
V
Vineet Gupta 已提交
826 827 828 829
		kstart += sz;
		tot_sz -= sz;
	}
}
830
EXPORT_SYMBOL(flush_icache_range);
V
Vineet Gupta 已提交
831 832

/*
833 834
 * General purpose helper to make I and D cache lines consistent.
 * @paddr is phy addr of region
835 836
 * @vaddr is typically user vaddr (breakpoint) or kernel vaddr (vmalloc)
 *    However in one instance, when called by kprobe (for a breakpt in
837 838
 *    builtin kernel code) @vaddr will be paddr only, meaning CDU operation will
 *    use a paddr to index the cache (despite VIPT). This is fine since since a
839 840
 *    builtin kernel page will not have any virtual mappings.
 *    kprobe on loadable module will be kernel vaddr.
V
Vineet Gupta 已提交
841
 */
842
void __sync_icache_dcache(phys_addr_t paddr, unsigned long vaddr, int len)
V
Vineet Gupta 已提交
843
{
844
	__dc_line_op(paddr, vaddr, len, OP_FLUSH_N_INV);
845
	__ic_line_inv_vaddr(paddr, vaddr, len);
V
Vineet Gupta 已提交
846 847
}

848
/* wrapper to compile time eliminate alignment checks in flush loop */
849
void __inv_icache_page(phys_addr_t paddr, unsigned long vaddr)
V
Vineet Gupta 已提交
850
{
851
	__ic_line_inv_vaddr(paddr, vaddr, PAGE_SIZE);
V
Vineet Gupta 已提交
852 853
}

854 855 856 857
/*
 * wrapper to clearout kernel or userspace mappings of a page
 * For kernel mappings @vaddr == @paddr
 */
858
void __flush_dcache_page(phys_addr_t paddr, unsigned long vaddr)
859
{
860
	__dc_line_op(paddr, vaddr & PAGE_MASK, PAGE_SIZE, OP_FLUSH_N_INV);
861 862
}

V
Vineet Gupta 已提交
863 864 865 866 867 868
noinline void flush_cache_all(void)
{
	unsigned long flags;

	local_irq_save(flags);

869
	__ic_entire_inv();
V
Vineet Gupta 已提交
870 871 872 873 874 875
	__dc_entire_op(OP_FLUSH_N_INV);

	local_irq_restore(flags);

}

876 877 878 879 880 881 882 883 884 885 886 887
#ifdef CONFIG_ARC_CACHE_VIPT_ALIASING

void flush_cache_mm(struct mm_struct *mm)
{
	flush_cache_all();
}

void flush_cache_page(struct vm_area_struct *vma, unsigned long u_vaddr,
		      unsigned long pfn)
{
	unsigned int paddr = pfn << PAGE_SHIFT;

888 889
	u_vaddr &= PAGE_MASK;

890
	__flush_dcache_page(paddr, u_vaddr);
891 892 893

	if (vma->vm_flags & VM_EXEC)
		__inv_icache_page(paddr, u_vaddr);
894 895 896 897 898 899 900 901
}

void flush_cache_range(struct vm_area_struct *vma, unsigned long start,
		       unsigned long end)
{
	flush_cache_all();
}

902 903 904 905 906 907 908 909 910 911 912
void flush_anon_page(struct vm_area_struct *vma, struct page *page,
		     unsigned long u_vaddr)
{
	/* TBD: do we really need to clear the kernel mapping */
	__flush_dcache_page(page_address(page), u_vaddr);
	__flush_dcache_page(page_address(page), page_address(page));

}

#endif

913 914 915
void copy_user_highpage(struct page *to, struct page *from,
	unsigned long u_vaddr, struct vm_area_struct *vma)
{
916 917
	void *kfrom = kmap_atomic(from);
	void *kto = kmap_atomic(to);
918 919 920 921 922 923 924 925 926
	int clean_src_k_mappings = 0;

	/*
	 * If SRC page was already mapped in userspace AND it's U-mapping is
	 * not congruent with K-mapping, sync former to physical page so that
	 * K-mapping in memcpy below, sees the right data
	 *
	 * Note that while @u_vaddr refers to DST page's userspace vaddr, it is
	 * equally valid for SRC page as well
927 928 929
	 *
	 * For !VIPT cache, all of this gets compiled out as
	 * addr_not_cache_congruent() is 0
930
	 */
931
	if (page_mapcount(from) && addr_not_cache_congruent(kfrom, u_vaddr)) {
932
		__flush_dcache_page((unsigned long)kfrom, u_vaddr);
933 934 935
		clean_src_k_mappings = 1;
	}

936
	copy_page(kto, kfrom);
937 938 939 940 941 942 943 944 945

	/*
	 * Mark DST page K-mapping as dirty for a later finalization by
	 * update_mmu_cache(). Although the finalization could have been done
	 * here as well (given that both vaddr/paddr are available).
	 * But update_mmu_cache() already has code to do that for other
	 * non copied user pages (e.g. read faults which wire in pagecache page
	 * directly).
	 */
946
	clear_bit(PG_dc_clean, &to->flags);
947 948 949 950 951 952

	/*
	 * if SRC was already usermapped and non-congruent to kernel mapping
	 * sync the kernel mapping back to physical page
	 */
	if (clean_src_k_mappings) {
953
		__flush_dcache_page((unsigned long)kfrom, (unsigned long)kfrom);
954
		set_bit(PG_dc_clean, &from->flags);
955
	} else {
956
		clear_bit(PG_dc_clean, &from->flags);
957
	}
958 959 960

	kunmap_atomic(kto);
	kunmap_atomic(kfrom);
961 962 963 964 965
}

void clear_user_page(void *to, unsigned long u_vaddr, struct page *page)
{
	clear_page(to);
966
	clear_bit(PG_dc_clean, &page->flags);
967 968 969
}


V
Vineet Gupta 已提交
970 971 972 973 974 975 976 977 978 979
/**********************************************************************
 * Explicit Cache flush request from user space via syscall
 * Needed for JITs which generate code on the fly
 */
SYSCALL_DEFINE3(cacheflush, uint32_t, start, uint32_t, sz, uint32_t, flags)
{
	/* TBD: optimize this */
	flush_cache_all();
	return 0;
}
980

981 982 983 984 985 986 987 988 989 990 991 992 993 994 995
/*
 * IO-Coherency (IOC) setup rules:
 *
 * 1. Needs to be at system level, so only once by Master core
 *    Non-Masters need not be accessing caches at that time
 *    - They are either HALT_ON_RESET and kick started much later or
 *    - if run on reset, need to ensure that arc_platform_smp_wait_to_boot()
 *      doesn't perturb caches or coherency unit
 *
 * 2. caches (L1 and SLC) need to be purged (flush+inv) before setting up IOC,
 *    otherwise any straggler data might behave strangely post IOC enabling
 *
 * 3. All Caches need to be disabled when setting up IOC to elide any in-flight
 *    Coherency transactions
 */
996
noinline void __init arc_ioc_setup(void)
997
{
998 999
	unsigned int ap_sz;

1000 1001 1002 1003 1004 1005 1006 1007
	/* Flush + invalidate + disable L1 dcache */
	__dc_disable();

	/* Flush + invalidate SLC */
	if (read_aux_reg(ARC_REG_SLC_BCR))
		slc_entire_op(OP_FLUSH_N_INV);

	/* IOC Aperture start: TDB: handle non default CONFIG_LINUX_LINK_BASE */
1008
	write_aux_reg(ARC_REG_IO_COH_AP0_BASE, 0x80000);
1009

1010 1011 1012 1013 1014 1015 1016 1017
	/*
	 * IOC Aperture size:
	 *   decoded as 2 ^ (SIZE + 2) KB: so setting 0x11 implies 512M
	 * TBD: fix for PGU + 1GB of low mem
	 * TBD: fix for PAE
	 */
	ap_sz = order_base_2(arc_get_mem_sz()/1024) - 2;
	write_aux_reg(ARC_REG_IO_COH_AP0_SIZE, ap_sz);
1018

1019 1020
	write_aux_reg(ARC_REG_IO_COH_PARTIAL, 1);
	write_aux_reg(ARC_REG_IO_COH_ENABLE, 1);
1021 1022 1023

	/* Re-enable L1 dcache */
	__dc_enable();
1024 1025
}

1026
void __init arc_cache_init_master(void)
1027 1028
{
	unsigned int __maybe_unused cpu = smp_processor_id();
1029

1030 1031 1032
	if (IS_ENABLED(CONFIG_ARC_HAS_ICACHE)) {
		struct cpuinfo_arc_cache *ic = &cpuinfo_arc700[cpu].icache;

1033
		if (!ic->line_len)
1034 1035 1036 1037 1038 1039
			panic("cache support enabled but non-existent cache\n");

		if (ic->line_len != L1_CACHE_BYTES)
			panic("ICache line [%d] != kernel Config [%d]",
			      ic->line_len, L1_CACHE_BYTES);

1040
		/*
A
Andrea Gelmini 已提交
1041
		 * In MMU v4 (HS38x) the aliasing icache config uses IVIL/PTAG
1042 1043 1044 1045 1046 1047
		 * pair to provide vaddr/paddr respectively, just as in MMU v3
		 */
		if (is_isa_arcv2() && ic->alias)
			_cache_line_loop_ic_fn = __cache_line_loop_v3;
		else
			_cache_line_loop_ic_fn = __cache_line_loop;
1048 1049 1050 1051 1052
	}

	if (IS_ENABLED(CONFIG_ARC_HAS_DCACHE)) {
		struct cpuinfo_arc_cache *dc = &cpuinfo_arc700[cpu].dcache;

1053
		if (!dc->line_len)
1054 1055 1056 1057 1058 1059
			panic("cache support enabled but non-existent cache\n");

		if (dc->line_len != L1_CACHE_BYTES)
			panic("DCache line [%d] != kernel Config [%d]",
			      dc->line_len, L1_CACHE_BYTES);

1060 1061 1062
		/* check for D-Cache aliasing on ARCompact: ARCv2 has PIPT */
		if (is_isa_arcompact()) {
			int handled = IS_ENABLED(CONFIG_ARC_CACHE_VIPT_ALIASING);
1063 1064 1065 1066 1067 1068 1069 1070
			int num_colors = dc->sz_k/dc->assoc/TO_KB(PAGE_SIZE);

			if (dc->alias) {
				if (!handled)
					panic("Enable CONFIG_ARC_CACHE_VIPT_ALIASING\n");
				if (CACHE_COLORS_NUM != num_colors)
					panic("CACHE_COLORS_NUM not optimized for config\n");
			} else if (!dc->alias && handled) {
1071
				panic("Disable CONFIG_ARC_CACHE_VIPT_ALIASING\n");
1072
			}
1073
		}
1074
	}
1075

1076 1077 1078
	/* Note that SLC disable not formally supported till HS 3.0 */
	if (is_isa_arcv2() && l2_line_sz && !slc_enable)
		arc_slc_disable();
1079

1080 1081
	if (is_isa_arcv2() && ioc_enable)
		arc_ioc_setup();
1082

1083
	if (is_isa_arcv2() && ioc_enable) {
1084 1085 1086
		__dma_cache_wback_inv = __dma_cache_wback_inv_ioc;
		__dma_cache_inv = __dma_cache_inv_ioc;
		__dma_cache_wback = __dma_cache_wback_ioc;
1087
	} else if (is_isa_arcv2() && l2_line_sz && slc_enable) {
1088 1089 1090 1091 1092 1093 1094 1095
		__dma_cache_wback_inv = __dma_cache_wback_inv_slc;
		__dma_cache_inv = __dma_cache_inv_slc;
		__dma_cache_wback = __dma_cache_wback_slc;
	} else {
		__dma_cache_wback_inv = __dma_cache_wback_inv_l1;
		__dma_cache_inv = __dma_cache_inv_l1;
		__dma_cache_wback = __dma_cache_wback_l1;
	}
1096
}
1097 1098 1099 1100 1101 1102 1103 1104 1105 1106 1107 1108 1109 1110 1111 1112 1113

void __ref arc_cache_init(void)
{
	unsigned int __maybe_unused cpu = smp_processor_id();
	char str[256];

	printk(arc_cache_mumbojumbo(0, str, sizeof(str)));

	/*
	 * Only master CPU needs to execute rest of function:
	 *  - Assume SMP so all cores will have same cache config so
	 *    any geomtry checks will be same for all
	 *  - IOC setup / dma callbacks only need to be setup once
	 */
	if (!cpu)
		arc_cache_init_master();
}