mpc85xx_edac.c 19 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545546547548549550551552553554555556557558559560561562563564565566567568569570571572573574575576577578579580581582583584585586587588589590591592593594595596597598599600601602603604605606607608609610611612613614615616617618619620621622623624625626627628629630631632633634635636637638639640641642643644645646647648649650651652653654655656657658659660661662663664665666667668669670671672673674675676677678679680681682683684685686687688689690691692693694695696697698699700701702703704705706707708709710711712713714715
  1. /*
  2. * Freescale MPC85xx Memory Controller kernel module
  3. *
  4. * Parts Copyrighted (c) 2013 by Freescale Semiconductor, Inc.
  5. *
  6. * Author: Dave Jiang <[email protected]>
  7. *
  8. * 2006-2007 (c) MontaVista Software, Inc. This file is licensed under
  9. * the terms of the GNU General Public License version 2. This program
  10. * is licensed "as is" without any warranty of any kind, whether express
  11. * or implied.
  12. *
  13. */
  14. #include <linux/module.h>
  15. #include <linux/init.h>
  16. #include <linux/interrupt.h>
  17. #include <linux/ctype.h>
  18. #include <linux/io.h>
  19. #include <linux/mod_devicetable.h>
  20. #include <linux/edac.h>
  21. #include <linux/smp.h>
  22. #include <linux/gfp.h>
  23. #include <linux/fsl/edac.h>
  24. #include <linux/of_platform.h>
  25. #include <linux/of_device.h>
  26. #include <linux/of_address.h>
  27. #include <linux/of_irq.h>
  28. #include "edac_module.h"
  29. #include "mpc85xx_edac.h"
  30. #include "fsl_ddr_edac.h"
  31. static int edac_dev_idx;
  32. #ifdef CONFIG_PCI
  33. static int edac_pci_idx;
  34. #endif
  35. /*
  36. * PCI Err defines
  37. */
  38. #ifdef CONFIG_PCI
  39. static u32 orig_pci_err_cap_dr;
  40. static u32 orig_pci_err_en;
  41. #endif
  42. static u32 orig_l2_err_disable;
  43. /**************************** PCI Err device ***************************/
  44. #ifdef CONFIG_PCI
  45. static void mpc85xx_pci_check(struct edac_pci_ctl_info *pci)
  46. {
  47. struct mpc85xx_pci_pdata *pdata = pci->pvt_info;
  48. u32 err_detect;
  49. err_detect = in_be32(pdata->pci_vbase + MPC85XX_PCI_ERR_DR);
  50. /* master aborts can happen during PCI config cycles */
  51. if (!(err_detect & ~(PCI_EDE_MULTI_ERR | PCI_EDE_MST_ABRT))) {
  52. out_be32(pdata->pci_vbase + MPC85XX_PCI_ERR_DR, err_detect);
  53. return;
  54. }
  55. pr_err("PCI error(s) detected\n");
  56. pr_err("PCI/X ERR_DR register: %#08x\n", err_detect);
  57. pr_err("PCI/X ERR_ATTRIB register: %#08x\n",
  58. in_be32(pdata->pci_vbase + MPC85XX_PCI_ERR_ATTRIB));
  59. pr_err("PCI/X ERR_ADDR register: %#08x\n",
  60. in_be32(pdata->pci_vbase + MPC85XX_PCI_ERR_ADDR));
  61. pr_err("PCI/X ERR_EXT_ADDR register: %#08x\n",
  62. in_be32(pdata->pci_vbase + MPC85XX_PCI_ERR_EXT_ADDR));
  63. pr_err("PCI/X ERR_DL register: %#08x\n",
  64. in_be32(pdata->pci_vbase + MPC85XX_PCI_ERR_DL));
  65. pr_err("PCI/X ERR_DH register: %#08x\n",
  66. in_be32(pdata->pci_vbase + MPC85XX_PCI_ERR_DH));
  67. /* clear error bits */
  68. out_be32(pdata->pci_vbase + MPC85XX_PCI_ERR_DR, err_detect);
  69. if (err_detect & PCI_EDE_PERR_MASK)
  70. edac_pci_handle_pe(pci, pci->ctl_name);
  71. if ((err_detect & ~PCI_EDE_MULTI_ERR) & ~PCI_EDE_PERR_MASK)
  72. edac_pci_handle_npe(pci, pci->ctl_name);
  73. }
  74. static void mpc85xx_pcie_check(struct edac_pci_ctl_info *pci)
  75. {
  76. struct mpc85xx_pci_pdata *pdata = pci->pvt_info;
  77. u32 err_detect, err_cap_stat;
  78. err_detect = in_be32(pdata->pci_vbase + MPC85XX_PCI_ERR_DR);
  79. err_cap_stat = in_be32(pdata->pci_vbase + MPC85XX_PCI_GAS_TIMR);
  80. pr_err("PCIe error(s) detected\n");
  81. pr_err("PCIe ERR_DR register: 0x%08x\n", err_detect);
  82. pr_err("PCIe ERR_CAP_STAT register: 0x%08x\n", err_cap_stat);
  83. pr_err("PCIe ERR_CAP_R0 register: 0x%08x\n",
  84. in_be32(pdata->pci_vbase + MPC85XX_PCIE_ERR_CAP_R0));
  85. pr_err("PCIe ERR_CAP_R1 register: 0x%08x\n",
  86. in_be32(pdata->pci_vbase + MPC85XX_PCIE_ERR_CAP_R1));
  87. pr_err("PCIe ERR_CAP_R2 register: 0x%08x\n",
  88. in_be32(pdata->pci_vbase + MPC85XX_PCIE_ERR_CAP_R2));
  89. pr_err("PCIe ERR_CAP_R3 register: 0x%08x\n",
  90. in_be32(pdata->pci_vbase + MPC85XX_PCIE_ERR_CAP_R3));
  91. /* clear error bits */
  92. out_be32(pdata->pci_vbase + MPC85XX_PCI_ERR_DR, err_detect);
  93. /* reset error capture */
  94. out_be32(pdata->pci_vbase + MPC85XX_PCI_GAS_TIMR, err_cap_stat | 0x1);
  95. }
  96. static int mpc85xx_pcie_find_capability(struct device_node *np)
  97. {
  98. struct pci_controller *hose;
  99. if (!np)
  100. return -EINVAL;
  101. hose = pci_find_hose_for_OF_device(np);
  102. return early_find_capability(hose, 0, 0, PCI_CAP_ID_EXP);
  103. }
  104. static irqreturn_t mpc85xx_pci_isr(int irq, void *dev_id)
  105. {
  106. struct edac_pci_ctl_info *pci = dev_id;
  107. struct mpc85xx_pci_pdata *pdata = pci->pvt_info;
  108. u32 err_detect;
  109. err_detect = in_be32(pdata->pci_vbase + MPC85XX_PCI_ERR_DR);
  110. if (!err_detect)
  111. return IRQ_NONE;
  112. if (pdata->is_pcie)
  113. mpc85xx_pcie_check(pci);
  114. else
  115. mpc85xx_pci_check(pci);
  116. return IRQ_HANDLED;
  117. }
  118. static int mpc85xx_pci_err_probe(struct platform_device *op)
  119. {
  120. struct edac_pci_ctl_info *pci;
  121. struct mpc85xx_pci_pdata *pdata;
  122. struct mpc85xx_edac_pci_plat_data *plat_data;
  123. struct device_node *of_node;
  124. struct resource r;
  125. int res = 0;
  126. if (!devres_open_group(&op->dev, mpc85xx_pci_err_probe, GFP_KERNEL))
  127. return -ENOMEM;
  128. pci = edac_pci_alloc_ctl_info(sizeof(*pdata), "mpc85xx_pci_err");
  129. if (!pci)
  130. return -ENOMEM;
  131. /* make sure error reporting method is sane */
  132. switch (edac_op_state) {
  133. case EDAC_OPSTATE_POLL:
  134. case EDAC_OPSTATE_INT:
  135. break;
  136. default:
  137. edac_op_state = EDAC_OPSTATE_INT;
  138. break;
  139. }
  140. pdata = pci->pvt_info;
  141. pdata->name = "mpc85xx_pci_err";
  142. plat_data = op->dev.platform_data;
  143. if (!plat_data) {
  144. dev_err(&op->dev, "no platform data");
  145. res = -ENXIO;
  146. goto err;
  147. }
  148. of_node = plat_data->of_node;
  149. if (mpc85xx_pcie_find_capability(of_node) > 0)
  150. pdata->is_pcie = true;
  151. dev_set_drvdata(&op->dev, pci);
  152. pci->dev = &op->dev;
  153. pci->mod_name = EDAC_MOD_STR;
  154. pci->ctl_name = pdata->name;
  155. pci->dev_name = dev_name(&op->dev);
  156. if (edac_op_state == EDAC_OPSTATE_POLL) {
  157. if (pdata->is_pcie)
  158. pci->edac_check = mpc85xx_pcie_check;
  159. else
  160. pci->edac_check = mpc85xx_pci_check;
  161. }
  162. pdata->edac_idx = edac_pci_idx++;
  163. res = of_address_to_resource(of_node, 0, &r);
  164. if (res) {
  165. pr_err("%s: Unable to get resource for PCI err regs\n", __func__);
  166. goto err;
  167. }
  168. /* we only need the error registers */
  169. r.start += 0xe00;
  170. if (!devm_request_mem_region(&op->dev, r.start, resource_size(&r),
  171. pdata->name)) {
  172. pr_err("%s: Error while requesting mem region\n", __func__);
  173. res = -EBUSY;
  174. goto err;
  175. }
  176. pdata->pci_vbase = devm_ioremap(&op->dev, r.start, resource_size(&r));
  177. if (!pdata->pci_vbase) {
  178. pr_err("%s: Unable to setup PCI err regs\n", __func__);
  179. res = -ENOMEM;
  180. goto err;
  181. }
  182. if (pdata->is_pcie) {
  183. orig_pci_err_cap_dr =
  184. in_be32(pdata->pci_vbase + MPC85XX_PCI_ERR_ADDR);
  185. out_be32(pdata->pci_vbase + MPC85XX_PCI_ERR_ADDR, ~0);
  186. orig_pci_err_en =
  187. in_be32(pdata->pci_vbase + MPC85XX_PCI_ERR_EN);
  188. out_be32(pdata->pci_vbase + MPC85XX_PCI_ERR_EN, 0);
  189. } else {
  190. orig_pci_err_cap_dr =
  191. in_be32(pdata->pci_vbase + MPC85XX_PCI_ERR_CAP_DR);
  192. /* PCI master abort is expected during config cycles */
  193. out_be32(pdata->pci_vbase + MPC85XX_PCI_ERR_CAP_DR, 0x40);
  194. orig_pci_err_en =
  195. in_be32(pdata->pci_vbase + MPC85XX_PCI_ERR_EN);
  196. /* disable master abort reporting */
  197. out_be32(pdata->pci_vbase + MPC85XX_PCI_ERR_EN, ~0x40);
  198. }
  199. /* clear error bits */
  200. out_be32(pdata->pci_vbase + MPC85XX_PCI_ERR_DR, ~0);
  201. /* reset error capture */
  202. out_be32(pdata->pci_vbase + MPC85XX_PCI_GAS_TIMR, 0x1);
  203. if (edac_pci_add_device(pci, pdata->edac_idx) > 0) {
  204. edac_dbg(3, "failed edac_pci_add_device()\n");
  205. goto err;
  206. }
  207. if (edac_op_state == EDAC_OPSTATE_INT) {
  208. pdata->irq = irq_of_parse_and_map(of_node, 0);
  209. res = devm_request_irq(&op->dev, pdata->irq,
  210. mpc85xx_pci_isr,
  211. IRQF_SHARED,
  212. "[EDAC] PCI err", pci);
  213. if (res < 0) {
  214. pr_err("%s: Unable to request irq %d for MPC85xx PCI err\n",
  215. __func__, pdata->irq);
  216. irq_dispose_mapping(pdata->irq);
  217. res = -ENODEV;
  218. goto err2;
  219. }
  220. pr_info(EDAC_MOD_STR " acquired irq %d for PCI Err\n",
  221. pdata->irq);
  222. }
  223. if (pdata->is_pcie) {
  224. /*
  225. * Enable all PCIe error interrupt & error detect except invalid
  226. * PEX_CONFIG_ADDR/PEX_CONFIG_DATA access interrupt generation
  227. * enable bit and invalid PEX_CONFIG_ADDR/PEX_CONFIG_DATA access
  228. * detection enable bit. Because PCIe bus code to initialize and
  229. * configure these PCIe devices on booting will use some invalid
  230. * PEX_CONFIG_ADDR/PEX_CONFIG_DATA, edac driver prints the much
  231. * notice information. So disable this detect to fix ugly print.
  232. */
  233. out_be32(pdata->pci_vbase + MPC85XX_PCI_ERR_EN, ~0
  234. & ~PEX_ERR_ICCAIE_EN_BIT);
  235. out_be32(pdata->pci_vbase + MPC85XX_PCI_ERR_ADDR, 0
  236. | PEX_ERR_ICCAD_DISR_BIT);
  237. }
  238. devres_remove_group(&op->dev, mpc85xx_pci_err_probe);
  239. edac_dbg(3, "success\n");
  240. pr_info(EDAC_MOD_STR " PCI err registered\n");
  241. return 0;
  242. err2:
  243. edac_pci_del_device(&op->dev);
  244. err:
  245. edac_pci_free_ctl_info(pci);
  246. devres_release_group(&op->dev, mpc85xx_pci_err_probe);
  247. return res;
  248. }
  249. static int mpc85xx_pci_err_remove(struct platform_device *op)
  250. {
  251. struct edac_pci_ctl_info *pci = dev_get_drvdata(&op->dev);
  252. struct mpc85xx_pci_pdata *pdata = pci->pvt_info;
  253. edac_dbg(0, "\n");
  254. out_be32(pdata->pci_vbase + MPC85XX_PCI_ERR_ADDR, orig_pci_err_cap_dr);
  255. out_be32(pdata->pci_vbase + MPC85XX_PCI_ERR_EN, orig_pci_err_en);
  256. edac_pci_del_device(&op->dev);
  257. edac_pci_free_ctl_info(pci);
  258. return 0;
  259. }
  260. static const struct platform_device_id mpc85xx_pci_err_match[] = {
  261. {
  262. .name = "mpc85xx-pci-edac"
  263. },
  264. {}
  265. };
  266. static struct platform_driver mpc85xx_pci_err_driver = {
  267. .probe = mpc85xx_pci_err_probe,
  268. .remove = mpc85xx_pci_err_remove,
  269. .id_table = mpc85xx_pci_err_match,
  270. .driver = {
  271. .name = "mpc85xx_pci_err",
  272. .suppress_bind_attrs = true,
  273. },
  274. };
  275. #endif /* CONFIG_PCI */
  276. /**************************** L2 Err device ***************************/
  277. /************************ L2 SYSFS parts ***********************************/
  278. static ssize_t mpc85xx_l2_inject_data_hi_show(struct edac_device_ctl_info
  279. *edac_dev, char *data)
  280. {
  281. struct mpc85xx_l2_pdata *pdata = edac_dev->pvt_info;
  282. return sprintf(data, "0x%08x",
  283. in_be32(pdata->l2_vbase + MPC85XX_L2_ERRINJHI));
  284. }
  285. static ssize_t mpc85xx_l2_inject_data_lo_show(struct edac_device_ctl_info
  286. *edac_dev, char *data)
  287. {
  288. struct mpc85xx_l2_pdata *pdata = edac_dev->pvt_info;
  289. return sprintf(data, "0x%08x",
  290. in_be32(pdata->l2_vbase + MPC85XX_L2_ERRINJLO));
  291. }
  292. static ssize_t mpc85xx_l2_inject_ctrl_show(struct edac_device_ctl_info
  293. *edac_dev, char *data)
  294. {
  295. struct mpc85xx_l2_pdata *pdata = edac_dev->pvt_info;
  296. return sprintf(data, "0x%08x",
  297. in_be32(pdata->l2_vbase + MPC85XX_L2_ERRINJCTL));
  298. }
  299. static ssize_t mpc85xx_l2_inject_data_hi_store(struct edac_device_ctl_info
  300. *edac_dev, const char *data,
  301. size_t count)
  302. {
  303. struct mpc85xx_l2_pdata *pdata = edac_dev->pvt_info;
  304. if (isdigit(*data)) {
  305. out_be32(pdata->l2_vbase + MPC85XX_L2_ERRINJHI,
  306. simple_strtoul(data, NULL, 0));
  307. return count;
  308. }
  309. return 0;
  310. }
  311. static ssize_t mpc85xx_l2_inject_data_lo_store(struct edac_device_ctl_info
  312. *edac_dev, const char *data,
  313. size_t count)
  314. {
  315. struct mpc85xx_l2_pdata *pdata = edac_dev->pvt_info;
  316. if (isdigit(*data)) {
  317. out_be32(pdata->l2_vbase + MPC85XX_L2_ERRINJLO,
  318. simple_strtoul(data, NULL, 0));
  319. return count;
  320. }
  321. return 0;
  322. }
  323. static ssize_t mpc85xx_l2_inject_ctrl_store(struct edac_device_ctl_info
  324. *edac_dev, const char *data,
  325. size_t count)
  326. {
  327. struct mpc85xx_l2_pdata *pdata = edac_dev->pvt_info;
  328. if (isdigit(*data)) {
  329. out_be32(pdata->l2_vbase + MPC85XX_L2_ERRINJCTL,
  330. simple_strtoul(data, NULL, 0));
  331. return count;
  332. }
  333. return 0;
  334. }
  335. static struct edac_dev_sysfs_attribute mpc85xx_l2_sysfs_attributes[] = {
  336. {
  337. .attr = {
  338. .name = "inject_data_hi",
  339. .mode = (S_IRUGO | S_IWUSR)
  340. },
  341. .show = mpc85xx_l2_inject_data_hi_show,
  342. .store = mpc85xx_l2_inject_data_hi_store},
  343. {
  344. .attr = {
  345. .name = "inject_data_lo",
  346. .mode = (S_IRUGO | S_IWUSR)
  347. },
  348. .show = mpc85xx_l2_inject_data_lo_show,
  349. .store = mpc85xx_l2_inject_data_lo_store},
  350. {
  351. .attr = {
  352. .name = "inject_ctrl",
  353. .mode = (S_IRUGO | S_IWUSR)
  354. },
  355. .show = mpc85xx_l2_inject_ctrl_show,
  356. .store = mpc85xx_l2_inject_ctrl_store},
  357. /* End of list */
  358. {
  359. .attr = {.name = NULL}
  360. }
  361. };
  362. static void mpc85xx_set_l2_sysfs_attributes(struct edac_device_ctl_info
  363. *edac_dev)
  364. {
  365. edac_dev->sysfs_attributes = mpc85xx_l2_sysfs_attributes;
  366. }
  367. /***************************** L2 ops ***********************************/
  368. static void mpc85xx_l2_check(struct edac_device_ctl_info *edac_dev)
  369. {
  370. struct mpc85xx_l2_pdata *pdata = edac_dev->pvt_info;
  371. u32 err_detect;
  372. err_detect = in_be32(pdata->l2_vbase + MPC85XX_L2_ERRDET);
  373. if (!(err_detect & L2_EDE_MASK))
  374. return;
  375. pr_err("ECC Error in CPU L2 cache\n");
  376. pr_err("L2 Error Detect Register: 0x%08x\n", err_detect);
  377. pr_err("L2 Error Capture Data High Register: 0x%08x\n",
  378. in_be32(pdata->l2_vbase + MPC85XX_L2_CAPTDATAHI));
  379. pr_err("L2 Error Capture Data Lo Register: 0x%08x\n",
  380. in_be32(pdata->l2_vbase + MPC85XX_L2_CAPTDATALO));
  381. pr_err("L2 Error Syndrome Register: 0x%08x\n",
  382. in_be32(pdata->l2_vbase + MPC85XX_L2_CAPTECC));
  383. pr_err("L2 Error Attributes Capture Register: 0x%08x\n",
  384. in_be32(pdata->l2_vbase + MPC85XX_L2_ERRATTR));
  385. pr_err("L2 Error Address Capture Register: 0x%08x\n",
  386. in_be32(pdata->l2_vbase + MPC85XX_L2_ERRADDR));
  387. /* clear error detect register */
  388. out_be32(pdata->l2_vbase + MPC85XX_L2_ERRDET, err_detect);
  389. if (err_detect & L2_EDE_CE_MASK)
  390. edac_device_handle_ce(edac_dev, 0, 0, edac_dev->ctl_name);
  391. if (err_detect & L2_EDE_UE_MASK)
  392. edac_device_handle_ue(edac_dev, 0, 0, edac_dev->ctl_name);
  393. }
  394. static irqreturn_t mpc85xx_l2_isr(int irq, void *dev_id)
  395. {
  396. struct edac_device_ctl_info *edac_dev = dev_id;
  397. struct mpc85xx_l2_pdata *pdata = edac_dev->pvt_info;
  398. u32 err_detect;
  399. err_detect = in_be32(pdata->l2_vbase + MPC85XX_L2_ERRDET);
  400. if (!(err_detect & L2_EDE_MASK))
  401. return IRQ_NONE;
  402. mpc85xx_l2_check(edac_dev);
  403. return IRQ_HANDLED;
  404. }
  405. static int mpc85xx_l2_err_probe(struct platform_device *op)
  406. {
  407. struct edac_device_ctl_info *edac_dev;
  408. struct mpc85xx_l2_pdata *pdata;
  409. struct resource r;
  410. int res;
  411. if (!devres_open_group(&op->dev, mpc85xx_l2_err_probe, GFP_KERNEL))
  412. return -ENOMEM;
  413. edac_dev = edac_device_alloc_ctl_info(sizeof(*pdata),
  414. "cpu", 1, "L", 1, 2, NULL, 0,
  415. edac_dev_idx);
  416. if (!edac_dev) {
  417. devres_release_group(&op->dev, mpc85xx_l2_err_probe);
  418. return -ENOMEM;
  419. }
  420. pdata = edac_dev->pvt_info;
  421. pdata->name = "mpc85xx_l2_err";
  422. edac_dev->dev = &op->dev;
  423. dev_set_drvdata(edac_dev->dev, edac_dev);
  424. edac_dev->ctl_name = pdata->name;
  425. edac_dev->dev_name = pdata->name;
  426. res = of_address_to_resource(op->dev.of_node, 0, &r);
  427. if (res) {
  428. pr_err("%s: Unable to get resource for L2 err regs\n", __func__);
  429. goto err;
  430. }
  431. /* we only need the error registers */
  432. r.start += 0xe00;
  433. if (!devm_request_mem_region(&op->dev, r.start, resource_size(&r),
  434. pdata->name)) {
  435. pr_err("%s: Error while requesting mem region\n", __func__);
  436. res = -EBUSY;
  437. goto err;
  438. }
  439. pdata->l2_vbase = devm_ioremap(&op->dev, r.start, resource_size(&r));
  440. if (!pdata->l2_vbase) {
  441. pr_err("%s: Unable to setup L2 err regs\n", __func__);
  442. res = -ENOMEM;
  443. goto err;
  444. }
  445. out_be32(pdata->l2_vbase + MPC85XX_L2_ERRDET, ~0);
  446. orig_l2_err_disable = in_be32(pdata->l2_vbase + MPC85XX_L2_ERRDIS);
  447. /* clear the err_dis */
  448. out_be32(pdata->l2_vbase + MPC85XX_L2_ERRDIS, 0);
  449. edac_dev->mod_name = EDAC_MOD_STR;
  450. if (edac_op_state == EDAC_OPSTATE_POLL)
  451. edac_dev->edac_check = mpc85xx_l2_check;
  452. mpc85xx_set_l2_sysfs_attributes(edac_dev);
  453. pdata->edac_idx = edac_dev_idx++;
  454. if (edac_device_add_device(edac_dev) > 0) {
  455. edac_dbg(3, "failed edac_device_add_device()\n");
  456. goto err;
  457. }
  458. if (edac_op_state == EDAC_OPSTATE_INT) {
  459. pdata->irq = irq_of_parse_and_map(op->dev.of_node, 0);
  460. res = devm_request_irq(&op->dev, pdata->irq,
  461. mpc85xx_l2_isr, IRQF_SHARED,
  462. "[EDAC] L2 err", edac_dev);
  463. if (res < 0) {
  464. pr_err("%s: Unable to request irq %d for MPC85xx L2 err\n",
  465. __func__, pdata->irq);
  466. irq_dispose_mapping(pdata->irq);
  467. res = -ENODEV;
  468. goto err2;
  469. }
  470. pr_info(EDAC_MOD_STR " acquired irq %d for L2 Err\n", pdata->irq);
  471. edac_dev->op_state = OP_RUNNING_INTERRUPT;
  472. out_be32(pdata->l2_vbase + MPC85XX_L2_ERRINTEN, L2_EIE_MASK);
  473. }
  474. devres_remove_group(&op->dev, mpc85xx_l2_err_probe);
  475. edac_dbg(3, "success\n");
  476. pr_info(EDAC_MOD_STR " L2 err registered\n");
  477. return 0;
  478. err2:
  479. edac_device_del_device(&op->dev);
  480. err:
  481. devres_release_group(&op->dev, mpc85xx_l2_err_probe);
  482. edac_device_free_ctl_info(edac_dev);
  483. return res;
  484. }
  485. static int mpc85xx_l2_err_remove(struct platform_device *op)
  486. {
  487. struct edac_device_ctl_info *edac_dev = dev_get_drvdata(&op->dev);
  488. struct mpc85xx_l2_pdata *pdata = edac_dev->pvt_info;
  489. edac_dbg(0, "\n");
  490. if (edac_op_state == EDAC_OPSTATE_INT) {
  491. out_be32(pdata->l2_vbase + MPC85XX_L2_ERRINTEN, 0);
  492. irq_dispose_mapping(pdata->irq);
  493. }
  494. out_be32(pdata->l2_vbase + MPC85XX_L2_ERRDIS, orig_l2_err_disable);
  495. edac_device_del_device(&op->dev);
  496. edac_device_free_ctl_info(edac_dev);
  497. return 0;
  498. }
  499. static const struct of_device_id mpc85xx_l2_err_of_match[] = {
  500. { .compatible = "fsl,mpc8536-l2-cache-controller", },
  501. { .compatible = "fsl,mpc8540-l2-cache-controller", },
  502. { .compatible = "fsl,mpc8541-l2-cache-controller", },
  503. { .compatible = "fsl,mpc8544-l2-cache-controller", },
  504. { .compatible = "fsl,mpc8548-l2-cache-controller", },
  505. { .compatible = "fsl,mpc8555-l2-cache-controller", },
  506. { .compatible = "fsl,mpc8560-l2-cache-controller", },
  507. { .compatible = "fsl,mpc8568-l2-cache-controller", },
  508. { .compatible = "fsl,mpc8569-l2-cache-controller", },
  509. { .compatible = "fsl,mpc8572-l2-cache-controller", },
  510. { .compatible = "fsl,p1020-l2-cache-controller", },
  511. { .compatible = "fsl,p1021-l2-cache-controller", },
  512. { .compatible = "fsl,p2020-l2-cache-controller", },
  513. { .compatible = "fsl,t2080-l2-cache-controller", },
  514. {},
  515. };
  516. MODULE_DEVICE_TABLE(of, mpc85xx_l2_err_of_match);
  517. static struct platform_driver mpc85xx_l2_err_driver = {
  518. .probe = mpc85xx_l2_err_probe,
  519. .remove = mpc85xx_l2_err_remove,
  520. .driver = {
  521. .name = "mpc85xx_l2_err",
  522. .of_match_table = mpc85xx_l2_err_of_match,
  523. },
  524. };
  525. static const struct of_device_id mpc85xx_mc_err_of_match[] = {
  526. { .compatible = "fsl,mpc8536-memory-controller", },
  527. { .compatible = "fsl,mpc8540-memory-controller", },
  528. { .compatible = "fsl,mpc8541-memory-controller", },
  529. { .compatible = "fsl,mpc8544-memory-controller", },
  530. { .compatible = "fsl,mpc8548-memory-controller", },
  531. { .compatible = "fsl,mpc8555-memory-controller", },
  532. { .compatible = "fsl,mpc8560-memory-controller", },
  533. { .compatible = "fsl,mpc8568-memory-controller", },
  534. { .compatible = "fsl,mpc8569-memory-controller", },
  535. { .compatible = "fsl,mpc8572-memory-controller", },
  536. { .compatible = "fsl,mpc8349-memory-controller", },
  537. { .compatible = "fsl,p1020-memory-controller", },
  538. { .compatible = "fsl,p1021-memory-controller", },
  539. { .compatible = "fsl,p2020-memory-controller", },
  540. { .compatible = "fsl,qoriq-memory-controller", },
  541. {},
  542. };
  543. MODULE_DEVICE_TABLE(of, mpc85xx_mc_err_of_match);
  544. static struct platform_driver mpc85xx_mc_err_driver = {
  545. .probe = fsl_mc_err_probe,
  546. .remove = fsl_mc_err_remove,
  547. .driver = {
  548. .name = "mpc85xx_mc_err",
  549. .of_match_table = mpc85xx_mc_err_of_match,
  550. },
  551. };
  552. static struct platform_driver * const drivers[] = {
  553. &mpc85xx_mc_err_driver,
  554. &mpc85xx_l2_err_driver,
  555. #ifdef CONFIG_PCI
  556. &mpc85xx_pci_err_driver,
  557. #endif
  558. };
  559. static int __init mpc85xx_mc_init(void)
  560. {
  561. int res = 0;
  562. u32 __maybe_unused pvr = 0;
  563. pr_info("Freescale(R) MPC85xx EDAC driver, (C) 2006 Montavista Software\n");
  564. /* make sure error reporting method is sane */
  565. switch (edac_op_state) {
  566. case EDAC_OPSTATE_POLL:
  567. case EDAC_OPSTATE_INT:
  568. break;
  569. default:
  570. edac_op_state = EDAC_OPSTATE_INT;
  571. break;
  572. }
  573. res = platform_register_drivers(drivers, ARRAY_SIZE(drivers));
  574. if (res)
  575. pr_warn(EDAC_MOD_STR "drivers fail to register\n");
  576. return 0;
  577. }
  578. module_init(mpc85xx_mc_init);
  579. static void __exit mpc85xx_mc_exit(void)
  580. {
  581. platform_unregister_drivers(drivers, ARRAY_SIZE(drivers));
  582. }
  583. module_exit(mpc85xx_mc_exit);
  584. MODULE_LICENSE("GPL");
  585. MODULE_AUTHOR("Montavista Software, Inc.");
  586. module_param(edac_op_state, int, 0444);
  587. MODULE_PARM_DESC(edac_op_state,
  588. "EDAC Error Reporting state: 0=Poll, 2=Interrupt");