1
2
3
4
5
6
7
8
9
10
11
12#include <linux/edac.h>
13#include <linux/interrupt.h>
14#include <linux/irq.h>
15#include <linux/kernel.h>
16#include <linux/mm.h>
17#include <linux/module.h>
18#include <linux/of_device.h>
19#include <linux/of_platform.h>
20#include <linux/types.h>
21
22#include <asm/dcr.h>
23
24#include "edac_core.h"
25#include "ppc4xx_edac.h"
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
58
59
60
61
62
63
64
65
66
67
68
69
70
71
72
73
74
75
76
77
78
79
80
81
82
83
84
85
86
87
88
89
90
91
92
93
94
95
96
97
98
99
100
101
102
103
104
105
106
107
108
109
110
111#define EDAC_OPSTATE_INT_STR "interrupt"
112#define EDAC_OPSTATE_POLL_STR "polled"
113#define EDAC_OPSTATE_UNKNOWN_STR "unknown"
114
115#define PPC4XX_EDAC_MODULE_NAME "ppc4xx_edac"
116#define PPC4XX_EDAC_MODULE_REVISION "v1.0.0"
117
118#define PPC4XX_EDAC_MESSAGE_SIZE 256
119
120
121
122
123#define ppc4xx_edac_printk(level, fmt, arg...) \
124 edac_printk(level, "PPC4xx MC", fmt, ##arg)
125
126
127
128
129#define ppc4xx_edac_mc_printk(level, mci, fmt, arg...) \
130 edac_mc_chipset_printk(mci, level, "PPC4xx", fmt, ##arg)
131
132
133
134
135
136#define SDRAM_MBCF_SZ_MiB_MIN 4
137#define SDRAM_MBCF_SZ_TO_MiB(n) (SDRAM_MBCF_SZ_MiB_MIN \
138 << (SDRAM_MBCF_SZ_DECODE(n)))
139#define SDRAM_MBCF_SZ_TO_PAGES(n) (SDRAM_MBCF_SZ_MiB_MIN \
140 << (20 - PAGE_SHIFT + \
141 SDRAM_MBCF_SZ_DECODE(n)))
142
143
144
145
146
147
148
149
150#define SDRAM_DCR_RESOURCE_LEN 2
151#define SDRAM_DCR_ADDR_OFFSET 0
152#define SDRAM_DCR_DATA_OFFSET 1
153
154
155
156
157#define INTMAP_ECCDED_INDEX 0
158#define INTMAP_ECCSEC_INDEX 1
159
160
161
162
163
164
165struct ppc4xx_edac_pdata {
166 dcr_host_t dcr_host;
167 struct {
168 int sec;
169 int ded;
170 } irqs;
171};
172
173
174
175
176
177struct ppc4xx_ecc_status {
178 u32 ecces;
179 u32 besr;
180 u32 bearh;
181 u32 bearl;
182 u32 wmirq;
183};
184
185
186
187static int ppc4xx_edac_probe(struct platform_device *device)
188static int ppc4xx_edac_remove(struct platform_device *device);
189
190
191
192
193
194
195
196static struct of_device_id ppc4xx_edac_match[] = {
197 {
198 .compatible = "ibm,sdram-4xx-ddr2"
199 },
200 { }
201};
202
203static struct platform_driver ppc4xx_edac_driver = {
204 .probe = ppc4xx_edac_probe,
205 .remove = ppc4xx_edac_remove,
206 .driver = {
207 .owner = THIS_MODULE,
208 .name = PPC4XX_EDAC_MODULE_NAME,
209 .of_match_table = ppc4xx_edac_match,
210 },
211};
212
213
214
215
216
217static const unsigned ppc4xx_edac_nr_csrows = 2;
218static const unsigned ppc4xx_edac_nr_chans = 1;
219
220
221
222
223
224static const char * const ppc4xx_plb_masters[9] = {
225 [SDRAM_PLB_M0ID_ICU] = "ICU",
226 [SDRAM_PLB_M0ID_PCIE0] = "PCI-E 0",
227 [SDRAM_PLB_M0ID_PCIE1] = "PCI-E 1",
228 [SDRAM_PLB_M0ID_DMA] = "DMA",
229 [SDRAM_PLB_M0ID_DCU] = "DCU",
230 [SDRAM_PLB_M0ID_OPB] = "OPB",
231 [SDRAM_PLB_M0ID_MAL] = "MAL",
232 [SDRAM_PLB_M0ID_SEC] = "SEC",
233 [SDRAM_PLB_M0ID_AHB] = "AHB"
234};
235
236
237
238
239
240
241
242
243
244
245
246static inline u32
247mfsdram(const dcr_host_t *dcr_host, unsigned int idcr_n)
248{
249 return __mfdcri(dcr_host->base + SDRAM_DCR_ADDR_OFFSET,
250 dcr_host->base + SDRAM_DCR_DATA_OFFSET,
251 idcr_n);
252}
253
254
255
256
257
258
259
260
261
262
263static inline void
264mtsdram(const dcr_host_t *dcr_host, unsigned int idcr_n, u32 value)
265{
266 return __mtdcri(dcr_host->base + SDRAM_DCR_ADDR_OFFSET,
267 dcr_host->base + SDRAM_DCR_DATA_OFFSET,
268 idcr_n,
269 value);
270}
271
272
273
274
275
276
277
278
279
280
281
282
283
284static bool
285ppc4xx_edac_check_bank_error(const struct ppc4xx_ecc_status *status,
286 unsigned int bank)
287{
288 switch (bank) {
289 case 0:
290 return status->ecces & SDRAM_ECCES_BK0ER;
291 case 1:
292 return status->ecces & SDRAM_ECCES_BK1ER;
293 default:
294 return false;
295 }
296}
297
298
299
300
301
302
303
304
305
306
307
308
309
310
311
312
313
314
315static int
316ppc4xx_edac_generate_bank_message(const struct mem_ctl_info *mci,
317 const struct ppc4xx_ecc_status *status,
318 char *buffer,
319 size_t size)
320{
321 int n, total = 0;
322 unsigned int row, rows;
323
324 n = snprintf(buffer, size, "%s: Banks: ", mci->dev_name);
325
326 if (n < 0 || n >= size)
327 goto fail;
328
329 buffer += n;
330 size -= n;
331 total += n;
332
333 for (rows = 0, row = 0; row < mci->nr_csrows; row++) {
334 if (ppc4xx_edac_check_bank_error(status, row)) {
335 n = snprintf(buffer, size, "%s%u",
336 (rows++ ? ", " : ""), row);
337
338 if (n < 0 || n >= size)
339 goto fail;
340
341 buffer += n;
342 size -= n;
343 total += n;
344 }
345 }
346
347 n = snprintf(buffer, size, "%s; ", rows ? "" : "None");
348
349 if (n < 0 || n >= size)
350 goto fail;
351
352 buffer += n;
353 size -= n;
354 total += n;
355
356 fail:
357 return total;
358}
359
360
361
362
363
364
365
366
367
368
369
370
371
372
373
374
375
376
377static int
378ppc4xx_edac_generate_checkbit_message(const struct mem_ctl_info *mci,
379 const struct ppc4xx_ecc_status *status,
380 char *buffer,
381 size_t size)
382{
383 const struct ppc4xx_edac_pdata *pdata = mci->pvt_info;
384 const char *ckber = NULL;
385
386 switch (status->ecces & SDRAM_ECCES_CKBER_MASK) {
387 case SDRAM_ECCES_CKBER_NONE:
388 ckber = "None";
389 break;
390 case SDRAM_ECCES_CKBER_32_ECC_0_3:
391 ckber = "ECC0:3";
392 break;
393 case SDRAM_ECCES_CKBER_32_ECC_4_8:
394 switch (mfsdram(&pdata->dcr_host, SDRAM_MCOPT1) &
395 SDRAM_MCOPT1_WDTH_MASK) {
396 case SDRAM_MCOPT1_WDTH_16:
397 ckber = "ECC0:3";
398 break;
399 case SDRAM_MCOPT1_WDTH_32:
400 ckber = "ECC4:8";
401 break;
402 default:
403 ckber = "Unknown";
404 break;
405 }
406 break;
407 case SDRAM_ECCES_CKBER_32_ECC_0_8:
408 ckber = "ECC0:8";
409 break;
410 default:
411 ckber = "Unknown";
412 break;
413 }
414
415 return snprintf(buffer, size, "Checkbit Error: %s", ckber);
416}
417
418
419
420
421
422
423
424
425
426
427
428
429
430
431
432
433
434
435static int
436ppc4xx_edac_generate_lane_message(const struct mem_ctl_info *mci,
437 const struct ppc4xx_ecc_status *status,
438 char *buffer,
439 size_t size)
440{
441 int n, total = 0;
442 unsigned int lane, lanes;
443 const unsigned int first_lane = 0;
444 const unsigned int lane_count = 16;
445
446 n = snprintf(buffer, size, "; Byte Lane Errors: ");
447
448 if (n < 0 || n >= size)
449 goto fail;
450
451 buffer += n;
452 size -= n;
453 total += n;
454
455 for (lanes = 0, lane = first_lane; lane < lane_count; lane++) {
456 if ((status->ecces & SDRAM_ECCES_BNCE_ENCODE(lane)) != 0) {
457 n = snprintf(buffer, size,
458 "%s%u",
459 (lanes++ ? ", " : ""), lane);
460
461 if (n < 0 || n >= size)
462 goto fail;
463
464 buffer += n;
465 size -= n;
466 total += n;
467 }
468 }
469
470 n = snprintf(buffer, size, "%s; ", lanes ? "" : "None");
471
472 if (n < 0 || n >= size)
473 goto fail;
474
475 buffer += n;
476 size -= n;
477 total += n;
478
479 fail:
480 return total;
481}
482
483
484
485
486
487
488
489
490
491
492
493
494
495
496
497
498
499
500static int
501ppc4xx_edac_generate_ecc_message(const struct mem_ctl_info *mci,
502 const struct ppc4xx_ecc_status *status,
503 char *buffer,
504 size_t size)
505{
506 int n, total = 0;
507
508 n = ppc4xx_edac_generate_bank_message(mci, status, buffer, size);
509
510 if (n < 0 || n >= size)
511 goto fail;
512
513 buffer += n;
514 size -= n;
515 total += n;
516
517 n = ppc4xx_edac_generate_checkbit_message(mci, status, buffer, size);
518
519 if (n < 0 || n >= size)
520 goto fail;
521
522 buffer += n;
523 size -= n;
524 total += n;
525
526 n = ppc4xx_edac_generate_lane_message(mci, status, buffer, size);
527
528 if (n < 0 || n >= size)
529 goto fail;
530
531 buffer += n;
532 size -= n;
533 total += n;
534
535 fail:
536 return total;
537}
538
539
540
541
542
543
544
545
546
547
548
549
550
551
552
553
554
555
556static int
557ppc4xx_edac_generate_plb_message(const struct mem_ctl_info *mci,
558 const struct ppc4xx_ecc_status *status,
559 char *buffer,
560 size_t size)
561{
562 unsigned int master;
563 bool read;
564
565 if ((status->besr & SDRAM_BESR_MASK) == 0)
566 return 0;
567
568 if ((status->besr & SDRAM_BESR_M0ET_MASK) == SDRAM_BESR_M0ET_NONE)
569 return 0;
570
571 read = ((status->besr & SDRAM_BESR_M0RW_MASK) == SDRAM_BESR_M0RW_READ);
572
573 master = SDRAM_BESR_M0ID_DECODE(status->besr);
574
575 return snprintf(buffer, size,
576 "%s error w/ PLB master %u \"%s\"; ",
577 (read ? "Read" : "Write"),
578 master,
579 (((master >= SDRAM_PLB_M0ID_FIRST) &&
580 (master <= SDRAM_PLB_M0ID_LAST)) ?
581 ppc4xx_plb_masters[master] : "UNKNOWN"));
582}
583
584
585
586
587
588
589
590
591
592
593
594
595
596
597static void
598ppc4xx_edac_generate_message(const struct mem_ctl_info *mci,
599 const struct ppc4xx_ecc_status *status,
600 char *buffer,
601 size_t size)
602{
603 int n;
604
605 if (buffer == NULL || size == 0)
606 return;
607
608 n = ppc4xx_edac_generate_ecc_message(mci, status, buffer, size);
609
610 if (n < 0 || n >= size)
611 return;
612
613 buffer += n;
614 size -= n;
615
616 ppc4xx_edac_generate_plb_message(mci, status, buffer, size);
617}
618
619#ifdef DEBUG
620
621
622
623
624
625
626
627
628
629
630static void
631ppc4xx_ecc_dump_status(const struct mem_ctl_info *mci,
632 const struct ppc4xx_ecc_status *status)
633{
634 char message[PPC4XX_EDAC_MESSAGE_SIZE];
635
636 ppc4xx_edac_generate_message(mci, status, message, sizeof(message));
637
638 ppc4xx_edac_mc_printk(KERN_INFO, mci,
639 "\n"
640 "\tECCES: 0x%08x\n"
641 "\tWMIRQ: 0x%08x\n"
642 "\tBESR: 0x%08x\n"
643 "\tBEAR: 0x%08x%08x\n"
644 "\t%s\n",
645 status->ecces,
646 status->wmirq,
647 status->besr,
648 status->bearh,
649 status->bearl,
650 message);
651}
652#endif
653
654
655
656
657
658
659
660
661
662
663
664
665
666
667static void
668ppc4xx_ecc_get_status(const struct mem_ctl_info *mci,
669 struct ppc4xx_ecc_status *status)
670{
671 const struct ppc4xx_edac_pdata *pdata = mci->pvt_info;
672 const dcr_host_t *dcr_host = &pdata->dcr_host;
673
674 status->ecces = mfsdram(dcr_host, SDRAM_ECCES) & SDRAM_ECCES_MASK;
675 status->wmirq = mfsdram(dcr_host, SDRAM_WMIRQ) & SDRAM_WMIRQ_MASK;
676 status->besr = mfsdram(dcr_host, SDRAM_BESR) & SDRAM_BESR_MASK;
677 status->bearl = mfsdram(dcr_host, SDRAM_BEARL);
678 status->bearh = mfsdram(dcr_host, SDRAM_BEARH);
679}
680
681
682
683
684
685
686
687
688
689
690
691
692static void
693ppc4xx_ecc_clear_status(const struct mem_ctl_info *mci,
694 const struct ppc4xx_ecc_status *status)
695{
696 const struct ppc4xx_edac_pdata *pdata = mci->pvt_info;
697 const dcr_host_t *dcr_host = &pdata->dcr_host;
698
699 mtsdram(dcr_host, SDRAM_ECCES, status->ecces & SDRAM_ECCES_MASK);
700 mtsdram(dcr_host, SDRAM_WMIRQ, status->wmirq & SDRAM_WMIRQ_MASK);
701 mtsdram(dcr_host, SDRAM_BESR, status->besr & SDRAM_BESR_MASK);
702 mtsdram(dcr_host, SDRAM_BEARL, 0);
703 mtsdram(dcr_host, SDRAM_BEARH, 0);
704}
705
706
707
708
709
710
711
712
713
714
715
716
717
718
719static void
720ppc4xx_edac_handle_ce(struct mem_ctl_info *mci,
721 const struct ppc4xx_ecc_status *status)
722{
723 int row;
724 char message[PPC4XX_EDAC_MESSAGE_SIZE];
725
726 ppc4xx_edac_generate_message(mci, status, message, sizeof(message));
727
728 for (row = 0; row < mci->nr_csrows; row++)
729 if (ppc4xx_edac_check_bank_error(status, row))
730 edac_mc_handle_ce_no_info(mci, message);
731}
732
733
734
735
736
737
738
739
740
741
742
743
744static void
745ppc4xx_edac_handle_ue(struct mem_ctl_info *mci,
746 const struct ppc4xx_ecc_status *status)
747{
748 const u64 bear = ((u64)status->bearh << 32 | status->bearl);
749 const unsigned long page = bear >> PAGE_SHIFT;
750 const unsigned long offset = bear & ~PAGE_MASK;
751 int row;
752 char message[PPC4XX_EDAC_MESSAGE_SIZE];
753
754 ppc4xx_edac_generate_message(mci, status, message, sizeof(message));
755
756 for (row = 0; row < mci->nr_csrows; row++)
757 if (ppc4xx_edac_check_bank_error(status, row))
758 edac_mc_handle_ue(mci, page, offset, row, message);
759}
760
761
762
763
764
765
766
767
768
769
770
771static void
772ppc4xx_edac_check(struct mem_ctl_info *mci)
773{
774#ifdef DEBUG
775 static unsigned int count;
776#endif
777 struct ppc4xx_ecc_status status;
778
779 ppc4xx_ecc_get_status(mci, &status);
780
781#ifdef DEBUG
782 if (count++ % 30 == 0)
783 ppc4xx_ecc_dump_status(mci, &status);
784#endif
785
786 if (status.ecces & SDRAM_ECCES_UE)
787 ppc4xx_edac_handle_ue(mci, &status);
788
789 if (status.ecces & SDRAM_ECCES_CE)
790 ppc4xx_edac_handle_ce(mci, &status);
791
792 ppc4xx_ecc_clear_status(mci, &status);
793}
794
795
796
797
798
799
800
801
802
803
804
805
806
807
808static irqreturn_t
809ppc4xx_edac_isr(int irq, void *dev_id)
810{
811 struct mem_ctl_info *mci = dev_id;
812
813 ppc4xx_edac_check(mci);
814
815 return IRQ_HANDLED;
816}
817
818
819
820
821
822
823
824
825
826
827
828
829
830
831
832
833
834
835static enum dev_type __devinit
836ppc4xx_edac_get_dtype(u32 mcopt1)
837{
838 switch (mcopt1 & SDRAM_MCOPT1_WDTH_MASK) {
839 case SDRAM_MCOPT1_WDTH_16:
840 return DEV_X2;
841 case SDRAM_MCOPT1_WDTH_32:
842 return DEV_X4;
843 default:
844 return DEV_UNKNOWN;
845 }
846}
847
848
849
850
851
852
853
854
855
856
857
858
859static enum mem_type __devinit
860ppc4xx_edac_get_mtype(u32 mcopt1)
861{
862 bool rden = ((mcopt1 & SDRAM_MCOPT1_RDEN_MASK) == SDRAM_MCOPT1_RDEN);
863
864 switch (mcopt1 & SDRAM_MCOPT1_DDR_TYPE_MASK) {
865 case SDRAM_MCOPT1_DDR2_TYPE:
866 return rden ? MEM_RDDR2 : MEM_DDR2;
867 case SDRAM_MCOPT1_DDR1_TYPE:
868 return rden ? MEM_RDDR : MEM_DDR;
869 default:
870 return MEM_UNKNOWN;
871 }
872}
873
874
875
876
877
878
879
880
881
882
883
884
885
886
887
888
889
890static int __devinit
891ppc4xx_edac_init_csrows(struct mem_ctl_info *mci, u32 mcopt1)
892{
893 const struct ppc4xx_edac_pdata *pdata = mci->pvt_info;
894 int status = 0;
895 enum mem_type mtype;
896 enum dev_type dtype;
897 enum edac_type edac_mode;
898 int row;
899 u32 mbxcf, size;
900 static u32 ppc4xx_last_page;
901
902
903
904 mtype = ppc4xx_edac_get_mtype(mcopt1);
905 dtype = ppc4xx_edac_get_dtype(mcopt1);
906
907
908
909 if (mci->edac_cap & EDAC_FLAG_SECDED)
910 edac_mode = EDAC_SECDED;
911 else if (mci->edac_cap & EDAC_FLAG_EC)
912 edac_mode = EDAC_EC;
913 else
914 edac_mode = EDAC_NONE;
915
916
917
918
919
920
921 for (row = 0; row < mci->nr_csrows; row++) {
922 struct csrow_info *csi = &mci->csrows[row];
923
924
925
926
927
928
929 mbxcf = mfsdram(&pdata->dcr_host, SDRAM_MBXCF(row));
930
931 if ((mbxcf & SDRAM_MBCF_BE_MASK) != SDRAM_MBCF_BE_ENABLE)
932 continue;
933
934
935
936 size = mbxcf & SDRAM_MBCF_SZ_MASK;
937
938 switch (size) {
939 case SDRAM_MBCF_SZ_4MB:
940 case SDRAM_MBCF_SZ_8MB:
941 case SDRAM_MBCF_SZ_16MB:
942 case SDRAM_MBCF_SZ_32MB:
943 case SDRAM_MBCF_SZ_64MB:
944 case SDRAM_MBCF_SZ_128MB:
945 case SDRAM_MBCF_SZ_256MB:
946 case SDRAM_MBCF_SZ_512MB:
947 case SDRAM_MBCF_SZ_1GB:
948 case SDRAM_MBCF_SZ_2GB:
949 case SDRAM_MBCF_SZ_4GB:
950 case SDRAM_MBCF_SZ_8GB:
951 csi->nr_pages = SDRAM_MBCF_SZ_TO_PAGES(size);
952 break;
953 default:
954 ppc4xx_edac_mc_printk(KERN_ERR, mci,
955 "Unrecognized memory bank %d "
956 "size 0x%08x\n",
957 row, SDRAM_MBCF_SZ_DECODE(size));
958 status = -EINVAL;
959 goto done;
960 }
961
962 csi->first_page = ppc4xx_last_page;
963 csi->last_page = csi->first_page + csi->nr_pages - 1;
964 csi->page_mask = 0;
965
966
967
968
969
970
971
972
973
974
975
976
977
978
979 csi->grain = 1;
980
981 csi->mtype = mtype;
982 csi->dtype = dtype;
983
984 csi->edac_mode = edac_mode;
985
986 ppc4xx_last_page += csi->nr_pages;
987 }
988
989 done:
990 return status;
991}
992
993
994
995
996
997
998
999
1000
1001
1002
1003
1004
1005
1006
1007
1008
1009
1010
1011static int __devinit
1012ppc4xx_edac_mc_init(struct mem_ctl_info *mci,
1013 struct platform_device *op,
1014 const dcr_host_t *dcr_host,
1015 u32 mcopt1)
1016{
1017 int status = 0;
1018 const u32 memcheck = (mcopt1 & SDRAM_MCOPT1_MCHK_MASK);
1019 struct ppc4xx_edac_pdata *pdata = NULL;
1020 const struct device_node *np = op->dev.of_node;
1021
1022 if (of_match_device(ppc4xx_edac_match, &op->dev) == NULL)
1023 return -EINVAL;
1024
1025
1026
1027 mci->dev = &op->dev;
1028
1029 dev_set_drvdata(mci->dev, mci);
1030
1031 pdata = mci->pvt_info;
1032
1033 pdata->dcr_host = *dcr_host;
1034 pdata->irqs.sec = NO_IRQ;
1035 pdata->irqs.ded = NO_IRQ;
1036
1037
1038
1039 mci->mtype_cap = (MEM_FLAG_DDR | MEM_FLAG_RDDR |
1040 MEM_FLAG_DDR2 | MEM_FLAG_RDDR2);
1041
1042 mci->edac_ctl_cap = (EDAC_FLAG_NONE |
1043 EDAC_FLAG_EC |
1044 EDAC_FLAG_SECDED);
1045
1046 mci->scrub_cap = SCRUB_NONE;
1047 mci->scrub_mode = SCRUB_NONE;
1048
1049
1050
1051
1052
1053
1054 switch (memcheck) {
1055 case SDRAM_MCOPT1_MCHK_CHK:
1056 mci->edac_cap = EDAC_FLAG_EC;
1057 break;
1058 case SDRAM_MCOPT1_MCHK_CHK_REP:
1059 mci->edac_cap = (EDAC_FLAG_EC | EDAC_FLAG_SECDED);
1060 mci->scrub_mode = SCRUB_SW_SRC;
1061 break;
1062 default:
1063 mci->edac_cap = EDAC_FLAG_NONE;
1064 break;
1065 }
1066
1067
1068
1069 mci->mod_name = PPC4XX_EDAC_MODULE_NAME;
1070 mci->mod_ver = PPC4XX_EDAC_MODULE_REVISION;
1071 mci->ctl_name = match->compatible,
1072 mci->dev_name = np->full_name;
1073
1074
1075
1076 mci->edac_check = ppc4xx_edac_check;
1077 mci->ctl_page_to_phys = NULL;
1078
1079
1080
1081 status = ppc4xx_edac_init_csrows(mci, mcopt1);
1082
1083 if (status)
1084 ppc4xx_edac_mc_printk(KERN_ERR, mci,
1085 "Failed to initialize rows!\n");
1086
1087 return status;
1088}
1089
1090
1091
1092
1093
1094
1095
1096
1097
1098
1099
1100
1101
1102
1103
1104
1105static int __devinit
1106ppc4xx_edac_register_irq(struct platform_device *op, struct mem_ctl_info *mci)
1107{
1108 int status = 0;
1109 int ded_irq, sec_irq;
1110 struct ppc4xx_edac_pdata *pdata = mci->pvt_info;
1111 struct device_node *np = op->dev.of_node;
1112
1113 ded_irq = irq_of_parse_and_map(np, INTMAP_ECCDED_INDEX);
1114 sec_irq = irq_of_parse_and_map(np, INTMAP_ECCSEC_INDEX);
1115
1116 if (ded_irq == NO_IRQ || sec_irq == NO_IRQ) {
1117 ppc4xx_edac_mc_printk(KERN_ERR, mci,
1118 "Unable to map interrupts.\n");
1119 status = -ENODEV;
1120 goto fail;
1121 }
1122
1123 status = request_irq(ded_irq,
1124 ppc4xx_edac_isr,
1125 IRQF_DISABLED,
1126 "[EDAC] MC ECCDED",
1127 mci);
1128
1129 if (status < 0) {
1130 ppc4xx_edac_mc_printk(KERN_ERR, mci,
1131 "Unable to request irq %d for ECC DED",
1132 ded_irq);
1133 status = -ENODEV;
1134 goto fail1;
1135 }
1136
1137 status = request_irq(sec_irq,
1138 ppc4xx_edac_isr,
1139 IRQF_DISABLED,
1140 "[EDAC] MC ECCSEC",
1141 mci);
1142
1143 if (status < 0) {
1144 ppc4xx_edac_mc_printk(KERN_ERR, mci,
1145 "Unable to request irq %d for ECC SEC",
1146 sec_irq);
1147 status = -ENODEV;
1148 goto fail2;
1149 }
1150
1151 ppc4xx_edac_mc_printk(KERN_INFO, mci, "ECCDED irq is %d\n", ded_irq);
1152 ppc4xx_edac_mc_printk(KERN_INFO, mci, "ECCSEC irq is %d\n", sec_irq);
1153
1154 pdata->irqs.ded = ded_irq;
1155 pdata->irqs.sec = sec_irq;
1156
1157 return 0;
1158
1159 fail2:
1160 free_irq(sec_irq, mci);
1161
1162 fail1:
1163 free_irq(ded_irq, mci);
1164
1165 fail:
1166 return status;
1167}
1168
1169
1170
1171
1172
1173
1174
1175
1176
1177
1178
1179
1180
1181
1182
1183static int __devinit
1184ppc4xx_edac_map_dcrs(const struct device_node *np, dcr_host_t *dcr_host)
1185{
1186 unsigned int dcr_base, dcr_len;
1187
1188 if (np == NULL || dcr_host == NULL)
1189 return -EINVAL;
1190
1191
1192
1193 dcr_base = dcr_resource_start(np, 0);
1194 dcr_len = dcr_resource_len(np, 0);
1195
1196 if (dcr_base == 0 || dcr_len == 0) {
1197 ppc4xx_edac_printk(KERN_ERR,
1198 "Failed to obtain DCR property.\n");
1199 return -ENODEV;
1200 }
1201
1202 if (dcr_len != SDRAM_DCR_RESOURCE_LEN) {
1203 ppc4xx_edac_printk(KERN_ERR,
1204 "Unexpected DCR length %d, expected %d.\n",
1205 dcr_len, SDRAM_DCR_RESOURCE_LEN);
1206 return -ENODEV;
1207 }
1208
1209
1210
1211 *dcr_host = dcr_map(np, dcr_base, dcr_len);
1212
1213 if (!DCR_MAP_OK(*dcr_host)) {
1214 ppc4xx_edac_printk(KERN_INFO, "Failed to map DCRs.\n");
1215 return -ENODEV;
1216 }
1217
1218 return 0;
1219}
1220
1221
1222
1223
1224
1225
1226
1227
1228
1229
1230
1231
1232static int __devinit ppc4xx_edac_probe(struct platform_device *op)
1233{
1234 int status = 0;
1235 u32 mcopt1, memcheck;
1236 dcr_host_t dcr_host;
1237 const struct device_node *np = op->dev.of_node;
1238 struct mem_ctl_info *mci = NULL;
1239 static int ppc4xx_edac_instance;
1240
1241
1242
1243
1244
1245
1246 if (!of_device_is_compatible(np, "ibm,sdram-405ex") &&
1247 !of_device_is_compatible(np, "ibm,sdram-405exr")) {
1248 ppc4xx_edac_printk(KERN_NOTICE,
1249 "Only the PPC405EX[r] is supported.\n");
1250 return -ENODEV;
1251 }
1252
1253
1254
1255
1256
1257
1258 status = ppc4xx_edac_map_dcrs(np, &dcr_host);
1259
1260 if (status)
1261 return status;
1262
1263
1264
1265
1266
1267
1268
1269 mcopt1 = mfsdram(&dcr_host, SDRAM_MCOPT1);
1270 memcheck = (mcopt1 & SDRAM_MCOPT1_MCHK_MASK);
1271
1272 if (memcheck == SDRAM_MCOPT1_MCHK_NON) {
1273 ppc4xx_edac_printk(KERN_INFO, "%s: No ECC memory detected or "
1274 "ECC is disabled.\n", np->full_name);
1275 status = -ENODEV;
1276 goto done;
1277 }
1278
1279
1280
1281
1282
1283
1284
1285 mci = edac_mc_alloc(sizeof(struct ppc4xx_edac_pdata),
1286 ppc4xx_edac_nr_csrows,
1287 ppc4xx_edac_nr_chans,
1288 ppc4xx_edac_instance);
1289
1290 if (mci == NULL) {
1291 ppc4xx_edac_printk(KERN_ERR, "%s: "
1292 "Failed to allocate EDAC MC instance!\n",
1293 np->full_name);
1294 status = -ENOMEM;
1295 goto done;
1296 }
1297
1298 status = ppc4xx_edac_mc_init(mci, op, &dcr_host, mcopt1);
1299
1300 if (status) {
1301 ppc4xx_edac_mc_printk(KERN_ERR, mci,
1302 "Failed to initialize instance!\n");
1303 goto fail;
1304 }
1305
1306
1307
1308
1309
1310
1311
1312 if (edac_mc_add_mc(mci)) {
1313 ppc4xx_edac_mc_printk(KERN_ERR, mci,
1314 "Failed to add instance!\n");
1315 status = -ENODEV;
1316 goto fail;
1317 }
1318
1319 if (edac_op_state == EDAC_OPSTATE_INT) {
1320 status = ppc4xx_edac_register_irq(op, mci);
1321
1322 if (status)
1323 goto fail1;
1324 }
1325
1326 ppc4xx_edac_instance++;
1327
1328 return 0;
1329
1330 fail1:
1331 edac_mc_del_mc(mci->dev);
1332
1333 fail:
1334 edac_mc_free(mci);
1335
1336 done:
1337 return status;
1338}
1339
1340
1341
1342
1343
1344
1345
1346
1347
1348
1349
1350
1351
1352static int
1353ppc4xx_edac_remove(struct platform_device *op)
1354{
1355 struct mem_ctl_info *mci = dev_get_drvdata(&op->dev);
1356 struct ppc4xx_edac_pdata *pdata = mci->pvt_info;
1357
1358 if (edac_op_state == EDAC_OPSTATE_INT) {
1359 free_irq(pdata->irqs.sec, mci);
1360 free_irq(pdata->irqs.ded, mci);
1361 }
1362
1363 dcr_unmap(pdata->dcr_host, SDRAM_DCR_RESOURCE_LEN);
1364
1365 edac_mc_del_mc(mci->dev);
1366 edac_mc_free(mci);
1367
1368 return 0;
1369}
1370
1371
1372
1373
1374
1375
1376
1377
1378
1379
1380static inline void __init
1381ppc4xx_edac_opstate_init(void)
1382{
1383 switch (edac_op_state) {
1384 case EDAC_OPSTATE_POLL:
1385 case EDAC_OPSTATE_INT:
1386 break;
1387 default:
1388 edac_op_state = EDAC_OPSTATE_INT;
1389 break;
1390 }
1391
1392 ppc4xx_edac_printk(KERN_INFO, "Reporting type: %s\n",
1393 ((edac_op_state == EDAC_OPSTATE_POLL) ?
1394 EDAC_OPSTATE_POLL_STR :
1395 ((edac_op_state == EDAC_OPSTATE_INT) ?
1396 EDAC_OPSTATE_INT_STR :
1397 EDAC_OPSTATE_UNKNOWN_STR)));
1398}
1399
1400
1401
1402
1403
1404
1405
1406
1407
1408static int __init
1409ppc4xx_edac_init(void)
1410{
1411 ppc4xx_edac_printk(KERN_INFO, PPC4XX_EDAC_MODULE_REVISION "\n");
1412
1413 ppc4xx_edac_opstate_init();
1414
1415 return platform_driver_register(&ppc4xx_edac_driver);
1416}
1417
1418
1419
1420
1421
1422
1423
1424
1425static void __exit
1426ppc4xx_edac_exit(void)
1427{
1428 platform_driver_unregister(&ppc4xx_edac_driver);
1429}
1430
1431module_init(ppc4xx_edac_init);
1432module_exit(ppc4xx_edac_exit);
1433
1434MODULE_LICENSE("GPL v2");
1435MODULE_AUTHOR("Grant Erickson <gerickson@nuovations.com>");
1436MODULE_DESCRIPTION("EDAC MC Driver for the PPC4xx IBM DDR2 Memory Controller");
1437module_param(edac_op_state, int, 0444);
1438MODULE_PARM_DESC(edac_op_state, "EDAC Error Reporting State: "
1439 "0=" EDAC_OPSTATE_POLL_STR ", 2=" EDAC_OPSTATE_INT_STR);
1440