altera_edac.c 60 KB

12345678910111213141516171819202122232425262728293031323334353637383940414243444546474849505152535455565758596061626364656667686970717273747576777879808182838485868788899091929394959697989910010110210310410510610710810911011111211311411511611711811912012112212312412512612712812913013113213313413513613713813914014114214314414514614714814915015115215315415515615715815916016116216316416516616716816917017117217317417517617717817918018118218318418518618718818919019119219319419519619719819920020120220320420520620720820921021121221321421521621721821922022122222322422522622722822923023123223323423523623723823924024124224324424524624724824925025125225325425525625725825926026126226326426526626726826927027127227327427527627727827928028128228328428528628728828929029129229329429529629729829930030130230330430530630730830931031131231331431531631731831932032132232332432532632732832933033133233333433533633733833934034134234334434534634734834935035135235335435535635735835936036136236336436536636736836937037137237337437537637737837938038138238338438538638738838939039139239339439539639739839940040140240340440540640740840941041141241341441541641741841942042142242342442542642742842943043143243343443543643743843944044144244344444544644744844945045145245345445545645745845946046146246346446546646746846947047147247347447547647747847948048148248348448548648748848949049149249349449549649749849950050150250350450550650750850951051151251351451551651751851952052152252352452552652752852953053153253353453553653753853954054154254354454554654754854955055155255355455555655755855956056156256356456556656756856957057157257357457557657757857958058158258358458558658758858959059159259359459559659759859960060160260360460560660760860961061161261361461561661761861962062162262362462562662762862963063163263363463563663763863964064164264364464564664764864965065165265365465565665765865966066166266366466566666766866967067167267367467567667767867968068168268368468568668768868969069169269369469569669769869970070170270370470570670770870971071171271371471571671771871972072172272372472572672772872973073173273373473573673773873974074174274374474574674774874975075175275375475575675775875976076176276376476576676776876977077177277377477577677777877978078178278378478578678778878979079179279379479579679779879980080180280380480580680780880981081181281381481581681781881982082182282382482582682782882983083183283383483583683783883984084184284384484584684784884985085185285385485585685785885986086186286386486586686786886987087187287387487587687787887988088188288388488588688788888989089189289389489589689789889990090190290390490590690790890991091191291391491591691791891992092192292392492592692792892993093193293393493593693793893994094194294394494594694794894995095195295395495595695795895996096196296396496596696796896997097197297397497597697797897998098198298398498598698798898999099199299399499599699799899910001001100210031004100510061007100810091010101110121013101410151016101710181019102010211022102310241025102610271028102910301031103210331034103510361037103810391040104110421043104410451046104710481049105010511052105310541055105610571058105910601061106210631064106510661067106810691070107110721073107410751076107710781079108010811082108310841085108610871088108910901091109210931094109510961097109810991100110111021103110411051106110711081109111011111112111311141115111611171118111911201121112211231124112511261127112811291130113111321133113411351136113711381139114011411142114311441145114611471148114911501151115211531154115511561157115811591160116111621163116411651166116711681169117011711172117311741175117611771178117911801181118211831184118511861187118811891190119111921193119411951196119711981199120012011202120312041205120612071208120912101211121212131214121512161217121812191220122112221223122412251226122712281229123012311232123312341235123612371238123912401241124212431244124512461247124812491250125112521253125412551256125712581259126012611262126312641265126612671268126912701271127212731274127512761277127812791280128112821283128412851286128712881289129012911292129312941295129612971298129913001301130213031304130513061307130813091310131113121313131413151316131713181319132013211322132313241325132613271328132913301331133213331334133513361337133813391340134113421343134413451346134713481349135013511352135313541355135613571358135913601361136213631364136513661367136813691370137113721373137413751376137713781379138013811382138313841385138613871388138913901391139213931394139513961397139813991400140114021403140414051406140714081409141014111412141314141415141614171418141914201421142214231424142514261427142814291430143114321433143414351436143714381439144014411442144314441445144614471448144914501451145214531454145514561457145814591460146114621463146414651466146714681469147014711472147314741475147614771478147914801481148214831484148514861487148814891490149114921493149414951496149714981499150015011502150315041505150615071508150915101511151215131514151515161517151815191520152115221523152415251526152715281529153015311532153315341535153615371538153915401541154215431544154515461547154815491550155115521553155415551556155715581559156015611562156315641565156615671568156915701571157215731574157515761577157815791580158115821583158415851586158715881589159015911592159315941595159615971598159916001601160216031604160516061607160816091610161116121613161416151616161716181619162016211622162316241625162616271628162916301631163216331634163516361637163816391640164116421643164416451646164716481649165016511652165316541655165616571658165916601661166216631664166516661667166816691670167116721673167416751676167716781679168016811682168316841685168616871688168916901691169216931694169516961697169816991700170117021703170417051706170717081709171017111712171317141715171617171718171917201721172217231724172517261727172817291730173117321733173417351736173717381739174017411742174317441745174617471748174917501751175217531754175517561757175817591760176117621763176417651766176717681769177017711772177317741775177617771778177917801781178217831784178517861787178817891790179117921793179417951796179717981799180018011802180318041805180618071808180918101811181218131814181518161817181818191820182118221823182418251826182718281829183018311832183318341835183618371838183918401841184218431844184518461847184818491850185118521853185418551856185718581859186018611862186318641865186618671868186918701871187218731874187518761877187818791880188118821883188418851886188718881889189018911892189318941895189618971898189919001901190219031904190519061907190819091910191119121913191419151916191719181919192019211922192319241925192619271928192919301931193219331934193519361937193819391940194119421943194419451946194719481949195019511952195319541955195619571958195919601961196219631964196519661967196819691970197119721973197419751976197719781979198019811982198319841985198619871988198919901991199219931994199519961997199819992000200120022003200420052006200720082009201020112012201320142015201620172018201920202021202220232024202520262027202820292030203120322033203420352036203720382039204020412042204320442045204620472048204920502051205220532054205520562057205820592060206120622063206420652066206720682069207020712072207320742075207620772078207920802081208220832084208520862087208820892090209120922093209420952096209720982099210021012102210321042105210621072108210921102111211221132114211521162117211821192120212121222123212421252126212721282129213021312132213321342135213621372138213921402141214221432144214521462147214821492150215121522153215421552156215721582159216021612162216321642165216621672168216921702171217221732174217521762177217821792180218121822183218421852186218721882189219021912192219321942195219621972198219922002201220222032204220522062207220822092210221122122213221422152216
  1. // SPDX-License-Identifier: GPL-2.0
  2. /*
  3. * Copyright (C) 2017-2018, Intel Corporation. All rights reserved
  4. * Copyright Altera Corporation (C) 2014-2016. All rights reserved.
  5. * Copyright 2011-2012 Calxeda, Inc.
  6. */
  7. #include <asm/cacheflush.h>
  8. #include <linux/ctype.h>
  9. #include <linux/delay.h>
  10. #include <linux/edac.h>
  11. #include <linux/firmware/intel/stratix10-smc.h>
  12. #include <linux/genalloc.h>
  13. #include <linux/interrupt.h>
  14. #include <linux/irqchip/chained_irq.h>
  15. #include <linux/kernel.h>
  16. #include <linux/mfd/altera-sysmgr.h>
  17. #include <linux/mfd/syscon.h>
  18. #include <linux/notifier.h>
  19. #include <linux/of_address.h>
  20. #include <linux/of_irq.h>
  21. #include <linux/of_platform.h>
  22. #include <linux/panic_notifier.h>
  23. #include <linux/platform_device.h>
  24. #include <linux/property.h>
  25. #include <linux/regmap.h>
  26. #include <linux/types.h>
  27. #include <linux/uaccess.h>
  28. #include "altera_edac.h"
  29. #include "edac_module.h"
  30. #define EDAC_MOD_STR "altera_edac"
  31. #define EDAC_DEVICE "Altera"
  32. #ifdef CONFIG_EDAC_ALTERA_SDRAM
  33. static const struct altr_sdram_prv_data c5_data = {
  34. .ecc_ctrl_offset = CV_CTLCFG_OFST,
  35. .ecc_ctl_en_mask = CV_CTLCFG_ECC_AUTO_EN,
  36. .ecc_stat_offset = CV_DRAMSTS_OFST,
  37. .ecc_stat_ce_mask = CV_DRAMSTS_SBEERR,
  38. .ecc_stat_ue_mask = CV_DRAMSTS_DBEERR,
  39. .ecc_saddr_offset = CV_ERRADDR_OFST,
  40. .ecc_daddr_offset = CV_ERRADDR_OFST,
  41. .ecc_cecnt_offset = CV_SBECOUNT_OFST,
  42. .ecc_uecnt_offset = CV_DBECOUNT_OFST,
  43. .ecc_irq_en_offset = CV_DRAMINTR_OFST,
  44. .ecc_irq_en_mask = CV_DRAMINTR_INTREN,
  45. .ecc_irq_clr_offset = CV_DRAMINTR_OFST,
  46. .ecc_irq_clr_mask = (CV_DRAMINTR_INTRCLR | CV_DRAMINTR_INTREN),
  47. .ecc_cnt_rst_offset = CV_DRAMINTR_OFST,
  48. .ecc_cnt_rst_mask = CV_DRAMINTR_INTRCLR,
  49. .ce_ue_trgr_offset = CV_CTLCFG_OFST,
  50. .ce_set_mask = CV_CTLCFG_GEN_SB_ERR,
  51. .ue_set_mask = CV_CTLCFG_GEN_DB_ERR,
  52. };
  53. static const struct altr_sdram_prv_data a10_data = {
  54. .ecc_ctrl_offset = A10_ECCCTRL1_OFST,
  55. .ecc_ctl_en_mask = A10_ECCCTRL1_ECC_EN,
  56. .ecc_stat_offset = A10_INTSTAT_OFST,
  57. .ecc_stat_ce_mask = A10_INTSTAT_SBEERR,
  58. .ecc_stat_ue_mask = A10_INTSTAT_DBEERR,
  59. .ecc_saddr_offset = A10_SERRADDR_OFST,
  60. .ecc_daddr_offset = A10_DERRADDR_OFST,
  61. .ecc_irq_en_offset = A10_ERRINTEN_OFST,
  62. .ecc_irq_en_mask = A10_ECC_IRQ_EN_MASK,
  63. .ecc_irq_clr_offset = A10_INTSTAT_OFST,
  64. .ecc_irq_clr_mask = (A10_INTSTAT_SBEERR | A10_INTSTAT_DBEERR),
  65. .ecc_cnt_rst_offset = A10_ECCCTRL1_OFST,
  66. .ecc_cnt_rst_mask = A10_ECC_CNT_RESET_MASK,
  67. .ce_ue_trgr_offset = A10_DIAGINTTEST_OFST,
  68. .ce_set_mask = A10_DIAGINT_TSERRA_MASK,
  69. .ue_set_mask = A10_DIAGINT_TDERRA_MASK,
  70. };
  71. /*********************** EDAC Memory Controller Functions ****************/
  72. /* The SDRAM controller uses the EDAC Memory Controller framework. */
  73. static irqreturn_t altr_sdram_mc_err_handler(int irq, void *dev_id)
  74. {
  75. struct mem_ctl_info *mci = dev_id;
  76. struct altr_sdram_mc_data *drvdata = mci->pvt_info;
  77. const struct altr_sdram_prv_data *priv = drvdata->data;
  78. u32 status, err_count = 1, err_addr;
  79. regmap_read(drvdata->mc_vbase, priv->ecc_stat_offset, &status);
  80. if (status & priv->ecc_stat_ue_mask) {
  81. regmap_read(drvdata->mc_vbase, priv->ecc_daddr_offset,
  82. &err_addr);
  83. if (priv->ecc_uecnt_offset)
  84. regmap_read(drvdata->mc_vbase, priv->ecc_uecnt_offset,
  85. &err_count);
  86. panic("\nEDAC: [%d Uncorrectable errors @ 0x%08X]\n",
  87. err_count, err_addr);
  88. }
  89. if (status & priv->ecc_stat_ce_mask) {
  90. regmap_read(drvdata->mc_vbase, priv->ecc_saddr_offset,
  91. &err_addr);
  92. if (priv->ecc_cecnt_offset)
  93. regmap_read(drvdata->mc_vbase, priv->ecc_cecnt_offset,
  94. &err_count);
  95. edac_mc_handle_error(HW_EVENT_ERR_CORRECTED, mci, err_count,
  96. err_addr >> PAGE_SHIFT,
  97. err_addr & ~PAGE_MASK, 0,
  98. 0, 0, -1, mci->ctl_name, "");
  99. /* Clear IRQ to resume */
  100. regmap_write(drvdata->mc_vbase, priv->ecc_irq_clr_offset,
  101. priv->ecc_irq_clr_mask);
  102. return IRQ_HANDLED;
  103. }
  104. return IRQ_NONE;
  105. }
  106. static ssize_t altr_sdr_mc_err_inject_write(struct file *file,
  107. const char __user *data,
  108. size_t count, loff_t *ppos)
  109. {
  110. struct mem_ctl_info *mci = file->private_data;
  111. struct altr_sdram_mc_data *drvdata = mci->pvt_info;
  112. const struct altr_sdram_prv_data *priv = drvdata->data;
  113. u32 *ptemp;
  114. dma_addr_t dma_handle;
  115. u32 reg, read_reg;
  116. ptemp = dma_alloc_coherent(mci->pdev, 16, &dma_handle, GFP_KERNEL);
  117. if (!ptemp) {
  118. edac_printk(KERN_ERR, EDAC_MC,
  119. "Inject: Buffer Allocation error\n");
  120. return -ENOMEM;
  121. }
  122. regmap_read(drvdata->mc_vbase, priv->ce_ue_trgr_offset,
  123. &read_reg);
  124. read_reg &= ~(priv->ce_set_mask | priv->ue_set_mask);
  125. /* Error are injected by writing a word while the SBE or DBE
  126. * bit in the CTLCFG register is set. Reading the word will
  127. * trigger the SBE or DBE error and the corresponding IRQ.
  128. */
  129. if (count == 3) {
  130. edac_printk(KERN_ALERT, EDAC_MC,
  131. "Inject Double bit error\n");
  132. local_irq_disable();
  133. regmap_write(drvdata->mc_vbase, priv->ce_ue_trgr_offset,
  134. (read_reg | priv->ue_set_mask));
  135. local_irq_enable();
  136. } else {
  137. edac_printk(KERN_ALERT, EDAC_MC,
  138. "Inject Single bit error\n");
  139. local_irq_disable();
  140. regmap_write(drvdata->mc_vbase, priv->ce_ue_trgr_offset,
  141. (read_reg | priv->ce_set_mask));
  142. local_irq_enable();
  143. }
  144. ptemp[0] = 0x5A5A5A5A;
  145. ptemp[1] = 0xA5A5A5A5;
  146. /* Clear the error injection bits */
  147. regmap_write(drvdata->mc_vbase, priv->ce_ue_trgr_offset, read_reg);
  148. /* Ensure it has been written out */
  149. wmb();
  150. /*
  151. * To trigger the error, we need to read the data back
  152. * (the data was written with errors above).
  153. * The READ_ONCE macros and printk are used to prevent the
  154. * the compiler optimizing these reads out.
  155. */
  156. reg = READ_ONCE(ptemp[0]);
  157. read_reg = READ_ONCE(ptemp[1]);
  158. /* Force Read */
  159. rmb();
  160. edac_printk(KERN_ALERT, EDAC_MC, "Read Data [0x%X, 0x%X]\n",
  161. reg, read_reg);
  162. dma_free_coherent(mci->pdev, 16, ptemp, dma_handle);
  163. return count;
  164. }
  165. static const struct file_operations altr_sdr_mc_debug_inject_fops = {
  166. .open = simple_open,
  167. .write = altr_sdr_mc_err_inject_write,
  168. .llseek = generic_file_llseek,
  169. };
  170. static void altr_sdr_mc_create_debugfs_nodes(struct mem_ctl_info *mci)
  171. {
  172. if (!IS_ENABLED(CONFIG_EDAC_DEBUG))
  173. return;
  174. if (!mci->debugfs)
  175. return;
  176. edac_debugfs_create_file("altr_trigger", S_IWUSR, mci->debugfs, mci,
  177. &altr_sdr_mc_debug_inject_fops);
  178. }
  179. /* Get total memory size from Open Firmware DTB */
  180. static unsigned long get_total_mem(void)
  181. {
  182. struct device_node *np = NULL;
  183. struct resource res;
  184. int ret;
  185. unsigned long total_mem = 0;
  186. for_each_node_by_type(np, "memory") {
  187. ret = of_address_to_resource(np, 0, &res);
  188. if (ret)
  189. continue;
  190. total_mem += resource_size(&res);
  191. }
  192. edac_dbg(0, "total_mem 0x%lx\n", total_mem);
  193. return total_mem;
  194. }
  195. static const struct of_device_id altr_sdram_ctrl_of_match[] = {
  196. { .compatible = "altr,sdram-edac", .data = &c5_data},
  197. { .compatible = "altr,sdram-edac-a10", .data = &a10_data},
  198. {},
  199. };
  200. MODULE_DEVICE_TABLE(of, altr_sdram_ctrl_of_match);
  201. static int a10_init(struct regmap *mc_vbase)
  202. {
  203. if (regmap_update_bits(mc_vbase, A10_INTMODE_OFST,
  204. A10_INTMODE_SB_INT, A10_INTMODE_SB_INT)) {
  205. edac_printk(KERN_ERR, EDAC_MC,
  206. "Error setting SB IRQ mode\n");
  207. return -ENODEV;
  208. }
  209. if (regmap_write(mc_vbase, A10_SERRCNTREG_OFST, 1)) {
  210. edac_printk(KERN_ERR, EDAC_MC,
  211. "Error setting trigger count\n");
  212. return -ENODEV;
  213. }
  214. return 0;
  215. }
  216. static int a10_unmask_irq(struct platform_device *pdev, u32 mask)
  217. {
  218. void __iomem *sm_base;
  219. int ret = 0;
  220. if (!request_mem_region(A10_SYMAN_INTMASK_CLR, sizeof(u32),
  221. dev_name(&pdev->dev))) {
  222. edac_printk(KERN_ERR, EDAC_MC,
  223. "Unable to request mem region\n");
  224. return -EBUSY;
  225. }
  226. sm_base = ioremap(A10_SYMAN_INTMASK_CLR, sizeof(u32));
  227. if (!sm_base) {
  228. edac_printk(KERN_ERR, EDAC_MC,
  229. "Unable to ioremap device\n");
  230. ret = -ENOMEM;
  231. goto release;
  232. }
  233. iowrite32(mask, sm_base);
  234. iounmap(sm_base);
  235. release:
  236. release_mem_region(A10_SYMAN_INTMASK_CLR, sizeof(u32));
  237. return ret;
  238. }
  239. static int altr_sdram_probe(struct platform_device *pdev)
  240. {
  241. struct edac_mc_layer layers[2];
  242. struct mem_ctl_info *mci;
  243. struct altr_sdram_mc_data *drvdata;
  244. const struct altr_sdram_prv_data *priv;
  245. struct regmap *mc_vbase;
  246. struct dimm_info *dimm;
  247. u32 read_reg;
  248. int irq, irq2, res = 0;
  249. unsigned long mem_size, irqflags = 0;
  250. /* Grab the register range from the sdr controller in device tree */
  251. mc_vbase = syscon_regmap_lookup_by_phandle(pdev->dev.of_node,
  252. "altr,sdr-syscon");
  253. if (IS_ERR(mc_vbase)) {
  254. edac_printk(KERN_ERR, EDAC_MC,
  255. "regmap for altr,sdr-syscon lookup failed.\n");
  256. return -ENODEV;
  257. }
  258. /* Check specific dependencies for the module */
  259. priv = device_get_match_data(&pdev->dev);
  260. /* Validate the SDRAM controller has ECC enabled */
  261. if (regmap_read(mc_vbase, priv->ecc_ctrl_offset, &read_reg) ||
  262. ((read_reg & priv->ecc_ctl_en_mask) != priv->ecc_ctl_en_mask)) {
  263. edac_printk(KERN_ERR, EDAC_MC,
  264. "No ECC/ECC disabled [0x%08X]\n", read_reg);
  265. return -ENODEV;
  266. }
  267. /* Grab memory size from device tree. */
  268. mem_size = get_total_mem();
  269. if (!mem_size) {
  270. edac_printk(KERN_ERR, EDAC_MC, "Unable to calculate memory size\n");
  271. return -ENODEV;
  272. }
  273. /* Ensure the SDRAM Interrupt is disabled */
  274. if (regmap_update_bits(mc_vbase, priv->ecc_irq_en_offset,
  275. priv->ecc_irq_en_mask, 0)) {
  276. edac_printk(KERN_ERR, EDAC_MC,
  277. "Error disabling SDRAM ECC IRQ\n");
  278. return -ENODEV;
  279. }
  280. /* Toggle to clear the SDRAM Error count */
  281. if (regmap_update_bits(mc_vbase, priv->ecc_cnt_rst_offset,
  282. priv->ecc_cnt_rst_mask,
  283. priv->ecc_cnt_rst_mask)) {
  284. edac_printk(KERN_ERR, EDAC_MC,
  285. "Error clearing SDRAM ECC count\n");
  286. return -ENODEV;
  287. }
  288. if (regmap_update_bits(mc_vbase, priv->ecc_cnt_rst_offset,
  289. priv->ecc_cnt_rst_mask, 0)) {
  290. edac_printk(KERN_ERR, EDAC_MC,
  291. "Error clearing SDRAM ECC count\n");
  292. return -ENODEV;
  293. }
  294. irq = platform_get_irq(pdev, 0);
  295. if (irq < 0) {
  296. edac_printk(KERN_ERR, EDAC_MC,
  297. "No irq %d in DT\n", irq);
  298. return irq;
  299. }
  300. /* Arria10 has a 2nd IRQ */
  301. irq2 = platform_get_irq(pdev, 1);
  302. layers[0].type = EDAC_MC_LAYER_CHIP_SELECT;
  303. layers[0].size = 1;
  304. layers[0].is_virt_csrow = true;
  305. layers[1].type = EDAC_MC_LAYER_CHANNEL;
  306. layers[1].size = 1;
  307. layers[1].is_virt_csrow = false;
  308. mci = edac_mc_alloc(0, ARRAY_SIZE(layers), layers,
  309. sizeof(struct altr_sdram_mc_data));
  310. if (!mci)
  311. return -ENOMEM;
  312. mci->pdev = &pdev->dev;
  313. drvdata = mci->pvt_info;
  314. drvdata->mc_vbase = mc_vbase;
  315. drvdata->data = priv;
  316. platform_set_drvdata(pdev, mci);
  317. if (!devres_open_group(&pdev->dev, NULL, GFP_KERNEL)) {
  318. edac_printk(KERN_ERR, EDAC_MC,
  319. "Unable to get managed device resource\n");
  320. res = -ENOMEM;
  321. goto free;
  322. }
  323. mci->mtype_cap = MEM_FLAG_DDR3;
  324. mci->edac_ctl_cap = EDAC_FLAG_NONE | EDAC_FLAG_SECDED;
  325. mci->edac_cap = EDAC_FLAG_SECDED;
  326. mci->mod_name = EDAC_MOD_STR;
  327. mci->ctl_name = dev_name(&pdev->dev);
  328. mci->scrub_mode = SCRUB_SW_SRC;
  329. mci->dev_name = dev_name(&pdev->dev);
  330. dimm = *mci->dimms;
  331. dimm->nr_pages = ((mem_size - 1) >> PAGE_SHIFT) + 1;
  332. dimm->grain = 8;
  333. dimm->dtype = DEV_X8;
  334. dimm->mtype = MEM_DDR3;
  335. dimm->edac_mode = EDAC_SECDED;
  336. res = edac_mc_add_mc(mci);
  337. if (res < 0)
  338. goto err;
  339. /* Only the Arria10 has separate IRQs */
  340. if (of_machine_is_compatible("altr,socfpga-arria10")) {
  341. /* Arria10 specific initialization */
  342. res = a10_init(mc_vbase);
  343. if (res < 0)
  344. goto err2;
  345. res = devm_request_irq(&pdev->dev, irq2,
  346. altr_sdram_mc_err_handler,
  347. IRQF_SHARED, dev_name(&pdev->dev), mci);
  348. if (res < 0) {
  349. edac_mc_printk(mci, KERN_ERR,
  350. "Unable to request irq %d\n", irq2);
  351. res = -ENODEV;
  352. goto err2;
  353. }
  354. res = a10_unmask_irq(pdev, A10_DDR0_IRQ_MASK);
  355. if (res < 0)
  356. goto err2;
  357. irqflags = IRQF_SHARED;
  358. }
  359. res = devm_request_irq(&pdev->dev, irq, altr_sdram_mc_err_handler,
  360. irqflags, dev_name(&pdev->dev), mci);
  361. if (res < 0) {
  362. edac_mc_printk(mci, KERN_ERR,
  363. "Unable to request irq %d\n", irq);
  364. res = -ENODEV;
  365. goto err2;
  366. }
  367. /* Infrastructure ready - enable the IRQ */
  368. if (regmap_update_bits(drvdata->mc_vbase, priv->ecc_irq_en_offset,
  369. priv->ecc_irq_en_mask, priv->ecc_irq_en_mask)) {
  370. edac_mc_printk(mci, KERN_ERR,
  371. "Error enabling SDRAM ECC IRQ\n");
  372. res = -ENODEV;
  373. goto err2;
  374. }
  375. altr_sdr_mc_create_debugfs_nodes(mci);
  376. devres_close_group(&pdev->dev, NULL);
  377. return 0;
  378. err2:
  379. edac_mc_del_mc(&pdev->dev);
  380. err:
  381. devres_release_group(&pdev->dev, NULL);
  382. free:
  383. edac_mc_free(mci);
  384. edac_printk(KERN_ERR, EDAC_MC,
  385. "EDAC Probe Failed; Error %d\n", res);
  386. return res;
  387. }
  388. static void altr_sdram_remove(struct platform_device *pdev)
  389. {
  390. struct mem_ctl_info *mci = platform_get_drvdata(pdev);
  391. edac_mc_del_mc(&pdev->dev);
  392. edac_mc_free(mci);
  393. platform_set_drvdata(pdev, NULL);
  394. }
  395. /*
  396. * If you want to suspend, need to disable EDAC by removing it
  397. * from the device tree or defconfig.
  398. */
  399. #ifdef CONFIG_PM
  400. static int altr_sdram_prepare(struct device *dev)
  401. {
  402. pr_err("Suspend not allowed when EDAC is enabled.\n");
  403. return -EPERM;
  404. }
  405. static const struct dev_pm_ops altr_sdram_pm_ops = {
  406. .prepare = altr_sdram_prepare,
  407. };
  408. #endif
  409. static struct platform_driver altr_sdram_edac_driver = {
  410. .probe = altr_sdram_probe,
  411. .remove_new = altr_sdram_remove,
  412. .driver = {
  413. .name = "altr_sdram_edac",
  414. #ifdef CONFIG_PM
  415. .pm = &altr_sdram_pm_ops,
  416. #endif
  417. .of_match_table = altr_sdram_ctrl_of_match,
  418. },
  419. };
  420. module_platform_driver(altr_sdram_edac_driver);
  421. #endif /* CONFIG_EDAC_ALTERA_SDRAM */
  422. /************************* EDAC Parent Probe *************************/
  423. static const struct of_device_id altr_edac_device_of_match[];
  424. static const struct of_device_id altr_edac_of_match[] = {
  425. { .compatible = "altr,socfpga-ecc-manager" },
  426. {},
  427. };
  428. MODULE_DEVICE_TABLE(of, altr_edac_of_match);
  429. static int altr_edac_probe(struct platform_device *pdev)
  430. {
  431. of_platform_populate(pdev->dev.of_node, altr_edac_device_of_match,
  432. NULL, &pdev->dev);
  433. return 0;
  434. }
  435. static struct platform_driver altr_edac_driver = {
  436. .probe = altr_edac_probe,
  437. .driver = {
  438. .name = "socfpga_ecc_manager",
  439. .of_match_table = altr_edac_of_match,
  440. },
  441. };
  442. module_platform_driver(altr_edac_driver);
  443. /************************* EDAC Device Functions *************************/
  444. /*
  445. * EDAC Device Functions (shared between various IPs).
  446. * The discrete memories use the EDAC Device framework. The probe
  447. * and error handling functions are very similar between memories
  448. * so they are shared. The memory allocation and freeing for EDAC
  449. * trigger testing are different for each memory.
  450. */
  451. #ifdef CONFIG_EDAC_ALTERA_OCRAM
  452. static const struct edac_device_prv_data ocramecc_data;
  453. #endif
  454. #ifdef CONFIG_EDAC_ALTERA_L2C
  455. static const struct edac_device_prv_data l2ecc_data;
  456. #endif
  457. #ifdef CONFIG_EDAC_ALTERA_OCRAM
  458. static const struct edac_device_prv_data a10_ocramecc_data;
  459. #endif
  460. #ifdef CONFIG_EDAC_ALTERA_L2C
  461. static const struct edac_device_prv_data a10_l2ecc_data;
  462. #endif
  463. static irqreturn_t altr_edac_device_handler(int irq, void *dev_id)
  464. {
  465. irqreturn_t ret_value = IRQ_NONE;
  466. struct edac_device_ctl_info *dci = dev_id;
  467. struct altr_edac_device_dev *drvdata = dci->pvt_info;
  468. const struct edac_device_prv_data *priv = drvdata->data;
  469. if (irq == drvdata->sb_irq) {
  470. if (priv->ce_clear_mask)
  471. writel(priv->ce_clear_mask, drvdata->base);
  472. edac_device_handle_ce(dci, 0, 0, drvdata->edac_dev_name);
  473. ret_value = IRQ_HANDLED;
  474. } else if (irq == drvdata->db_irq) {
  475. if (priv->ue_clear_mask)
  476. writel(priv->ue_clear_mask, drvdata->base);
  477. edac_device_handle_ue(dci, 0, 0, drvdata->edac_dev_name);
  478. panic("\nEDAC:ECC_DEVICE[Uncorrectable errors]\n");
  479. ret_value = IRQ_HANDLED;
  480. } else {
  481. WARN_ON(1);
  482. }
  483. return ret_value;
  484. }
  485. static ssize_t __maybe_unused
  486. altr_edac_device_trig(struct file *file, const char __user *user_buf,
  487. size_t count, loff_t *ppos)
  488. {
  489. u32 *ptemp, i, error_mask;
  490. int result = 0;
  491. u8 trig_type;
  492. unsigned long flags;
  493. struct edac_device_ctl_info *edac_dci = file->private_data;
  494. struct altr_edac_device_dev *drvdata = edac_dci->pvt_info;
  495. const struct edac_device_prv_data *priv = drvdata->data;
  496. void *generic_ptr = edac_dci->dev;
  497. if (!user_buf || get_user(trig_type, user_buf))
  498. return -EFAULT;
  499. if (!priv->alloc_mem)
  500. return -ENOMEM;
  501. /*
  502. * Note that generic_ptr is initialized to the device * but in
  503. * some alloc_functions, this is overridden and returns data.
  504. */
  505. ptemp = priv->alloc_mem(priv->trig_alloc_sz, &generic_ptr);
  506. if (!ptemp) {
  507. edac_printk(KERN_ERR, EDAC_DEVICE,
  508. "Inject: Buffer Allocation error\n");
  509. return -ENOMEM;
  510. }
  511. if (trig_type == ALTR_UE_TRIGGER_CHAR)
  512. error_mask = priv->ue_set_mask;
  513. else
  514. error_mask = priv->ce_set_mask;
  515. edac_printk(KERN_ALERT, EDAC_DEVICE,
  516. "Trigger Error Mask (0x%X)\n", error_mask);
  517. local_irq_save(flags);
  518. /* write ECC corrupted data out. */
  519. for (i = 0; i < (priv->trig_alloc_sz / sizeof(*ptemp)); i++) {
  520. /* Read data so we're in the correct state */
  521. rmb();
  522. if (READ_ONCE(ptemp[i]))
  523. result = -1;
  524. /* Toggle Error bit (it is latched), leave ECC enabled */
  525. writel(error_mask, (drvdata->base + priv->set_err_ofst));
  526. writel(priv->ecc_enable_mask, (drvdata->base +
  527. priv->set_err_ofst));
  528. ptemp[i] = i;
  529. }
  530. /* Ensure it has been written out */
  531. wmb();
  532. local_irq_restore(flags);
  533. if (result)
  534. edac_printk(KERN_ERR, EDAC_DEVICE, "Mem Not Cleared\n");
  535. /* Read out written data. ECC error caused here */
  536. for (i = 0; i < ALTR_TRIGGER_READ_WRD_CNT; i++)
  537. if (READ_ONCE(ptemp[i]) != i)
  538. edac_printk(KERN_ERR, EDAC_DEVICE,
  539. "Read doesn't match written data\n");
  540. if (priv->free_mem)
  541. priv->free_mem(ptemp, priv->trig_alloc_sz, generic_ptr);
  542. return count;
  543. }
  544. static const struct file_operations altr_edac_device_inject_fops __maybe_unused = {
  545. .open = simple_open,
  546. .write = altr_edac_device_trig,
  547. .llseek = generic_file_llseek,
  548. };
  549. static ssize_t __maybe_unused
  550. altr_edac_a10_device_trig(struct file *file, const char __user *user_buf,
  551. size_t count, loff_t *ppos);
  552. static const struct file_operations altr_edac_a10_device_inject_fops __maybe_unused = {
  553. .open = simple_open,
  554. .write = altr_edac_a10_device_trig,
  555. .llseek = generic_file_llseek,
  556. };
  557. static ssize_t __maybe_unused
  558. altr_edac_a10_device_trig2(struct file *file, const char __user *user_buf,
  559. size_t count, loff_t *ppos);
  560. static const struct file_operations altr_edac_a10_device_inject2_fops __maybe_unused = {
  561. .open = simple_open,
  562. .write = altr_edac_a10_device_trig2,
  563. .llseek = generic_file_llseek,
  564. };
  565. static void altr_create_edacdev_dbgfs(struct edac_device_ctl_info *edac_dci,
  566. const struct edac_device_prv_data *priv)
  567. {
  568. struct altr_edac_device_dev *drvdata = edac_dci->pvt_info;
  569. if (!IS_ENABLED(CONFIG_EDAC_DEBUG))
  570. return;
  571. drvdata->debugfs_dir = edac_debugfs_create_dir(drvdata->edac_dev_name);
  572. if (!drvdata->debugfs_dir)
  573. return;
  574. if (!edac_debugfs_create_file("altr_trigger", S_IWUSR,
  575. drvdata->debugfs_dir, edac_dci,
  576. priv->inject_fops))
  577. debugfs_remove_recursive(drvdata->debugfs_dir);
  578. }
  579. static const struct of_device_id altr_edac_device_of_match[] = {
  580. #ifdef CONFIG_EDAC_ALTERA_L2C
  581. { .compatible = "altr,socfpga-l2-ecc", .data = &l2ecc_data },
  582. #endif
  583. #ifdef CONFIG_EDAC_ALTERA_OCRAM
  584. { .compatible = "altr,socfpga-ocram-ecc", .data = &ocramecc_data },
  585. #endif
  586. {},
  587. };
  588. MODULE_DEVICE_TABLE(of, altr_edac_device_of_match);
  589. /*
  590. * altr_edac_device_probe()
  591. * This is a generic EDAC device driver that will support
  592. * various Altera memory devices such as the L2 cache ECC and
  593. * OCRAM ECC as well as the memories for other peripherals.
  594. * Module specific initialization is done by passing the
  595. * function index in the device tree.
  596. */
  597. static int altr_edac_device_probe(struct platform_device *pdev)
  598. {
  599. struct edac_device_ctl_info *dci;
  600. struct altr_edac_device_dev *drvdata;
  601. struct resource *r;
  602. int res = 0;
  603. struct device_node *np = pdev->dev.of_node;
  604. char *ecc_name = (char *)np->name;
  605. static int dev_instance;
  606. if (!devres_open_group(&pdev->dev, NULL, GFP_KERNEL)) {
  607. edac_printk(KERN_ERR, EDAC_DEVICE,
  608. "Unable to open devm\n");
  609. return -ENOMEM;
  610. }
  611. r = platform_get_resource(pdev, IORESOURCE_MEM, 0);
  612. if (!r) {
  613. edac_printk(KERN_ERR, EDAC_DEVICE,
  614. "Unable to get mem resource\n");
  615. res = -ENODEV;
  616. goto fail;
  617. }
  618. if (!devm_request_mem_region(&pdev->dev, r->start, resource_size(r),
  619. dev_name(&pdev->dev))) {
  620. edac_printk(KERN_ERR, EDAC_DEVICE,
  621. "%s:Error requesting mem region\n", ecc_name);
  622. res = -EBUSY;
  623. goto fail;
  624. }
  625. dci = edac_device_alloc_ctl_info(sizeof(*drvdata), ecc_name,
  626. 1, ecc_name, 1, 0, dev_instance++);
  627. if (!dci) {
  628. edac_printk(KERN_ERR, EDAC_DEVICE,
  629. "%s: Unable to allocate EDAC device\n", ecc_name);
  630. res = -ENOMEM;
  631. goto fail;
  632. }
  633. drvdata = dci->pvt_info;
  634. dci->dev = &pdev->dev;
  635. platform_set_drvdata(pdev, dci);
  636. drvdata->edac_dev_name = ecc_name;
  637. drvdata->base = devm_ioremap(&pdev->dev, r->start, resource_size(r));
  638. if (!drvdata->base) {
  639. res = -ENOMEM;
  640. goto fail1;
  641. }
  642. /* Get driver specific data for this EDAC device */
  643. drvdata->data = of_match_node(altr_edac_device_of_match, np)->data;
  644. /* Check specific dependencies for the module */
  645. if (drvdata->data->setup) {
  646. res = drvdata->data->setup(drvdata);
  647. if (res)
  648. goto fail1;
  649. }
  650. drvdata->sb_irq = platform_get_irq(pdev, 0);
  651. res = devm_request_irq(&pdev->dev, drvdata->sb_irq,
  652. altr_edac_device_handler,
  653. 0, dev_name(&pdev->dev), dci);
  654. if (res)
  655. goto fail1;
  656. drvdata->db_irq = platform_get_irq(pdev, 1);
  657. res = devm_request_irq(&pdev->dev, drvdata->db_irq,
  658. altr_edac_device_handler,
  659. 0, dev_name(&pdev->dev), dci);
  660. if (res)
  661. goto fail1;
  662. dci->mod_name = "Altera ECC Manager";
  663. dci->dev_name = drvdata->edac_dev_name;
  664. res = edac_device_add_device(dci);
  665. if (res)
  666. goto fail1;
  667. altr_create_edacdev_dbgfs(dci, drvdata->data);
  668. devres_close_group(&pdev->dev, NULL);
  669. return 0;
  670. fail1:
  671. edac_device_free_ctl_info(dci);
  672. fail:
  673. devres_release_group(&pdev->dev, NULL);
  674. edac_printk(KERN_ERR, EDAC_DEVICE,
  675. "%s:Error setting up EDAC device: %d\n", ecc_name, res);
  676. return res;
  677. }
  678. static void altr_edac_device_remove(struct platform_device *pdev)
  679. {
  680. struct edac_device_ctl_info *dci = platform_get_drvdata(pdev);
  681. struct altr_edac_device_dev *drvdata = dci->pvt_info;
  682. debugfs_remove_recursive(drvdata->debugfs_dir);
  683. edac_device_del_device(&pdev->dev);
  684. edac_device_free_ctl_info(dci);
  685. }
  686. static struct platform_driver altr_edac_device_driver = {
  687. .probe = altr_edac_device_probe,
  688. .remove_new = altr_edac_device_remove,
  689. .driver = {
  690. .name = "altr_edac_device",
  691. .of_match_table = altr_edac_device_of_match,
  692. },
  693. };
  694. module_platform_driver(altr_edac_device_driver);
  695. /******************* Arria10 Device ECC Shared Functions *****************/
  696. /*
  697. * Test for memory's ECC dependencies upon entry because platform specific
  698. * startup should have initialized the memory and enabled the ECC.
  699. * Can't turn on ECC here because accessing un-initialized memory will
  700. * cause CE/UE errors possibly causing an ABORT.
  701. */
  702. static int __maybe_unused
  703. altr_check_ecc_deps(struct altr_edac_device_dev *device)
  704. {
  705. void __iomem *base = device->base;
  706. const struct edac_device_prv_data *prv = device->data;
  707. if (readl(base + prv->ecc_en_ofst) & prv->ecc_enable_mask)
  708. return 0;
  709. edac_printk(KERN_ERR, EDAC_DEVICE,
  710. "%s: No ECC present or ECC disabled.\n",
  711. device->edac_dev_name);
  712. return -ENODEV;
  713. }
  714. static irqreturn_t __maybe_unused altr_edac_a10_ecc_irq(int irq, void *dev_id)
  715. {
  716. struct altr_edac_device_dev *dci = dev_id;
  717. void __iomem *base = dci->base;
  718. if (irq == dci->sb_irq) {
  719. writel(ALTR_A10_ECC_SERRPENA,
  720. base + ALTR_A10_ECC_INTSTAT_OFST);
  721. edac_device_handle_ce(dci->edac_dev, 0, 0, dci->edac_dev_name);
  722. return IRQ_HANDLED;
  723. } else if (irq == dci->db_irq) {
  724. writel(ALTR_A10_ECC_DERRPENA,
  725. base + ALTR_A10_ECC_INTSTAT_OFST);
  726. edac_device_handle_ue(dci->edac_dev, 0, 0, dci->edac_dev_name);
  727. if (dci->data->panic)
  728. panic("\nEDAC:ECC_DEVICE[Uncorrectable errors]\n");
  729. return IRQ_HANDLED;
  730. }
  731. WARN_ON(1);
  732. return IRQ_NONE;
  733. }
  734. /******************* Arria10 Memory Buffer Functions *********************/
  735. static inline int a10_get_irq_mask(struct device_node *np)
  736. {
  737. int irq;
  738. const u32 *handle = of_get_property(np, "interrupts", NULL);
  739. if (!handle)
  740. return -ENODEV;
  741. irq = be32_to_cpup(handle);
  742. return irq;
  743. }
  744. static inline void ecc_set_bits(u32 bit_mask, void __iomem *ioaddr)
  745. {
  746. u32 value = readl(ioaddr);
  747. value |= bit_mask;
  748. writel(value, ioaddr);
  749. }
  750. static inline void ecc_clear_bits(u32 bit_mask, void __iomem *ioaddr)
  751. {
  752. u32 value = readl(ioaddr);
  753. value &= ~bit_mask;
  754. writel(value, ioaddr);
  755. }
  756. static inline int ecc_test_bits(u32 bit_mask, void __iomem *ioaddr)
  757. {
  758. u32 value = readl(ioaddr);
  759. return (value & bit_mask) ? 1 : 0;
  760. }
  761. /*
  762. * This function uses the memory initialization block in the Arria10 ECC
  763. * controller to initialize/clear the entire memory data and ECC data.
  764. */
  765. static int __maybe_unused altr_init_memory_port(void __iomem *ioaddr, int port)
  766. {
  767. int limit = ALTR_A10_ECC_INIT_WATCHDOG_10US;
  768. u32 init_mask, stat_mask, clear_mask;
  769. int ret = 0;
  770. if (port) {
  771. init_mask = ALTR_A10_ECC_INITB;
  772. stat_mask = ALTR_A10_ECC_INITCOMPLETEB;
  773. clear_mask = ALTR_A10_ECC_ERRPENB_MASK;
  774. } else {
  775. init_mask = ALTR_A10_ECC_INITA;
  776. stat_mask = ALTR_A10_ECC_INITCOMPLETEA;
  777. clear_mask = ALTR_A10_ECC_ERRPENA_MASK;
  778. }
  779. ecc_set_bits(init_mask, (ioaddr + ALTR_A10_ECC_CTRL_OFST));
  780. while (limit--) {
  781. if (ecc_test_bits(stat_mask,
  782. (ioaddr + ALTR_A10_ECC_INITSTAT_OFST)))
  783. break;
  784. udelay(1);
  785. }
  786. if (limit < 0)
  787. ret = -EBUSY;
  788. /* Clear any pending ECC interrupts */
  789. writel(clear_mask, (ioaddr + ALTR_A10_ECC_INTSTAT_OFST));
  790. return ret;
  791. }
  792. static __init int __maybe_unused
  793. altr_init_a10_ecc_block(struct device_node *np, u32 irq_mask,
  794. u32 ecc_ctrl_en_mask, bool dual_port)
  795. {
  796. int ret = 0;
  797. void __iomem *ecc_block_base;
  798. struct regmap *ecc_mgr_map;
  799. char *ecc_name;
  800. struct device_node *np_eccmgr;
  801. ecc_name = (char *)np->name;
  802. /* Get the ECC Manager - parent of the device EDACs */
  803. np_eccmgr = of_get_parent(np);
  804. ecc_mgr_map =
  805. altr_sysmgr_regmap_lookup_by_phandle(np_eccmgr,
  806. "altr,sysmgr-syscon");
  807. of_node_put(np_eccmgr);
  808. if (IS_ERR(ecc_mgr_map)) {
  809. edac_printk(KERN_ERR, EDAC_DEVICE,
  810. "Unable to get syscon altr,sysmgr-syscon\n");
  811. return -ENODEV;
  812. }
  813. /* Map the ECC Block */
  814. ecc_block_base = of_iomap(np, 0);
  815. if (!ecc_block_base) {
  816. edac_printk(KERN_ERR, EDAC_DEVICE,
  817. "Unable to map %s ECC block\n", ecc_name);
  818. return -ENODEV;
  819. }
  820. /* Disable ECC */
  821. regmap_write(ecc_mgr_map, A10_SYSMGR_ECC_INTMASK_SET_OFST, irq_mask);
  822. writel(ALTR_A10_ECC_SERRINTEN,
  823. (ecc_block_base + ALTR_A10_ECC_ERRINTENR_OFST));
  824. ecc_clear_bits(ecc_ctrl_en_mask,
  825. (ecc_block_base + ALTR_A10_ECC_CTRL_OFST));
  826. /* Ensure all writes complete */
  827. wmb();
  828. /* Use HW initialization block to initialize memory for ECC */
  829. ret = altr_init_memory_port(ecc_block_base, 0);
  830. if (ret) {
  831. edac_printk(KERN_ERR, EDAC_DEVICE,
  832. "ECC: cannot init %s PORTA memory\n", ecc_name);
  833. goto out;
  834. }
  835. if (dual_port) {
  836. ret = altr_init_memory_port(ecc_block_base, 1);
  837. if (ret) {
  838. edac_printk(KERN_ERR, EDAC_DEVICE,
  839. "ECC: cannot init %s PORTB memory\n",
  840. ecc_name);
  841. goto out;
  842. }
  843. }
  844. /* Enable ECC */
  845. ecc_set_bits(ecc_ctrl_en_mask, (ecc_block_base +
  846. ALTR_A10_ECC_CTRL_OFST));
  847. writel(ALTR_A10_ECC_SERRINTEN,
  848. (ecc_block_base + ALTR_A10_ECC_ERRINTENS_OFST));
  849. regmap_write(ecc_mgr_map, A10_SYSMGR_ECC_INTMASK_CLR_OFST, irq_mask);
  850. /* Ensure all writes complete */
  851. wmb();
  852. out:
  853. iounmap(ecc_block_base);
  854. return ret;
  855. }
  856. static int validate_parent_available(struct device_node *np);
  857. static const struct of_device_id altr_edac_a10_device_of_match[];
  858. static int __init __maybe_unused altr_init_a10_ecc_device_type(char *compat)
  859. {
  860. int irq;
  861. struct device_node *child, *np;
  862. np = of_find_compatible_node(NULL, NULL,
  863. "altr,socfpga-a10-ecc-manager");
  864. if (!np) {
  865. edac_printk(KERN_ERR, EDAC_DEVICE, "ECC Manager not found\n");
  866. return -ENODEV;
  867. }
  868. for_each_child_of_node(np, child) {
  869. const struct of_device_id *pdev_id;
  870. const struct edac_device_prv_data *prv;
  871. if (!of_device_is_available(child))
  872. continue;
  873. if (!of_device_is_compatible(child, compat))
  874. continue;
  875. if (validate_parent_available(child))
  876. continue;
  877. irq = a10_get_irq_mask(child);
  878. if (irq < 0)
  879. continue;
  880. /* Get matching node and check for valid result */
  881. pdev_id = of_match_node(altr_edac_a10_device_of_match, child);
  882. if (IS_ERR_OR_NULL(pdev_id))
  883. continue;
  884. /* Validate private data pointer before dereferencing */
  885. prv = pdev_id->data;
  886. if (!prv)
  887. continue;
  888. altr_init_a10_ecc_block(child, BIT(irq),
  889. prv->ecc_enable_mask, 0);
  890. }
  891. of_node_put(np);
  892. return 0;
  893. }
  894. /*********************** SDRAM EDAC Device Functions *********************/
  895. #ifdef CONFIG_EDAC_ALTERA_SDRAM
  896. /*
  897. * A legacy U-Boot bug only enabled memory mapped access to the ECC Enable
  898. * register if ECC is enabled. Linux checks the ECC Enable register to
  899. * determine ECC status.
  900. * Use an SMC call (which always works) to determine ECC enablement.
  901. */
  902. static int altr_s10_sdram_check_ecc_deps(struct altr_edac_device_dev *device)
  903. {
  904. const struct edac_device_prv_data *prv = device->data;
  905. unsigned long sdram_ecc_addr;
  906. struct arm_smccc_res result;
  907. struct device_node *np;
  908. phys_addr_t sdram_addr;
  909. u32 read_reg;
  910. int ret;
  911. np = of_find_compatible_node(NULL, NULL, "altr,sdr-ctl");
  912. if (!np)
  913. goto sdram_err;
  914. sdram_addr = of_translate_address(np, of_get_address(np, 0,
  915. NULL, NULL));
  916. of_node_put(np);
  917. sdram_ecc_addr = (unsigned long)sdram_addr + prv->ecc_en_ofst;
  918. arm_smccc_smc(INTEL_SIP_SMC_REG_READ, sdram_ecc_addr,
  919. 0, 0, 0, 0, 0, 0, &result);
  920. read_reg = (unsigned int)result.a1;
  921. ret = (int)result.a0;
  922. if (!ret && (read_reg & prv->ecc_enable_mask))
  923. return 0;
  924. sdram_err:
  925. edac_printk(KERN_ERR, EDAC_DEVICE,
  926. "%s: No ECC present or ECC disabled.\n",
  927. device->edac_dev_name);
  928. return -ENODEV;
  929. }
  930. static const struct edac_device_prv_data s10_sdramecc_data = {
  931. .setup = altr_s10_sdram_check_ecc_deps,
  932. .ce_clear_mask = ALTR_S10_ECC_SERRPENA,
  933. .ue_clear_mask = ALTR_S10_ECC_DERRPENA,
  934. .ecc_enable_mask = ALTR_S10_ECC_EN,
  935. .ecc_en_ofst = ALTR_S10_ECC_CTRL_SDRAM_OFST,
  936. .ce_set_mask = ALTR_S10_ECC_TSERRA,
  937. .ue_set_mask = ALTR_S10_ECC_TDERRA,
  938. .set_err_ofst = ALTR_S10_ECC_INTTEST_OFST,
  939. .ecc_irq_handler = altr_edac_a10_ecc_irq,
  940. .inject_fops = &altr_edac_a10_device_inject_fops,
  941. };
  942. #endif /* CONFIG_EDAC_ALTERA_SDRAM */
  943. /*********************** OCRAM EDAC Device Functions *********************/
  944. #ifdef CONFIG_EDAC_ALTERA_OCRAM
  945. static void *ocram_alloc_mem(size_t size, void **other)
  946. {
  947. struct device_node *np;
  948. struct gen_pool *gp;
  949. void *sram_addr;
  950. np = of_find_compatible_node(NULL, NULL, "altr,socfpga-ocram-ecc");
  951. if (!np)
  952. return NULL;
  953. gp = of_gen_pool_get(np, "iram", 0);
  954. of_node_put(np);
  955. if (!gp)
  956. return NULL;
  957. sram_addr = (void *)gen_pool_alloc(gp, size);
  958. if (!sram_addr)
  959. return NULL;
  960. memset(sram_addr, 0, size);
  961. /* Ensure data is written out */
  962. wmb();
  963. /* Remember this handle for freeing later */
  964. *other = gp;
  965. return sram_addr;
  966. }
  967. static void ocram_free_mem(void *p, size_t size, void *other)
  968. {
  969. gen_pool_free((struct gen_pool *)other, (unsigned long)p, size);
  970. }
  971. static const struct edac_device_prv_data ocramecc_data = {
  972. .setup = altr_check_ecc_deps,
  973. .ce_clear_mask = (ALTR_OCR_ECC_EN | ALTR_OCR_ECC_SERR),
  974. .ue_clear_mask = (ALTR_OCR_ECC_EN | ALTR_OCR_ECC_DERR),
  975. .alloc_mem = ocram_alloc_mem,
  976. .free_mem = ocram_free_mem,
  977. .ecc_enable_mask = ALTR_OCR_ECC_EN,
  978. .ecc_en_ofst = ALTR_OCR_ECC_REG_OFFSET,
  979. .ce_set_mask = (ALTR_OCR_ECC_EN | ALTR_OCR_ECC_INJS),
  980. .ue_set_mask = (ALTR_OCR_ECC_EN | ALTR_OCR_ECC_INJD),
  981. .set_err_ofst = ALTR_OCR_ECC_REG_OFFSET,
  982. .trig_alloc_sz = ALTR_TRIG_OCRAM_BYTE_SIZE,
  983. .inject_fops = &altr_edac_device_inject_fops,
  984. };
  985. static int __maybe_unused
  986. altr_check_ocram_deps_init(struct altr_edac_device_dev *device)
  987. {
  988. void __iomem *base = device->base;
  989. int ret;
  990. ret = altr_check_ecc_deps(device);
  991. if (ret)
  992. return ret;
  993. /* Verify OCRAM has been initialized */
  994. if (!ecc_test_bits(ALTR_A10_ECC_INITCOMPLETEA,
  995. (base + ALTR_A10_ECC_INITSTAT_OFST)))
  996. return -ENODEV;
  997. /* Enable IRQ on Single Bit Error */
  998. writel(ALTR_A10_ECC_SERRINTEN, (base + ALTR_A10_ECC_ERRINTENS_OFST));
  999. /* Ensure all writes complete */
  1000. wmb();
  1001. return 0;
  1002. }
  1003. static const struct edac_device_prv_data a10_ocramecc_data = {
  1004. .setup = altr_check_ocram_deps_init,
  1005. .ce_clear_mask = ALTR_A10_ECC_SERRPENA,
  1006. .ue_clear_mask = ALTR_A10_ECC_DERRPENA,
  1007. .irq_status_mask = A10_SYSMGR_ECC_INTSTAT_OCRAM,
  1008. .ecc_enable_mask = ALTR_A10_OCRAM_ECC_EN_CTL,
  1009. .ecc_en_ofst = ALTR_A10_ECC_CTRL_OFST,
  1010. .ce_set_mask = ALTR_A10_ECC_TSERRA,
  1011. .ue_set_mask = ALTR_A10_ECC_TDERRA,
  1012. .set_err_ofst = ALTR_A10_ECC_INTTEST_OFST,
  1013. .ecc_irq_handler = altr_edac_a10_ecc_irq,
  1014. .inject_fops = &altr_edac_a10_device_inject2_fops,
  1015. /*
  1016. * OCRAM panic on uncorrectable error because sleep/resume
  1017. * functions and FPGA contents are stored in OCRAM. Prefer
  1018. * a kernel panic over executing/loading corrupted data.
  1019. */
  1020. .panic = true,
  1021. };
  1022. #endif /* CONFIG_EDAC_ALTERA_OCRAM */
  1023. /********************* L2 Cache EDAC Device Functions ********************/
  1024. #ifdef CONFIG_EDAC_ALTERA_L2C
  1025. static void *l2_alloc_mem(size_t size, void **other)
  1026. {
  1027. struct device *dev = *other;
  1028. void *ptemp = devm_kzalloc(dev, size, GFP_KERNEL);
  1029. if (!ptemp)
  1030. return NULL;
  1031. /* Make sure everything is written out */
  1032. wmb();
  1033. /*
  1034. * Clean all cache levels up to LoC (includes L2)
  1035. * This ensures the corrupted data is written into
  1036. * L2 cache for readback test (which causes ECC error).
  1037. */
  1038. flush_cache_all();
  1039. return ptemp;
  1040. }
  1041. static void l2_free_mem(void *p, size_t size, void *other)
  1042. {
  1043. struct device *dev = other;
  1044. if (dev && p)
  1045. devm_kfree(dev, p);
  1046. }
  1047. /*
  1048. * altr_l2_check_deps()
  1049. * Test for L2 cache ECC dependencies upon entry because
  1050. * platform specific startup should have initialized the L2
  1051. * memory and enabled the ECC.
  1052. * Bail if ECC is not enabled.
  1053. * Note that L2 Cache Enable is forced at build time.
  1054. */
  1055. static int altr_l2_check_deps(struct altr_edac_device_dev *device)
  1056. {
  1057. void __iomem *base = device->base;
  1058. const struct edac_device_prv_data *prv = device->data;
  1059. if ((readl(base) & prv->ecc_enable_mask) ==
  1060. prv->ecc_enable_mask)
  1061. return 0;
  1062. edac_printk(KERN_ERR, EDAC_DEVICE,
  1063. "L2: No ECC present, or ECC disabled\n");
  1064. return -ENODEV;
  1065. }
  1066. static irqreturn_t altr_edac_a10_l2_irq(int irq, void *dev_id)
  1067. {
  1068. struct altr_edac_device_dev *dci = dev_id;
  1069. if (irq == dci->sb_irq) {
  1070. regmap_write(dci->edac->ecc_mgr_map,
  1071. A10_SYSGMR_MPU_CLEAR_L2_ECC_OFST,
  1072. A10_SYSGMR_MPU_CLEAR_L2_ECC_SB);
  1073. edac_device_handle_ce(dci->edac_dev, 0, 0, dci->edac_dev_name);
  1074. return IRQ_HANDLED;
  1075. } else if (irq == dci->db_irq) {
  1076. regmap_write(dci->edac->ecc_mgr_map,
  1077. A10_SYSGMR_MPU_CLEAR_L2_ECC_OFST,
  1078. A10_SYSGMR_MPU_CLEAR_L2_ECC_MB);
  1079. edac_device_handle_ue(dci->edac_dev, 0, 0, dci->edac_dev_name);
  1080. panic("\nEDAC:ECC_DEVICE[Uncorrectable errors]\n");
  1081. return IRQ_HANDLED;
  1082. }
  1083. WARN_ON(1);
  1084. return IRQ_NONE;
  1085. }
  1086. static const struct edac_device_prv_data l2ecc_data = {
  1087. .setup = altr_l2_check_deps,
  1088. .ce_clear_mask = 0,
  1089. .ue_clear_mask = 0,
  1090. .alloc_mem = l2_alloc_mem,
  1091. .free_mem = l2_free_mem,
  1092. .ecc_enable_mask = ALTR_L2_ECC_EN,
  1093. .ce_set_mask = (ALTR_L2_ECC_EN | ALTR_L2_ECC_INJS),
  1094. .ue_set_mask = (ALTR_L2_ECC_EN | ALTR_L2_ECC_INJD),
  1095. .set_err_ofst = ALTR_L2_ECC_REG_OFFSET,
  1096. .trig_alloc_sz = ALTR_TRIG_L2C_BYTE_SIZE,
  1097. .inject_fops = &altr_edac_device_inject_fops,
  1098. };
  1099. static const struct edac_device_prv_data a10_l2ecc_data = {
  1100. .setup = altr_l2_check_deps,
  1101. .ce_clear_mask = ALTR_A10_L2_ECC_SERR_CLR,
  1102. .ue_clear_mask = ALTR_A10_L2_ECC_MERR_CLR,
  1103. .irq_status_mask = A10_SYSMGR_ECC_INTSTAT_L2,
  1104. .alloc_mem = l2_alloc_mem,
  1105. .free_mem = l2_free_mem,
  1106. .ecc_enable_mask = ALTR_A10_L2_ECC_EN_CTL,
  1107. .ce_set_mask = ALTR_A10_L2_ECC_CE_INJ_MASK,
  1108. .ue_set_mask = ALTR_A10_L2_ECC_UE_INJ_MASK,
  1109. .set_err_ofst = ALTR_A10_L2_ECC_INJ_OFST,
  1110. .ecc_irq_handler = altr_edac_a10_l2_irq,
  1111. .trig_alloc_sz = ALTR_TRIG_L2C_BYTE_SIZE,
  1112. .inject_fops = &altr_edac_device_inject_fops,
  1113. };
  1114. #endif /* CONFIG_EDAC_ALTERA_L2C */
  1115. /********************* Ethernet Device Functions ********************/
  1116. #ifdef CONFIG_EDAC_ALTERA_ETHERNET
  1117. static int __init socfpga_init_ethernet_ecc(struct altr_edac_device_dev *dev)
  1118. {
  1119. int ret;
  1120. ret = altr_init_a10_ecc_device_type("altr,socfpga-eth-mac-ecc");
  1121. if (ret)
  1122. return ret;
  1123. return altr_check_ecc_deps(dev);
  1124. }
  1125. static const struct edac_device_prv_data a10_enetecc_data = {
  1126. .setup = socfpga_init_ethernet_ecc,
  1127. .ce_clear_mask = ALTR_A10_ECC_SERRPENA,
  1128. .ue_clear_mask = ALTR_A10_ECC_DERRPENA,
  1129. .ecc_enable_mask = ALTR_A10_COMMON_ECC_EN_CTL,
  1130. .ecc_en_ofst = ALTR_A10_ECC_CTRL_OFST,
  1131. .ce_set_mask = ALTR_A10_ECC_TSERRA,
  1132. .ue_set_mask = ALTR_A10_ECC_TDERRA,
  1133. .set_err_ofst = ALTR_A10_ECC_INTTEST_OFST,
  1134. .ecc_irq_handler = altr_edac_a10_ecc_irq,
  1135. .inject_fops = &altr_edac_a10_device_inject2_fops,
  1136. };
  1137. #endif /* CONFIG_EDAC_ALTERA_ETHERNET */
  1138. /********************** NAND Device Functions **********************/
  1139. #ifdef CONFIG_EDAC_ALTERA_NAND
  1140. static int __init socfpga_init_nand_ecc(struct altr_edac_device_dev *device)
  1141. {
  1142. int ret;
  1143. ret = altr_init_a10_ecc_device_type("altr,socfpga-nand-ecc");
  1144. if (ret)
  1145. return ret;
  1146. return altr_check_ecc_deps(device);
  1147. }
  1148. static const struct edac_device_prv_data a10_nandecc_data = {
  1149. .setup = socfpga_init_nand_ecc,
  1150. .ce_clear_mask = ALTR_A10_ECC_SERRPENA,
  1151. .ue_clear_mask = ALTR_A10_ECC_DERRPENA,
  1152. .ecc_enable_mask = ALTR_A10_COMMON_ECC_EN_CTL,
  1153. .ecc_en_ofst = ALTR_A10_ECC_CTRL_OFST,
  1154. .ce_set_mask = ALTR_A10_ECC_TSERRA,
  1155. .ue_set_mask = ALTR_A10_ECC_TDERRA,
  1156. .set_err_ofst = ALTR_A10_ECC_INTTEST_OFST,
  1157. .ecc_irq_handler = altr_edac_a10_ecc_irq,
  1158. .inject_fops = &altr_edac_a10_device_inject_fops,
  1159. };
  1160. #endif /* CONFIG_EDAC_ALTERA_NAND */
  1161. /********************** DMA Device Functions **********************/
  1162. #ifdef CONFIG_EDAC_ALTERA_DMA
  1163. static int __init socfpga_init_dma_ecc(struct altr_edac_device_dev *device)
  1164. {
  1165. int ret;
  1166. ret = altr_init_a10_ecc_device_type("altr,socfpga-dma-ecc");
  1167. if (ret)
  1168. return ret;
  1169. return altr_check_ecc_deps(device);
  1170. }
  1171. static const struct edac_device_prv_data a10_dmaecc_data = {
  1172. .setup = socfpga_init_dma_ecc,
  1173. .ce_clear_mask = ALTR_A10_ECC_SERRPENA,
  1174. .ue_clear_mask = ALTR_A10_ECC_DERRPENA,
  1175. .ecc_enable_mask = ALTR_A10_COMMON_ECC_EN_CTL,
  1176. .ecc_en_ofst = ALTR_A10_ECC_CTRL_OFST,
  1177. .ce_set_mask = ALTR_A10_ECC_TSERRA,
  1178. .ue_set_mask = ALTR_A10_ECC_TDERRA,
  1179. .set_err_ofst = ALTR_A10_ECC_INTTEST_OFST,
  1180. .ecc_irq_handler = altr_edac_a10_ecc_irq,
  1181. .inject_fops = &altr_edac_a10_device_inject_fops,
  1182. };
  1183. #endif /* CONFIG_EDAC_ALTERA_DMA */
  1184. /********************** USB Device Functions **********************/
  1185. #ifdef CONFIG_EDAC_ALTERA_USB
  1186. static int __init socfpga_init_usb_ecc(struct altr_edac_device_dev *device)
  1187. {
  1188. int ret;
  1189. ret = altr_init_a10_ecc_device_type("altr,socfpga-usb-ecc");
  1190. if (ret)
  1191. return ret;
  1192. return altr_check_ecc_deps(device);
  1193. }
  1194. static const struct edac_device_prv_data a10_usbecc_data = {
  1195. .setup = socfpga_init_usb_ecc,
  1196. .ce_clear_mask = ALTR_A10_ECC_SERRPENA,
  1197. .ue_clear_mask = ALTR_A10_ECC_DERRPENA,
  1198. .ecc_enable_mask = ALTR_A10_COMMON_ECC_EN_CTL,
  1199. .ecc_en_ofst = ALTR_A10_ECC_CTRL_OFST,
  1200. .ce_set_mask = ALTR_A10_ECC_TSERRA,
  1201. .ue_set_mask = ALTR_A10_ECC_TDERRA,
  1202. .set_err_ofst = ALTR_A10_ECC_INTTEST_OFST,
  1203. .ecc_irq_handler = altr_edac_a10_ecc_irq,
  1204. .inject_fops = &altr_edac_a10_device_inject2_fops,
  1205. };
  1206. #endif /* CONFIG_EDAC_ALTERA_USB */
  1207. /********************** QSPI Device Functions **********************/
  1208. #ifdef CONFIG_EDAC_ALTERA_QSPI
  1209. static int __init socfpga_init_qspi_ecc(struct altr_edac_device_dev *device)
  1210. {
  1211. int ret;
  1212. ret = altr_init_a10_ecc_device_type("altr,socfpga-qspi-ecc");
  1213. if (ret)
  1214. return ret;
  1215. return altr_check_ecc_deps(device);
  1216. }
  1217. static const struct edac_device_prv_data a10_qspiecc_data = {
  1218. .setup = socfpga_init_qspi_ecc,
  1219. .ce_clear_mask = ALTR_A10_ECC_SERRPENA,
  1220. .ue_clear_mask = ALTR_A10_ECC_DERRPENA,
  1221. .ecc_enable_mask = ALTR_A10_COMMON_ECC_EN_CTL,
  1222. .ecc_en_ofst = ALTR_A10_ECC_CTRL_OFST,
  1223. .ce_set_mask = ALTR_A10_ECC_TSERRA,
  1224. .ue_set_mask = ALTR_A10_ECC_TDERRA,
  1225. .set_err_ofst = ALTR_A10_ECC_INTTEST_OFST,
  1226. .ecc_irq_handler = altr_edac_a10_ecc_irq,
  1227. .inject_fops = &altr_edac_a10_device_inject_fops,
  1228. };
  1229. #endif /* CONFIG_EDAC_ALTERA_QSPI */
  1230. /********************* SDMMC Device Functions **********************/
  1231. #ifdef CONFIG_EDAC_ALTERA_SDMMC
  1232. static const struct edac_device_prv_data a10_sdmmceccb_data;
  1233. static int altr_portb_setup(struct altr_edac_device_dev *device)
  1234. {
  1235. struct edac_device_ctl_info *dci;
  1236. struct altr_edac_device_dev *altdev;
  1237. char *ecc_name = "sdmmcb-ecc";
  1238. int edac_idx, rc;
  1239. struct device_node *np;
  1240. const struct edac_device_prv_data *prv = &a10_sdmmceccb_data;
  1241. rc = altr_check_ecc_deps(device);
  1242. if (rc)
  1243. return rc;
  1244. np = of_find_compatible_node(NULL, NULL, "altr,socfpga-sdmmc-ecc");
  1245. if (!np) {
  1246. edac_printk(KERN_WARNING, EDAC_DEVICE, "SDMMC node not found\n");
  1247. return -ENODEV;
  1248. }
  1249. /* Create the PortB EDAC device */
  1250. edac_idx = edac_device_alloc_index();
  1251. dci = edac_device_alloc_ctl_info(sizeof(*altdev), ecc_name, 1,
  1252. ecc_name, 1, 0, edac_idx);
  1253. if (!dci) {
  1254. edac_printk(KERN_ERR, EDAC_DEVICE,
  1255. "%s: Unable to allocate PortB EDAC device\n",
  1256. ecc_name);
  1257. return -ENOMEM;
  1258. }
  1259. /* Initialize the PortB EDAC device structure from PortA structure */
  1260. altdev = dci->pvt_info;
  1261. *altdev = *device;
  1262. if (!devres_open_group(&altdev->ddev, altr_portb_setup, GFP_KERNEL))
  1263. return -ENOMEM;
  1264. /* Update PortB specific values */
  1265. altdev->edac_dev_name = ecc_name;
  1266. altdev->edac_idx = edac_idx;
  1267. altdev->edac_dev = dci;
  1268. altdev->data = prv;
  1269. dci->dev = &altdev->ddev;
  1270. dci->ctl_name = "Altera ECC Manager";
  1271. dci->mod_name = ecc_name;
  1272. dci->dev_name = ecc_name;
  1273. /*
  1274. * Update the PortB IRQs - A10 has 4, S10 has 2, Index accordingly
  1275. *
  1276. * FIXME: Instead of ifdefs with different architectures the driver
  1277. * should properly use compatibles.
  1278. */
  1279. #ifdef CONFIG_64BIT
  1280. altdev->sb_irq = irq_of_parse_and_map(np, 1);
  1281. #else
  1282. altdev->sb_irq = irq_of_parse_and_map(np, 2);
  1283. #endif
  1284. if (!altdev->sb_irq) {
  1285. edac_printk(KERN_ERR, EDAC_DEVICE, "Error PortB SBIRQ alloc\n");
  1286. rc = -ENODEV;
  1287. goto err_release_group_1;
  1288. }
  1289. rc = devm_request_irq(&altdev->ddev, altdev->sb_irq,
  1290. prv->ecc_irq_handler,
  1291. IRQF_ONESHOT | IRQF_TRIGGER_HIGH,
  1292. ecc_name, altdev);
  1293. if (rc) {
  1294. edac_printk(KERN_ERR, EDAC_DEVICE, "PortB SBERR IRQ error\n");
  1295. goto err_release_group_1;
  1296. }
  1297. #ifdef CONFIG_64BIT
  1298. /* Use IRQ to determine SError origin instead of assigning IRQ */
  1299. rc = of_property_read_u32_index(np, "interrupts", 1, &altdev->db_irq);
  1300. if (rc) {
  1301. edac_printk(KERN_ERR, EDAC_DEVICE,
  1302. "Error PortB DBIRQ alloc\n");
  1303. goto err_release_group_1;
  1304. }
  1305. #else
  1306. altdev->db_irq = irq_of_parse_and_map(np, 3);
  1307. if (!altdev->db_irq) {
  1308. edac_printk(KERN_ERR, EDAC_DEVICE, "Error PortB DBIRQ alloc\n");
  1309. rc = -ENODEV;
  1310. goto err_release_group_1;
  1311. }
  1312. rc = devm_request_irq(&altdev->ddev, altdev->db_irq,
  1313. prv->ecc_irq_handler,
  1314. IRQF_ONESHOT | IRQF_TRIGGER_HIGH,
  1315. ecc_name, altdev);
  1316. if (rc) {
  1317. edac_printk(KERN_ERR, EDAC_DEVICE, "PortB DBERR IRQ error\n");
  1318. goto err_release_group_1;
  1319. }
  1320. #endif
  1321. rc = edac_device_add_device(dci);
  1322. if (rc) {
  1323. edac_printk(KERN_ERR, EDAC_DEVICE,
  1324. "edac_device_add_device portB failed\n");
  1325. rc = -ENOMEM;
  1326. goto err_release_group_1;
  1327. }
  1328. altr_create_edacdev_dbgfs(dci, prv);
  1329. list_add(&altdev->next, &altdev->edac->a10_ecc_devices);
  1330. devres_remove_group(&altdev->ddev, altr_portb_setup);
  1331. return 0;
  1332. err_release_group_1:
  1333. edac_device_free_ctl_info(dci);
  1334. devres_release_group(&altdev->ddev, altr_portb_setup);
  1335. edac_printk(KERN_ERR, EDAC_DEVICE,
  1336. "%s:Error setting up EDAC device: %d\n", ecc_name, rc);
  1337. return rc;
  1338. }
  1339. static int __init socfpga_init_sdmmc_ecc(struct altr_edac_device_dev *device)
  1340. {
  1341. int rc = -ENODEV;
  1342. struct device_node *child;
  1343. child = of_find_compatible_node(NULL, NULL, "altr,socfpga-sdmmc-ecc");
  1344. if (!child)
  1345. return -ENODEV;
  1346. if (!of_device_is_available(child))
  1347. goto exit;
  1348. if (validate_parent_available(child))
  1349. goto exit;
  1350. /* Init portB */
  1351. rc = altr_init_a10_ecc_block(child, ALTR_A10_SDMMC_IRQ_MASK,
  1352. a10_sdmmceccb_data.ecc_enable_mask, 1);
  1353. if (rc)
  1354. goto exit;
  1355. /* Setup portB */
  1356. return altr_portb_setup(device);
  1357. exit:
  1358. of_node_put(child);
  1359. return rc;
  1360. }
  1361. static irqreturn_t altr_edac_a10_ecc_irq_portb(int irq, void *dev_id)
  1362. {
  1363. struct altr_edac_device_dev *ad = dev_id;
  1364. void __iomem *base = ad->base;
  1365. const struct edac_device_prv_data *priv = ad->data;
  1366. if (irq == ad->sb_irq) {
  1367. writel(priv->ce_clear_mask,
  1368. base + ALTR_A10_ECC_INTSTAT_OFST);
  1369. edac_device_handle_ce(ad->edac_dev, 0, 0, ad->edac_dev_name);
  1370. return IRQ_HANDLED;
  1371. } else if (irq == ad->db_irq) {
  1372. writel(priv->ue_clear_mask,
  1373. base + ALTR_A10_ECC_INTSTAT_OFST);
  1374. edac_device_handle_ue(ad->edac_dev, 0, 0, ad->edac_dev_name);
  1375. return IRQ_HANDLED;
  1376. }
  1377. WARN_ONCE(1, "Unhandled IRQ%d on Port B.", irq);
  1378. return IRQ_NONE;
  1379. }
  1380. static const struct edac_device_prv_data a10_sdmmcecca_data = {
  1381. .setup = socfpga_init_sdmmc_ecc,
  1382. .ce_clear_mask = ALTR_A10_ECC_SERRPENA,
  1383. .ue_clear_mask = ALTR_A10_ECC_DERRPENA,
  1384. .ecc_enable_mask = ALTR_A10_COMMON_ECC_EN_CTL,
  1385. .ecc_en_ofst = ALTR_A10_ECC_CTRL_OFST,
  1386. .ce_set_mask = ALTR_A10_ECC_SERRPENA,
  1387. .ue_set_mask = ALTR_A10_ECC_DERRPENA,
  1388. .set_err_ofst = ALTR_A10_ECC_INTTEST_OFST,
  1389. .ecc_irq_handler = altr_edac_a10_ecc_irq,
  1390. .inject_fops = &altr_edac_a10_device_inject_fops,
  1391. };
  1392. static const struct edac_device_prv_data a10_sdmmceccb_data = {
  1393. .setup = socfpga_init_sdmmc_ecc,
  1394. .ce_clear_mask = ALTR_A10_ECC_SERRPENB,
  1395. .ue_clear_mask = ALTR_A10_ECC_DERRPENB,
  1396. .ecc_enable_mask = ALTR_A10_COMMON_ECC_EN_CTL,
  1397. .ecc_en_ofst = ALTR_A10_ECC_CTRL_OFST,
  1398. .ce_set_mask = ALTR_A10_ECC_TSERRB,
  1399. .ue_set_mask = ALTR_A10_ECC_TDERRB,
  1400. .set_err_ofst = ALTR_A10_ECC_INTTEST_OFST,
  1401. .ecc_irq_handler = altr_edac_a10_ecc_irq_portb,
  1402. .inject_fops = &altr_edac_a10_device_inject_fops,
  1403. };
  1404. #endif /* CONFIG_EDAC_ALTERA_SDMMC */
  1405. /********************* Arria10 EDAC Device Functions *************************/
  1406. static const struct of_device_id altr_edac_a10_device_of_match[] = {
  1407. #ifdef CONFIG_EDAC_ALTERA_L2C
  1408. { .compatible = "altr,socfpga-a10-l2-ecc", .data = &a10_l2ecc_data },
  1409. #endif
  1410. #ifdef CONFIG_EDAC_ALTERA_OCRAM
  1411. { .compatible = "altr,socfpga-a10-ocram-ecc",
  1412. .data = &a10_ocramecc_data },
  1413. #endif
  1414. #ifdef CONFIG_EDAC_ALTERA_ETHERNET
  1415. { .compatible = "altr,socfpga-eth-mac-ecc",
  1416. .data = &a10_enetecc_data },
  1417. #endif
  1418. #ifdef CONFIG_EDAC_ALTERA_NAND
  1419. { .compatible = "altr,socfpga-nand-ecc", .data = &a10_nandecc_data },
  1420. #endif
  1421. #ifdef CONFIG_EDAC_ALTERA_DMA
  1422. { .compatible = "altr,socfpga-dma-ecc", .data = &a10_dmaecc_data },
  1423. #endif
  1424. #ifdef CONFIG_EDAC_ALTERA_USB
  1425. { .compatible = "altr,socfpga-usb-ecc", .data = &a10_usbecc_data },
  1426. #endif
  1427. #ifdef CONFIG_EDAC_ALTERA_QSPI
  1428. { .compatible = "altr,socfpga-qspi-ecc", .data = &a10_qspiecc_data },
  1429. #endif
  1430. #ifdef CONFIG_EDAC_ALTERA_SDMMC
  1431. { .compatible = "altr,socfpga-sdmmc-ecc", .data = &a10_sdmmcecca_data },
  1432. #endif
  1433. #ifdef CONFIG_EDAC_ALTERA_SDRAM
  1434. { .compatible = "altr,sdram-edac-s10", .data = &s10_sdramecc_data },
  1435. #endif
  1436. {},
  1437. };
  1438. MODULE_DEVICE_TABLE(of, altr_edac_a10_device_of_match);
  1439. /*
  1440. * The Arria10 EDAC Device Functions differ from the Cyclone5/Arria5
  1441. * because 2 IRQs are shared among the all ECC peripherals. The ECC
  1442. * manager manages the IRQs and the children.
  1443. * Based on xgene_edac.c peripheral code.
  1444. */
  1445. static ssize_t __maybe_unused
  1446. altr_edac_a10_device_trig(struct file *file, const char __user *user_buf,
  1447. size_t count, loff_t *ppos)
  1448. {
  1449. struct edac_device_ctl_info *edac_dci = file->private_data;
  1450. struct altr_edac_device_dev *drvdata = edac_dci->pvt_info;
  1451. const struct edac_device_prv_data *priv = drvdata->data;
  1452. void __iomem *set_addr = (drvdata->base + priv->set_err_ofst);
  1453. unsigned long flags;
  1454. u8 trig_type;
  1455. if (!user_buf || get_user(trig_type, user_buf))
  1456. return -EFAULT;
  1457. local_irq_save(flags);
  1458. if (trig_type == ALTR_UE_TRIGGER_CHAR)
  1459. writew(priv->ue_set_mask, set_addr);
  1460. else
  1461. writew(priv->ce_set_mask, set_addr);
  1462. /* Ensure the interrupt test bits are set */
  1463. wmb();
  1464. local_irq_restore(flags);
  1465. return count;
  1466. }
  1467. /*
  1468. * The Stratix10 EDAC Error Injection Functions differ from Arria10
  1469. * slightly. A few Arria10 peripherals can use this injection function.
  1470. * Inject the error into the memory and then readback to trigger the IRQ.
  1471. */
  1472. static ssize_t __maybe_unused
  1473. altr_edac_a10_device_trig2(struct file *file, const char __user *user_buf,
  1474. size_t count, loff_t *ppos)
  1475. {
  1476. struct edac_device_ctl_info *edac_dci = file->private_data;
  1477. struct altr_edac_device_dev *drvdata = edac_dci->pvt_info;
  1478. const struct edac_device_prv_data *priv = drvdata->data;
  1479. void __iomem *set_addr = (drvdata->base + priv->set_err_ofst);
  1480. unsigned long flags;
  1481. u8 trig_type;
  1482. if (!user_buf || get_user(trig_type, user_buf))
  1483. return -EFAULT;
  1484. local_irq_save(flags);
  1485. if (trig_type == ALTR_UE_TRIGGER_CHAR) {
  1486. writew(priv->ue_set_mask, set_addr);
  1487. } else {
  1488. /* Setup read/write of 4 bytes */
  1489. writel(ECC_WORD_WRITE, drvdata->base + ECC_BLK_DBYTECTRL_OFST);
  1490. /* Setup Address to 0 */
  1491. writel(0, drvdata->base + ECC_BLK_ADDRESS_OFST);
  1492. /* Setup accctrl to read & ecc & data override */
  1493. writel(ECC_READ_EDOVR, drvdata->base + ECC_BLK_ACCCTRL_OFST);
  1494. /* Kick it. */
  1495. writel(ECC_XACT_KICK, drvdata->base + ECC_BLK_STARTACC_OFST);
  1496. /* Setup write for single bit change */
  1497. writel(readl(drvdata->base + ECC_BLK_RDATA0_OFST) ^ 0x1,
  1498. drvdata->base + ECC_BLK_WDATA0_OFST);
  1499. writel(readl(drvdata->base + ECC_BLK_RDATA1_OFST),
  1500. drvdata->base + ECC_BLK_WDATA1_OFST);
  1501. writel(readl(drvdata->base + ECC_BLK_RDATA2_OFST),
  1502. drvdata->base + ECC_BLK_WDATA2_OFST);
  1503. writel(readl(drvdata->base + ECC_BLK_RDATA3_OFST),
  1504. drvdata->base + ECC_BLK_WDATA3_OFST);
  1505. /* Copy Read ECC to Write ECC */
  1506. writel(readl(drvdata->base + ECC_BLK_RECC0_OFST),
  1507. drvdata->base + ECC_BLK_WECC0_OFST);
  1508. writel(readl(drvdata->base + ECC_BLK_RECC1_OFST),
  1509. drvdata->base + ECC_BLK_WECC1_OFST);
  1510. /* Setup accctrl to write & ecc override & data override */
  1511. writel(ECC_WRITE_EDOVR, drvdata->base + ECC_BLK_ACCCTRL_OFST);
  1512. /* Kick it. */
  1513. writel(ECC_XACT_KICK, drvdata->base + ECC_BLK_STARTACC_OFST);
  1514. /* Setup accctrl to read & ecc overwrite & data overwrite */
  1515. writel(ECC_READ_EDOVR, drvdata->base + ECC_BLK_ACCCTRL_OFST);
  1516. /* Kick it. */
  1517. writel(ECC_XACT_KICK, drvdata->base + ECC_BLK_STARTACC_OFST);
  1518. }
  1519. /* Ensure the interrupt test bits are set */
  1520. wmb();
  1521. local_irq_restore(flags);
  1522. return count;
  1523. }
  1524. static void altr_edac_a10_irq_handler(struct irq_desc *desc)
  1525. {
  1526. int dberr, bit, sm_offset, irq_status;
  1527. struct altr_arria10_edac *edac = irq_desc_get_handler_data(desc);
  1528. struct irq_chip *chip = irq_desc_get_chip(desc);
  1529. int irq = irq_desc_get_irq(desc);
  1530. unsigned long bits;
  1531. dberr = (irq == edac->db_irq) ? 1 : 0;
  1532. sm_offset = dberr ? A10_SYSMGR_ECC_INTSTAT_DERR_OFST :
  1533. A10_SYSMGR_ECC_INTSTAT_SERR_OFST;
  1534. chained_irq_enter(chip, desc);
  1535. regmap_read(edac->ecc_mgr_map, sm_offset, &irq_status);
  1536. bits = irq_status;
  1537. for_each_set_bit(bit, &bits, 32)
  1538. generic_handle_domain_irq(edac->domain, dberr * 32 + bit);
  1539. chained_irq_exit(chip, desc);
  1540. }
  1541. static int validate_parent_available(struct device_node *np)
  1542. {
  1543. struct device_node *parent;
  1544. int ret = 0;
  1545. /* SDRAM must be present for Linux (implied parent) */
  1546. if (of_device_is_compatible(np, "altr,sdram-edac-s10"))
  1547. return 0;
  1548. /* Ensure parent device is enabled if parent node exists */
  1549. parent = of_parse_phandle(np, "altr,ecc-parent", 0);
  1550. if (parent && !of_device_is_available(parent))
  1551. ret = -ENODEV;
  1552. of_node_put(parent);
  1553. return ret;
  1554. }
  1555. static int get_s10_sdram_edac_resource(struct device_node *np,
  1556. struct resource *res)
  1557. {
  1558. struct device_node *parent;
  1559. int ret;
  1560. parent = of_parse_phandle(np, "altr,sdr-syscon", 0);
  1561. if (!parent)
  1562. return -ENODEV;
  1563. ret = of_address_to_resource(parent, 0, res);
  1564. of_node_put(parent);
  1565. return ret;
  1566. }
  1567. static int altr_edac_a10_device_add(struct altr_arria10_edac *edac,
  1568. struct device_node *np)
  1569. {
  1570. struct edac_device_ctl_info *dci;
  1571. struct altr_edac_device_dev *altdev;
  1572. char *ecc_name = (char *)np->name;
  1573. struct resource res;
  1574. int edac_idx;
  1575. int rc = 0;
  1576. const struct edac_device_prv_data *prv;
  1577. /* Get matching node and check for valid result */
  1578. const struct of_device_id *pdev_id =
  1579. of_match_node(altr_edac_a10_device_of_match, np);
  1580. if (IS_ERR_OR_NULL(pdev_id))
  1581. return -ENODEV;
  1582. /* Get driver specific data for this EDAC device */
  1583. prv = pdev_id->data;
  1584. if (IS_ERR_OR_NULL(prv))
  1585. return -ENODEV;
  1586. if (validate_parent_available(np))
  1587. return -ENODEV;
  1588. if (!devres_open_group(edac->dev, altr_edac_a10_device_add, GFP_KERNEL))
  1589. return -ENOMEM;
  1590. if (of_device_is_compatible(np, "altr,sdram-edac-s10"))
  1591. rc = get_s10_sdram_edac_resource(np, &res);
  1592. else
  1593. rc = of_address_to_resource(np, 0, &res);
  1594. if (rc < 0) {
  1595. edac_printk(KERN_ERR, EDAC_DEVICE,
  1596. "%s: no resource address\n", ecc_name);
  1597. goto err_release_group;
  1598. }
  1599. edac_idx = edac_device_alloc_index();
  1600. dci = edac_device_alloc_ctl_info(sizeof(*altdev), ecc_name,
  1601. 1, ecc_name, 1, 0, edac_idx);
  1602. if (!dci) {
  1603. edac_printk(KERN_ERR, EDAC_DEVICE,
  1604. "%s: Unable to allocate EDAC device\n", ecc_name);
  1605. rc = -ENOMEM;
  1606. goto err_release_group;
  1607. }
  1608. altdev = dci->pvt_info;
  1609. dci->dev = edac->dev;
  1610. altdev->edac_dev_name = ecc_name;
  1611. altdev->edac_idx = edac_idx;
  1612. altdev->edac = edac;
  1613. altdev->edac_dev = dci;
  1614. altdev->data = prv;
  1615. altdev->ddev = *edac->dev;
  1616. dci->dev = &altdev->ddev;
  1617. dci->ctl_name = "Altera ECC Manager";
  1618. dci->mod_name = ecc_name;
  1619. dci->dev_name = ecc_name;
  1620. altdev->base = devm_ioremap_resource(edac->dev, &res);
  1621. if (IS_ERR(altdev->base)) {
  1622. rc = PTR_ERR(altdev->base);
  1623. goto err_release_group1;
  1624. }
  1625. /* Check specific dependencies for the module */
  1626. if (altdev->data->setup) {
  1627. rc = altdev->data->setup(altdev);
  1628. if (rc)
  1629. goto err_release_group1;
  1630. }
  1631. altdev->sb_irq = irq_of_parse_and_map(np, 0);
  1632. if (!altdev->sb_irq) {
  1633. edac_printk(KERN_ERR, EDAC_DEVICE, "Error allocating SBIRQ\n");
  1634. rc = -ENODEV;
  1635. goto err_release_group1;
  1636. }
  1637. rc = devm_request_irq(edac->dev, altdev->sb_irq, prv->ecc_irq_handler,
  1638. IRQF_ONESHOT | IRQF_TRIGGER_HIGH,
  1639. ecc_name, altdev);
  1640. if (rc) {
  1641. edac_printk(KERN_ERR, EDAC_DEVICE, "No SBERR IRQ resource\n");
  1642. goto err_release_group1;
  1643. }
  1644. #ifdef CONFIG_64BIT
  1645. /* Use IRQ to determine SError origin instead of assigning IRQ */
  1646. rc = of_property_read_u32_index(np, "interrupts", 0, &altdev->db_irq);
  1647. if (rc) {
  1648. edac_printk(KERN_ERR, EDAC_DEVICE,
  1649. "Unable to parse DB IRQ index\n");
  1650. goto err_release_group1;
  1651. }
  1652. #else
  1653. altdev->db_irq = irq_of_parse_and_map(np, 1);
  1654. if (!altdev->db_irq) {
  1655. edac_printk(KERN_ERR, EDAC_DEVICE, "Error allocating DBIRQ\n");
  1656. rc = -ENODEV;
  1657. goto err_release_group1;
  1658. }
  1659. rc = devm_request_irq(edac->dev, altdev->db_irq, prv->ecc_irq_handler,
  1660. IRQF_ONESHOT | IRQF_TRIGGER_HIGH,
  1661. ecc_name, altdev);
  1662. if (rc) {
  1663. edac_printk(KERN_ERR, EDAC_DEVICE, "No DBERR IRQ resource\n");
  1664. goto err_release_group1;
  1665. }
  1666. #endif
  1667. rc = edac_device_add_device(dci);
  1668. if (rc) {
  1669. dev_err(edac->dev, "edac_device_add_device failed\n");
  1670. rc = -ENOMEM;
  1671. goto err_release_group1;
  1672. }
  1673. altr_create_edacdev_dbgfs(dci, prv);
  1674. list_add(&altdev->next, &edac->a10_ecc_devices);
  1675. devres_remove_group(edac->dev, altr_edac_a10_device_add);
  1676. return 0;
  1677. err_release_group1:
  1678. edac_device_free_ctl_info(dci);
  1679. err_release_group:
  1680. devres_release_group(edac->dev, NULL);
  1681. edac_printk(KERN_ERR, EDAC_DEVICE,
  1682. "%s:Error setting up EDAC device: %d\n", ecc_name, rc);
  1683. return rc;
  1684. }
  1685. static void a10_eccmgr_irq_mask(struct irq_data *d)
  1686. {
  1687. struct altr_arria10_edac *edac = irq_data_get_irq_chip_data(d);
  1688. regmap_write(edac->ecc_mgr_map, A10_SYSMGR_ECC_INTMASK_SET_OFST,
  1689. BIT(d->hwirq));
  1690. }
  1691. static void a10_eccmgr_irq_unmask(struct irq_data *d)
  1692. {
  1693. struct altr_arria10_edac *edac = irq_data_get_irq_chip_data(d);
  1694. regmap_write(edac->ecc_mgr_map, A10_SYSMGR_ECC_INTMASK_CLR_OFST,
  1695. BIT(d->hwirq));
  1696. }
  1697. static int a10_eccmgr_irqdomain_map(struct irq_domain *d, unsigned int irq,
  1698. irq_hw_number_t hwirq)
  1699. {
  1700. struct altr_arria10_edac *edac = d->host_data;
  1701. irq_set_chip_and_handler(irq, &edac->irq_chip, handle_simple_irq);
  1702. irq_set_chip_data(irq, edac);
  1703. irq_set_noprobe(irq);
  1704. return 0;
  1705. }
  1706. static const struct irq_domain_ops a10_eccmgr_ic_ops = {
  1707. .map = a10_eccmgr_irqdomain_map,
  1708. .xlate = irq_domain_xlate_twocell,
  1709. };
  1710. /************** Stratix 10 EDAC Double Bit Error Handler ************/
  1711. #define to_a10edac(p, m) container_of(p, struct altr_arria10_edac, m)
  1712. #ifdef CONFIG_64BIT
  1713. /* panic routine issues reboot on non-zero panic_timeout */
  1714. extern int panic_timeout;
  1715. /*
  1716. * The double bit error is handled through SError which is fatal. This is
  1717. * called as a panic notifier to printout ECC error info as part of the panic.
  1718. */
  1719. static int s10_edac_dberr_handler(struct notifier_block *this,
  1720. unsigned long event, void *ptr)
  1721. {
  1722. struct altr_arria10_edac *edac = to_a10edac(this, panic_notifier);
  1723. int err_addr, dberror;
  1724. regmap_read(edac->ecc_mgr_map, S10_SYSMGR_ECC_INTSTAT_DERR_OFST,
  1725. &dberror);
  1726. regmap_write(edac->ecc_mgr_map, S10_SYSMGR_UE_VAL_OFST, dberror);
  1727. if (dberror & S10_DBE_IRQ_MASK) {
  1728. struct list_head *position;
  1729. struct altr_edac_device_dev *ed;
  1730. struct arm_smccc_res result;
  1731. /* Find the matching DBE in the list of devices */
  1732. list_for_each(position, &edac->a10_ecc_devices) {
  1733. ed = list_entry(position, struct altr_edac_device_dev,
  1734. next);
  1735. if (!(BIT(ed->db_irq) & dberror))
  1736. continue;
  1737. writel(ALTR_A10_ECC_DERRPENA,
  1738. ed->base + ALTR_A10_ECC_INTSTAT_OFST);
  1739. err_addr = readl(ed->base + ALTR_S10_DERR_ADDRA_OFST);
  1740. regmap_write(edac->ecc_mgr_map,
  1741. S10_SYSMGR_UE_ADDR_OFST, err_addr);
  1742. edac_printk(KERN_ERR, EDAC_DEVICE,
  1743. "EDAC: [Fatal DBE on %s @ 0x%08X]\n",
  1744. ed->edac_dev_name, err_addr);
  1745. break;
  1746. }
  1747. /* Notify the System through SMC. Reboot delay = 1 second */
  1748. panic_timeout = 1;
  1749. arm_smccc_smc(INTEL_SIP_SMC_ECC_DBE, dberror, 0, 0, 0, 0,
  1750. 0, 0, &result);
  1751. }
  1752. return NOTIFY_DONE;
  1753. }
  1754. #endif
  1755. /****************** Arria 10 EDAC Probe Function *********************/
  1756. static int altr_edac_a10_probe(struct platform_device *pdev)
  1757. {
  1758. struct altr_arria10_edac *edac;
  1759. struct device_node *child;
  1760. edac = devm_kzalloc(&pdev->dev, sizeof(*edac), GFP_KERNEL);
  1761. if (!edac)
  1762. return -ENOMEM;
  1763. edac->dev = &pdev->dev;
  1764. platform_set_drvdata(pdev, edac);
  1765. INIT_LIST_HEAD(&edac->a10_ecc_devices);
  1766. edac->ecc_mgr_map =
  1767. altr_sysmgr_regmap_lookup_by_phandle(pdev->dev.of_node,
  1768. "altr,sysmgr-syscon");
  1769. if (IS_ERR(edac->ecc_mgr_map)) {
  1770. edac_printk(KERN_ERR, EDAC_DEVICE,
  1771. "Unable to get syscon altr,sysmgr-syscon\n");
  1772. return PTR_ERR(edac->ecc_mgr_map);
  1773. }
  1774. /* Set irq mask for DDR SBE to avoid any pending irq before registration */
  1775. regmap_write(edac->ecc_mgr_map, A10_SYSMGR_ECC_INTMASK_SET_OFST,
  1776. (A10_SYSMGR_ECC_INTMASK_SDMMCB | A10_SYSMGR_ECC_INTMASK_DDR0));
  1777. edac->irq_chip.name = pdev->dev.of_node->name;
  1778. edac->irq_chip.irq_mask = a10_eccmgr_irq_mask;
  1779. edac->irq_chip.irq_unmask = a10_eccmgr_irq_unmask;
  1780. edac->domain = irq_domain_add_linear(pdev->dev.of_node, 64,
  1781. &a10_eccmgr_ic_ops, edac);
  1782. if (!edac->domain) {
  1783. dev_err(&pdev->dev, "Error adding IRQ domain\n");
  1784. return -ENOMEM;
  1785. }
  1786. edac->sb_irq = platform_get_irq(pdev, 0);
  1787. if (edac->sb_irq < 0)
  1788. return edac->sb_irq;
  1789. irq_set_chained_handler_and_data(edac->sb_irq,
  1790. altr_edac_a10_irq_handler,
  1791. edac);
  1792. #ifdef CONFIG_64BIT
  1793. {
  1794. int dberror, err_addr;
  1795. edac->panic_notifier.notifier_call = s10_edac_dberr_handler;
  1796. atomic_notifier_chain_register(&panic_notifier_list,
  1797. &edac->panic_notifier);
  1798. /* Printout a message if uncorrectable error previously. */
  1799. regmap_read(edac->ecc_mgr_map, S10_SYSMGR_UE_VAL_OFST,
  1800. &dberror);
  1801. if (dberror) {
  1802. regmap_read(edac->ecc_mgr_map, S10_SYSMGR_UE_ADDR_OFST,
  1803. &err_addr);
  1804. edac_printk(KERN_ERR, EDAC_DEVICE,
  1805. "Previous Boot UE detected[0x%X] @ 0x%X\n",
  1806. dberror, err_addr);
  1807. /* Reset the sticky registers */
  1808. regmap_write(edac->ecc_mgr_map,
  1809. S10_SYSMGR_UE_VAL_OFST, 0);
  1810. regmap_write(edac->ecc_mgr_map,
  1811. S10_SYSMGR_UE_ADDR_OFST, 0);
  1812. }
  1813. }
  1814. #else
  1815. edac->db_irq = platform_get_irq(pdev, 1);
  1816. if (edac->db_irq < 0)
  1817. return edac->db_irq;
  1818. irq_set_chained_handler_and_data(edac->db_irq,
  1819. altr_edac_a10_irq_handler, edac);
  1820. #endif
  1821. for_each_child_of_node(pdev->dev.of_node, child) {
  1822. if (!of_device_is_available(child))
  1823. continue;
  1824. if (of_match_node(altr_edac_a10_device_of_match, child))
  1825. altr_edac_a10_device_add(edac, child);
  1826. #ifdef CONFIG_EDAC_ALTERA_SDRAM
  1827. else if (of_device_is_compatible(child, "altr,sdram-edac-a10"))
  1828. of_platform_populate(pdev->dev.of_node,
  1829. altr_sdram_ctrl_of_match,
  1830. NULL, &pdev->dev);
  1831. #endif
  1832. }
  1833. return 0;
  1834. }
  1835. static const struct of_device_id altr_edac_a10_of_match[] = {
  1836. { .compatible = "altr,socfpga-a10-ecc-manager" },
  1837. { .compatible = "altr,socfpga-s10-ecc-manager" },
  1838. {},
  1839. };
  1840. MODULE_DEVICE_TABLE(of, altr_edac_a10_of_match);
  1841. static struct platform_driver altr_edac_a10_driver = {
  1842. .probe = altr_edac_a10_probe,
  1843. .driver = {
  1844. .name = "socfpga_a10_ecc_manager",
  1845. .of_match_table = altr_edac_a10_of_match,
  1846. },
  1847. };
  1848. module_platform_driver(altr_edac_a10_driver);
  1849. MODULE_AUTHOR("Thor Thayer");
  1850. MODULE_DESCRIPTION("EDAC Driver for Altera Memories");