1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19#include <linux/module.h>
20#include <linux/init.h>
21#include <linux/pci.h>
22#include <linux/pci_ids.h>
23#include <linux/slab.h>
24#include <linux/delay.h>
25#include <linux/edac.h>
26#include <linux/mmzone.h>
27#include <linux/smp.h>
28#include <linux/bitmap.h>
29#include <linux/math64.h>
30#include <linux/mod_devicetable.h>
31#include <asm/cpu_device_id.h>
32#include <asm/intel-family.h>
33#include <asm/processor.h>
34#include <asm/mce.h>
35
36#include "edac_mc.h"
37#include "edac_module.h"
38#include "pnd2_edac.h"
39
40#define EDAC_MOD_STR "pnd2_edac"
41
42#define APL_NUM_CHANNELS 4
43#define DNV_NUM_CHANNELS 2
44#define DNV_MAX_DIMMS 2
45
46enum type {
47 APL,
48 DNV,
49};
50
51struct dram_addr {
52 int chan;
53 int dimm;
54 int rank;
55 int bank;
56 int row;
57 int col;
58};
59
60struct pnd2_pvt {
61 int dimm_geom[APL_NUM_CHANNELS];
62 u64 tolm, tohm;
63};
64
65
66
67
68
69
70
71
72
73
74static struct region {
75 u64 base;
76 u64 limit;
77 u8 enabled;
78} mot, as0, as1, as2;
79
80static struct dunit_ops {
81 char *name;
82 enum type type;
83 int pmiaddr_shift;
84 int pmiidx_shift;
85 int channels;
86 int dimms_per_channel;
87 int (*rd_reg)(int port, int off, int op, void *data, size_t sz, char *name);
88 int (*get_registers)(void);
89 int (*check_ecc)(void);
90 void (*mk_region)(char *name, struct region *rp, void *asym);
91 void (*get_dimm_config)(struct mem_ctl_info *mci);
92 int (*pmi2mem)(struct mem_ctl_info *mci, u64 pmiaddr, u32 pmiidx,
93 struct dram_addr *daddr, char *msg);
94} *ops;
95
96static struct mem_ctl_info *pnd2_mci;
97
98#define PND2_MSG_SIZE 256
99
100
101#define pnd2_printk(level, fmt, arg...) \
102 edac_printk(level, "pnd2", fmt, ##arg)
103
104#define pnd2_mc_printk(mci, level, fmt, arg...) \
105 edac_mc_chipset_printk(mci, level, "pnd2", fmt, ##arg)
106
107#define MOT_CHAN_INTLV_BIT_1SLC_2CH 12
108#define MOT_CHAN_INTLV_BIT_2SLC_2CH 13
109#define SELECTOR_DISABLED (-1)
110#define _4GB (1ul << 32)
111
112#define PMI_ADDRESS_WIDTH 31
113#define PND_MAX_PHYS_BIT 39
114
115#define APL_ASYMSHIFT 28
116#define DNV_ASYMSHIFT 31
117#define CH_HASH_MASK_LSB 6
118#define SLICE_HASH_MASK_LSB 6
119#define MOT_SLC_INTLV_BIT 12
120#define LOG2_PMI_ADDR_GRANULARITY 5
121#define MOT_SHIFT 24
122
123#define GET_BITFIELD(v, lo, hi) (((v) & GENMASK_ULL(hi, lo)) >> (lo))
124#define U64_LSHIFT(val, s) ((u64)(val) << (s))
125
126
127
128
129
130
131static struct pci_bus *p2sb_bus;
132#define P2SB_DEVFN PCI_DEVFN(0xd, 0)
133#define P2SB_ADDR_OFF 0xd0
134#define P2SB_DATA_OFF 0xd4
135#define P2SB_STAT_OFF 0xd8
136#define P2SB_ROUT_OFF 0xda
137#define P2SB_EADD_OFF 0xdc
138#define P2SB_HIDE_OFF 0xe1
139
140#define P2SB_BUSY 1
141
142#define P2SB_READ(size, off, ptr) \
143 pci_bus_read_config_##size(p2sb_bus, P2SB_DEVFN, off, ptr)
144#define P2SB_WRITE(size, off, val) \
145 pci_bus_write_config_##size(p2sb_bus, P2SB_DEVFN, off, val)
146
147static bool p2sb_is_busy(u16 *status)
148{
149 P2SB_READ(word, P2SB_STAT_OFF, status);
150
151 return !!(*status & P2SB_BUSY);
152}
153
154static int _apl_rd_reg(int port, int off, int op, u32 *data)
155{
156 int retries = 0xff, ret;
157 u16 status;
158 u8 hidden;
159
160
161 P2SB_READ(byte, P2SB_HIDE_OFF, &hidden);
162 if (hidden)
163 P2SB_WRITE(byte, P2SB_HIDE_OFF, 0);
164
165 if (p2sb_is_busy(&status)) {
166 ret = -EAGAIN;
167 goto out;
168 }
169
170 P2SB_WRITE(dword, P2SB_ADDR_OFF, (port << 24) | off);
171 P2SB_WRITE(dword, P2SB_DATA_OFF, 0);
172 P2SB_WRITE(dword, P2SB_EADD_OFF, 0);
173 P2SB_WRITE(word, P2SB_ROUT_OFF, 0);
174 P2SB_WRITE(word, P2SB_STAT_OFF, (op << 8) | P2SB_BUSY);
175
176 while (p2sb_is_busy(&status)) {
177 if (retries-- == 0) {
178 ret = -EBUSY;
179 goto out;
180 }
181 }
182
183 P2SB_READ(dword, P2SB_DATA_OFF, data);
184 ret = (status >> 1) & 0x3;
185out:
186
187 if (hidden)
188 P2SB_WRITE(byte, P2SB_HIDE_OFF, hidden);
189
190 return ret;
191}
192
193static int apl_rd_reg(int port, int off, int op, void *data, size_t sz, char *name)
194{
195 int ret = 0;
196
197 edac_dbg(2, "Read %s port=%x off=%x op=%x\n", name, port, off, op);
198 switch (sz) {
199 case 8:
200 ret = _apl_rd_reg(port, off + 4, op, (u32 *)(data + 4));
201 fallthrough;
202 case 4:
203 ret |= _apl_rd_reg(port, off, op, (u32 *)data);
204 pnd2_printk(KERN_DEBUG, "%s=%x%08x ret=%d\n", name,
205 sz == 8 ? *((u32 *)(data + 4)) : 0, *((u32 *)data), ret);
206 break;
207 }
208
209 return ret;
210}
211
212static u64 get_mem_ctrl_hub_base_addr(void)
213{
214 struct b_cr_mchbar_lo_pci lo;
215 struct b_cr_mchbar_hi_pci hi;
216 struct pci_dev *pdev;
217
218 pdev = pci_get_device(PCI_VENDOR_ID_INTEL, 0x1980, NULL);
219 if (pdev) {
220 pci_read_config_dword(pdev, 0x48, (u32 *)&lo);
221 pci_read_config_dword(pdev, 0x4c, (u32 *)&hi);
222 pci_dev_put(pdev);
223 } else {
224 return 0;
225 }
226
227 if (!lo.enable) {
228 edac_dbg(2, "MMIO via memory controller hub base address is disabled!\n");
229 return 0;
230 }
231
232 return U64_LSHIFT(hi.base, 32) | U64_LSHIFT(lo.base, 15);
233}
234
235static u64 get_sideband_reg_base_addr(void)
236{
237 struct pci_dev *pdev;
238 u32 hi, lo;
239 u8 hidden;
240
241 pdev = pci_get_device(PCI_VENDOR_ID_INTEL, 0x19dd, NULL);
242 if (pdev) {
243
244 pci_read_config_byte(pdev, 0xe1, &hidden);
245 if (hidden)
246 pci_write_config_byte(pdev, 0xe1, 0);
247
248 pci_read_config_dword(pdev, 0x10, &lo);
249 pci_read_config_dword(pdev, 0x14, &hi);
250 lo &= 0xfffffff0;
251
252
253 if (hidden)
254 pci_write_config_byte(pdev, 0xe1, hidden);
255
256 pci_dev_put(pdev);
257 return (U64_LSHIFT(hi, 32) | U64_LSHIFT(lo, 0));
258 } else {
259 return 0xfd000000;
260 }
261}
262
263#define DNV_MCHBAR_SIZE 0x8000
264#define DNV_SB_PORT_SIZE 0x10000
265static int dnv_rd_reg(int port, int off, int op, void *data, size_t sz, char *name)
266{
267 struct pci_dev *pdev;
268 char *base;
269 u64 addr;
270 unsigned long size;
271
272 if (op == 4) {
273 pdev = pci_get_device(PCI_VENDOR_ID_INTEL, 0x1980, NULL);
274 if (!pdev)
275 return -ENODEV;
276
277 pci_read_config_dword(pdev, off, data);
278 pci_dev_put(pdev);
279 } else {
280
281 if (op == 0 && port == 0x4c) {
282 addr = get_mem_ctrl_hub_base_addr();
283 if (!addr)
284 return -ENODEV;
285 size = DNV_MCHBAR_SIZE;
286 } else {
287
288 addr = get_sideband_reg_base_addr();
289 if (!addr)
290 return -ENODEV;
291 addr += (port << 16);
292 size = DNV_SB_PORT_SIZE;
293 }
294
295 base = ioremap((resource_size_t)addr, size);
296 if (!base)
297 return -ENODEV;
298
299 if (sz == 8)
300 *(u32 *)(data + 4) = *(u32 *)(base + off + 4);
301 *(u32 *)data = *(u32 *)(base + off);
302
303 iounmap(base);
304 }
305
306 edac_dbg(2, "Read %s=%.8x_%.8x\n", name,
307 (sz == 8) ? *(u32 *)(data + 4) : 0, *(u32 *)data);
308
309 return 0;
310}
311
312#define RD_REGP(regp, regname, port) \
313 ops->rd_reg(port, \
314 regname##_offset, \
315 regname##_r_opcode, \
316 regp, sizeof(struct regname), \
317 #regname)
318
319#define RD_REG(regp, regname) \
320 ops->rd_reg(regname ## _port, \
321 regname##_offset, \
322 regname##_r_opcode, \
323 regp, sizeof(struct regname), \
324 #regname)
325
326static u64 top_lm, top_hm;
327static bool two_slices;
328static bool two_channels;
329
330static u8 sym_chan_mask;
331static u8 asym_chan_mask;
332static u8 chan_mask;
333
334static int slice_selector = -1;
335static int chan_selector = -1;
336static u64 slice_hash_mask;
337static u64 chan_hash_mask;
338
339static void mk_region(char *name, struct region *rp, u64 base, u64 limit)
340{
341 rp->enabled = 1;
342 rp->base = base;
343 rp->limit = limit;
344 edac_dbg(2, "Region:%s [%llx, %llx]\n", name, base, limit);
345}
346
347static void mk_region_mask(char *name, struct region *rp, u64 base, u64 mask)
348{
349 if (mask == 0) {
350 pr_info(FW_BUG "MOT mask cannot be zero\n");
351 return;
352 }
353 if (mask != GENMASK_ULL(PND_MAX_PHYS_BIT, __ffs(mask))) {
354 pr_info(FW_BUG "MOT mask not power of two\n");
355 return;
356 }
357 if (base & ~mask) {
358 pr_info(FW_BUG "MOT region base/mask alignment error\n");
359 return;
360 }
361 rp->base = base;
362 rp->limit = (base | ~mask) & GENMASK_ULL(PND_MAX_PHYS_BIT, 0);
363 rp->enabled = 1;
364 edac_dbg(2, "Region:%s [%llx, %llx]\n", name, base, rp->limit);
365}
366
367static bool in_region(struct region *rp, u64 addr)
368{
369 if (!rp->enabled)
370 return false;
371
372 return rp->base <= addr && addr <= rp->limit;
373}
374
375static int gen_sym_mask(struct b_cr_slice_channel_hash *p)
376{
377 int mask = 0;
378
379 if (!p->slice_0_mem_disabled)
380 mask |= p->sym_slice0_channel_enabled;
381
382 if (!p->slice_1_disabled)
383 mask |= p->sym_slice1_channel_enabled << 2;
384
385 if (p->ch_1_disabled || p->enable_pmi_dual_data_mode)
386 mask &= 0x5;
387
388 return mask;
389}
390
391static int gen_asym_mask(struct b_cr_slice_channel_hash *p,
392 struct b_cr_asym_mem_region0_mchbar *as0,
393 struct b_cr_asym_mem_region1_mchbar *as1,
394 struct b_cr_asym_2way_mem_region_mchbar *as2way)
395{
396 const int intlv[] = { 0x5, 0xA, 0x3, 0xC };
397 int mask = 0;
398
399 if (as2way->asym_2way_interleave_enable)
400 mask = intlv[as2way->asym_2way_intlv_mode];
401 if (as0->slice0_asym_enable)
402 mask |= (1 << as0->slice0_asym_channel_select);
403 if (as1->slice1_asym_enable)
404 mask |= (4 << as1->slice1_asym_channel_select);
405 if (p->slice_0_mem_disabled)
406 mask &= 0xc;
407 if (p->slice_1_disabled)
408 mask &= 0x3;
409 if (p->ch_1_disabled || p->enable_pmi_dual_data_mode)
410 mask &= 0x5;
411
412 return mask;
413}
414
415static struct b_cr_tolud_pci tolud;
416static struct b_cr_touud_lo_pci touud_lo;
417static struct b_cr_touud_hi_pci touud_hi;
418static struct b_cr_asym_mem_region0_mchbar asym0;
419static struct b_cr_asym_mem_region1_mchbar asym1;
420static struct b_cr_asym_2way_mem_region_mchbar asym_2way;
421static struct b_cr_mot_out_base_mchbar mot_base;
422static struct b_cr_mot_out_mask_mchbar mot_mask;
423static struct b_cr_slice_channel_hash chash;
424
425
426
427
428
429
430
431static const int apl_dports[APL_NUM_CHANNELS] = { 0x18, 0x10, 0x11, 0x19 };
432static struct d_cr_drp0 drp0[APL_NUM_CHANNELS];
433
434
435static const int dnv_dports[DNV_NUM_CHANNELS] = { 0x10, 0x12 };
436static struct d_cr_dsch dsch;
437static struct d_cr_ecc_ctrl ecc_ctrl[DNV_NUM_CHANNELS];
438static struct d_cr_drp drp[DNV_NUM_CHANNELS];
439static struct d_cr_dmap dmap[DNV_NUM_CHANNELS];
440static struct d_cr_dmap1 dmap1[DNV_NUM_CHANNELS];
441static struct d_cr_dmap2 dmap2[DNV_NUM_CHANNELS];
442static struct d_cr_dmap3 dmap3[DNV_NUM_CHANNELS];
443static struct d_cr_dmap4 dmap4[DNV_NUM_CHANNELS];
444static struct d_cr_dmap5 dmap5[DNV_NUM_CHANNELS];
445
446static void apl_mk_region(char *name, struct region *rp, void *asym)
447{
448 struct b_cr_asym_mem_region0_mchbar *a = asym;
449
450 mk_region(name, rp,
451 U64_LSHIFT(a->slice0_asym_base, APL_ASYMSHIFT),
452 U64_LSHIFT(a->slice0_asym_limit, APL_ASYMSHIFT) +
453 GENMASK_ULL(APL_ASYMSHIFT - 1, 0));
454}
455
456static void dnv_mk_region(char *name, struct region *rp, void *asym)
457{
458 struct b_cr_asym_mem_region_denverton *a = asym;
459
460 mk_region(name, rp,
461 U64_LSHIFT(a->slice_asym_base, DNV_ASYMSHIFT),
462 U64_LSHIFT(a->slice_asym_limit, DNV_ASYMSHIFT) +
463 GENMASK_ULL(DNV_ASYMSHIFT - 1, 0));
464}
465
466static int apl_get_registers(void)
467{
468 int ret = -ENODEV;
469 int i;
470
471 if (RD_REG(&asym_2way, b_cr_asym_2way_mem_region_mchbar))
472 return -ENODEV;
473
474
475
476
477
478 for (i = 0; i < APL_NUM_CHANNELS; i++)
479 if (!RD_REGP(&drp0[i], d_cr_drp0, apl_dports[i]))
480 ret = 0;
481
482 return ret;
483}
484
485static int dnv_get_registers(void)
486{
487 int i;
488
489 if (RD_REG(&dsch, d_cr_dsch))
490 return -ENODEV;
491
492 for (i = 0; i < DNV_NUM_CHANNELS; i++)
493 if (RD_REGP(&ecc_ctrl[i], d_cr_ecc_ctrl, dnv_dports[i]) ||
494 RD_REGP(&drp[i], d_cr_drp, dnv_dports[i]) ||
495 RD_REGP(&dmap[i], d_cr_dmap, dnv_dports[i]) ||
496 RD_REGP(&dmap1[i], d_cr_dmap1, dnv_dports[i]) ||
497 RD_REGP(&dmap2[i], d_cr_dmap2, dnv_dports[i]) ||
498 RD_REGP(&dmap3[i], d_cr_dmap3, dnv_dports[i]) ||
499 RD_REGP(&dmap4[i], d_cr_dmap4, dnv_dports[i]) ||
500 RD_REGP(&dmap5[i], d_cr_dmap5, dnv_dports[i]))
501 return -ENODEV;
502
503 return 0;
504}
505
506
507
508
509
510
511static int get_registers(void)
512{
513 const int intlv[] = { 10, 11, 12, 12 };
514
515 if (RD_REG(&tolud, b_cr_tolud_pci) ||
516 RD_REG(&touud_lo, b_cr_touud_lo_pci) ||
517 RD_REG(&touud_hi, b_cr_touud_hi_pci) ||
518 RD_REG(&asym0, b_cr_asym_mem_region0_mchbar) ||
519 RD_REG(&asym1, b_cr_asym_mem_region1_mchbar) ||
520 RD_REG(&mot_base, b_cr_mot_out_base_mchbar) ||
521 RD_REG(&mot_mask, b_cr_mot_out_mask_mchbar) ||
522 RD_REG(&chash, b_cr_slice_channel_hash))
523 return -ENODEV;
524
525 if (ops->get_registers())
526 return -ENODEV;
527
528 if (ops->type == DNV) {
529
530 asym0.slice0_asym_channel_select = 0;
531 asym1.slice1_asym_channel_select = 0;
532
533 chash.sym_slice0_channel_enabled = 0x1;
534 chash.sym_slice1_channel_enabled = 0x1;
535 }
536
537 if (asym0.slice0_asym_enable)
538 ops->mk_region("as0", &as0, &asym0);
539
540 if (asym1.slice1_asym_enable)
541 ops->mk_region("as1", &as1, &asym1);
542
543 if (asym_2way.asym_2way_interleave_enable) {
544 mk_region("as2way", &as2,
545 U64_LSHIFT(asym_2way.asym_2way_base, APL_ASYMSHIFT),
546 U64_LSHIFT(asym_2way.asym_2way_limit, APL_ASYMSHIFT) +
547 GENMASK_ULL(APL_ASYMSHIFT - 1, 0));
548 }
549
550 if (mot_base.imr_en) {
551 mk_region_mask("mot", &mot,
552 U64_LSHIFT(mot_base.mot_out_base, MOT_SHIFT),
553 U64_LSHIFT(mot_mask.mot_out_mask, MOT_SHIFT));
554 }
555
556 top_lm = U64_LSHIFT(tolud.tolud, 20);
557 top_hm = U64_LSHIFT(touud_hi.touud, 32) | U64_LSHIFT(touud_lo.touud, 20);
558
559 two_slices = !chash.slice_1_disabled &&
560 !chash.slice_0_mem_disabled &&
561 (chash.sym_slice0_channel_enabled != 0) &&
562 (chash.sym_slice1_channel_enabled != 0);
563 two_channels = !chash.ch_1_disabled &&
564 !chash.enable_pmi_dual_data_mode &&
565 ((chash.sym_slice0_channel_enabled == 3) ||
566 (chash.sym_slice1_channel_enabled == 3));
567
568 sym_chan_mask = gen_sym_mask(&chash);
569 asym_chan_mask = gen_asym_mask(&chash, &asym0, &asym1, &asym_2way);
570 chan_mask = sym_chan_mask | asym_chan_mask;
571
572 if (two_slices && !two_channels) {
573 if (chash.hvm_mode)
574 slice_selector = 29;
575 else
576 slice_selector = intlv[chash.interleave_mode];
577 } else if (!two_slices && two_channels) {
578 if (chash.hvm_mode)
579 chan_selector = 29;
580 else
581 chan_selector = intlv[chash.interleave_mode];
582 } else if (two_slices && two_channels) {
583 if (chash.hvm_mode) {
584 slice_selector = 29;
585 chan_selector = 30;
586 } else {
587 slice_selector = intlv[chash.interleave_mode];
588 chan_selector = intlv[chash.interleave_mode] + 1;
589 }
590 }
591
592 if (two_slices) {
593 if (!chash.hvm_mode)
594 slice_hash_mask = chash.slice_hash_mask << SLICE_HASH_MASK_LSB;
595 if (!two_channels)
596 slice_hash_mask |= BIT_ULL(slice_selector);
597 }
598
599 if (two_channels) {
600 if (!chash.hvm_mode)
601 chan_hash_mask = chash.ch_hash_mask << CH_HASH_MASK_LSB;
602 if (!two_slices)
603 chan_hash_mask |= BIT_ULL(chan_selector);
604 }
605
606 return 0;
607}
608
609
610static u64 remove_mmio_gap(u64 sys)
611{
612 return (sys < _4GB) ? sys : sys - (_4GB - top_lm);
613}
614
615
616static void remove_addr_bit(u64 *addr, int bitidx)
617{
618 u64 mask;
619
620 if (bitidx == -1)
621 return;
622
623 mask = (1ull << bitidx) - 1;
624 *addr = ((*addr >> 1) & ~mask) | (*addr & mask);
625}
626
627
628static int hash_by_mask(u64 addr, u64 mask)
629{
630 u64 result = addr & mask;
631
632 result = (result >> 32) ^ result;
633 result = (result >> 16) ^ result;
634 result = (result >> 8) ^ result;
635 result = (result >> 4) ^ result;
636 result = (result >> 2) ^ result;
637 result = (result >> 1) ^ result;
638
639 return (int)result & 1;
640}
641
642
643
644
645
646static int sys2pmi(const u64 addr, u32 *pmiidx, u64 *pmiaddr, char *msg)
647{
648 u64 contig_addr, contig_base, contig_offset, contig_base_adj;
649 int mot_intlv_bit = two_slices ? MOT_CHAN_INTLV_BIT_2SLC_2CH :
650 MOT_CHAN_INTLV_BIT_1SLC_2CH;
651 int slice_intlv_bit_rm = SELECTOR_DISABLED;
652 int chan_intlv_bit_rm = SELECTOR_DISABLED;
653
654 bool mot_hit = in_region(&mot, addr);
655
656 int sym_channels = hweight8(sym_chan_mask);
657
658
659
660
661
662
663
664 int sym_chan_shift = sym_channels >> 1;
665
666
667 if (addr >= (1ul << PND_MAX_PHYS_BIT) ||
668 (addr >= top_lm && addr < _4GB) || addr >= top_hm) {
669 snprintf(msg, PND2_MSG_SIZE, "Error address 0x%llx is not DRAM", addr);
670 return -EINVAL;
671 }
672
673
674 contig_addr = remove_mmio_gap(addr);
675
676 if (in_region(&as0, addr)) {
677 *pmiidx = asym0.slice0_asym_channel_select;
678
679 contig_base = remove_mmio_gap(as0.base);
680 contig_offset = contig_addr - contig_base;
681 contig_base_adj = (contig_base >> sym_chan_shift) *
682 ((chash.sym_slice0_channel_enabled >> (*pmiidx & 1)) & 1);
683 contig_addr = contig_offset + ((sym_channels > 0) ? contig_base_adj : 0ull);
684 } else if (in_region(&as1, addr)) {
685 *pmiidx = 2u + asym1.slice1_asym_channel_select;
686
687 contig_base = remove_mmio_gap(as1.base);
688 contig_offset = contig_addr - contig_base;
689 contig_base_adj = (contig_base >> sym_chan_shift) *
690 ((chash.sym_slice1_channel_enabled >> (*pmiidx & 1)) & 1);
691 contig_addr = contig_offset + ((sym_channels > 0) ? contig_base_adj : 0ull);
692 } else if (in_region(&as2, addr) && (asym_2way.asym_2way_intlv_mode == 0x3ul)) {
693 bool channel1;
694
695 mot_intlv_bit = MOT_CHAN_INTLV_BIT_1SLC_2CH;
696 *pmiidx = (asym_2way.asym_2way_intlv_mode & 1) << 1;
697 channel1 = mot_hit ? ((bool)((addr >> mot_intlv_bit) & 1)) :
698 hash_by_mask(contig_addr, chan_hash_mask);
699 *pmiidx |= (u32)channel1;
700
701 contig_base = remove_mmio_gap(as2.base);
702 chan_intlv_bit_rm = mot_hit ? mot_intlv_bit : chan_selector;
703 contig_offset = contig_addr - contig_base;
704 remove_addr_bit(&contig_offset, chan_intlv_bit_rm);
705 contig_addr = (contig_base >> sym_chan_shift) + contig_offset;
706 } else {
707
708 *pmiidx = 0u;
709
710 if (two_slices) {
711 bool slice1;
712
713 if (mot_hit) {
714 slice_intlv_bit_rm = MOT_SLC_INTLV_BIT;
715 slice1 = (addr >> MOT_SLC_INTLV_BIT) & 1;
716 } else {
717 slice_intlv_bit_rm = slice_selector;
718 slice1 = hash_by_mask(addr, slice_hash_mask);
719 }
720
721 *pmiidx = (u32)slice1 << 1;
722 }
723
724 if (two_channels) {
725 bool channel1;
726
727 mot_intlv_bit = two_slices ? MOT_CHAN_INTLV_BIT_2SLC_2CH :
728 MOT_CHAN_INTLV_BIT_1SLC_2CH;
729
730 if (mot_hit) {
731 chan_intlv_bit_rm = mot_intlv_bit;
732 channel1 = (addr >> mot_intlv_bit) & 1;
733 } else {
734 chan_intlv_bit_rm = chan_selector;
735 channel1 = hash_by_mask(contig_addr, chan_hash_mask);
736 }
737
738 *pmiidx |= (u32)channel1;
739 }
740 }
741
742
743 remove_addr_bit(&contig_addr, chan_intlv_bit_rm);
744
745 remove_addr_bit(&contig_addr, slice_intlv_bit_rm);
746 *pmiaddr = contig_addr;
747
748 return 0;
749}
750
751
752#define C(n) (0x10 | (n))
753#define B(n) (0x20 | (n))
754#define R(n) (0x40 | (n))
755#define RS (0x80)
756
757
758#define AMAP_1KB 0
759#define AMAP_2KB 1
760#define AMAP_4KB 2
761#define AMAP_RSVD 3
762
763
764#define DEN_4Gb 0
765#define DEN_8Gb 2
766
767
768#define X8 0
769#define X16 1
770
771static struct dimm_geometry {
772 u8 addrdec;
773 u8 dden;
774 u8 dwid;
775 u8 rowbits, colbits;
776 u16 bits[PMI_ADDRESS_WIDTH];
777} dimms[] = {
778 {
779 .addrdec = AMAP_1KB, .dden = DEN_4Gb, .dwid = X16,
780 .rowbits = 15, .colbits = 10,
781 .bits = {
782 C(2), C(3), C(4), C(5), C(6), B(0), B(1), B(2), R(0),
783 R(1), R(2), R(3), R(4), R(5), R(6), R(7), R(8), R(9),
784 R(10), C(7), C(8), C(9), R(11), RS, R(12), R(13), R(14),
785 0, 0, 0, 0
786 }
787 },
788 {
789 .addrdec = AMAP_1KB, .dden = DEN_4Gb, .dwid = X8,
790 .rowbits = 16, .colbits = 10,
791 .bits = {
792 C(2), C(3), C(4), C(5), C(6), B(0), B(1), B(2), R(0),
793 R(1), R(2), R(3), R(4), R(5), R(6), R(7), R(8), R(9),
794 R(10), C(7), C(8), C(9), R(11), RS, R(12), R(13), R(14),
795 R(15), 0, 0, 0
796 }
797 },
798 {
799 .addrdec = AMAP_1KB, .dden = DEN_8Gb, .dwid = X16,
800 .rowbits = 16, .colbits = 10,
801 .bits = {
802 C(2), C(3), C(4), C(5), C(6), B(0), B(1), B(2), R(0),
803 R(1), R(2), R(3), R(4), R(5), R(6), R(7), R(8), R(9),
804 R(10), C(7), C(8), C(9), R(11), RS, R(12), R(13), R(14),
805 R(15), 0, 0, 0
806 }
807 },
808 {
809 .addrdec = AMAP_1KB, .dden = DEN_8Gb, .dwid = X8,
810 .rowbits = 16, .colbits = 11,
811 .bits = {
812 C(2), C(3), C(4), C(5), C(6), B(0), B(1), B(2), R(0),
813 R(1), R(2), R(3), R(4), R(5), R(6), R(7), R(8), R(9),
814 R(10), C(7), C(8), C(9), R(11), RS, C(11), R(12), R(13),
815 R(14), R(15), 0, 0
816 }
817 },
818 {
819 .addrdec = AMAP_2KB, .dden = DEN_4Gb, .dwid = X16,
820 .rowbits = 15, .colbits = 10,
821 .bits = {
822 C(2), C(3), C(4), C(5), C(6), C(7), B(0), B(1), B(2),
823 R(0), R(1), R(2), R(3), R(4), R(5), R(6), R(7), R(8),
824 R(9), R(10), C(8), C(9), R(11), RS, R(12), R(13), R(14),
825 0, 0, 0, 0
826 }
827 },
828 {
829 .addrdec = AMAP_2KB, .dden = DEN_4Gb, .dwid = X8,
830 .rowbits = 16, .colbits = 10,
831 .bits = {
832 C(2), C(3), C(4), C(5), C(6), C(7), B(0), B(1), B(2),
833 R(0), R(1), R(2), R(3), R(4), R(5), R(6), R(7), R(8),
834 R(9), R(10), C(8), C(9), R(11), RS, R(12), R(13), R(14),
835 R(15), 0, 0, 0
836 }
837 },
838 {
839 .addrdec = AMAP_2KB, .dden = DEN_8Gb, .dwid = X16,
840 .rowbits = 16, .colbits = 10,
841 .bits = {
842 C(2), C(3), C(4), C(5), C(6), C(7), B(0), B(1), B(2),
843 R(0), R(1), R(2), R(3), R(4), R(5), R(6), R(7), R(8),
844 R(9), R(10), C(8), C(9), R(11), RS, R(12), R(13), R(14),
845 R(15), 0, 0, 0
846 }
847 },
848 {
849 .addrdec = AMAP_2KB, .dden = DEN_8Gb, .dwid = X8,
850 .rowbits = 16, .colbits = 11,
851 .bits = {
852 C(2), C(3), C(4), C(5), C(6), C(7), B(0), B(1), B(2),
853 R(0), R(1), R(2), R(3), R(4), R(5), R(6), R(7), R(8),
854 R(9), R(10), C(8), C(9), R(11), RS, C(11), R(12), R(13),
855 R(14), R(15), 0, 0
856 }
857 },
858 {
859 .addrdec = AMAP_4KB, .dden = DEN_4Gb, .dwid = X16,
860 .rowbits = 15, .colbits = 10,
861 .bits = {
862 C(2), C(3), C(4), C(5), C(6), C(7), C(8), B(0), B(1),
863 B(2), R(0), R(1), R(2), R(3), R(4), R(5), R(6), R(7),
864 R(8), R(9), R(10), C(9), R(11), RS, R(12), R(13), R(14),
865 0, 0, 0, 0
866 }
867 },
868 {
869 .addrdec = AMAP_4KB, .dden = DEN_4Gb, .dwid = X8,
870 .rowbits = 16, .colbits = 10,
871 .bits = {
872 C(2), C(3), C(4), C(5), C(6), C(7), C(8), B(0), B(1),
873 B(2), R(0), R(1), R(2), R(3), R(4), R(5), R(6), R(7),
874 R(8), R(9), R(10), C(9), R(11), RS, R(12), R(13), R(14),
875 R(15), 0, 0, 0
876 }
877 },
878 {
879 .addrdec = AMAP_4KB, .dden = DEN_8Gb, .dwid = X16,
880 .rowbits = 16, .colbits = 10,
881 .bits = {
882 C(2), C(3), C(4), C(5), C(6), C(7), C(8), B(0), B(1),
883 B(2), R(0), R(1), R(2), R(3), R(4), R(5), R(6), R(7),
884 R(8), R(9), R(10), C(9), R(11), RS, R(12), R(13), R(14),
885 R(15), 0, 0, 0
886 }
887 },
888 {
889 .addrdec = AMAP_4KB, .dden = DEN_8Gb, .dwid = X8,
890 .rowbits = 16, .colbits = 11,
891 .bits = {
892 C(2), C(3), C(4), C(5), C(6), C(7), C(8), B(0), B(1),
893 B(2), R(0), R(1), R(2), R(3), R(4), R(5), R(6), R(7),
894 R(8), R(9), R(10), C(9), R(11), RS, C(11), R(12), R(13),
895 R(14), R(15), 0, 0
896 }
897 }
898};
899
900static int bank_hash(u64 pmiaddr, int idx, int shft)
901{
902 int bhash = 0;
903
904 switch (idx) {
905 case 0:
906 bhash ^= ((pmiaddr >> (12 + shft)) ^ (pmiaddr >> (9 + shft))) & 1;
907 break;
908 case 1:
909 bhash ^= (((pmiaddr >> (10 + shft)) ^ (pmiaddr >> (8 + shft))) & 1) << 1;
910 bhash ^= ((pmiaddr >> 22) & 1) << 1;
911 break;
912 case 2:
913 bhash ^= (((pmiaddr >> (13 + shft)) ^ (pmiaddr >> (11 + shft))) & 1) << 2;
914 break;
915 }
916
917 return bhash;
918}
919
920static int rank_hash(u64 pmiaddr)
921{
922 return ((pmiaddr >> 16) ^ (pmiaddr >> 10)) & 1;
923}
924
925
926static int apl_pmi2mem(struct mem_ctl_info *mci, u64 pmiaddr, u32 pmiidx,
927 struct dram_addr *daddr, char *msg)
928{
929 struct d_cr_drp0 *cr_drp0 = &drp0[pmiidx];
930 struct pnd2_pvt *pvt = mci->pvt_info;
931 int g = pvt->dimm_geom[pmiidx];
932 struct dimm_geometry *d = &dimms[g];
933 int column = 0, bank = 0, row = 0, rank = 0;
934 int i, idx, type, skiprs = 0;
935
936 for (i = 0; i < PMI_ADDRESS_WIDTH; i++) {
937 int bit = (pmiaddr >> i) & 1;
938
939 if (i + skiprs >= PMI_ADDRESS_WIDTH) {
940 snprintf(msg, PND2_MSG_SIZE, "Bad dimm_geometry[] table\n");
941 return -EINVAL;
942 }
943
944 type = d->bits[i + skiprs] & ~0xf;
945 idx = d->bits[i + skiprs] & 0xf;
946
947
948
949
950
951 if (type == RS && (cr_drp0->rken0 + cr_drp0->rken1) == 1) {
952 skiprs = 1;
953 type = d->bits[i + skiprs] & ~0xf;
954 idx = d->bits[i + skiprs] & 0xf;
955 }
956
957 switch (type) {
958 case C(0):
959 column |= (bit << idx);
960 break;
961 case B(0):
962 bank |= (bit << idx);
963 if (cr_drp0->bahen)
964 bank ^= bank_hash(pmiaddr, idx, d->addrdec);
965 break;
966 case R(0):
967 row |= (bit << idx);
968 break;
969 case RS:
970 rank = bit;
971 if (cr_drp0->rsien)
972 rank ^= rank_hash(pmiaddr);
973 break;
974 default:
975 if (bit) {
976 snprintf(msg, PND2_MSG_SIZE, "Bad translation\n");
977 return -EINVAL;
978 }
979 goto done;
980 }
981 }
982
983done:
984 daddr->col = column;
985 daddr->bank = bank;
986 daddr->row = row;
987 daddr->rank = rank;
988 daddr->dimm = 0;
989
990 return 0;
991}
992
993
994#define dnv_get_bit(pmi, in, out) ((int)(((pmi) >> (in)) & 1u) << (out))
995
996static int dnv_pmi2mem(struct mem_ctl_info *mci, u64 pmiaddr, u32 pmiidx,
997 struct dram_addr *daddr, char *msg)
998{
999
1000 daddr->rank = dnv_get_bit(pmiaddr, dmap[pmiidx].rs0 + 13, 0);
1001
1002 daddr->rank |= dnv_get_bit(pmiaddr, dmap[pmiidx].rs1 + 13, 1);
1003
1004
1005
1006
1007
1008 daddr->dimm = (daddr->rank >= 2) ^ drp[pmiidx].dimmflip;
1009
1010 daddr->bank = dnv_get_bit(pmiaddr, dmap[pmiidx].ba0 + 6, 0);
1011 daddr->bank |= dnv_get_bit(pmiaddr, dmap[pmiidx].ba1 + 6, 1);
1012 daddr->bank |= dnv_get_bit(pmiaddr, dmap[pmiidx].bg0 + 6, 2);
1013 if (dsch.ddr4en)
1014 daddr->bank |= dnv_get_bit(pmiaddr, dmap[pmiidx].bg1 + 6, 3);
1015 if (dmap1[pmiidx].bxor) {
1016 if (dsch.ddr4en) {
1017 daddr->bank ^= dnv_get_bit(pmiaddr, dmap3[pmiidx].row6 + 6, 0);
1018 daddr->bank ^= dnv_get_bit(pmiaddr, dmap3[pmiidx].row7 + 6, 1);
1019 if (dsch.chan_width == 0)
1020
1021 daddr->bank ^= dnv_get_bit(pmiaddr, dmap5[pmiidx].ca3 + 6, 2);
1022 else
1023
1024 daddr->bank ^= dnv_get_bit(pmiaddr, dmap5[pmiidx].ca4 + 6, 2);
1025 daddr->bank ^= dnv_get_bit(pmiaddr, dmap2[pmiidx].row2 + 6, 3);
1026 } else {
1027 daddr->bank ^= dnv_get_bit(pmiaddr, dmap2[pmiidx].row2 + 6, 0);
1028 daddr->bank ^= dnv_get_bit(pmiaddr, dmap3[pmiidx].row6 + 6, 1);
1029 if (dsch.chan_width == 0)
1030 daddr->bank ^= dnv_get_bit(pmiaddr, dmap5[pmiidx].ca3 + 6, 2);
1031 else
1032 daddr->bank ^= dnv_get_bit(pmiaddr, dmap5[pmiidx].ca4 + 6, 2);
1033 }
1034 }
1035
1036 daddr->row = dnv_get_bit(pmiaddr, dmap2[pmiidx].row0 + 6, 0);
1037 daddr->row |= dnv_get_bit(pmiaddr, dmap2[pmiidx].row1 + 6, 1);
1038 daddr->row |= dnv_get_bit(pmiaddr, dmap2[pmiidx].row2 + 6, 2);
1039 daddr->row |= dnv_get_bit(pmiaddr, dmap2[pmiidx].row3 + 6, 3);
1040 daddr->row |= dnv_get_bit(pmiaddr, dmap2[pmiidx].row4 + 6, 4);
1041 daddr->row |= dnv_get_bit(pmiaddr, dmap2[pmiidx].row5 + 6, 5);
1042 daddr->row |= dnv_get_bit(pmiaddr, dmap3[pmiidx].row6 + 6, 6);
1043 daddr->row |= dnv_get_bit(pmiaddr, dmap3[pmiidx].row7 + 6, 7);
1044 daddr->row |= dnv_get_bit(pmiaddr, dmap3[pmiidx].row8 + 6, 8);
1045 daddr->row |= dnv_get_bit(pmiaddr, dmap3[pmiidx].row9 + 6, 9);
1046 daddr->row |= dnv_get_bit(pmiaddr, dmap3[pmiidx].row10 + 6, 10);
1047 daddr->row |= dnv_get_bit(pmiaddr, dmap3[pmiidx].row11 + 6, 11);
1048 daddr->row |= dnv_get_bit(pmiaddr, dmap4[pmiidx].row12 + 6, 12);
1049 daddr->row |= dnv_get_bit(pmiaddr, dmap4[pmiidx].row13 + 6, 13);
1050 if (dmap4[pmiidx].row14 != 31)
1051 daddr->row |= dnv_get_bit(pmiaddr, dmap4[pmiidx].row14 + 6, 14);
1052 if (dmap4[pmiidx].row15 != 31)
1053 daddr->row |= dnv_get_bit(pmiaddr, dmap4[pmiidx].row15 + 6, 15);
1054 if (dmap4[pmiidx].row16 != 31)
1055 daddr->row |= dnv_get_bit(pmiaddr, dmap4[pmiidx].row16 + 6, 16);
1056 if (dmap4[pmiidx].row17 != 31)
1057 daddr->row |= dnv_get_bit(pmiaddr, dmap4[pmiidx].row17 + 6, 17);
1058
1059 daddr->col = dnv_get_bit(pmiaddr, dmap5[pmiidx].ca3 + 6, 3);
1060 daddr->col |= dnv_get_bit(pmiaddr, dmap5[pmiidx].ca4 + 6, 4);
1061 daddr->col |= dnv_get_bit(pmiaddr, dmap5[pmiidx].ca5 + 6, 5);
1062 daddr->col |= dnv_get_bit(pmiaddr, dmap5[pmiidx].ca6 + 6, 6);
1063 daddr->col |= dnv_get_bit(pmiaddr, dmap5[pmiidx].ca7 + 6, 7);
1064 daddr->col |= dnv_get_bit(pmiaddr, dmap5[pmiidx].ca8 + 6, 8);
1065 daddr->col |= dnv_get_bit(pmiaddr, dmap5[pmiidx].ca9 + 6, 9);
1066 if (!dsch.ddr4en && dmap1[pmiidx].ca11 != 0x3f)
1067 daddr->col |= dnv_get_bit(pmiaddr, dmap1[pmiidx].ca11 + 13, 11);
1068
1069 return 0;
1070}
1071
1072static int check_channel(int ch)
1073{
1074 if (drp0[ch].dramtype != 0) {
1075 pnd2_printk(KERN_INFO, "Unsupported DIMM in channel %d\n", ch);
1076 return 1;
1077 } else if (drp0[ch].eccen == 0) {
1078 pnd2_printk(KERN_INFO, "ECC disabled on channel %d\n", ch);
1079 return 1;
1080 }
1081 return 0;
1082}
1083
1084static int apl_check_ecc_active(void)
1085{
1086 int i, ret = 0;
1087
1088
1089 for (i = 0; i < APL_NUM_CHANNELS; i++)
1090 if (chan_mask & BIT(i))
1091 ret += check_channel(i);
1092 return ret ? -EINVAL : 0;
1093}
1094
1095#define DIMMS_PRESENT(d) ((d)->rken0 + (d)->rken1 + (d)->rken2 + (d)->rken3)
1096
1097static int check_unit(int ch)
1098{
1099 struct d_cr_drp *d = &drp[ch];
1100
1101 if (DIMMS_PRESENT(d) && !ecc_ctrl[ch].eccen) {
1102 pnd2_printk(KERN_INFO, "ECC disabled on channel %d\n", ch);
1103 return 1;
1104 }
1105 return 0;
1106}
1107
1108static int dnv_check_ecc_active(void)
1109{
1110 int i, ret = 0;
1111
1112 for (i = 0; i < DNV_NUM_CHANNELS; i++)
1113 ret += check_unit(i);
1114 return ret ? -EINVAL : 0;
1115}
1116
1117static int get_memory_error_data(struct mem_ctl_info *mci, u64 addr,
1118 struct dram_addr *daddr, char *msg)
1119{
1120 u64 pmiaddr;
1121 u32 pmiidx;
1122 int ret;
1123
1124 ret = sys2pmi(addr, &pmiidx, &pmiaddr, msg);
1125 if (ret)
1126 return ret;
1127
1128 pmiaddr >>= ops->pmiaddr_shift;
1129
1130 pmiidx >>= ops->pmiidx_shift;
1131 daddr->chan = pmiidx;
1132
1133 ret = ops->pmi2mem(mci, pmiaddr, pmiidx, daddr, msg);
1134 if (ret)
1135 return ret;
1136
1137 edac_dbg(0, "SysAddr=%llx PmiAddr=%llx Channel=%d DIMM=%d Rank=%d Bank=%d Row=%d Column=%d\n",
1138 addr, pmiaddr, daddr->chan, daddr->dimm, daddr->rank, daddr->bank, daddr->row, daddr->col);
1139
1140 return 0;
1141}
1142
1143static void pnd2_mce_output_error(struct mem_ctl_info *mci, const struct mce *m,
1144 struct dram_addr *daddr)
1145{
1146 enum hw_event_mc_err_type tp_event;
1147 char *optype, msg[PND2_MSG_SIZE];
1148 bool ripv = m->mcgstatus & MCG_STATUS_RIPV;
1149 bool overflow = m->status & MCI_STATUS_OVER;
1150 bool uc_err = m->status & MCI_STATUS_UC;
1151 bool recov = m->status & MCI_STATUS_S;
1152 u32 core_err_cnt = GET_BITFIELD(m->status, 38, 52);
1153 u32 mscod = GET_BITFIELD(m->status, 16, 31);
1154 u32 errcode = GET_BITFIELD(m->status, 0, 15);
1155 u32 optypenum = GET_BITFIELD(m->status, 4, 6);
1156 int rc;
1157
1158 tp_event = uc_err ? (ripv ? HW_EVENT_ERR_UNCORRECTED : HW_EVENT_ERR_FATAL) :
1159 HW_EVENT_ERR_CORRECTED;
1160
1161
1162
1163
1164
1165
1166
1167
1168
1169
1170
1171
1172 if (!((errcode & 0xef80) == 0x80)) {
1173 optype = "Can't parse: it is not a mem";
1174 } else {
1175 switch (optypenum) {
1176 case 0:
1177 optype = "generic undef request error";
1178 break;
1179 case 1:
1180 optype = "memory read error";
1181 break;
1182 case 2:
1183 optype = "memory write error";
1184 break;
1185 case 3:
1186 optype = "addr/cmd error";
1187 break;
1188 case 4:
1189 optype = "memory scrubbing error";
1190 break;
1191 default:
1192 optype = "reserved";
1193 break;
1194 }
1195 }
1196
1197
1198 if (!(m->status & MCI_STATUS_ADDRV))
1199 return;
1200
1201 rc = get_memory_error_data(mci, m->addr, daddr, msg);
1202 if (rc)
1203 goto address_error;
1204
1205 snprintf(msg, sizeof(msg),
1206 "%s%s err_code:%04x:%04x channel:%d DIMM:%d rank:%d row:%d bank:%d col:%d",
1207 overflow ? " OVERFLOW" : "", (uc_err && recov) ? " recoverable" : "", mscod,
1208 errcode, daddr->chan, daddr->dimm, daddr->rank, daddr->row, daddr->bank, daddr->col);
1209
1210 edac_dbg(0, "%s\n", msg);
1211
1212
1213 edac_mc_handle_error(tp_event, mci, core_err_cnt, m->addr >> PAGE_SHIFT,
1214 m->addr & ~PAGE_MASK, 0, daddr->chan, daddr->dimm, -1, optype, msg);
1215
1216 return;
1217
1218address_error:
1219 edac_mc_handle_error(tp_event, mci, core_err_cnt, 0, 0, 0, -1, -1, -1, msg, "");
1220}
1221
1222static void apl_get_dimm_config(struct mem_ctl_info *mci)
1223{
1224 struct pnd2_pvt *pvt = mci->pvt_info;
1225 struct dimm_info *dimm;
1226 struct d_cr_drp0 *d;
1227 u64 capacity;
1228 int i, g;
1229
1230 for (i = 0; i < APL_NUM_CHANNELS; i++) {
1231 if (!(chan_mask & BIT(i)))
1232 continue;
1233
1234 dimm = edac_get_dimm(mci, i, 0, 0);
1235 if (!dimm) {
1236 edac_dbg(0, "No allocated DIMM for channel %d\n", i);
1237 continue;
1238 }
1239
1240 d = &drp0[i];
1241 for (g = 0; g < ARRAY_SIZE(dimms); g++)
1242 if (dimms[g].addrdec == d->addrdec &&
1243 dimms[g].dden == d->dden &&
1244 dimms[g].dwid == d->dwid)
1245 break;
1246
1247 if (g == ARRAY_SIZE(dimms)) {
1248 edac_dbg(0, "Channel %d: unrecognized DIMM\n", i);
1249 continue;
1250 }
1251
1252 pvt->dimm_geom[i] = g;
1253 capacity = (d->rken0 + d->rken1) * 8 * (1ul << dimms[g].rowbits) *
1254 (1ul << dimms[g].colbits);
1255 edac_dbg(0, "Channel %d: %lld MByte DIMM\n", i, capacity >> (20 - 3));
1256 dimm->nr_pages = MiB_TO_PAGES(capacity >> (20 - 3));
1257 dimm->grain = 32;
1258 dimm->dtype = (d->dwid == 0) ? DEV_X8 : DEV_X16;
1259 dimm->mtype = MEM_DDR3;
1260 dimm->edac_mode = EDAC_SECDED;
1261 snprintf(dimm->label, sizeof(dimm->label), "Slice#%d_Chan#%d", i / 2, i % 2);
1262 }
1263}
1264
1265static const int dnv_dtypes[] = {
1266 DEV_X8, DEV_X4, DEV_X16, DEV_UNKNOWN
1267};
1268
1269static void dnv_get_dimm_config(struct mem_ctl_info *mci)
1270{
1271 int i, j, ranks_of_dimm[DNV_MAX_DIMMS], banks, rowbits, colbits, memtype;
1272 struct dimm_info *dimm;
1273 struct d_cr_drp *d;
1274 u64 capacity;
1275
1276 if (dsch.ddr4en) {
1277 memtype = MEM_DDR4;
1278 banks = 16;
1279 colbits = 10;
1280 } else {
1281 memtype = MEM_DDR3;
1282 banks = 8;
1283 }
1284
1285 for (i = 0; i < DNV_NUM_CHANNELS; i++) {
1286 if (dmap4[i].row14 == 31)
1287 rowbits = 14;
1288 else if (dmap4[i].row15 == 31)
1289 rowbits = 15;
1290 else if (dmap4[i].row16 == 31)
1291 rowbits = 16;
1292 else if (dmap4[i].row17 == 31)
1293 rowbits = 17;
1294 else
1295 rowbits = 18;
1296
1297 if (memtype == MEM_DDR3) {
1298 if (dmap1[i].ca11 != 0x3f)
1299 colbits = 12;
1300 else
1301 colbits = 10;
1302 }
1303
1304 d = &drp[i];
1305
1306 ranks_of_dimm[0] = d->rken0 + d->rken1;
1307
1308 ranks_of_dimm[1] = d->rken2 + d->rken3;
1309
1310 for (j = 0; j < DNV_MAX_DIMMS; j++) {
1311 if (!ranks_of_dimm[j])
1312 continue;
1313
1314 dimm = edac_get_dimm(mci, i, j, 0);
1315 if (!dimm) {
1316 edac_dbg(0, "No allocated DIMM for channel %d DIMM %d\n", i, j);
1317 continue;
1318 }
1319
1320 capacity = ranks_of_dimm[j] * banks * (1ul << rowbits) * (1ul << colbits);
1321 edac_dbg(0, "Channel %d DIMM %d: %lld MByte DIMM\n", i, j, capacity >> (20 - 3));
1322 dimm->nr_pages = MiB_TO_PAGES(capacity >> (20 - 3));
1323 dimm->grain = 32;
1324 dimm->dtype = dnv_dtypes[j ? d->dimmdwid0 : d->dimmdwid1];
1325 dimm->mtype = memtype;
1326 dimm->edac_mode = EDAC_SECDED;
1327 snprintf(dimm->label, sizeof(dimm->label), "Chan#%d_DIMM#%d", i, j);
1328 }
1329 }
1330}
1331
1332static int pnd2_register_mci(struct mem_ctl_info **ppmci)
1333{
1334 struct edac_mc_layer layers[2];
1335 struct mem_ctl_info *mci;
1336 struct pnd2_pvt *pvt;
1337 int rc;
1338
1339 rc = ops->check_ecc();
1340 if (rc < 0)
1341 return rc;
1342
1343
1344 layers[0].type = EDAC_MC_LAYER_CHANNEL;
1345 layers[0].size = ops->channels;
1346 layers[0].is_virt_csrow = false;
1347 layers[1].type = EDAC_MC_LAYER_SLOT;
1348 layers[1].size = ops->dimms_per_channel;
1349 layers[1].is_virt_csrow = true;
1350 mci = edac_mc_alloc(0, ARRAY_SIZE(layers), layers, sizeof(*pvt));
1351 if (!mci)
1352 return -ENOMEM;
1353
1354 pvt = mci->pvt_info;
1355 memset(pvt, 0, sizeof(*pvt));
1356
1357 mci->mod_name = EDAC_MOD_STR;
1358 mci->dev_name = ops->name;
1359 mci->ctl_name = "Pondicherry2";
1360
1361
1362 ops->get_dimm_config(mci);
1363
1364 if (edac_mc_add_mc(mci)) {
1365 edac_dbg(0, "MC: failed edac_mc_add_mc()\n");
1366 edac_mc_free(mci);
1367 return -EINVAL;
1368 }
1369
1370 *ppmci = mci;
1371
1372 return 0;
1373}
1374
1375static void pnd2_unregister_mci(struct mem_ctl_info *mci)
1376{
1377 if (unlikely(!mci || !mci->pvt_info)) {
1378 pnd2_printk(KERN_ERR, "Couldn't find mci handler\n");
1379 return;
1380 }
1381
1382
1383 edac_mc_del_mc(NULL);
1384 edac_dbg(1, "%s: free mci struct\n", mci->ctl_name);
1385 edac_mc_free(mci);
1386}
1387
1388
1389
1390
1391
1392static int pnd2_mce_check_error(struct notifier_block *nb, unsigned long val, void *data)
1393{
1394 struct mce *mce = (struct mce *)data;
1395 struct mem_ctl_info *mci;
1396 struct dram_addr daddr;
1397 char *type;
1398
1399 mci = pnd2_mci;
1400 if (!mci || (mce->kflags & MCE_HANDLED_CEC))
1401 return NOTIFY_DONE;
1402
1403
1404
1405
1406
1407
1408
1409 if ((mce->status & 0xefff) >> 7 != 1)
1410 return NOTIFY_DONE;
1411
1412 if (mce->mcgstatus & MCG_STATUS_MCIP)
1413 type = "Exception";
1414 else
1415 type = "Event";
1416
1417 pnd2_mc_printk(mci, KERN_INFO, "HANDLING MCE MEMORY ERROR\n");
1418 pnd2_mc_printk(mci, KERN_INFO, "CPU %u: Machine Check %s: %llx Bank %u: %llx\n",
1419 mce->extcpu, type, mce->mcgstatus, mce->bank, mce->status);
1420 pnd2_mc_printk(mci, KERN_INFO, "TSC %llx ", mce->tsc);
1421 pnd2_mc_printk(mci, KERN_INFO, "ADDR %llx ", mce->addr);
1422 pnd2_mc_printk(mci, KERN_INFO, "MISC %llx ", mce->misc);
1423 pnd2_mc_printk(mci, KERN_INFO, "PROCESSOR %u:%x TIME %llu SOCKET %u APIC %x\n",
1424 mce->cpuvendor, mce->cpuid, mce->time, mce->socketid, mce->apicid);
1425
1426 pnd2_mce_output_error(mci, mce, &daddr);
1427
1428
1429 mce->kflags |= MCE_HANDLED_EDAC;
1430 return NOTIFY_OK;
1431}
1432
1433static struct notifier_block pnd2_mce_dec = {
1434 .notifier_call = pnd2_mce_check_error,
1435 .priority = MCE_PRIO_EDAC,
1436};
1437
1438#ifdef CONFIG_EDAC_DEBUG
1439
1440
1441
1442
1443static u64 pnd2_fake_addr;
1444#define PND2_BLOB_SIZE 1024
1445static char pnd2_result[PND2_BLOB_SIZE];
1446static struct dentry *pnd2_test;
1447static struct debugfs_blob_wrapper pnd2_blob = {
1448 .data = pnd2_result,
1449 .size = 0
1450};
1451
1452static int debugfs_u64_set(void *data, u64 val)
1453{
1454 struct dram_addr daddr;
1455 struct mce m;
1456
1457 *(u64 *)data = val;
1458 m.mcgstatus = 0;
1459
1460 m.status = MCI_STATUS_ADDRV + 0x9f;
1461 m.addr = val;
1462 pnd2_mce_output_error(pnd2_mci, &m, &daddr);
1463 snprintf(pnd2_blob.data, PND2_BLOB_SIZE,
1464 "SysAddr=%llx Channel=%d DIMM=%d Rank=%d Bank=%d Row=%d Column=%d\n",
1465 m.addr, daddr.chan, daddr.dimm, daddr.rank, daddr.bank, daddr.row, daddr.col);
1466 pnd2_blob.size = strlen(pnd2_blob.data);
1467
1468 return 0;
1469}
1470DEFINE_DEBUGFS_ATTRIBUTE(fops_u64_wo, NULL, debugfs_u64_set, "%llu\n");
1471
1472static void setup_pnd2_debug(void)
1473{
1474 pnd2_test = edac_debugfs_create_dir("pnd2_test");
1475 edac_debugfs_create_file("pnd2_debug_addr", 0200, pnd2_test,
1476 &pnd2_fake_addr, &fops_u64_wo);
1477 debugfs_create_blob("pnd2_debug_results", 0400, pnd2_test, &pnd2_blob);
1478}
1479
1480static void teardown_pnd2_debug(void)
1481{
1482 debugfs_remove_recursive(pnd2_test);
1483}
1484#else
1485static void setup_pnd2_debug(void) {}
1486static void teardown_pnd2_debug(void) {}
1487#endif
1488
1489
1490static int pnd2_probe(void)
1491{
1492 int rc;
1493
1494 edac_dbg(2, "\n");
1495 rc = get_registers();
1496 if (rc)
1497 return rc;
1498
1499 return pnd2_register_mci(&pnd2_mci);
1500}
1501
1502static void pnd2_remove(void)
1503{
1504 edac_dbg(0, "\n");
1505 pnd2_unregister_mci(pnd2_mci);
1506}
1507
1508static struct dunit_ops apl_ops = {
1509 .name = "pnd2/apl",
1510 .type = APL,
1511 .pmiaddr_shift = LOG2_PMI_ADDR_GRANULARITY,
1512 .pmiidx_shift = 0,
1513 .channels = APL_NUM_CHANNELS,
1514 .dimms_per_channel = 1,
1515 .rd_reg = apl_rd_reg,
1516 .get_registers = apl_get_registers,
1517 .check_ecc = apl_check_ecc_active,
1518 .mk_region = apl_mk_region,
1519 .get_dimm_config = apl_get_dimm_config,
1520 .pmi2mem = apl_pmi2mem,
1521};
1522
1523static struct dunit_ops dnv_ops = {
1524 .name = "pnd2/dnv",
1525 .type = DNV,
1526 .pmiaddr_shift = 0,
1527 .pmiidx_shift = 1,
1528 .channels = DNV_NUM_CHANNELS,
1529 .dimms_per_channel = 2,
1530 .rd_reg = dnv_rd_reg,
1531 .get_registers = dnv_get_registers,
1532 .check_ecc = dnv_check_ecc_active,
1533 .mk_region = dnv_mk_region,
1534 .get_dimm_config = dnv_get_dimm_config,
1535 .pmi2mem = dnv_pmi2mem,
1536};
1537
1538static const struct x86_cpu_id pnd2_cpuids[] = {
1539 X86_MATCH_INTEL_FAM6_MODEL(ATOM_GOLDMONT, &apl_ops),
1540 X86_MATCH_INTEL_FAM6_MODEL(ATOM_GOLDMONT_D, &dnv_ops),
1541 { }
1542};
1543MODULE_DEVICE_TABLE(x86cpu, pnd2_cpuids);
1544
1545static int __init pnd2_init(void)
1546{
1547 const struct x86_cpu_id *id;
1548 const char *owner;
1549 int rc;
1550
1551 edac_dbg(2, "\n");
1552
1553 owner = edac_get_owner();
1554 if (owner && strncmp(owner, EDAC_MOD_STR, sizeof(EDAC_MOD_STR)))
1555 return -EBUSY;
1556
1557 if (cpu_feature_enabled(X86_FEATURE_HYPERVISOR))
1558 return -ENODEV;
1559
1560 id = x86_match_cpu(pnd2_cpuids);
1561 if (!id)
1562 return -ENODEV;
1563
1564 ops = (struct dunit_ops *)id->driver_data;
1565
1566 if (ops->type == APL) {
1567 p2sb_bus = pci_find_bus(0, 0);
1568 if (!p2sb_bus)
1569 return -ENODEV;
1570 }
1571
1572
1573 opstate_init();
1574
1575 rc = pnd2_probe();
1576 if (rc < 0) {
1577 pnd2_printk(KERN_ERR, "Failed to register device with error %d.\n", rc);
1578 return rc;
1579 }
1580
1581 if (!pnd2_mci)
1582 return -ENODEV;
1583
1584 mce_register_decode_chain(&pnd2_mce_dec);
1585 setup_pnd2_debug();
1586
1587 return 0;
1588}
1589
1590static void __exit pnd2_exit(void)
1591{
1592 edac_dbg(2, "\n");
1593 teardown_pnd2_debug();
1594 mce_unregister_decode_chain(&pnd2_mce_dec);
1595 pnd2_remove();
1596}
1597
1598module_init(pnd2_init);
1599module_exit(pnd2_exit);
1600
1601module_param(edac_op_state, int, 0444);
1602MODULE_PARM_DESC(edac_op_state, "EDAC Error Reporting state: 0=Poll,1=NMI");
1603
1604MODULE_LICENSE("GPL v2");
1605MODULE_AUTHOR("Tony Luck");
1606MODULE_DESCRIPTION("MC Driver for Intel SoC using Pondicherry memory controller");
1607
