Blame view

drivers/edac/mpc85xx_edac.c 20.1 KB
a9a753d53   Dave Jiang   drivers-edac: add...
1
  /*
775c503f6   Alexander Kuleshov   mpc85xx_edac: Fix...
2
   * Freescale MPC85xx Memory Controller kernel module
a9a753d53   Dave Jiang   drivers-edac: add...
3
   *
c92132f59   Chunhe Lan   edac/85xx: Add PC...
4
5
   * Parts Copyrighted (c) 2013 by Freescale Semiconductor, Inc.
   *
a9a753d53   Dave Jiang   drivers-edac: add...
6
7
8
9
10
11
12
13
14
15
   * Author: Dave Jiang <djiang@mvista.com>
   *
   * 2006-2007 (c) MontaVista Software, Inc. This file is licensed under
   * the terms of the GNU General Public License version 2. This program
   * is licensed "as is" without any warranty of any kind, whether express
   * or implied.
   *
   */
  #include <linux/module.h>
  #include <linux/init.h>
a9a753d53   Dave Jiang   drivers-edac: add...
16
17
18
19
20
  #include <linux/interrupt.h>
  #include <linux/ctype.h>
  #include <linux/io.h>
  #include <linux/mod_devicetable.h>
  #include <linux/edac.h>
60be75515   Andrew Kilkenny   edac mpc85xx: add...
21
  #include <linux/smp.h>
5a0e3ad6a   Tejun Heo   include cleanup: ...
22
  #include <linux/gfp.h>
666db563d   Scott Wood   EDAC, mpc85xx: Ma...
23
  #include <linux/fsl/edac.h>
a9a753d53   Dave Jiang   drivers-edac: add...
24
25
26
  
  #include <linux/of_platform.h>
  #include <linux/of_device.h>
a9a753d53   Dave Jiang   drivers-edac: add...
27
  #include "edac_module.h"
a9a753d53   Dave Jiang   drivers-edac: add...
28
  #include "mpc85xx_edac.h"
ea2eb9a8b   York Sun   EDAC, fsl-ddr: Se...
29
  #include "fsl_ddr_edac.h"
a9a753d53   Dave Jiang   drivers-edac: add...
30
31
  
  static int edac_dev_idx;
0616fb003   Ira W. Snyder   edac: i5400 fix m...
32
  #ifdef CONFIG_PCI
a9a753d53   Dave Jiang   drivers-edac: add...
33
  static int edac_pci_idx;
0616fb003   Ira W. Snyder   edac: i5400 fix m...
34
  #endif
a9a753d53   Dave Jiang   drivers-edac: add...
35
36
37
38
39
40
41
42
43
44
  
  /*
   * PCI Err defines
   */
  #ifdef CONFIG_PCI
  static u32 orig_pci_err_cap_dr;
  static u32 orig_pci_err_en;
  #endif
  
  static u32 orig_l2_err_disable;
a9a753d53   Dave Jiang   drivers-edac: add...
45

a9a753d53   Dave Jiang   drivers-edac: add...
46
47
48
49
50
51
52
53
54
55
56
57
58
59
60
  /**************************** PCI Err device ***************************/
  #ifdef CONFIG_PCI
  
  static void mpc85xx_pci_check(struct edac_pci_ctl_info *pci)
  {
  	struct mpc85xx_pci_pdata *pdata = pci->pvt_info;
  	u32 err_detect;
  
  	err_detect = in_be32(pdata->pci_vbase + MPC85XX_PCI_ERR_DR);
  
  	/* master aborts can happen during PCI config cycles */
  	if (!(err_detect & ~(PCI_EDE_MULTI_ERR | PCI_EDE_MST_ABRT))) {
  		out_be32(pdata->pci_vbase + MPC85XX_PCI_ERR_DR, err_detect);
  		return;
  	}
88857ebe7   York Sun   EDAC, mpc85xx: Re...
61
62
63
64
  	pr_err("PCI error(s) detected
  ");
  	pr_err("PCI/X ERR_DR register: %#08x
  ", err_detect);
a9a753d53   Dave Jiang   drivers-edac: add...
65

88857ebe7   York Sun   EDAC, mpc85xx: Re...
66
67
  	pr_err("PCI/X ERR_ATTRIB register: %#08x
  ",
a9a753d53   Dave Jiang   drivers-edac: add...
68
  	       in_be32(pdata->pci_vbase + MPC85XX_PCI_ERR_ATTRIB));
88857ebe7   York Sun   EDAC, mpc85xx: Re...
69
70
  	pr_err("PCI/X ERR_ADDR register: %#08x
  ",
a9a753d53   Dave Jiang   drivers-edac: add...
71
  	       in_be32(pdata->pci_vbase + MPC85XX_PCI_ERR_ADDR));
88857ebe7   York Sun   EDAC, mpc85xx: Re...
72
73
  	pr_err("PCI/X ERR_EXT_ADDR register: %#08x
  ",
a9a753d53   Dave Jiang   drivers-edac: add...
74
  	       in_be32(pdata->pci_vbase + MPC85XX_PCI_ERR_EXT_ADDR));
88857ebe7   York Sun   EDAC, mpc85xx: Re...
75
76
  	pr_err("PCI/X ERR_DL register: %#08x
  ",
a9a753d53   Dave Jiang   drivers-edac: add...
77
  	       in_be32(pdata->pci_vbase + MPC85XX_PCI_ERR_DL));
88857ebe7   York Sun   EDAC, mpc85xx: Re...
78
79
  	pr_err("PCI/X ERR_DH register: %#08x
  ",
a9a753d53   Dave Jiang   drivers-edac: add...
80
81
82
83
84
85
86
87
88
89
90
  	       in_be32(pdata->pci_vbase + MPC85XX_PCI_ERR_DH));
  
  	/* clear error bits */
  	out_be32(pdata->pci_vbase + MPC85XX_PCI_ERR_DR, err_detect);
  
  	if (err_detect & PCI_EDE_PERR_MASK)
  		edac_pci_handle_pe(pci, pci->ctl_name);
  
  	if ((err_detect & ~PCI_EDE_MULTI_ERR) & ~PCI_EDE_PERR_MASK)
  		edac_pci_handle_npe(pci, pci->ctl_name);
  }
c92132f59   Chunhe Lan   edac/85xx: Add PC...
91
92
93
  static void mpc85xx_pcie_check(struct edac_pci_ctl_info *pci)
  {
  	struct mpc85xx_pci_pdata *pdata = pci->pvt_info;
6fa06b0d9   Tillmann Heidsieck   EDAC, mpc85xx: Fi...
94
  	u32 err_detect, err_cap_stat;
c92132f59   Chunhe Lan   edac/85xx: Add PC...
95
96
  
  	err_detect = in_be32(pdata->pci_vbase + MPC85XX_PCI_ERR_DR);
6fa06b0d9   Tillmann Heidsieck   EDAC, mpc85xx: Fi...
97
  	err_cap_stat = in_be32(pdata->pci_vbase + MPC85XX_PCI_GAS_TIMR);
c92132f59   Chunhe Lan   edac/85xx: Add PC...
98
99
100
101
102
  
  	pr_err("PCIe error(s) detected
  ");
  	pr_err("PCIe ERR_DR register: 0x%08x
  ", err_detect);
6fa06b0d9   Tillmann Heidsieck   EDAC, mpc85xx: Fi...
103
104
  	pr_err("PCIe ERR_CAP_STAT register: 0x%08x
  ", err_cap_stat);
c92132f59   Chunhe Lan   edac/85xx: Add PC...
105
106
107
108
109
110
111
112
113
114
115
116
117
118
119
  	pr_err("PCIe ERR_CAP_R0 register: 0x%08x
  ",
  			in_be32(pdata->pci_vbase + MPC85XX_PCIE_ERR_CAP_R0));
  	pr_err("PCIe ERR_CAP_R1 register: 0x%08x
  ",
  			in_be32(pdata->pci_vbase + MPC85XX_PCIE_ERR_CAP_R1));
  	pr_err("PCIe ERR_CAP_R2 register: 0x%08x
  ",
  			in_be32(pdata->pci_vbase + MPC85XX_PCIE_ERR_CAP_R2));
  	pr_err("PCIe ERR_CAP_R3 register: 0x%08x
  ",
  			in_be32(pdata->pci_vbase + MPC85XX_PCIE_ERR_CAP_R3));
  
  	/* clear error bits */
  	out_be32(pdata->pci_vbase + MPC85XX_PCI_ERR_DR, err_detect);
6fa06b0d9   Tillmann Heidsieck   EDAC, mpc85xx: Fi...
120
121
122
  
  	/* reset error capture */
  	out_be32(pdata->pci_vbase + MPC85XX_PCI_GAS_TIMR, err_cap_stat | 0x1);
c92132f59   Chunhe Lan   edac/85xx: Add PC...
123
124
125
126
127
128
129
130
131
132
133
134
135
  }
  
  static int mpc85xx_pcie_find_capability(struct device_node *np)
  {
  	struct pci_controller *hose;
  
  	if (!np)
  		return -EINVAL;
  
  	hose = pci_find_hose_for_OF_device(np);
  
  	return early_find_capability(hose, 0, 0, PCI_CAP_ID_EXP);
  }
a9a753d53   Dave Jiang   drivers-edac: add...
136
137
138
139
140
141
142
143
144
145
  static irqreturn_t mpc85xx_pci_isr(int irq, void *dev_id)
  {
  	struct edac_pci_ctl_info *pci = dev_id;
  	struct mpc85xx_pci_pdata *pdata = pci->pvt_info;
  	u32 err_detect;
  
  	err_detect = in_be32(pdata->pci_vbase + MPC85XX_PCI_ERR_DR);
  
  	if (!err_detect)
  		return IRQ_NONE;
c92132f59   Chunhe Lan   edac/85xx: Add PC...
146
147
148
149
  	if (pdata->is_pcie)
  		mpc85xx_pcie_check(pci);
  	else
  		mpc85xx_pci_check(pci);
a9a753d53   Dave Jiang   drivers-edac: add...
150
151
152
  
  	return IRQ_HANDLED;
  }
666db563d   Scott Wood   EDAC, mpc85xx: Ma...
153
  static int mpc85xx_pci_err_probe(struct platform_device *op)
a9a753d53   Dave Jiang   drivers-edac: add...
154
155
156
  {
  	struct edac_pci_ctl_info *pci;
  	struct mpc85xx_pci_pdata *pdata;
666db563d   Scott Wood   EDAC, mpc85xx: Ma...
157
158
  	struct mpc85xx_edac_pci_plat_data *plat_data;
  	struct device_node *of_node;
f87bd330e   Dave Jiang   edac: mpc85xx fix...
159
  	struct resource r;
a9a753d53   Dave Jiang   drivers-edac: add...
160
  	int res = 0;
f87bd330e   Dave Jiang   edac: mpc85xx fix...
161
  	if (!devres_open_group(&op->dev, mpc85xx_pci_err_probe, GFP_KERNEL))
a9a753d53   Dave Jiang   drivers-edac: add...
162
163
164
165
166
  		return -ENOMEM;
  
  	pci = edac_pci_alloc_ctl_info(sizeof(*pdata), "mpc85xx_pci_err");
  	if (!pci)
  		return -ENOMEM;
905e75c46   Jia Hongtao   powerpc/fsl-pci: ...
167
168
169
170
171
172
173
174
175
  	/* make sure error reporting method is sane */
  	switch (edac_op_state) {
  	case EDAC_OPSTATE_POLL:
  	case EDAC_OPSTATE_INT:
  		break;
  	default:
  		edac_op_state = EDAC_OPSTATE_INT;
  		break;
  	}
a9a753d53   Dave Jiang   drivers-edac: add...
176
177
  	pdata = pci->pvt_info;
  	pdata->name = "mpc85xx_pci_err";
c92132f59   Chunhe Lan   edac/85xx: Add PC...
178

666db563d   Scott Wood   EDAC, mpc85xx: Ma...
179
180
181
182
183
184
185
186
187
  	plat_data = op->dev.platform_data;
  	if (!plat_data) {
  		dev_err(&op->dev, "no platform data");
  		res = -ENXIO;
  		goto err;
  	}
  	of_node = plat_data->of_node;
  
  	if (mpc85xx_pcie_find_capability(of_node) > 0)
c92132f59   Chunhe Lan   edac/85xx: Add PC...
188
  		pdata->is_pcie = true;
f87bd330e   Dave Jiang   edac: mpc85xx fix...
189
190
  	dev_set_drvdata(&op->dev, pci);
  	pci->dev = &op->dev;
a9a753d53   Dave Jiang   drivers-edac: add...
191
192
  	pci->mod_name = EDAC_MOD_STR;
  	pci->ctl_name = pdata->name;
031d55185   Kay Sievers   edac: struct devi...
193
  	pci->dev_name = dev_name(&op->dev);
a9a753d53   Dave Jiang   drivers-edac: add...
194

c92132f59   Chunhe Lan   edac/85xx: Add PC...
195
196
197
198
199
200
  	if (edac_op_state == EDAC_OPSTATE_POLL) {
  		if (pdata->is_pcie)
  			pci->edac_check = mpc85xx_pcie_check;
  		else
  			pci->edac_check = mpc85xx_pci_check;
  	}
a9a753d53   Dave Jiang   drivers-edac: add...
201
202
  
  	pdata->edac_idx = edac_pci_idx++;
666db563d   Scott Wood   EDAC, mpc85xx: Ma...
203
  	res = of_address_to_resource(of_node, 0, &r);
f87bd330e   Dave Jiang   edac: mpc85xx fix...
204
  	if (res) {
88857ebe7   York Sun   EDAC, mpc85xx: Re...
205
206
  		pr_err("%s: Unable to get resource for PCI err regs
  ", __func__);
a9a753d53   Dave Jiang   drivers-edac: add...
207
208
  		goto err;
  	}
f87bd330e   Dave Jiang   edac: mpc85xx fix...
209
210
  	/* we only need the error registers */
  	r.start += 0xe00;
66ed3f751   H Hartley Sweeten   edac: mpc85xx use...
211
212
  	if (!devm_request_mem_region(&op->dev, r.start, resource_size(&r),
  					pdata->name)) {
88857ebe7   York Sun   EDAC, mpc85xx: Re...
213
214
  		pr_err("%s: Error while requesting mem region
  ", __func__);
a9a753d53   Dave Jiang   drivers-edac: add...
215
216
217
  		res = -EBUSY;
  		goto err;
  	}
66ed3f751   H Hartley Sweeten   edac: mpc85xx use...
218
  	pdata->pci_vbase = devm_ioremap(&op->dev, r.start, resource_size(&r));
a9a753d53   Dave Jiang   drivers-edac: add...
219
  	if (!pdata->pci_vbase) {
88857ebe7   York Sun   EDAC, mpc85xx: Re...
220
221
  		pr_err("%s: Unable to setup PCI err regs
  ", __func__);
a9a753d53   Dave Jiang   drivers-edac: add...
222
223
224
  		res = -ENOMEM;
  		goto err;
  	}
c92132f59   Chunhe Lan   edac/85xx: Add PC...
225
226
227
228
229
230
231
232
233
234
235
236
237
238
239
240
241
242
243
244
  	if (pdata->is_pcie) {
  		orig_pci_err_cap_dr =
  		    in_be32(pdata->pci_vbase + MPC85XX_PCI_ERR_ADDR);
  		out_be32(pdata->pci_vbase + MPC85XX_PCI_ERR_ADDR, ~0);
  		orig_pci_err_en =
  		    in_be32(pdata->pci_vbase + MPC85XX_PCI_ERR_EN);
  		out_be32(pdata->pci_vbase + MPC85XX_PCI_ERR_EN, 0);
  	} else {
  		orig_pci_err_cap_dr =
  		    in_be32(pdata->pci_vbase + MPC85XX_PCI_ERR_CAP_DR);
  
  		/* PCI master abort is expected during config cycles */
  		out_be32(pdata->pci_vbase + MPC85XX_PCI_ERR_CAP_DR, 0x40);
  
  		orig_pci_err_en =
  		    in_be32(pdata->pci_vbase + MPC85XX_PCI_ERR_EN);
  
  		/* disable master abort reporting */
  		out_be32(pdata->pci_vbase + MPC85XX_PCI_ERR_EN, ~0x40);
  	}
a9a753d53   Dave Jiang   drivers-edac: add...
245
246
247
  
  	/* clear error bits */
  	out_be32(pdata->pci_vbase + MPC85XX_PCI_ERR_DR, ~0);
6fa06b0d9   Tillmann Heidsieck   EDAC, mpc85xx: Fi...
248
249
  	/* reset error capture */
  	out_be32(pdata->pci_vbase + MPC85XX_PCI_GAS_TIMR, 0x1);
a9a753d53   Dave Jiang   drivers-edac: add...
250
  	if (edac_pci_add_device(pci, pdata->edac_idx) > 0) {
956b9ba15   Joe Perches   edac: Convert deb...
251
252
  		edac_dbg(3, "failed edac_pci_add_device()
  ");
a9a753d53   Dave Jiang   drivers-edac: add...
253
254
255
256
  		goto err;
  	}
  
  	if (edac_op_state == EDAC_OPSTATE_INT) {
666db563d   Scott Wood   EDAC, mpc85xx: Ma...
257
  		pdata->irq = irq_of_parse_and_map(of_node, 0);
f87bd330e   Dave Jiang   edac: mpc85xx fix...
258
  		res = devm_request_irq(&op->dev, pdata->irq,
c92132f59   Chunhe Lan   edac/85xx: Add PC...
259
  				       mpc85xx_pci_isr,
e245e3b25   Johannes Thumshirn   edac/85xx: Remove...
260
  				       IRQF_SHARED,
a9a753d53   Dave Jiang   drivers-edac: add...
261
262
  				       "[EDAC] PCI err", pci);
  		if (res < 0) {
88857ebe7   York Sun   EDAC, mpc85xx: Re...
263
264
265
  			pr_err("%s: Unable to request irq %d for MPC85xx PCI err
  ",
  				__func__, pdata->irq);
f87bd330e   Dave Jiang   edac: mpc85xx fix...
266
  			irq_dispose_mapping(pdata->irq);
a9a753d53   Dave Jiang   drivers-edac: add...
267
268
269
  			res = -ENODEV;
  			goto err2;
  		}
88857ebe7   York Sun   EDAC, mpc85xx: Re...
270
271
  		pr_info(EDAC_MOD_STR " acquired irq %d for PCI Err
  ",
a9a753d53   Dave Jiang   drivers-edac: add...
272
273
  		       pdata->irq);
  	}
c92132f59   Chunhe Lan   edac/85xx: Add PC...
274
275
276
277
278
279
280
281
282
283
284
285
286
287
288
  	if (pdata->is_pcie) {
  		/*
  		 * Enable all PCIe error interrupt & error detect except invalid
  		 * PEX_CONFIG_ADDR/PEX_CONFIG_DATA access interrupt generation
  		 * enable bit and invalid PEX_CONFIG_ADDR/PEX_CONFIG_DATA access
  		 * detection enable bit. Because PCIe bus code to initialize and
  		 * configure these PCIe devices on booting will use some invalid
  		 * PEX_CONFIG_ADDR/PEX_CONFIG_DATA, edac driver prints the much
  		 * notice information. So disable this detect to fix ugly print.
  		 */
  		out_be32(pdata->pci_vbase + MPC85XX_PCI_ERR_EN, ~0
  			 & ~PEX_ERR_ICCAIE_EN_BIT);
  		out_be32(pdata->pci_vbase + MPC85XX_PCI_ERR_ADDR, 0
  			 | PEX_ERR_ICCAD_DISR_BIT);
  	}
f87bd330e   Dave Jiang   edac: mpc85xx fix...
289
  	devres_remove_group(&op->dev, mpc85xx_pci_err_probe);
956b9ba15   Joe Perches   edac: Convert deb...
290
291
  	edac_dbg(3, "success
  ");
88857ebe7   York Sun   EDAC, mpc85xx: Re...
292
293
  	pr_info(EDAC_MOD_STR " PCI err registered
  ");
a9a753d53   Dave Jiang   drivers-edac: add...
294
295
296
297
  
  	return 0;
  
  err2:
f87bd330e   Dave Jiang   edac: mpc85xx fix...
298
  	edac_pci_del_device(&op->dev);
a9a753d53   Dave Jiang   drivers-edac: add...
299
300
  err:
  	edac_pci_free_ctl_info(pci);
f87bd330e   Dave Jiang   edac: mpc85xx fix...
301
  	devres_release_group(&op->dev, mpc85xx_pci_err_probe);
a9a753d53   Dave Jiang   drivers-edac: add...
302
303
  	return res;
  }
27bda205b   Yanjiang Jin   EDAC, mpc85xx: Im...
304
305
306
307
308
309
310
311
312
313
314
315
316
317
318
319
  static int mpc85xx_pci_err_remove(struct platform_device *op)
  {
  	struct edac_pci_ctl_info *pci = dev_get_drvdata(&op->dev);
  	struct mpc85xx_pci_pdata *pdata = pci->pvt_info;
  
  	edac_dbg(0, "
  ");
  
  	out_be32(pdata->pci_vbase + MPC85XX_PCI_ERR_ADDR, orig_pci_err_cap_dr);
  	out_be32(pdata->pci_vbase + MPC85XX_PCI_ERR_EN, orig_pci_err_en);
  
  	edac_pci_del_device(&op->dev);
  	edac_pci_free_ctl_info(pci);
  
  	return 0;
  }
666db563d   Scott Wood   EDAC, mpc85xx: Ma...
320
321
322
323
324
325
326
327
328
  static const struct platform_device_id mpc85xx_pci_err_match[] = {
  	{
  		.name = "mpc85xx-pci-edac"
  	},
  	{}
  };
  
  static struct platform_driver mpc85xx_pci_err_driver = {
  	.probe = mpc85xx_pci_err_probe,
27bda205b   Yanjiang Jin   EDAC, mpc85xx: Im...
329
  	.remove = mpc85xx_pci_err_remove,
666db563d   Scott Wood   EDAC, mpc85xx: Ma...
330
331
332
333
334
335
  	.id_table = mpc85xx_pci_err_match,
  	.driver = {
  		.name = "mpc85xx_pci_err",
  		.suppress_bind_attrs = true,
  	},
  };
a9a753d53   Dave Jiang   drivers-edac: add...
336
337
338
339
340
341
342
343
344
345
346
347
348
349
350
351
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
378
379
380
381
382
383
384
385
386
387
388
389
390
391
392
393
394
395
396
397
398
399
400
401
402
403
404
405
406
407
408
409
410
411
412
413
414
415
416
417
418
419
420
421
422
423
424
425
426
427
428
429
430
431
432
433
434
435
436
437
438
439
440
441
442
443
444
445
446
447
448
449
450
  #endif				/* CONFIG_PCI */
  
  /**************************** L2 Err device ***************************/
  
  /************************ L2 SYSFS parts ***********************************/
  
  static ssize_t mpc85xx_l2_inject_data_hi_show(struct edac_device_ctl_info
  					      *edac_dev, char *data)
  {
  	struct mpc85xx_l2_pdata *pdata = edac_dev->pvt_info;
  	return sprintf(data, "0x%08x",
  		       in_be32(pdata->l2_vbase + MPC85XX_L2_ERRINJHI));
  }
  
  static ssize_t mpc85xx_l2_inject_data_lo_show(struct edac_device_ctl_info
  					      *edac_dev, char *data)
  {
  	struct mpc85xx_l2_pdata *pdata = edac_dev->pvt_info;
  	return sprintf(data, "0x%08x",
  		       in_be32(pdata->l2_vbase + MPC85XX_L2_ERRINJLO));
  }
  
  static ssize_t mpc85xx_l2_inject_ctrl_show(struct edac_device_ctl_info
  					   *edac_dev, char *data)
  {
  	struct mpc85xx_l2_pdata *pdata = edac_dev->pvt_info;
  	return sprintf(data, "0x%08x",
  		       in_be32(pdata->l2_vbase + MPC85XX_L2_ERRINJCTL));
  }
  
  static ssize_t mpc85xx_l2_inject_data_hi_store(struct edac_device_ctl_info
  					       *edac_dev, const char *data,
  					       size_t count)
  {
  	struct mpc85xx_l2_pdata *pdata = edac_dev->pvt_info;
  	if (isdigit(*data)) {
  		out_be32(pdata->l2_vbase + MPC85XX_L2_ERRINJHI,
  			 simple_strtoul(data, NULL, 0));
  		return count;
  	}
  	return 0;
  }
  
  static ssize_t mpc85xx_l2_inject_data_lo_store(struct edac_device_ctl_info
  					       *edac_dev, const char *data,
  					       size_t count)
  {
  	struct mpc85xx_l2_pdata *pdata = edac_dev->pvt_info;
  	if (isdigit(*data)) {
  		out_be32(pdata->l2_vbase + MPC85XX_L2_ERRINJLO,
  			 simple_strtoul(data, NULL, 0));
  		return count;
  	}
  	return 0;
  }
  
  static ssize_t mpc85xx_l2_inject_ctrl_store(struct edac_device_ctl_info
  					    *edac_dev, const char *data,
  					    size_t count)
  {
  	struct mpc85xx_l2_pdata *pdata = edac_dev->pvt_info;
  	if (isdigit(*data)) {
  		out_be32(pdata->l2_vbase + MPC85XX_L2_ERRINJCTL,
  			 simple_strtoul(data, NULL, 0));
  		return count;
  	}
  	return 0;
  }
  
  static struct edac_dev_sysfs_attribute mpc85xx_l2_sysfs_attributes[] = {
  	{
  	 .attr = {
  		  .name = "inject_data_hi",
  		  .mode = (S_IRUGO | S_IWUSR)
  		  },
  	 .show = mpc85xx_l2_inject_data_hi_show,
  	 .store = mpc85xx_l2_inject_data_hi_store},
  	{
  	 .attr = {
  		  .name = "inject_data_lo",
  		  .mode = (S_IRUGO | S_IWUSR)
  		  },
  	 .show = mpc85xx_l2_inject_data_lo_show,
  	 .store = mpc85xx_l2_inject_data_lo_store},
  	{
  	 .attr = {
  		  .name = "inject_ctrl",
  		  .mode = (S_IRUGO | S_IWUSR)
  		  },
  	 .show = mpc85xx_l2_inject_ctrl_show,
  	 .store = mpc85xx_l2_inject_ctrl_store},
  
  	/* End of list */
  	{
  	 .attr = {.name = NULL}
  	 }
  };
  
  static void mpc85xx_set_l2_sysfs_attributes(struct edac_device_ctl_info
  					    *edac_dev)
  {
  	edac_dev->sysfs_attributes = mpc85xx_l2_sysfs_attributes;
  }
  
  /***************************** L2 ops ***********************************/
  
  static void mpc85xx_l2_check(struct edac_device_ctl_info *edac_dev)
  {
  	struct mpc85xx_l2_pdata *pdata = edac_dev->pvt_info;
  	u32 err_detect;
  
  	err_detect = in_be32(pdata->l2_vbase + MPC85XX_L2_ERRDET);
  
  	if (!(err_detect & L2_EDE_MASK))
  		return;
88857ebe7   York Sun   EDAC, mpc85xx: Re...
451
452
453
454
455
456
  	pr_err("ECC Error in CPU L2 cache
  ");
  	pr_err("L2 Error Detect Register: 0x%08x
  ", err_detect);
  	pr_err("L2 Error Capture Data High Register: 0x%08x
  ",
a9a753d53   Dave Jiang   drivers-edac: add...
457
  	       in_be32(pdata->l2_vbase + MPC85XX_L2_CAPTDATAHI));
88857ebe7   York Sun   EDAC, mpc85xx: Re...
458
459
  	pr_err("L2 Error Capture Data Lo Register: 0x%08x
  ",
a9a753d53   Dave Jiang   drivers-edac: add...
460
  	       in_be32(pdata->l2_vbase + MPC85XX_L2_CAPTDATALO));
88857ebe7   York Sun   EDAC, mpc85xx: Re...
461
462
  	pr_err("L2 Error Syndrome Register: 0x%08x
  ",
a9a753d53   Dave Jiang   drivers-edac: add...
463
  	       in_be32(pdata->l2_vbase + MPC85XX_L2_CAPTECC));
88857ebe7   York Sun   EDAC, mpc85xx: Re...
464
465
  	pr_err("L2 Error Attributes Capture Register: 0x%08x
  ",
a9a753d53   Dave Jiang   drivers-edac: add...
466
  	       in_be32(pdata->l2_vbase + MPC85XX_L2_ERRATTR));
88857ebe7   York Sun   EDAC, mpc85xx: Re...
467
468
  	pr_err("L2 Error Address Capture Register: 0x%08x
  ",
a9a753d53   Dave Jiang   drivers-edac: add...
469
470
471
472
473
474
475
476
477
478
479
480
481
482
483
484
485
486
487
488
489
490
491
492
493
494
495
  	       in_be32(pdata->l2_vbase + MPC85XX_L2_ERRADDR));
  
  	/* clear error detect register */
  	out_be32(pdata->l2_vbase + MPC85XX_L2_ERRDET, err_detect);
  
  	if (err_detect & L2_EDE_CE_MASK)
  		edac_device_handle_ce(edac_dev, 0, 0, edac_dev->ctl_name);
  
  	if (err_detect & L2_EDE_UE_MASK)
  		edac_device_handle_ue(edac_dev, 0, 0, edac_dev->ctl_name);
  }
  
  static irqreturn_t mpc85xx_l2_isr(int irq, void *dev_id)
  {
  	struct edac_device_ctl_info *edac_dev = dev_id;
  	struct mpc85xx_l2_pdata *pdata = edac_dev->pvt_info;
  	u32 err_detect;
  
  	err_detect = in_be32(pdata->l2_vbase + MPC85XX_L2_ERRDET);
  
  	if (!(err_detect & L2_EDE_MASK))
  		return IRQ_NONE;
  
  	mpc85xx_l2_check(edac_dev);
  
  	return IRQ_HANDLED;
  }
9b3c6e85c   Greg Kroah-Hartman   Drivers: edac: re...
496
  static int mpc85xx_l2_err_probe(struct platform_device *op)
a9a753d53   Dave Jiang   drivers-edac: add...
497
498
499
500
501
502
503
504
505
506
507
508
509
510
511
512
513
514
515
  {
  	struct edac_device_ctl_info *edac_dev;
  	struct mpc85xx_l2_pdata *pdata;
  	struct resource r;
  	int res;
  
  	if (!devres_open_group(&op->dev, mpc85xx_l2_err_probe, GFP_KERNEL))
  		return -ENOMEM;
  
  	edac_dev = edac_device_alloc_ctl_info(sizeof(*pdata),
  					      "cpu", 1, "L", 1, 2, NULL, 0,
  					      edac_dev_idx);
  	if (!edac_dev) {
  		devres_release_group(&op->dev, mpc85xx_l2_err_probe);
  		return -ENOMEM;
  	}
  
  	pdata = edac_dev->pvt_info;
  	pdata->name = "mpc85xx_l2_err";
a9a753d53   Dave Jiang   drivers-edac: add...
516
517
518
519
  	edac_dev->dev = &op->dev;
  	dev_set_drvdata(edac_dev->dev, edac_dev);
  	edac_dev->ctl_name = pdata->name;
  	edac_dev->dev_name = pdata->name;
a26f95fed   Anatolij Gustschin   of/edac: fix buil...
520
  	res = of_address_to_resource(op->dev.of_node, 0, &r);
a9a753d53   Dave Jiang   drivers-edac: add...
521
  	if (res) {
88857ebe7   York Sun   EDAC, mpc85xx: Re...
522
523
  		pr_err("%s: Unable to get resource for L2 err regs
  ", __func__);
a9a753d53   Dave Jiang   drivers-edac: add...
524
525
526
527
528
  		goto err;
  	}
  
  	/* we only need the error registers */
  	r.start += 0xe00;
28f65c11f   Joe Perches   treewide: Convert...
529
530
  	if (!devm_request_mem_region(&op->dev, r.start, resource_size(&r),
  				     pdata->name)) {
88857ebe7   York Sun   EDAC, mpc85xx: Re...
531
532
  		pr_err("%s: Error while requesting mem region
  ", __func__);
a9a753d53   Dave Jiang   drivers-edac: add...
533
534
535
  		res = -EBUSY;
  		goto err;
  	}
28f65c11f   Joe Perches   treewide: Convert...
536
  	pdata->l2_vbase = devm_ioremap(&op->dev, r.start, resource_size(&r));
a9a753d53   Dave Jiang   drivers-edac: add...
537
  	if (!pdata->l2_vbase) {
88857ebe7   York Sun   EDAC, mpc85xx: Re...
538
539
  		pr_err("%s: Unable to setup L2 err regs
  ", __func__);
a9a753d53   Dave Jiang   drivers-edac: add...
540
541
542
543
544
545
546
547
548
549
550
551
552
553
554
555
556
557
558
559
560
  		res = -ENOMEM;
  		goto err;
  	}
  
  	out_be32(pdata->l2_vbase + MPC85XX_L2_ERRDET, ~0);
  
  	orig_l2_err_disable = in_be32(pdata->l2_vbase + MPC85XX_L2_ERRDIS);
  
  	/* clear the err_dis */
  	out_be32(pdata->l2_vbase + MPC85XX_L2_ERRDIS, 0);
  
  	edac_dev->mod_name = EDAC_MOD_STR;
  
  	if (edac_op_state == EDAC_OPSTATE_POLL)
  		edac_dev->edac_check = mpc85xx_l2_check;
  
  	mpc85xx_set_l2_sysfs_attributes(edac_dev);
  
  	pdata->edac_idx = edac_dev_idx++;
  
  	if (edac_device_add_device(edac_dev) > 0) {
956b9ba15   Joe Perches   edac: Convert deb...
561
562
  		edac_dbg(3, "failed edac_device_add_device()
  ");
a9a753d53   Dave Jiang   drivers-edac: add...
563
564
565
566
  		goto err;
  	}
  
  	if (edac_op_state == EDAC_OPSTATE_INT) {
a26f95fed   Anatolij Gustschin   of/edac: fix buil...
567
  		pdata->irq = irq_of_parse_and_map(op->dev.of_node, 0);
a9a753d53   Dave Jiang   drivers-edac: add...
568
  		res = devm_request_irq(&op->dev, pdata->irq,
a18c3f16a   Borislav Petkov   mpc85xx_edac: Mak...
569
  				       mpc85xx_l2_isr, IRQF_SHARED,
a9a753d53   Dave Jiang   drivers-edac: add...
570
571
  				       "[EDAC] L2 err", edac_dev);
  		if (res < 0) {
88857ebe7   York Sun   EDAC, mpc85xx: Re...
572
573
574
  			pr_err("%s: Unable to request irq %d for MPC85xx L2 err
  ",
  				__func__, pdata->irq);
a9a753d53   Dave Jiang   drivers-edac: add...
575
576
577
578
  			irq_dispose_mapping(pdata->irq);
  			res = -ENODEV;
  			goto err2;
  		}
88857ebe7   York Sun   EDAC, mpc85xx: Re...
579
580
  		pr_info(EDAC_MOD_STR " acquired irq %d for L2 Err
  ", pdata->irq);
a9a753d53   Dave Jiang   drivers-edac: add...
581
582
583
584
585
586
587
  
  		edac_dev->op_state = OP_RUNNING_INTERRUPT;
  
  		out_be32(pdata->l2_vbase + MPC85XX_L2_ERRINTEN, L2_EIE_MASK);
  	}
  
  	devres_remove_group(&op->dev, mpc85xx_l2_err_probe);
956b9ba15   Joe Perches   edac: Convert deb...
588
589
  	edac_dbg(3, "success
  ");
88857ebe7   York Sun   EDAC, mpc85xx: Re...
590
591
  	pr_info(EDAC_MOD_STR " L2 err registered
  ");
a9a753d53   Dave Jiang   drivers-edac: add...
592
593
594
595
596
597
598
599
600
601
  
  	return 0;
  
  err2:
  	edac_device_del_device(&op->dev);
  err:
  	devres_release_group(&op->dev, mpc85xx_l2_err_probe);
  	edac_device_free_ctl_info(edac_dev);
  	return res;
  }
2dc115813   Grant Likely   of/device: Replac...
602
  static int mpc85xx_l2_err_remove(struct platform_device *op)
a9a753d53   Dave Jiang   drivers-edac: add...
603
604
605
  {
  	struct edac_device_ctl_info *edac_dev = dev_get_drvdata(&op->dev);
  	struct mpc85xx_l2_pdata *pdata = edac_dev->pvt_info;
956b9ba15   Joe Perches   edac: Convert deb...
606
607
  	edac_dbg(0, "
  ");
a9a753d53   Dave Jiang   drivers-edac: add...
608
609
610
611
612
613
614
615
616
617
618
  
  	if (edac_op_state == EDAC_OPSTATE_INT) {
  		out_be32(pdata->l2_vbase + MPC85XX_L2_ERRINTEN, 0);
  		irq_dispose_mapping(pdata->irq);
  	}
  
  	out_be32(pdata->l2_vbase + MPC85XX_L2_ERRDIS, orig_l2_err_disable);
  	edac_device_del_device(&op->dev);
  	edac_device_free_ctl_info(edac_dev);
  	return 0;
  }
1afaa0551   Fabian Frederick   EDAC: Constify of...
619
  static const struct of_device_id mpc85xx_l2_err_of_match[] = {
29d6cf26a   Kumar Gala   edac: fix mpc85xx...
620
621
622
623
624
625
626
627
628
629
630
631
632
633
634
  /* deprecate the fsl,85.. forms in the future, 2.6.30? */
  	{ .compatible = "fsl,8540-l2-cache-controller", },
  	{ .compatible = "fsl,8541-l2-cache-controller", },
  	{ .compatible = "fsl,8544-l2-cache-controller", },
  	{ .compatible = "fsl,8548-l2-cache-controller", },
  	{ .compatible = "fsl,8555-l2-cache-controller", },
  	{ .compatible = "fsl,8568-l2-cache-controller", },
  	{ .compatible = "fsl,mpc8536-l2-cache-controller", },
  	{ .compatible = "fsl,mpc8540-l2-cache-controller", },
  	{ .compatible = "fsl,mpc8541-l2-cache-controller", },
  	{ .compatible = "fsl,mpc8544-l2-cache-controller", },
  	{ .compatible = "fsl,mpc8548-l2-cache-controller", },
  	{ .compatible = "fsl,mpc8555-l2-cache-controller", },
  	{ .compatible = "fsl,mpc8560-l2-cache-controller", },
  	{ .compatible = "fsl,mpc8568-l2-cache-controller", },
cd1542c81   Anton Vorontsov   edac: mpc85xx: ad...
635
  	{ .compatible = "fsl,mpc8569-l2-cache-controller", },
29d6cf26a   Kumar Gala   edac: fix mpc85xx...
636
  	{ .compatible = "fsl,mpc8572-l2-cache-controller", },
cd1542c81   Anton Vorontsov   edac: mpc85xx: ad...
637
638
  	{ .compatible = "fsl,p1020-l2-cache-controller", },
  	{ .compatible = "fsl,p1021-l2-cache-controller", },
a014554e6   Yang Shi   edac: mpc85xx add...
639
  	{ .compatible = "fsl,p2020-l2-cache-controller", },
321d17c19   Chris Packham   EDAC, mpc85xx: Ad...
640
  	{ .compatible = "fsl,t2080-l2-cache-controller", },
a9a753d53   Dave Jiang   drivers-edac: add...
641
642
  	{},
  };
952e1c663   Anton Vorontsov   edac: mpc85xx: fi...
643
  MODULE_DEVICE_TABLE(of, mpc85xx_l2_err_of_match);
a9a753d53   Dave Jiang   drivers-edac: add...
644

000061245   Grant Likely   dt/powerpc: Elimi...
645
  static struct platform_driver mpc85xx_l2_err_driver = {
a9a753d53   Dave Jiang   drivers-edac: add...
646
647
648
  	.probe = mpc85xx_l2_err_probe,
  	.remove = mpc85xx_l2_err_remove,
  	.driver = {
4018294b5   Grant Likely   of: Remove duplic...
649
  		.name = "mpc85xx_l2_err",
4018294b5   Grant Likely   of: Remove duplic...
650
651
  		.of_match_table = mpc85xx_l2_err_of_match,
  	},
a9a753d53   Dave Jiang   drivers-edac: add...
652
  };
1afaa0551   Fabian Frederick   EDAC: Constify of...
653
  static const struct of_device_id mpc85xx_mc_err_of_match[] = {
29d6cf26a   Kumar Gala   edac: fix mpc85xx...
654
655
656
657
658
659
660
661
662
663
664
665
666
667
668
  /* deprecate the fsl,85.. forms in the future, 2.6.30? */
  	{ .compatible = "fsl,8540-memory-controller", },
  	{ .compatible = "fsl,8541-memory-controller", },
  	{ .compatible = "fsl,8544-memory-controller", },
  	{ .compatible = "fsl,8548-memory-controller", },
  	{ .compatible = "fsl,8555-memory-controller", },
  	{ .compatible = "fsl,8568-memory-controller", },
  	{ .compatible = "fsl,mpc8536-memory-controller", },
  	{ .compatible = "fsl,mpc8540-memory-controller", },
  	{ .compatible = "fsl,mpc8541-memory-controller", },
  	{ .compatible = "fsl,mpc8544-memory-controller", },
  	{ .compatible = "fsl,mpc8548-memory-controller", },
  	{ .compatible = "fsl,mpc8555-memory-controller", },
  	{ .compatible = "fsl,mpc8560-memory-controller", },
  	{ .compatible = "fsl,mpc8568-memory-controller", },
5528e229f   Anton Vorontsov   edac: mpc85xx: ad...
669
  	{ .compatible = "fsl,mpc8569-memory-controller", },
29d6cf26a   Kumar Gala   edac: fix mpc85xx...
670
  	{ .compatible = "fsl,mpc8572-memory-controller", },
b48462517   Ira W. Snyder   edac: mpc85xx add...
671
  	{ .compatible = "fsl,mpc8349-memory-controller", },
cd1542c81   Anton Vorontsov   edac: mpc85xx: ad...
672
673
  	{ .compatible = "fsl,p1020-memory-controller", },
  	{ .compatible = "fsl,p1021-memory-controller", },
a014554e6   Yang Shi   edac: mpc85xx add...
674
  	{ .compatible = "fsl,p2020-memory-controller", },
86f9a4330   Shaohui Xie   drivers/edac/mpc8...
675
  	{ .compatible = "fsl,qoriq-memory-controller", },
a9a753d53   Dave Jiang   drivers-edac: add...
676
677
  	{},
  };
952e1c663   Anton Vorontsov   edac: mpc85xx: fi...
678
  MODULE_DEVICE_TABLE(of, mpc85xx_mc_err_of_match);
a9a753d53   Dave Jiang   drivers-edac: add...
679

000061245   Grant Likely   dt/powerpc: Elimi...
680
  static struct platform_driver mpc85xx_mc_err_driver = {
d43a9fb20   York Sun   EDAC, fsl_ddr: Re...
681
682
  	.probe = fsl_mc_err_probe,
  	.remove = fsl_mc_err_remove,
a9a753d53   Dave Jiang   drivers-edac: add...
683
  	.driver = {
4018294b5   Grant Likely   of: Remove duplic...
684
  		.name = "mpc85xx_mc_err",
4018294b5   Grant Likely   of: Remove duplic...
685
686
  		.of_match_table = mpc85xx_mc_err_of_match,
  	},
a9a753d53   Dave Jiang   drivers-edac: add...
687
  };
d54051f1c   Thierry Reding   EDAC, mpc85xx: Us...
688
689
690
  static struct platform_driver * const drivers[] = {
  	&mpc85xx_mc_err_driver,
  	&mpc85xx_l2_err_driver,
666db563d   Scott Wood   EDAC, mpc85xx: Ma...
691
692
693
  #ifdef CONFIG_PCI
  	&mpc85xx_pci_err_driver,
  #endif
d54051f1c   Thierry Reding   EDAC, mpc85xx: Us...
694
  };
a9a753d53   Dave Jiang   drivers-edac: add...
695
696
697
  static int __init mpc85xx_mc_init(void)
  {
  	int res = 0;
f2b59ac66   Sudip Mukherjee   EDAC, mpc85xx: Si...
698
  	u32 __maybe_unused pvr = 0;
a9a753d53   Dave Jiang   drivers-edac: add...
699

88857ebe7   York Sun   EDAC, mpc85xx: Re...
700
701
  	pr_info("Freescale(R) MPC85xx EDAC driver, (C) 2006 Montavista Software
  ");
a9a753d53   Dave Jiang   drivers-edac: add...
702
703
704
705
706
707
708
709
710
711
  
  	/* make sure error reporting method is sane */
  	switch (edac_op_state) {
  	case EDAC_OPSTATE_POLL:
  	case EDAC_OPSTATE_INT:
  		break;
  	default:
  		edac_op_state = EDAC_OPSTATE_INT;
  		break;
  	}
d54051f1c   Thierry Reding   EDAC, mpc85xx: Us...
712
  	res = platform_register_drivers(drivers, ARRAY_SIZE(drivers));
a9a753d53   Dave Jiang   drivers-edac: add...
713
  	if (res)
88857ebe7   York Sun   EDAC, mpc85xx: Re...
714
715
  		pr_warn(EDAC_MOD_STR "drivers fail to register
  ");
a9a753d53   Dave Jiang   drivers-edac: add...
716

a9a753d53   Dave Jiang   drivers-edac: add...
717
718
719
720
721
722
723
  	return 0;
  }
  
  module_init(mpc85xx_mc_init);
  
  static void __exit mpc85xx_mc_exit(void)
  {
d54051f1c   Thierry Reding   EDAC, mpc85xx: Us...
724
  	platform_unregister_drivers(drivers, ARRAY_SIZE(drivers));
a9a753d53   Dave Jiang   drivers-edac: add...
725
726
727
728
729
730
731
732
733
  }
  
  module_exit(mpc85xx_mc_exit);
  
  MODULE_LICENSE("GPL");
  MODULE_AUTHOR("Montavista Software, Inc.");
  module_param(edac_op_state, int, 0444);
  MODULE_PARM_DESC(edac_op_state,
  		 "EDAC Error Reporting state: 0=Poll, 2=Interrupt");