1 // SPDX-License-Identifier: GPL-2.0-or-later
2 /*
3 * Copyright (C) 2013 Imagination Technologies
4 * Author: Paul Burton <paul.burton@mips.com>
5 */
6
7 #include <linux/errno.h>
8 #include <linux/percpu.h>
9 #include <linux/spinlock.h>
10
11 #include <asm/mips-cps.h>
12 #include <asm/mipsregs.h>
13
14 void __iomem *mips_gcr_base;
15 void __iomem *mips_cm_l2sync_base;
16 int mips_cm_is64;
17
18 static char *cm2_tr[8] = {
19 "mem", "gcr", "gic", "mmio",
20 "0x04", "cpc", "0x06", "0x07"
21 };
22
23 /* CM3 Tag ECC transaction type */
24 static char *cm3_tr[16] = {
25 [0x0] = "ReqNoData",
26 [0x1] = "0x1",
27 [0x2] = "ReqWData",
28 [0x3] = "0x3",
29 [0x4] = "IReqNoResp",
30 [0x5] = "IReqWResp",
31 [0x6] = "IReqNoRespDat",
32 [0x7] = "IReqWRespDat",
33 [0x8] = "RespNoData",
34 [0x9] = "RespDataFol",
35 [0xa] = "RespWData",
36 [0xb] = "RespDataOnly",
37 [0xc] = "IRespNoData",
38 [0xd] = "IRespDataFol",
39 [0xe] = "IRespWData",
40 [0xf] = "IRespDataOnly"
41 };
42
43 static char *cm2_cmd[32] = {
44 [0x00] = "0x00",
45 [0x01] = "Legacy Write",
46 [0x02] = "Legacy Read",
47 [0x03] = "0x03",
48 [0x04] = "0x04",
49 [0x05] = "0x05",
50 [0x06] = "0x06",
51 [0x07] = "0x07",
52 [0x08] = "Coherent Read Own",
53 [0x09] = "Coherent Read Share",
54 [0x0a] = "Coherent Read Discard",
55 [0x0b] = "Coherent Ready Share Always",
56 [0x0c] = "Coherent Upgrade",
57 [0x0d] = "Coherent Writeback",
58 [0x0e] = "0x0e",
59 [0x0f] = "0x0f",
60 [0x10] = "Coherent Copyback",
61 [0x11] = "Coherent Copyback Invalidate",
62 [0x12] = "Coherent Invalidate",
63 [0x13] = "Coherent Write Invalidate",
64 [0x14] = "Coherent Completion Sync",
65 [0x15] = "0x15",
66 [0x16] = "0x16",
67 [0x17] = "0x17",
68 [0x18] = "0x18",
69 [0x19] = "0x19",
70 [0x1a] = "0x1a",
71 [0x1b] = "0x1b",
72 [0x1c] = "0x1c",
73 [0x1d] = "0x1d",
74 [0x1e] = "0x1e",
75 [0x1f] = "0x1f"
76 };
77
78 /* CM3 Tag ECC command type */
79 static char *cm3_cmd[16] = {
80 [0x0] = "Legacy Read",
81 [0x1] = "Legacy Write",
82 [0x2] = "Coherent Read Own",
83 [0x3] = "Coherent Read Share",
84 [0x4] = "Coherent Read Discard",
85 [0x5] = "Coherent Evicted",
86 [0x6] = "Coherent Upgrade",
87 [0x7] = "Coherent Upgrade for Store Conditional",
88 [0x8] = "Coherent Writeback",
89 [0x9] = "Coherent Write Invalidate",
90 [0xa] = "0xa",
91 [0xb] = "0xb",
92 [0xc] = "0xc",
93 [0xd] = "0xd",
94 [0xe] = "0xe",
95 [0xf] = "0xf"
96 };
97
98 /* CM3 Tag ECC command group */
99 static char *cm3_cmd_group[8] = {
100 [0x0] = "Normal",
101 [0x1] = "Registers",
102 [0x2] = "TLB",
103 [0x3] = "0x3",
104 [0x4] = "L1I",
105 [0x5] = "L1D",
106 [0x6] = "L3",
107 [0x7] = "L2"
108 };
109
110 static char *cm2_core[8] = {
111 "Invalid/OK", "Invalid/Data",
112 "Shared/OK", "Shared/Data",
113 "Modified/OK", "Modified/Data",
114 "Exclusive/OK", "Exclusive/Data"
115 };
116
117 static char *cm2_l2_type[4] = {
118 [0x0] = "None",
119 [0x1] = "Tag RAM single/double ECC error",
120 [0x2] = "Data RAM single/double ECC error",
121 [0x3] = "WS RAM uncorrectable dirty parity"
122 };
123
124 static char *cm2_l2_instr[32] = {
125 [0x00] = "L2_NOP",
126 [0x01] = "L2_ERR_CORR",
127 [0x02] = "L2_TAG_INV",
128 [0x03] = "L2_WS_CLEAN",
129 [0x04] = "L2_RD_MDYFY_WR",
130 [0x05] = "L2_WS_MRU",
131 [0x06] = "L2_EVICT_LN2",
132 [0x07] = "0x07",
133 [0x08] = "L2_EVICT",
134 [0x09] = "L2_REFL",
135 [0x0a] = "L2_RD",
136 [0x0b] = "L2_WR",
137 [0x0c] = "L2_EVICT_MRU",
138 [0x0d] = "L2_SYNC",
139 [0x0e] = "L2_REFL_ERR",
140 [0x0f] = "0x0f",
141 [0x10] = "L2_INDX_WB_INV",
142 [0x11] = "L2_INDX_LD_TAG",
143 [0x12] = "L2_INDX_ST_TAG",
144 [0x13] = "L2_INDX_ST_DATA",
145 [0x14] = "L2_INDX_ST_ECC",
146 [0x15] = "0x15",
147 [0x16] = "0x16",
148 [0x17] = "0x17",
149 [0x18] = "L2_FTCH_AND_LCK",
150 [0x19] = "L2_HIT_INV",
151 [0x1a] = "L2_HIT_WB_INV",
152 [0x1b] = "L2_HIT_WB",
153 [0x1c] = "0x1c",
154 [0x1d] = "0x1d",
155 [0x1e] = "0x1e",
156 [0x1f] = "0x1f"
157 };
158
159 static char *cm2_causes[32] = {
160 "None", "GC_WR_ERR", "GC_RD_ERR", "COH_WR_ERR",
161 "COH_RD_ERR", "MMIO_WR_ERR", "MMIO_RD_ERR", "0x07",
162 "0x08", "0x09", "0x0a", "0x0b",
163 "0x0c", "0x0d", "0x0e", "0x0f",
164 "0x10", "INTVN_WR_ERR", "INTVN_RD_ERR", "0x13",
165 "0x14", "0x15", "0x16", "0x17",
166 "L2_RD_UNCORR", "L2_WR_UNCORR", "L2_CORR", "0x1b",
167 "0x1c", "0x1d", "0x1e", "0x1f"
168 };
169
170 static char *cm3_causes[32] = {
171 "0x0", "MP_CORRECTABLE_ECC_ERR", "MP_REQUEST_DECODE_ERR",
172 "MP_UNCORRECTABLE_ECC_ERR", "MP_PARITY_ERR", "MP_COHERENCE_ERR",
173 "CMBIU_REQUEST_DECODE_ERR", "CMBIU_PARITY_ERR", "CMBIU_AXI_RESP_ERR",
174 "0x9", "RBI_BUS_ERR", "0xb", "0xc", "0xd", "0xe", "0xf", "0x10",
175 "0x11", "0x12", "0x13", "0x14", "0x15", "0x16", "0x17", "0x18",
176 "0x19", "0x1a", "0x1b", "0x1c", "0x1d", "0x1e", "0x1f"
177 };
178
179 static DEFINE_PER_CPU_ALIGNED(spinlock_t, cm_core_lock);
180 static DEFINE_PER_CPU_ALIGNED(unsigned long, cm_core_lock_flags);
181
mips_cm_phys_base(void)182 phys_addr_t __weak mips_cm_phys_base(void)
183 {
184 unsigned long cmgcr;
185
186 /* Check the CMGCRBase register is implemented */
187 if (!(read_c0_config() & MIPS_CONF_M))
188 return 0;
189
190 if (!(read_c0_config2() & MIPS_CONF_M))
191 return 0;
192
193 if (!(read_c0_config3() & MIPS_CONF3_CMGCR))
194 return 0;
195
196 /* Read the address from CMGCRBase */
197 cmgcr = read_c0_cmgcrbase();
198 return (cmgcr & MIPS_CMGCRF_BASE) << (36 - 32);
199 }
200
mips_cm_l2sync_phys_base(void)201 phys_addr_t __weak mips_cm_l2sync_phys_base(void)
202 {
203 u32 base_reg;
204
205 /*
206 * If the L2-only sync region is already enabled then leave it at it's
207 * current location.
208 */
209 base_reg = read_gcr_l2_only_sync_base();
210 if (base_reg & CM_GCR_L2_ONLY_SYNC_BASE_SYNCEN)
211 return base_reg & CM_GCR_L2_ONLY_SYNC_BASE_SYNCBASE;
212
213 /* Default to following the CM */
214 return mips_cm_phys_base() + MIPS_CM_GCR_SIZE;
215 }
216
mips_cm_probe_l2sync(void)217 static void mips_cm_probe_l2sync(void)
218 {
219 unsigned major_rev;
220 phys_addr_t addr;
221
222 /* L2-only sync was introduced with CM major revision 6 */
223 major_rev = FIELD_GET(CM_GCR_REV_MAJOR, read_gcr_rev());
224 if (major_rev < 6)
225 return;
226
227 /* Find a location for the L2 sync region */
228 addr = mips_cm_l2sync_phys_base();
229 BUG_ON((addr & CM_GCR_L2_ONLY_SYNC_BASE_SYNCBASE) != addr);
230 if (!addr)
231 return;
232
233 /* Set the region base address & enable it */
234 write_gcr_l2_only_sync_base(addr | CM_GCR_L2_ONLY_SYNC_BASE_SYNCEN);
235
236 /* Map the region */
237 mips_cm_l2sync_base = ioremap(addr, MIPS_CM_L2SYNC_SIZE);
238 }
239
mips_cm_probe(void)240 int mips_cm_probe(void)
241 {
242 phys_addr_t addr;
243 u32 base_reg;
244 unsigned cpu;
245
246 /*
247 * No need to probe again if we have already been
248 * here before.
249 */
250 if (mips_gcr_base)
251 return 0;
252
253 addr = mips_cm_phys_base();
254 BUG_ON((addr & CM_GCR_BASE_GCRBASE) != addr);
255 if (!addr)
256 return -ENODEV;
257
258 mips_gcr_base = ioremap(addr, MIPS_CM_GCR_SIZE);
259 if (!mips_gcr_base)
260 return -ENXIO;
261
262 /* sanity check that we're looking at a CM */
263 base_reg = read_gcr_base();
264 if ((base_reg & CM_GCR_BASE_GCRBASE) != addr) {
265 pr_err("GCRs appear to have been moved (expected them at 0x%08lx)!\n",
266 (unsigned long)addr);
267 iounmap(mips_gcr_base);
268 mips_gcr_base = NULL;
269 return -ENODEV;
270 }
271
272 /* set default target to memory */
273 change_gcr_base(CM_GCR_BASE_CMDEFTGT, CM_GCR_BASE_CMDEFTGT_MEM);
274
275 /* disable CM regions */
276 write_gcr_reg0_base(CM_GCR_REGn_BASE_BASEADDR);
277 write_gcr_reg0_mask(CM_GCR_REGn_MASK_ADDRMASK);
278 write_gcr_reg1_base(CM_GCR_REGn_BASE_BASEADDR);
279 write_gcr_reg1_mask(CM_GCR_REGn_MASK_ADDRMASK);
280 write_gcr_reg2_base(CM_GCR_REGn_BASE_BASEADDR);
281 write_gcr_reg2_mask(CM_GCR_REGn_MASK_ADDRMASK);
282 write_gcr_reg3_base(CM_GCR_REGn_BASE_BASEADDR);
283 write_gcr_reg3_mask(CM_GCR_REGn_MASK_ADDRMASK);
284
285 /* probe for an L2-only sync region */
286 mips_cm_probe_l2sync();
287
288 /* determine register width for this CM */
289 mips_cm_is64 = IS_ENABLED(CONFIG_64BIT) && (mips_cm_revision() >= CM_REV_CM3);
290
291 for_each_possible_cpu(cpu)
292 spin_lock_init(&per_cpu(cm_core_lock, cpu));
293
294 return 0;
295 }
296
mips_cm_lock_other(unsigned int cluster,unsigned int core,unsigned int vp,unsigned int block)297 void mips_cm_lock_other(unsigned int cluster, unsigned int core,
298 unsigned int vp, unsigned int block)
299 {
300 unsigned int curr_core, cm_rev;
301 u32 val;
302
303 cm_rev = mips_cm_revision();
304 preempt_disable();
305
306 if (cm_rev >= CM_REV_CM3) {
307 val = FIELD_PREP(CM3_GCR_Cx_OTHER_CORE, core) |
308 FIELD_PREP(CM3_GCR_Cx_OTHER_VP, vp);
309
310 if (cm_rev >= CM_REV_CM3_5) {
311 val |= CM_GCR_Cx_OTHER_CLUSTER_EN;
312 val |= FIELD_PREP(CM_GCR_Cx_OTHER_CLUSTER, cluster);
313 val |= FIELD_PREP(CM_GCR_Cx_OTHER_BLOCK, block);
314 } else {
315 WARN_ON(cluster != 0);
316 WARN_ON(block != CM_GCR_Cx_OTHER_BLOCK_LOCAL);
317 }
318
319 /*
320 * We need to disable interrupts in SMP systems in order to
321 * ensure that we don't interrupt the caller with code which
322 * may modify the redirect register. We do so here in a
323 * slightly obscure way by using a spin lock, since this has
324 * the neat property of also catching any nested uses of
325 * mips_cm_lock_other() leading to a deadlock or a nice warning
326 * with lockdep enabled.
327 */
328 spin_lock_irqsave(this_cpu_ptr(&cm_core_lock),
329 *this_cpu_ptr(&cm_core_lock_flags));
330 } else {
331 WARN_ON(cluster != 0);
332 WARN_ON(block != CM_GCR_Cx_OTHER_BLOCK_LOCAL);
333
334 /*
335 * We only have a GCR_CL_OTHER per core in systems with
336 * CM 2.5 & older, so have to ensure other VP(E)s don't
337 * race with us.
338 */
339 curr_core = cpu_core(¤t_cpu_data);
340 spin_lock_irqsave(&per_cpu(cm_core_lock, curr_core),
341 per_cpu(cm_core_lock_flags, curr_core));
342
343 val = FIELD_PREP(CM_GCR_Cx_OTHER_CORENUM, core);
344 }
345
346 write_gcr_cl_other(val);
347
348 /*
349 * Ensure the core-other region reflects the appropriate core &
350 * VP before any accesses to it occur.
351 */
352 mb();
353 }
354
mips_cm_unlock_other(void)355 void mips_cm_unlock_other(void)
356 {
357 unsigned int curr_core;
358
359 if (mips_cm_revision() < CM_REV_CM3) {
360 curr_core = cpu_core(¤t_cpu_data);
361 spin_unlock_irqrestore(&per_cpu(cm_core_lock, curr_core),
362 per_cpu(cm_core_lock_flags, curr_core));
363 } else {
364 spin_unlock_irqrestore(this_cpu_ptr(&cm_core_lock),
365 *this_cpu_ptr(&cm_core_lock_flags));
366 }
367
368 preempt_enable();
369 }
370
mips_cm_error_report(void)371 void mips_cm_error_report(void)
372 {
373 u64 cm_error, cm_addr, cm_other;
374 unsigned long revision;
375 int ocause, cause;
376 char buf[256];
377
378 if (!mips_cm_present())
379 return;
380
381 revision = mips_cm_revision();
382 cm_error = read_gcr_error_cause();
383 cm_addr = read_gcr_error_addr();
384 cm_other = read_gcr_error_mult();
385
386 if (revision < CM_REV_CM3) { /* CM2 */
387 cause = FIELD_GET(CM_GCR_ERROR_CAUSE_ERRTYPE, cm_error);
388 ocause = FIELD_GET(CM_GCR_ERROR_MULT_ERR2ND, cm_other);
389
390 if (!cause)
391 return;
392
393 if (cause < 16) {
394 unsigned long cca_bits = (cm_error >> 15) & 7;
395 unsigned long tr_bits = (cm_error >> 12) & 7;
396 unsigned long cmd_bits = (cm_error >> 7) & 0x1f;
397 unsigned long stag_bits = (cm_error >> 3) & 15;
398 unsigned long sport_bits = (cm_error >> 0) & 7;
399
400 snprintf(buf, sizeof(buf),
401 "CCA=%lu TR=%s MCmd=%s STag=%lu "
402 "SPort=%lu\n", cca_bits, cm2_tr[tr_bits],
403 cm2_cmd[cmd_bits], stag_bits, sport_bits);
404 } else if (cause < 24) {
405 /* glob state & sresp together */
406 unsigned long c3_bits = (cm_error >> 18) & 7;
407 unsigned long c2_bits = (cm_error >> 15) & 7;
408 unsigned long c1_bits = (cm_error >> 12) & 7;
409 unsigned long c0_bits = (cm_error >> 9) & 7;
410 unsigned long sc_bit = (cm_error >> 8) & 1;
411 unsigned long cmd_bits = (cm_error >> 3) & 0x1f;
412 unsigned long sport_bits = (cm_error >> 0) & 7;
413
414 snprintf(buf, sizeof(buf),
415 "C3=%s C2=%s C1=%s C0=%s SC=%s "
416 "MCmd=%s SPort=%lu\n",
417 cm2_core[c3_bits], cm2_core[c2_bits],
418 cm2_core[c1_bits], cm2_core[c0_bits],
419 sc_bit ? "True" : "False",
420 cm2_cmd[cmd_bits], sport_bits);
421 } else {
422 unsigned long muc_bit = (cm_error >> 23) & 1;
423 unsigned long ins_bits = (cm_error >> 18) & 0x1f;
424 unsigned long arr_bits = (cm_error >> 16) & 3;
425 unsigned long dw_bits = (cm_error >> 12) & 15;
426 unsigned long way_bits = (cm_error >> 9) & 7;
427 unsigned long mway_bit = (cm_error >> 8) & 1;
428 unsigned long syn_bits = (cm_error >> 0) & 0xFF;
429
430 snprintf(buf, sizeof(buf),
431 "Type=%s%s Instr=%s DW=%lu Way=%lu "
432 "MWay=%s Syndrome=0x%02lx",
433 muc_bit ? "Multi-UC " : "",
434 cm2_l2_type[arr_bits],
435 cm2_l2_instr[ins_bits], dw_bits, way_bits,
436 mway_bit ? "True" : "False", syn_bits);
437 }
438 pr_err("CM_ERROR=%08llx %s <%s>\n", cm_error,
439 cm2_causes[cause], buf);
440 pr_err("CM_ADDR =%08llx\n", cm_addr);
441 pr_err("CM_OTHER=%08llx %s\n", cm_other, cm2_causes[ocause]);
442 } else { /* CM3 */
443 ulong core_id_bits, vp_id_bits, cmd_bits, cmd_group_bits;
444 ulong cm3_cca_bits, mcp_bits, cm3_tr_bits, sched_bit;
445
446 cause = FIELD_GET(CM3_GCR_ERROR_CAUSE_ERRTYPE, cm_error);
447 ocause = FIELD_GET(CM_GCR_ERROR_MULT_ERR2ND, cm_other);
448
449 if (!cause)
450 return;
451
452 /* Used by cause == {1,2,3} */
453 core_id_bits = (cm_error >> 22) & 0xf;
454 vp_id_bits = (cm_error >> 18) & 0xf;
455 cmd_bits = (cm_error >> 14) & 0xf;
456 cmd_group_bits = (cm_error >> 11) & 0xf;
457 cm3_cca_bits = (cm_error >> 8) & 7;
458 mcp_bits = (cm_error >> 5) & 0xf;
459 cm3_tr_bits = (cm_error >> 1) & 0xf;
460 sched_bit = cm_error & 0x1;
461
462 if (cause == 1 || cause == 3) { /* Tag ECC */
463 unsigned long tag_ecc = (cm_error >> 57) & 0x1;
464 unsigned long tag_way_bits = (cm_error >> 29) & 0xffff;
465 unsigned long dword_bits = (cm_error >> 49) & 0xff;
466 unsigned long data_way_bits = (cm_error >> 45) & 0xf;
467 unsigned long data_sets_bits = (cm_error >> 29) & 0xfff;
468 unsigned long bank_bit = (cm_error >> 28) & 0x1;
469 snprintf(buf, sizeof(buf),
470 "%s ECC Error: Way=%lu (DWORD=%lu, Sets=%lu)"
471 "Bank=%lu CoreID=%lu VPID=%lu Command=%s"
472 "Command Group=%s CCA=%lu MCP=%d"
473 "Transaction type=%s Scheduler=%lu\n",
474 tag_ecc ? "TAG" : "DATA",
475 tag_ecc ? (unsigned long)ffs(tag_way_bits) - 1 :
476 data_way_bits, bank_bit, dword_bits,
477 data_sets_bits,
478 core_id_bits, vp_id_bits,
479 cm3_cmd[cmd_bits],
480 cm3_cmd_group[cmd_group_bits],
481 cm3_cca_bits, 1 << mcp_bits,
482 cm3_tr[cm3_tr_bits], sched_bit);
483 } else if (cause == 2) {
484 unsigned long data_error_type = (cm_error >> 41) & 0xfff;
485 unsigned long data_decode_cmd = (cm_error >> 37) & 0xf;
486 unsigned long data_decode_group = (cm_error >> 34) & 0x7;
487 unsigned long data_decode_destination_id = (cm_error >> 28) & 0x3f;
488
489 snprintf(buf, sizeof(buf),
490 "Decode Request Error: Type=%lu, Command=%lu"
491 "Command Group=%lu Destination ID=%lu"
492 "CoreID=%lu VPID=%lu Command=%s"
493 "Command Group=%s CCA=%lu MCP=%d"
494 "Transaction type=%s Scheduler=%lu\n",
495 data_error_type, data_decode_cmd,
496 data_decode_group, data_decode_destination_id,
497 core_id_bits, vp_id_bits,
498 cm3_cmd[cmd_bits],
499 cm3_cmd_group[cmd_group_bits],
500 cm3_cca_bits, 1 << mcp_bits,
501 cm3_tr[cm3_tr_bits], sched_bit);
502 } else {
503 buf[0] = 0;
504 }
505
506 pr_err("CM_ERROR=%llx %s <%s>\n", cm_error,
507 cm3_causes[cause], buf);
508 pr_err("CM_ADDR =%llx\n", cm_addr);
509 pr_err("CM_OTHER=%llx %s\n", cm_other, cm3_causes[ocause]);
510 }
511
512 /* reprime cause register */
513 write_gcr_error_cause(cm_error);
514 }
515
mips_cps_first_online_in_cluster(void)516 unsigned int mips_cps_first_online_in_cluster(void)
517 {
518 unsigned int local_cl;
519 int i;
520
521 local_cl = cpu_cluster(¤t_cpu_data);
522
523 /*
524 * We rely upon knowledge that CPUs are numbered sequentially by
525 * cluster - ie. CPUs 0..X will be in cluster 0, CPUs X+1..Y in cluster
526 * 1, CPUs Y+1..Z in cluster 2 etc. This means that CPUs in the same
527 * cluster will immediately precede or follow one another.
528 *
529 * First we scan backwards, until we find an online CPU in the cluster
530 * or we move on to another cluster.
531 */
532 for (i = smp_processor_id() - 1; i >= 0; i--) {
533 if (cpu_cluster(&cpu_data[i]) != local_cl)
534 break;
535 if (!cpu_online(i))
536 continue;
537 return false;
538 }
539
540 /* Then do the same for higher numbered CPUs */
541 for (i = smp_processor_id() + 1; i < nr_cpu_ids; i++) {
542 if (cpu_cluster(&cpu_data[i]) != local_cl)
543 break;
544 if (!cpu_online(i))
545 continue;
546 return false;
547 }
548
549 /* We found no online CPUs in the local cluster */
550 return true;
551 }
552