mpc85xx_edac.c 35 KB

1234567891011121314151617181920212223242526272829303132333435363738394041424344454647484950515253545556575859606162636465666768697071727374757677787980818283848586878889909192939495969798991001011021031041051061071081091101111121131141151161171181191201211221231241251261271281291301311321331341351361371381391401411421431441451461471481491501511521531541551561571581591601611621631641651661671681691701711721731741751761771781791801811821831841851861871881891901911921931941951961971981992002012022032042052062072082092102112122132142152162172182192202212222232242252262272282292302312322332342352362372382392402412422432442452462472482492502512522532542552562572582592602612622632642652662672682692702712722732742752762772782792802812822832842852862872882892902912922932942952962972982993003013023033043053063073083093103113123133143153163173183193203213223233243253263273283293303313323333343353363373383393403413423433443453463473483493503513523533543553563573583593603613623633643653663673683693703713723733743753763773783793803813823833843853863873883893903913923933943953963973983994004014024034044054064074084094104114124134144154164174184194204214224234244254264274284294304314324334344354364374384394404414424434444454464474484494504514524534544554564574584594604614624634644654664674684694704714724734744754764774784794804814824834844854864874884894904914924934944954964974984995005015025035045055065075085095105115125135145155165175185195205215225235245255265275285295305315325335345355365375385395405415425435445455465475485495505515525535545555565575585595605615625635645655665675685695705715725735745755765775785795805815825835845855865875885895905915925935945955965975985996006016026036046056066076086096106116126136146156166176186196206216226236246256266276286296306316326336346356366376386396406416426436446456466476486496506516526536546556566576586596606616626636646656666676686696706716726736746756766776786796806816826836846856866876886896906916926936946956966976986997007017027037047057067077087097107117127137147157167177187197207217227237247257267277287297307317327337347357367377387397407417427437447457467477487497507517527537547557567577587597607617627637647657667677687697707717727737747757767777787797807817827837847857867877887897907917927937947957967977987998008018028038048058068078088098108118128138148158168178188198208218228238248258268278288298308318328338348358368378388398408418428438448458468478488498508518528538548558568578588598608618628638648658668678688698708718728738748758768778788798808818828838848858868878888898908918928938948958968978988999009019029039049059069079089099109119129139149159169179189199209219229239249259269279289299309319329339349359369379389399409419429439449459469479489499509519529539549559569579589599609619629639649659669679689699709719729739749759769779789799809819829839849859869879889899909919929939949959969979989991000100110021003100410051006100710081009101010111012101310141015101610171018101910201021102210231024102510261027102810291030103110321033103410351036103710381039104010411042104310441045104610471048104910501051105210531054105510561057105810591060106110621063106410651066106710681069107010711072107310741075107610771078107910801081108210831084108510861087108810891090109110921093109410951096109710981099110011011102110311041105110611071108110911101111111211131114111511161117111811191120112111221123112411251126112711281129113011311132113311341135113611371138113911401141114211431144114511461147114811491150115111521153115411551156115711581159116011611162116311641165116611671168116911701171117211731174117511761177117811791180118111821183118411851186118711881189119011911192119311941195119611971198119912001201120212031204120512061207120812091210121112121213121412151216121712181219122012211222122312241225122612271228122912301231123212331234123512361237123812391240124112421243124412451246124712481249125012511252125312541255125612571258125912601261126212631264126512661267126812691270127112721273127412751276127712781279128012811282128312841285128612871288128912901291129212931294129512961297129812991300130113021303
  1. /*
  2. * Freescale MPC85xx Memory Controller kenel module
  3. *
  4. * Parts Copyrighted (c) 2013 by Freescale Semiconductor, Inc.
  5. *
  6. * Author: Dave Jiang <djiang@mvista.com>
  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/of_platform.h>
  24. #include <linux/of_device.h>
  25. #include "edac_module.h"
  26. #include "edac_core.h"
  27. #include "mpc85xx_edac.h"
  28. static int edac_dev_idx;
  29. #ifdef CONFIG_PCI
  30. static int edac_pci_idx;
  31. #endif
  32. static int edac_mc_idx;
  33. static u32 orig_ddr_err_disable;
  34. static u32 orig_ddr_err_sbe;
  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. #ifdef CONFIG_FSL_SOC_BOOKE
  44. static u32 orig_hid1[2];
  45. #endif
  46. /************************ MC SYSFS parts ***********************************/
  47. #define to_mci(k) container_of(k, struct mem_ctl_info, dev)
  48. static ssize_t mpc85xx_mc_inject_data_hi_show(struct device *dev,
  49. struct device_attribute *mattr,
  50. char *data)
  51. {
  52. struct mem_ctl_info *mci = to_mci(dev);
  53. struct mpc85xx_mc_pdata *pdata = mci->pvt_info;
  54. return sprintf(data, "0x%08x",
  55. in_be32(pdata->mc_vbase +
  56. MPC85XX_MC_DATA_ERR_INJECT_HI));
  57. }
  58. static ssize_t mpc85xx_mc_inject_data_lo_show(struct device *dev,
  59. struct device_attribute *mattr,
  60. char *data)
  61. {
  62. struct mem_ctl_info *mci = to_mci(dev);
  63. struct mpc85xx_mc_pdata *pdata = mci->pvt_info;
  64. return sprintf(data, "0x%08x",
  65. in_be32(pdata->mc_vbase +
  66. MPC85XX_MC_DATA_ERR_INJECT_LO));
  67. }
  68. static ssize_t mpc85xx_mc_inject_ctrl_show(struct device *dev,
  69. struct device_attribute *mattr,
  70. char *data)
  71. {
  72. struct mem_ctl_info *mci = to_mci(dev);
  73. struct mpc85xx_mc_pdata *pdata = mci->pvt_info;
  74. return sprintf(data, "0x%08x",
  75. in_be32(pdata->mc_vbase + MPC85XX_MC_ECC_ERR_INJECT));
  76. }
  77. static ssize_t mpc85xx_mc_inject_data_hi_store(struct device *dev,
  78. struct device_attribute *mattr,
  79. const char *data, size_t count)
  80. {
  81. struct mem_ctl_info *mci = to_mci(dev);
  82. struct mpc85xx_mc_pdata *pdata = mci->pvt_info;
  83. if (isdigit(*data)) {
  84. out_be32(pdata->mc_vbase + MPC85XX_MC_DATA_ERR_INJECT_HI,
  85. simple_strtoul(data, NULL, 0));
  86. return count;
  87. }
  88. return 0;
  89. }
  90. static ssize_t mpc85xx_mc_inject_data_lo_store(struct device *dev,
  91. struct device_attribute *mattr,
  92. const char *data, size_t count)
  93. {
  94. struct mem_ctl_info *mci = to_mci(dev);
  95. struct mpc85xx_mc_pdata *pdata = mci->pvt_info;
  96. if (isdigit(*data)) {
  97. out_be32(pdata->mc_vbase + MPC85XX_MC_DATA_ERR_INJECT_LO,
  98. simple_strtoul(data, NULL, 0));
  99. return count;
  100. }
  101. return 0;
  102. }
  103. static ssize_t mpc85xx_mc_inject_ctrl_store(struct device *dev,
  104. struct device_attribute *mattr,
  105. const char *data, size_t count)
  106. {
  107. struct mem_ctl_info *mci = to_mci(dev);
  108. struct mpc85xx_mc_pdata *pdata = mci->pvt_info;
  109. if (isdigit(*data)) {
  110. out_be32(pdata->mc_vbase + MPC85XX_MC_ECC_ERR_INJECT,
  111. simple_strtoul(data, NULL, 0));
  112. return count;
  113. }
  114. return 0;
  115. }
  116. DEVICE_ATTR(inject_data_hi, S_IRUGO | S_IWUSR,
  117. mpc85xx_mc_inject_data_hi_show, mpc85xx_mc_inject_data_hi_store);
  118. DEVICE_ATTR(inject_data_lo, S_IRUGO | S_IWUSR,
  119. mpc85xx_mc_inject_data_lo_show, mpc85xx_mc_inject_data_lo_store);
  120. DEVICE_ATTR(inject_ctrl, S_IRUGO | S_IWUSR,
  121. mpc85xx_mc_inject_ctrl_show, mpc85xx_mc_inject_ctrl_store);
  122. static int mpc85xx_create_sysfs_attributes(struct mem_ctl_info *mci)
  123. {
  124. int rc;
  125. rc = device_create_file(&mci->dev, &dev_attr_inject_data_hi);
  126. if (rc < 0)
  127. return rc;
  128. rc = device_create_file(&mci->dev, &dev_attr_inject_data_lo);
  129. if (rc < 0)
  130. return rc;
  131. rc = device_create_file(&mci->dev, &dev_attr_inject_ctrl);
  132. if (rc < 0)
  133. return rc;
  134. return 0;
  135. }
  136. static void mpc85xx_remove_sysfs_attributes(struct mem_ctl_info *mci)
  137. {
  138. device_remove_file(&mci->dev, &dev_attr_inject_data_hi);
  139. device_remove_file(&mci->dev, &dev_attr_inject_data_lo);
  140. device_remove_file(&mci->dev, &dev_attr_inject_ctrl);
  141. }
  142. /**************************** PCI Err device ***************************/
  143. #ifdef CONFIG_PCI
  144. static void mpc85xx_pci_check(struct edac_pci_ctl_info *pci)
  145. {
  146. struct mpc85xx_pci_pdata *pdata = pci->pvt_info;
  147. u32 err_detect;
  148. err_detect = in_be32(pdata->pci_vbase + MPC85XX_PCI_ERR_DR);
  149. /* master aborts can happen during PCI config cycles */
  150. if (!(err_detect & ~(PCI_EDE_MULTI_ERR | PCI_EDE_MST_ABRT))) {
  151. out_be32(pdata->pci_vbase + MPC85XX_PCI_ERR_DR, err_detect);
  152. return;
  153. }
  154. printk(KERN_ERR "PCI error(s) detected\n");
  155. printk(KERN_ERR "PCI/X ERR_DR register: %#08x\n", err_detect);
  156. printk(KERN_ERR "PCI/X ERR_ATTRIB register: %#08x\n",
  157. in_be32(pdata->pci_vbase + MPC85XX_PCI_ERR_ATTRIB));
  158. printk(KERN_ERR "PCI/X ERR_ADDR register: %#08x\n",
  159. in_be32(pdata->pci_vbase + MPC85XX_PCI_ERR_ADDR));
  160. printk(KERN_ERR "PCI/X ERR_EXT_ADDR register: %#08x\n",
  161. in_be32(pdata->pci_vbase + MPC85XX_PCI_ERR_EXT_ADDR));
  162. printk(KERN_ERR "PCI/X ERR_DL register: %#08x\n",
  163. in_be32(pdata->pci_vbase + MPC85XX_PCI_ERR_DL));
  164. printk(KERN_ERR "PCI/X ERR_DH register: %#08x\n",
  165. in_be32(pdata->pci_vbase + MPC85XX_PCI_ERR_DH));
  166. /* clear error bits */
  167. out_be32(pdata->pci_vbase + MPC85XX_PCI_ERR_DR, err_detect);
  168. if (err_detect & PCI_EDE_PERR_MASK)
  169. edac_pci_handle_pe(pci, pci->ctl_name);
  170. if ((err_detect & ~PCI_EDE_MULTI_ERR) & ~PCI_EDE_PERR_MASK)
  171. edac_pci_handle_npe(pci, pci->ctl_name);
  172. }
  173. static void mpc85xx_pcie_check(struct edac_pci_ctl_info *pci)
  174. {
  175. struct mpc85xx_pci_pdata *pdata = pci->pvt_info;
  176. u32 err_detect;
  177. err_detect = in_be32(pdata->pci_vbase + MPC85XX_PCI_ERR_DR);
  178. pr_err("PCIe error(s) detected\n");
  179. pr_err("PCIe ERR_DR register: 0x%08x\n", err_detect);
  180. pr_err("PCIe ERR_CAP_STAT register: 0x%08x\n",
  181. in_be32(pdata->pci_vbase + MPC85XX_PCI_GAS_TIMR));
  182. pr_err("PCIe ERR_CAP_R0 register: 0x%08x\n",
  183. in_be32(pdata->pci_vbase + MPC85XX_PCIE_ERR_CAP_R0));
  184. pr_err("PCIe ERR_CAP_R1 register: 0x%08x\n",
  185. in_be32(pdata->pci_vbase + MPC85XX_PCIE_ERR_CAP_R1));
  186. pr_err("PCIe ERR_CAP_R2 register: 0x%08x\n",
  187. in_be32(pdata->pci_vbase + MPC85XX_PCIE_ERR_CAP_R2));
  188. pr_err("PCIe ERR_CAP_R3 register: 0x%08x\n",
  189. in_be32(pdata->pci_vbase + MPC85XX_PCIE_ERR_CAP_R3));
  190. /* clear error bits */
  191. out_be32(pdata->pci_vbase + MPC85XX_PCI_ERR_DR, err_detect);
  192. }
  193. static int mpc85xx_pcie_find_capability(struct device_node *np)
  194. {
  195. struct pci_controller *hose;
  196. if (!np)
  197. return -EINVAL;
  198. hose = pci_find_hose_for_OF_device(np);
  199. return early_find_capability(hose, 0, 0, PCI_CAP_ID_EXP);
  200. }
  201. static irqreturn_t mpc85xx_pci_isr(int irq, void *dev_id)
  202. {
  203. struct edac_pci_ctl_info *pci = dev_id;
  204. struct mpc85xx_pci_pdata *pdata = pci->pvt_info;
  205. u32 err_detect;
  206. err_detect = in_be32(pdata->pci_vbase + MPC85XX_PCI_ERR_DR);
  207. if (!err_detect)
  208. return IRQ_NONE;
  209. if (pdata->is_pcie)
  210. mpc85xx_pcie_check(pci);
  211. else
  212. mpc85xx_pci_check(pci);
  213. return IRQ_HANDLED;
  214. }
  215. int mpc85xx_pci_err_probe(struct platform_device *op)
  216. {
  217. struct edac_pci_ctl_info *pci;
  218. struct mpc85xx_pci_pdata *pdata;
  219. struct resource r;
  220. int res = 0;
  221. if (!devres_open_group(&op->dev, mpc85xx_pci_err_probe, GFP_KERNEL))
  222. return -ENOMEM;
  223. pci = edac_pci_alloc_ctl_info(sizeof(*pdata), "mpc85xx_pci_err");
  224. if (!pci)
  225. return -ENOMEM;
  226. /* make sure error reporting method is sane */
  227. switch (edac_op_state) {
  228. case EDAC_OPSTATE_POLL:
  229. case EDAC_OPSTATE_INT:
  230. break;
  231. default:
  232. edac_op_state = EDAC_OPSTATE_INT;
  233. break;
  234. }
  235. pdata = pci->pvt_info;
  236. pdata->name = "mpc85xx_pci_err";
  237. pdata->irq = NO_IRQ;
  238. if (mpc85xx_pcie_find_capability(op->dev.of_node) > 0)
  239. pdata->is_pcie = true;
  240. dev_set_drvdata(&op->dev, pci);
  241. pci->dev = &op->dev;
  242. pci->mod_name = EDAC_MOD_STR;
  243. pci->ctl_name = pdata->name;
  244. pci->dev_name = dev_name(&op->dev);
  245. if (edac_op_state == EDAC_OPSTATE_POLL) {
  246. if (pdata->is_pcie)
  247. pci->edac_check = mpc85xx_pcie_check;
  248. else
  249. pci->edac_check = mpc85xx_pci_check;
  250. }
  251. pdata->edac_idx = edac_pci_idx++;
  252. res = of_address_to_resource(op->dev.of_node, 0, &r);
  253. if (res) {
  254. printk(KERN_ERR "%s: Unable to get resource for "
  255. "PCI err regs\n", __func__);
  256. goto err;
  257. }
  258. /* we only need the error registers */
  259. r.start += 0xe00;
  260. if (!devm_request_mem_region(&op->dev, r.start, resource_size(&r),
  261. pdata->name)) {
  262. printk(KERN_ERR "%s: Error while requesting mem region\n",
  263. __func__);
  264. res = -EBUSY;
  265. goto err;
  266. }
  267. pdata->pci_vbase = devm_ioremap(&op->dev, r.start, resource_size(&r));
  268. if (!pdata->pci_vbase) {
  269. printk(KERN_ERR "%s: Unable to setup PCI err regs\n", __func__);
  270. res = -ENOMEM;
  271. goto err;
  272. }
  273. if (pdata->is_pcie) {
  274. orig_pci_err_cap_dr =
  275. in_be32(pdata->pci_vbase + MPC85XX_PCI_ERR_ADDR);
  276. out_be32(pdata->pci_vbase + MPC85XX_PCI_ERR_ADDR, ~0);
  277. orig_pci_err_en =
  278. in_be32(pdata->pci_vbase + MPC85XX_PCI_ERR_EN);
  279. out_be32(pdata->pci_vbase + MPC85XX_PCI_ERR_EN, 0);
  280. } else {
  281. orig_pci_err_cap_dr =
  282. in_be32(pdata->pci_vbase + MPC85XX_PCI_ERR_CAP_DR);
  283. /* PCI master abort is expected during config cycles */
  284. out_be32(pdata->pci_vbase + MPC85XX_PCI_ERR_CAP_DR, 0x40);
  285. orig_pci_err_en =
  286. in_be32(pdata->pci_vbase + MPC85XX_PCI_ERR_EN);
  287. /* disable master abort reporting */
  288. out_be32(pdata->pci_vbase + MPC85XX_PCI_ERR_EN, ~0x40);
  289. }
  290. /* clear error bits */
  291. out_be32(pdata->pci_vbase + MPC85XX_PCI_ERR_DR, ~0);
  292. if (edac_pci_add_device(pci, pdata->edac_idx) > 0) {
  293. edac_dbg(3, "failed edac_pci_add_device()\n");
  294. goto err;
  295. }
  296. if (edac_op_state == EDAC_OPSTATE_INT) {
  297. pdata->irq = irq_of_parse_and_map(op->dev.of_node, 0);
  298. res = devm_request_irq(&op->dev, pdata->irq,
  299. mpc85xx_pci_isr,
  300. IRQF_SHARED,
  301. "[EDAC] PCI err", pci);
  302. if (res < 0) {
  303. printk(KERN_ERR
  304. "%s: Unable to request irq %d for "
  305. "MPC85xx PCI err\n", __func__, pdata->irq);
  306. irq_dispose_mapping(pdata->irq);
  307. res = -ENODEV;
  308. goto err2;
  309. }
  310. printk(KERN_INFO EDAC_MOD_STR " acquired irq %d for PCI Err\n",
  311. pdata->irq);
  312. }
  313. if (pdata->is_pcie) {
  314. /*
  315. * Enable all PCIe error interrupt & error detect except invalid
  316. * PEX_CONFIG_ADDR/PEX_CONFIG_DATA access interrupt generation
  317. * enable bit and invalid PEX_CONFIG_ADDR/PEX_CONFIG_DATA access
  318. * detection enable bit. Because PCIe bus code to initialize and
  319. * configure these PCIe devices on booting will use some invalid
  320. * PEX_CONFIG_ADDR/PEX_CONFIG_DATA, edac driver prints the much
  321. * notice information. So disable this detect to fix ugly print.
  322. */
  323. out_be32(pdata->pci_vbase + MPC85XX_PCI_ERR_EN, ~0
  324. & ~PEX_ERR_ICCAIE_EN_BIT);
  325. out_be32(pdata->pci_vbase + MPC85XX_PCI_ERR_ADDR, 0
  326. | PEX_ERR_ICCAD_DISR_BIT);
  327. }
  328. devres_remove_group(&op->dev, mpc85xx_pci_err_probe);
  329. edac_dbg(3, "success\n");
  330. printk(KERN_INFO EDAC_MOD_STR " PCI err registered\n");
  331. return 0;
  332. err2:
  333. edac_pci_del_device(&op->dev);
  334. err:
  335. edac_pci_free_ctl_info(pci);
  336. devres_release_group(&op->dev, mpc85xx_pci_err_probe);
  337. return res;
  338. }
  339. EXPORT_SYMBOL(mpc85xx_pci_err_probe);
  340. #endif /* CONFIG_PCI */
  341. /**************************** L2 Err device ***************************/
  342. /************************ L2 SYSFS parts ***********************************/
  343. static ssize_t mpc85xx_l2_inject_data_hi_show(struct edac_device_ctl_info
  344. *edac_dev, char *data)
  345. {
  346. struct mpc85xx_l2_pdata *pdata = edac_dev->pvt_info;
  347. return sprintf(data, "0x%08x",
  348. in_be32(pdata->l2_vbase + MPC85XX_L2_ERRINJHI));
  349. }
  350. static ssize_t mpc85xx_l2_inject_data_lo_show(struct edac_device_ctl_info
  351. *edac_dev, char *data)
  352. {
  353. struct mpc85xx_l2_pdata *pdata = edac_dev->pvt_info;
  354. return sprintf(data, "0x%08x",
  355. in_be32(pdata->l2_vbase + MPC85XX_L2_ERRINJLO));
  356. }
  357. static ssize_t mpc85xx_l2_inject_ctrl_show(struct edac_device_ctl_info
  358. *edac_dev, char *data)
  359. {
  360. struct mpc85xx_l2_pdata *pdata = edac_dev->pvt_info;
  361. return sprintf(data, "0x%08x",
  362. in_be32(pdata->l2_vbase + MPC85XX_L2_ERRINJCTL));
  363. }
  364. static ssize_t mpc85xx_l2_inject_data_hi_store(struct edac_device_ctl_info
  365. *edac_dev, const char *data,
  366. size_t count)
  367. {
  368. struct mpc85xx_l2_pdata *pdata = edac_dev->pvt_info;
  369. if (isdigit(*data)) {
  370. out_be32(pdata->l2_vbase + MPC85XX_L2_ERRINJHI,
  371. simple_strtoul(data, NULL, 0));
  372. return count;
  373. }
  374. return 0;
  375. }
  376. static ssize_t mpc85xx_l2_inject_data_lo_store(struct edac_device_ctl_info
  377. *edac_dev, const char *data,
  378. size_t count)
  379. {
  380. struct mpc85xx_l2_pdata *pdata = edac_dev->pvt_info;
  381. if (isdigit(*data)) {
  382. out_be32(pdata->l2_vbase + MPC85XX_L2_ERRINJLO,
  383. simple_strtoul(data, NULL, 0));
  384. return count;
  385. }
  386. return 0;
  387. }
  388. static ssize_t mpc85xx_l2_inject_ctrl_store(struct edac_device_ctl_info
  389. *edac_dev, const char *data,
  390. size_t count)
  391. {
  392. struct mpc85xx_l2_pdata *pdata = edac_dev->pvt_info;
  393. if (isdigit(*data)) {
  394. out_be32(pdata->l2_vbase + MPC85XX_L2_ERRINJCTL,
  395. simple_strtoul(data, NULL, 0));
  396. return count;
  397. }
  398. return 0;
  399. }
  400. static struct edac_dev_sysfs_attribute mpc85xx_l2_sysfs_attributes[] = {
  401. {
  402. .attr = {
  403. .name = "inject_data_hi",
  404. .mode = (S_IRUGO | S_IWUSR)
  405. },
  406. .show = mpc85xx_l2_inject_data_hi_show,
  407. .store = mpc85xx_l2_inject_data_hi_store},
  408. {
  409. .attr = {
  410. .name = "inject_data_lo",
  411. .mode = (S_IRUGO | S_IWUSR)
  412. },
  413. .show = mpc85xx_l2_inject_data_lo_show,
  414. .store = mpc85xx_l2_inject_data_lo_store},
  415. {
  416. .attr = {
  417. .name = "inject_ctrl",
  418. .mode = (S_IRUGO | S_IWUSR)
  419. },
  420. .show = mpc85xx_l2_inject_ctrl_show,
  421. .store = mpc85xx_l2_inject_ctrl_store},
  422. /* End of list */
  423. {
  424. .attr = {.name = NULL}
  425. }
  426. };
  427. static void mpc85xx_set_l2_sysfs_attributes(struct edac_device_ctl_info
  428. *edac_dev)
  429. {
  430. edac_dev->sysfs_attributes = mpc85xx_l2_sysfs_attributes;
  431. }
  432. /***************************** L2 ops ***********************************/
  433. static void mpc85xx_l2_check(struct edac_device_ctl_info *edac_dev)
  434. {
  435. struct mpc85xx_l2_pdata *pdata = edac_dev->pvt_info;
  436. u32 err_detect;
  437. err_detect = in_be32(pdata->l2_vbase + MPC85XX_L2_ERRDET);
  438. if (!(err_detect & L2_EDE_MASK))
  439. return;
  440. printk(KERN_ERR "ECC Error in CPU L2 cache\n");
  441. printk(KERN_ERR "L2 Error Detect Register: 0x%08x\n", err_detect);
  442. printk(KERN_ERR "L2 Error Capture Data High Register: 0x%08x\n",
  443. in_be32(pdata->l2_vbase + MPC85XX_L2_CAPTDATAHI));
  444. printk(KERN_ERR "L2 Error Capture Data Lo Register: 0x%08x\n",
  445. in_be32(pdata->l2_vbase + MPC85XX_L2_CAPTDATALO));
  446. printk(KERN_ERR "L2 Error Syndrome Register: 0x%08x\n",
  447. in_be32(pdata->l2_vbase + MPC85XX_L2_CAPTECC));
  448. printk(KERN_ERR "L2 Error Attributes Capture Register: 0x%08x\n",
  449. in_be32(pdata->l2_vbase + MPC85XX_L2_ERRATTR));
  450. printk(KERN_ERR "L2 Error Address Capture Register: 0x%08x\n",
  451. in_be32(pdata->l2_vbase + MPC85XX_L2_ERRADDR));
  452. /* clear error detect register */
  453. out_be32(pdata->l2_vbase + MPC85XX_L2_ERRDET, err_detect);
  454. if (err_detect & L2_EDE_CE_MASK)
  455. edac_device_handle_ce(edac_dev, 0, 0, edac_dev->ctl_name);
  456. if (err_detect & L2_EDE_UE_MASK)
  457. edac_device_handle_ue(edac_dev, 0, 0, edac_dev->ctl_name);
  458. }
  459. static irqreturn_t mpc85xx_l2_isr(int irq, void *dev_id)
  460. {
  461. struct edac_device_ctl_info *edac_dev = dev_id;
  462. struct mpc85xx_l2_pdata *pdata = edac_dev->pvt_info;
  463. u32 err_detect;
  464. err_detect = in_be32(pdata->l2_vbase + MPC85XX_L2_ERRDET);
  465. if (!(err_detect & L2_EDE_MASK))
  466. return IRQ_NONE;
  467. mpc85xx_l2_check(edac_dev);
  468. return IRQ_HANDLED;
  469. }
  470. static int mpc85xx_l2_err_probe(struct platform_device *op)
  471. {
  472. struct edac_device_ctl_info *edac_dev;
  473. struct mpc85xx_l2_pdata *pdata;
  474. struct resource r;
  475. int res;
  476. if (!devres_open_group(&op->dev, mpc85xx_l2_err_probe, GFP_KERNEL))
  477. return -ENOMEM;
  478. edac_dev = edac_device_alloc_ctl_info(sizeof(*pdata),
  479. "cpu", 1, "L", 1, 2, NULL, 0,
  480. edac_dev_idx);
  481. if (!edac_dev) {
  482. devres_release_group(&op->dev, mpc85xx_l2_err_probe);
  483. return -ENOMEM;
  484. }
  485. pdata = edac_dev->pvt_info;
  486. pdata->name = "mpc85xx_l2_err";
  487. pdata->irq = NO_IRQ;
  488. edac_dev->dev = &op->dev;
  489. dev_set_drvdata(edac_dev->dev, edac_dev);
  490. edac_dev->ctl_name = pdata->name;
  491. edac_dev->dev_name = pdata->name;
  492. res = of_address_to_resource(op->dev.of_node, 0, &r);
  493. if (res) {
  494. printk(KERN_ERR "%s: Unable to get resource for "
  495. "L2 err regs\n", __func__);
  496. goto err;
  497. }
  498. /* we only need the error registers */
  499. r.start += 0xe00;
  500. if (!devm_request_mem_region(&op->dev, r.start, resource_size(&r),
  501. pdata->name)) {
  502. printk(KERN_ERR "%s: Error while requesting mem region\n",
  503. __func__);
  504. res = -EBUSY;
  505. goto err;
  506. }
  507. pdata->l2_vbase = devm_ioremap(&op->dev, r.start, resource_size(&r));
  508. if (!pdata->l2_vbase) {
  509. printk(KERN_ERR "%s: Unable to setup L2 err regs\n", __func__);
  510. res = -ENOMEM;
  511. goto err;
  512. }
  513. out_be32(pdata->l2_vbase + MPC85XX_L2_ERRDET, ~0);
  514. orig_l2_err_disable = in_be32(pdata->l2_vbase + MPC85XX_L2_ERRDIS);
  515. /* clear the err_dis */
  516. out_be32(pdata->l2_vbase + MPC85XX_L2_ERRDIS, 0);
  517. edac_dev->mod_name = EDAC_MOD_STR;
  518. if (edac_op_state == EDAC_OPSTATE_POLL)
  519. edac_dev->edac_check = mpc85xx_l2_check;
  520. mpc85xx_set_l2_sysfs_attributes(edac_dev);
  521. pdata->edac_idx = edac_dev_idx++;
  522. if (edac_device_add_device(edac_dev) > 0) {
  523. edac_dbg(3, "failed edac_device_add_device()\n");
  524. goto err;
  525. }
  526. if (edac_op_state == EDAC_OPSTATE_INT) {
  527. pdata->irq = irq_of_parse_and_map(op->dev.of_node, 0);
  528. res = devm_request_irq(&op->dev, pdata->irq,
  529. mpc85xx_l2_isr, 0,
  530. "[EDAC] L2 err", edac_dev);
  531. if (res < 0) {
  532. printk(KERN_ERR
  533. "%s: Unable to request irq %d for "
  534. "MPC85xx L2 err\n", __func__, pdata->irq);
  535. irq_dispose_mapping(pdata->irq);
  536. res = -ENODEV;
  537. goto err2;
  538. }
  539. printk(KERN_INFO EDAC_MOD_STR " acquired irq %d for L2 Err\n",
  540. pdata->irq);
  541. edac_dev->op_state = OP_RUNNING_INTERRUPT;
  542. out_be32(pdata->l2_vbase + MPC85XX_L2_ERRINTEN, L2_EIE_MASK);
  543. }
  544. devres_remove_group(&op->dev, mpc85xx_l2_err_probe);
  545. edac_dbg(3, "success\n");
  546. printk(KERN_INFO EDAC_MOD_STR " L2 err registered\n");
  547. return 0;
  548. err2:
  549. edac_device_del_device(&op->dev);
  550. err:
  551. devres_release_group(&op->dev, mpc85xx_l2_err_probe);
  552. edac_device_free_ctl_info(edac_dev);
  553. return res;
  554. }
  555. static int mpc85xx_l2_err_remove(struct platform_device *op)
  556. {
  557. struct edac_device_ctl_info *edac_dev = dev_get_drvdata(&op->dev);
  558. struct mpc85xx_l2_pdata *pdata = edac_dev->pvt_info;
  559. edac_dbg(0, "\n");
  560. if (edac_op_state == EDAC_OPSTATE_INT) {
  561. out_be32(pdata->l2_vbase + MPC85XX_L2_ERRINTEN, 0);
  562. irq_dispose_mapping(pdata->irq);
  563. }
  564. out_be32(pdata->l2_vbase + MPC85XX_L2_ERRDIS, orig_l2_err_disable);
  565. edac_device_del_device(&op->dev);
  566. edac_device_free_ctl_info(edac_dev);
  567. return 0;
  568. }
  569. static struct of_device_id mpc85xx_l2_err_of_match[] = {
  570. /* deprecate the fsl,85.. forms in the future, 2.6.30? */
  571. { .compatible = "fsl,8540-l2-cache-controller", },
  572. { .compatible = "fsl,8541-l2-cache-controller", },
  573. { .compatible = "fsl,8544-l2-cache-controller", },
  574. { .compatible = "fsl,8548-l2-cache-controller", },
  575. { .compatible = "fsl,8555-l2-cache-controller", },
  576. { .compatible = "fsl,8568-l2-cache-controller", },
  577. { .compatible = "fsl,mpc8536-l2-cache-controller", },
  578. { .compatible = "fsl,mpc8540-l2-cache-controller", },
  579. { .compatible = "fsl,mpc8541-l2-cache-controller", },
  580. { .compatible = "fsl,mpc8544-l2-cache-controller", },
  581. { .compatible = "fsl,mpc8548-l2-cache-controller", },
  582. { .compatible = "fsl,mpc8555-l2-cache-controller", },
  583. { .compatible = "fsl,mpc8560-l2-cache-controller", },
  584. { .compatible = "fsl,mpc8568-l2-cache-controller", },
  585. { .compatible = "fsl,mpc8569-l2-cache-controller", },
  586. { .compatible = "fsl,mpc8572-l2-cache-controller", },
  587. { .compatible = "fsl,p1020-l2-cache-controller", },
  588. { .compatible = "fsl,p1021-l2-cache-controller", },
  589. { .compatible = "fsl,p2020-l2-cache-controller", },
  590. {},
  591. };
  592. MODULE_DEVICE_TABLE(of, mpc85xx_l2_err_of_match);
  593. static struct platform_driver mpc85xx_l2_err_driver = {
  594. .probe = mpc85xx_l2_err_probe,
  595. .remove = mpc85xx_l2_err_remove,
  596. .driver = {
  597. .name = "mpc85xx_l2_err",
  598. .owner = THIS_MODULE,
  599. .of_match_table = mpc85xx_l2_err_of_match,
  600. },
  601. };
  602. /**************************** MC Err device ***************************/
  603. /*
  604. * Taken from table 8-55 in the MPC8641 User's Manual and/or 9-61 in the
  605. * MPC8572 User's Manual. Each line represents a syndrome bit column as a
  606. * 64-bit value, but split into an upper and lower 32-bit chunk. The labels
  607. * below correspond to Freescale's manuals.
  608. */
  609. static unsigned int ecc_table[16] = {
  610. /* MSB LSB */
  611. /* [0:31] [32:63] */
  612. 0xf00fe11e, 0xc33c0ff7, /* Syndrome bit 7 */
  613. 0x00ff00ff, 0x00fff0ff,
  614. 0x0f0f0f0f, 0x0f0fff00,
  615. 0x11113333, 0x7777000f,
  616. 0x22224444, 0x8888222f,
  617. 0x44448888, 0xffff4441,
  618. 0x8888ffff, 0x11118882,
  619. 0xffff1111, 0x22221114, /* Syndrome bit 0 */
  620. };
  621. /*
  622. * Calculate the correct ECC value for a 64-bit value specified by high:low
  623. */
  624. static u8 calculate_ecc(u32 high, u32 low)
  625. {
  626. u32 mask_low;
  627. u32 mask_high;
  628. int bit_cnt;
  629. u8 ecc = 0;
  630. int i;
  631. int j;
  632. for (i = 0; i < 8; i++) {
  633. mask_high = ecc_table[i * 2];
  634. mask_low = ecc_table[i * 2 + 1];
  635. bit_cnt = 0;
  636. for (j = 0; j < 32; j++) {
  637. if ((mask_high >> j) & 1)
  638. bit_cnt ^= (high >> j) & 1;
  639. if ((mask_low >> j) & 1)
  640. bit_cnt ^= (low >> j) & 1;
  641. }
  642. ecc |= bit_cnt << i;
  643. }
  644. return ecc;
  645. }
  646. /*
  647. * Create the syndrome code which is generated if the data line specified by
  648. * 'bit' failed. Eg generate an 8-bit codes seen in Table 8-55 in the MPC8641
  649. * User's Manual and 9-61 in the MPC8572 User's Manual.
  650. */
  651. static u8 syndrome_from_bit(unsigned int bit) {
  652. int i;
  653. u8 syndrome = 0;
  654. /*
  655. * Cycle through the upper or lower 32-bit portion of each value in
  656. * ecc_table depending on if 'bit' is in the upper or lower half of
  657. * 64-bit data.
  658. */
  659. for (i = bit < 32; i < 16; i += 2)
  660. syndrome |= ((ecc_table[i] >> (bit % 32)) & 1) << (i / 2);
  661. return syndrome;
  662. }
  663. /*
  664. * Decode data and ecc syndrome to determine what went wrong
  665. * Note: This can only decode single-bit errors
  666. */
  667. static void sbe_ecc_decode(u32 cap_high, u32 cap_low, u32 cap_ecc,
  668. int *bad_data_bit, int *bad_ecc_bit)
  669. {
  670. int i;
  671. u8 syndrome;
  672. *bad_data_bit = -1;
  673. *bad_ecc_bit = -1;
  674. /*
  675. * Calculate the ECC of the captured data and XOR it with the captured
  676. * ECC to find an ECC syndrome value we can search for
  677. */
  678. syndrome = calculate_ecc(cap_high, cap_low) ^ cap_ecc;
  679. /* Check if a data line is stuck... */
  680. for (i = 0; i < 64; i++) {
  681. if (syndrome == syndrome_from_bit(i)) {
  682. *bad_data_bit = i;
  683. return;
  684. }
  685. }
  686. /* If data is correct, check ECC bits for errors... */
  687. for (i = 0; i < 8; i++) {
  688. if ((syndrome >> i) & 0x1) {
  689. *bad_ecc_bit = i;
  690. return;
  691. }
  692. }
  693. }
  694. static void mpc85xx_mc_check(struct mem_ctl_info *mci)
  695. {
  696. struct mpc85xx_mc_pdata *pdata = mci->pvt_info;
  697. struct csrow_info *csrow;
  698. u32 bus_width;
  699. u32 err_detect;
  700. u32 syndrome;
  701. u32 err_addr;
  702. u32 pfn;
  703. int row_index;
  704. u32 cap_high;
  705. u32 cap_low;
  706. int bad_data_bit;
  707. int bad_ecc_bit;
  708. err_detect = in_be32(pdata->mc_vbase + MPC85XX_MC_ERR_DETECT);
  709. if (!err_detect)
  710. return;
  711. mpc85xx_mc_printk(mci, KERN_ERR, "Err Detect Register: %#8.8x\n",
  712. err_detect);
  713. /* no more processing if not ECC bit errors */
  714. if (!(err_detect & (DDR_EDE_SBE | DDR_EDE_MBE))) {
  715. out_be32(pdata->mc_vbase + MPC85XX_MC_ERR_DETECT, err_detect);
  716. return;
  717. }
  718. syndrome = in_be32(pdata->mc_vbase + MPC85XX_MC_CAPTURE_ECC);
  719. /* Mask off appropriate bits of syndrome based on bus width */
  720. bus_width = (in_be32(pdata->mc_vbase + MPC85XX_MC_DDR_SDRAM_CFG) &
  721. DSC_DBW_MASK) ? 32 : 64;
  722. if (bus_width == 64)
  723. syndrome &= 0xff;
  724. else
  725. syndrome &= 0xffff;
  726. err_addr = in_be32(pdata->mc_vbase + MPC85XX_MC_CAPTURE_ADDRESS);
  727. pfn = err_addr >> PAGE_SHIFT;
  728. for (row_index = 0; row_index < mci->nr_csrows; row_index++) {
  729. csrow = mci->csrows[row_index];
  730. if ((pfn >= csrow->first_page) && (pfn <= csrow->last_page))
  731. break;
  732. }
  733. cap_high = in_be32(pdata->mc_vbase + MPC85XX_MC_CAPTURE_DATA_HI);
  734. cap_low = in_be32(pdata->mc_vbase + MPC85XX_MC_CAPTURE_DATA_LO);
  735. /*
  736. * Analyze single-bit errors on 64-bit wide buses
  737. * TODO: Add support for 32-bit wide buses
  738. */
  739. if ((err_detect & DDR_EDE_SBE) && (bus_width == 64)) {
  740. sbe_ecc_decode(cap_high, cap_low, syndrome,
  741. &bad_data_bit, &bad_ecc_bit);
  742. if (bad_data_bit != -1)
  743. mpc85xx_mc_printk(mci, KERN_ERR,
  744. "Faulty Data bit: %d\n", bad_data_bit);
  745. if (bad_ecc_bit != -1)
  746. mpc85xx_mc_printk(mci, KERN_ERR,
  747. "Faulty ECC bit: %d\n", bad_ecc_bit);
  748. mpc85xx_mc_printk(mci, KERN_ERR,
  749. "Expected Data / ECC:\t%#8.8x_%08x / %#2.2x\n",
  750. cap_high ^ (1 << (bad_data_bit - 32)),
  751. cap_low ^ (1 << bad_data_bit),
  752. syndrome ^ (1 << bad_ecc_bit));
  753. }
  754. mpc85xx_mc_printk(mci, KERN_ERR,
  755. "Captured Data / ECC:\t%#8.8x_%08x / %#2.2x\n",
  756. cap_high, cap_low, syndrome);
  757. mpc85xx_mc_printk(mci, KERN_ERR, "Err addr: %#8.8x\n", err_addr);
  758. mpc85xx_mc_printk(mci, KERN_ERR, "PFN: %#8.8x\n", pfn);
  759. /* we are out of range */
  760. if (row_index == mci->nr_csrows)
  761. mpc85xx_mc_printk(mci, KERN_ERR, "PFN out of range!\n");
  762. if (err_detect & DDR_EDE_SBE)
  763. edac_mc_handle_error(HW_EVENT_ERR_CORRECTED, mci, 1,
  764. pfn, err_addr & ~PAGE_MASK, syndrome,
  765. row_index, 0, -1,
  766. mci->ctl_name, "");
  767. if (err_detect & DDR_EDE_MBE)
  768. edac_mc_handle_error(HW_EVENT_ERR_UNCORRECTED, mci, 1,
  769. pfn, err_addr & ~PAGE_MASK, syndrome,
  770. row_index, 0, -1,
  771. mci->ctl_name, "");
  772. out_be32(pdata->mc_vbase + MPC85XX_MC_ERR_DETECT, err_detect);
  773. }
  774. static irqreturn_t mpc85xx_mc_isr(int irq, void *dev_id)
  775. {
  776. struct mem_ctl_info *mci = dev_id;
  777. struct mpc85xx_mc_pdata *pdata = mci->pvt_info;
  778. u32 err_detect;
  779. err_detect = in_be32(pdata->mc_vbase + MPC85XX_MC_ERR_DETECT);
  780. if (!err_detect)
  781. return IRQ_NONE;
  782. mpc85xx_mc_check(mci);
  783. return IRQ_HANDLED;
  784. }
  785. static void mpc85xx_init_csrows(struct mem_ctl_info *mci)
  786. {
  787. struct mpc85xx_mc_pdata *pdata = mci->pvt_info;
  788. struct csrow_info *csrow;
  789. struct dimm_info *dimm;
  790. u32 sdram_ctl;
  791. u32 sdtype;
  792. enum mem_type mtype;
  793. u32 cs_bnds;
  794. int index;
  795. sdram_ctl = in_be32(pdata->mc_vbase + MPC85XX_MC_DDR_SDRAM_CFG);
  796. sdtype = sdram_ctl & DSC_SDTYPE_MASK;
  797. if (sdram_ctl & DSC_RD_EN) {
  798. switch (sdtype) {
  799. case DSC_SDTYPE_DDR:
  800. mtype = MEM_RDDR;
  801. break;
  802. case DSC_SDTYPE_DDR2:
  803. mtype = MEM_RDDR2;
  804. break;
  805. case DSC_SDTYPE_DDR3:
  806. mtype = MEM_RDDR3;
  807. break;
  808. default:
  809. mtype = MEM_UNKNOWN;
  810. break;
  811. }
  812. } else {
  813. switch (sdtype) {
  814. case DSC_SDTYPE_DDR:
  815. mtype = MEM_DDR;
  816. break;
  817. case DSC_SDTYPE_DDR2:
  818. mtype = MEM_DDR2;
  819. break;
  820. case DSC_SDTYPE_DDR3:
  821. mtype = MEM_DDR3;
  822. break;
  823. default:
  824. mtype = MEM_UNKNOWN;
  825. break;
  826. }
  827. }
  828. for (index = 0; index < mci->nr_csrows; index++) {
  829. u32 start;
  830. u32 end;
  831. csrow = mci->csrows[index];
  832. dimm = csrow->channels[0]->dimm;
  833. cs_bnds = in_be32(pdata->mc_vbase + MPC85XX_MC_CS_BNDS_0 +
  834. (index * MPC85XX_MC_CS_BNDS_OFS));
  835. start = (cs_bnds & 0xffff0000) >> 16;
  836. end = (cs_bnds & 0x0000ffff);
  837. if (start == end)
  838. continue; /* not populated */
  839. start <<= (24 - PAGE_SHIFT);
  840. end <<= (24 - PAGE_SHIFT);
  841. end |= (1 << (24 - PAGE_SHIFT)) - 1;
  842. csrow->first_page = start;
  843. csrow->last_page = end;
  844. dimm->nr_pages = end + 1 - start;
  845. dimm->grain = 8;
  846. dimm->mtype = mtype;
  847. dimm->dtype = DEV_UNKNOWN;
  848. if (sdram_ctl & DSC_X32_EN)
  849. dimm->dtype = DEV_X32;
  850. dimm->edac_mode = EDAC_SECDED;
  851. }
  852. }
  853. static int mpc85xx_mc_err_probe(struct platform_device *op)
  854. {
  855. struct mem_ctl_info *mci;
  856. struct edac_mc_layer layers[2];
  857. struct mpc85xx_mc_pdata *pdata;
  858. struct resource r;
  859. u32 sdram_ctl;
  860. int res;
  861. if (!devres_open_group(&op->dev, mpc85xx_mc_err_probe, GFP_KERNEL))
  862. return -ENOMEM;
  863. layers[0].type = EDAC_MC_LAYER_CHIP_SELECT;
  864. layers[0].size = 4;
  865. layers[0].is_virt_csrow = true;
  866. layers[1].type = EDAC_MC_LAYER_CHANNEL;
  867. layers[1].size = 1;
  868. layers[1].is_virt_csrow = false;
  869. mci = edac_mc_alloc(edac_mc_idx, ARRAY_SIZE(layers), layers,
  870. sizeof(*pdata));
  871. if (!mci) {
  872. devres_release_group(&op->dev, mpc85xx_mc_err_probe);
  873. return -ENOMEM;
  874. }
  875. pdata = mci->pvt_info;
  876. pdata->name = "mpc85xx_mc_err";
  877. pdata->irq = NO_IRQ;
  878. mci->pdev = &op->dev;
  879. pdata->edac_idx = edac_mc_idx++;
  880. dev_set_drvdata(mci->pdev, mci);
  881. mci->ctl_name = pdata->name;
  882. mci->dev_name = pdata->name;
  883. res = of_address_to_resource(op->dev.of_node, 0, &r);
  884. if (res) {
  885. printk(KERN_ERR "%s: Unable to get resource for MC err regs\n",
  886. __func__);
  887. goto err;
  888. }
  889. if (!devm_request_mem_region(&op->dev, r.start, resource_size(&r),
  890. pdata->name)) {
  891. printk(KERN_ERR "%s: Error while requesting mem region\n",
  892. __func__);
  893. res = -EBUSY;
  894. goto err;
  895. }
  896. pdata->mc_vbase = devm_ioremap(&op->dev, r.start, resource_size(&r));
  897. if (!pdata->mc_vbase) {
  898. printk(KERN_ERR "%s: Unable to setup MC err regs\n", __func__);
  899. res = -ENOMEM;
  900. goto err;
  901. }
  902. sdram_ctl = in_be32(pdata->mc_vbase + MPC85XX_MC_DDR_SDRAM_CFG);
  903. if (!(sdram_ctl & DSC_ECC_EN)) {
  904. /* no ECC */
  905. printk(KERN_WARNING "%s: No ECC DIMMs discovered\n", __func__);
  906. res = -ENODEV;
  907. goto err;
  908. }
  909. edac_dbg(3, "init mci\n");
  910. mci->mtype_cap = MEM_FLAG_RDDR | MEM_FLAG_RDDR2 |
  911. MEM_FLAG_DDR | MEM_FLAG_DDR2;
  912. mci->edac_ctl_cap = EDAC_FLAG_NONE | EDAC_FLAG_SECDED;
  913. mci->edac_cap = EDAC_FLAG_SECDED;
  914. mci->mod_name = EDAC_MOD_STR;
  915. mci->mod_ver = MPC85XX_REVISION;
  916. if (edac_op_state == EDAC_OPSTATE_POLL)
  917. mci->edac_check = mpc85xx_mc_check;
  918. mci->ctl_page_to_phys = NULL;
  919. mci->scrub_mode = SCRUB_SW_SRC;
  920. mpc85xx_init_csrows(mci);
  921. /* store the original error disable bits */
  922. orig_ddr_err_disable =
  923. in_be32(pdata->mc_vbase + MPC85XX_MC_ERR_DISABLE);
  924. out_be32(pdata->mc_vbase + MPC85XX_MC_ERR_DISABLE, 0);
  925. /* clear all error bits */
  926. out_be32(pdata->mc_vbase + MPC85XX_MC_ERR_DETECT, ~0);
  927. if (edac_mc_add_mc(mci)) {
  928. edac_dbg(3, "failed edac_mc_add_mc()\n");
  929. goto err;
  930. }
  931. if (mpc85xx_create_sysfs_attributes(mci)) {
  932. edac_mc_del_mc(mci->pdev);
  933. edac_dbg(3, "failed edac_mc_add_mc()\n");
  934. goto err;
  935. }
  936. if (edac_op_state == EDAC_OPSTATE_INT) {
  937. out_be32(pdata->mc_vbase + MPC85XX_MC_ERR_INT_EN,
  938. DDR_EIE_MBEE | DDR_EIE_SBEE);
  939. /* store the original error management threshold */
  940. orig_ddr_err_sbe = in_be32(pdata->mc_vbase +
  941. MPC85XX_MC_ERR_SBE) & 0xff0000;
  942. /* set threshold to 1 error per interrupt */
  943. out_be32(pdata->mc_vbase + MPC85XX_MC_ERR_SBE, 0x10000);
  944. /* register interrupts */
  945. pdata->irq = irq_of_parse_and_map(op->dev.of_node, 0);
  946. res = devm_request_irq(&op->dev, pdata->irq,
  947. mpc85xx_mc_isr,
  948. IRQF_SHARED,
  949. "[EDAC] MC err", mci);
  950. if (res < 0) {
  951. printk(KERN_ERR "%s: Unable to request irq %d for "
  952. "MPC85xx DRAM ERR\n", __func__, pdata->irq);
  953. irq_dispose_mapping(pdata->irq);
  954. res = -ENODEV;
  955. goto err2;
  956. }
  957. printk(KERN_INFO EDAC_MOD_STR " acquired irq %d for MC\n",
  958. pdata->irq);
  959. }
  960. devres_remove_group(&op->dev, mpc85xx_mc_err_probe);
  961. edac_dbg(3, "success\n");
  962. printk(KERN_INFO EDAC_MOD_STR " MC err registered\n");
  963. return 0;
  964. err2:
  965. edac_mc_del_mc(&op->dev);
  966. err:
  967. devres_release_group(&op->dev, mpc85xx_mc_err_probe);
  968. edac_mc_free(mci);
  969. return res;
  970. }
  971. static int mpc85xx_mc_err_remove(struct platform_device *op)
  972. {
  973. struct mem_ctl_info *mci = dev_get_drvdata(&op->dev);
  974. struct mpc85xx_mc_pdata *pdata = mci->pvt_info;
  975. edac_dbg(0, "\n");
  976. if (edac_op_state == EDAC_OPSTATE_INT) {
  977. out_be32(pdata->mc_vbase + MPC85XX_MC_ERR_INT_EN, 0);
  978. irq_dispose_mapping(pdata->irq);
  979. }
  980. out_be32(pdata->mc_vbase + MPC85XX_MC_ERR_DISABLE,
  981. orig_ddr_err_disable);
  982. out_be32(pdata->mc_vbase + MPC85XX_MC_ERR_SBE, orig_ddr_err_sbe);
  983. mpc85xx_remove_sysfs_attributes(mci);
  984. edac_mc_del_mc(&op->dev);
  985. edac_mc_free(mci);
  986. return 0;
  987. }
  988. static struct of_device_id mpc85xx_mc_err_of_match[] = {
  989. /* deprecate the fsl,85.. forms in the future, 2.6.30? */
  990. { .compatible = "fsl,8540-memory-controller", },
  991. { .compatible = "fsl,8541-memory-controller", },
  992. { .compatible = "fsl,8544-memory-controller", },
  993. { .compatible = "fsl,8548-memory-controller", },
  994. { .compatible = "fsl,8555-memory-controller", },
  995. { .compatible = "fsl,8568-memory-controller", },
  996. { .compatible = "fsl,mpc8536-memory-controller", },
  997. { .compatible = "fsl,mpc8540-memory-controller", },
  998. { .compatible = "fsl,mpc8541-memory-controller", },
  999. { .compatible = "fsl,mpc8544-memory-controller", },
  1000. { .compatible = "fsl,mpc8548-memory-controller", },
  1001. { .compatible = "fsl,mpc8555-memory-controller", },
  1002. { .compatible = "fsl,mpc8560-memory-controller", },
  1003. { .compatible = "fsl,mpc8568-memory-controller", },
  1004. { .compatible = "fsl,mpc8569-memory-controller", },
  1005. { .compatible = "fsl,mpc8572-memory-controller", },
  1006. { .compatible = "fsl,mpc8349-memory-controller", },
  1007. { .compatible = "fsl,p1020-memory-controller", },
  1008. { .compatible = "fsl,p1021-memory-controller", },
  1009. { .compatible = "fsl,p2020-memory-controller", },
  1010. { .compatible = "fsl,qoriq-memory-controller", },
  1011. {},
  1012. };
  1013. MODULE_DEVICE_TABLE(of, mpc85xx_mc_err_of_match);
  1014. static struct platform_driver mpc85xx_mc_err_driver = {
  1015. .probe = mpc85xx_mc_err_probe,
  1016. .remove = mpc85xx_mc_err_remove,
  1017. .driver = {
  1018. .name = "mpc85xx_mc_err",
  1019. .owner = THIS_MODULE,
  1020. .of_match_table = mpc85xx_mc_err_of_match,
  1021. },
  1022. };
  1023. #ifdef CONFIG_FSL_SOC_BOOKE
  1024. static void __init mpc85xx_mc_clear_rfxe(void *data)
  1025. {
  1026. orig_hid1[smp_processor_id()] = mfspr(SPRN_HID1);
  1027. mtspr(SPRN_HID1, (orig_hid1[smp_processor_id()] & ~HID1_RFXE));
  1028. }
  1029. #endif
  1030. static int __init mpc85xx_mc_init(void)
  1031. {
  1032. int res = 0;
  1033. u32 pvr = 0;
  1034. printk(KERN_INFO "Freescale(R) MPC85xx EDAC driver, "
  1035. "(C) 2006 Montavista Software\n");
  1036. /* make sure error reporting method is sane */
  1037. switch (edac_op_state) {
  1038. case EDAC_OPSTATE_POLL:
  1039. case EDAC_OPSTATE_INT:
  1040. break;
  1041. default:
  1042. edac_op_state = EDAC_OPSTATE_INT;
  1043. break;
  1044. }
  1045. res = platform_driver_register(&mpc85xx_mc_err_driver);
  1046. if (res)
  1047. printk(KERN_WARNING EDAC_MOD_STR "MC fails to register\n");
  1048. res = platform_driver_register(&mpc85xx_l2_err_driver);
  1049. if (res)
  1050. printk(KERN_WARNING EDAC_MOD_STR "L2 fails to register\n");
  1051. #ifdef CONFIG_FSL_SOC_BOOKE
  1052. pvr = mfspr(SPRN_PVR);
  1053. if ((PVR_VER(pvr) == PVR_VER_E500V1) ||
  1054. (PVR_VER(pvr) == PVR_VER_E500V2)) {
  1055. /*
  1056. * need to clear HID1[RFXE] to disable machine check int
  1057. * so we can catch it
  1058. */
  1059. if (edac_op_state == EDAC_OPSTATE_INT)
  1060. on_each_cpu(mpc85xx_mc_clear_rfxe, NULL, 0);
  1061. }
  1062. #endif
  1063. return 0;
  1064. }
  1065. module_init(mpc85xx_mc_init);
  1066. #ifdef CONFIG_FSL_SOC_BOOKE
  1067. static void __exit mpc85xx_mc_restore_hid1(void *data)
  1068. {
  1069. mtspr(SPRN_HID1, orig_hid1[smp_processor_id()]);
  1070. }
  1071. #endif
  1072. static void __exit mpc85xx_mc_exit(void)
  1073. {
  1074. #ifdef CONFIG_FSL_SOC_BOOKE
  1075. u32 pvr = mfspr(SPRN_PVR);
  1076. if ((PVR_VER(pvr) == PVR_VER_E500V1) ||
  1077. (PVR_VER(pvr) == PVR_VER_E500V2)) {
  1078. on_each_cpu(mpc85xx_mc_restore_hid1, NULL, 0);
  1079. }
  1080. #endif
  1081. platform_driver_unregister(&mpc85xx_l2_err_driver);
  1082. platform_driver_unregister(&mpc85xx_mc_err_driver);
  1083. }
  1084. module_exit(mpc85xx_mc_exit);
  1085. MODULE_LICENSE("GPL");
  1086. MODULE_AUTHOR("Montavista Software, Inc.");
  1087. module_param(edac_op_state, int, 0444);
  1088. MODULE_PARM_DESC(edac_op_state,
  1089. "EDAC Error Reporting state: 0=Poll, 2=Interrupt");