xref: /openbmc/linux/drivers/edac/ie31200_edac.c (revision 3a83e4e6)
1 // SPDX-License-Identifier: GPL-2.0-only
2 /*
3  * Intel E3-1200
4  * Copyright (C) 2014 Jason Baron <jbaron@akamai.com>
5  *
6  * Support for the E3-1200 processor family. Heavily based on previous
7  * Intel EDAC drivers.
8  *
9  * Since the DRAM controller is on the cpu chip, we can use its PCI device
10  * id to identify these processors.
11  *
12  * PCI DRAM controller device ids (Taken from The PCI ID Repository - http://pci-ids.ucw.cz/)
13  *
14  * 0108: Xeon E3-1200 Processor Family DRAM Controller
15  * 010c: Xeon E3-1200/2nd Generation Core Processor Family DRAM Controller
16  * 0150: Xeon E3-1200 v2/3rd Gen Core processor DRAM Controller
17  * 0158: Xeon E3-1200 v2/Ivy Bridge DRAM Controller
18  * 015c: Xeon E3-1200 v2/3rd Gen Core processor DRAM Controller
19  * 0c04: Xeon E3-1200 v3/4th Gen Core Processor DRAM Controller
20  * 0c08: Xeon E3-1200 v3 Processor DRAM Controller
21  * 1918: Xeon E3-1200 v5 Skylake Host Bridge/DRAM Registers
22  * 5918: Xeon E3-1200 Xeon E3-1200 v6/7th Gen Core Processor Host Bridge/DRAM Registers
23  * 3e..: 8th/9th Gen Core Processor Host Bridge/DRAM Registers
24  *
25  * Based on Intel specification:
26  * http://www.intel.com/content/dam/www/public/us/en/documents/datasheets/xeon-e3-1200v3-vol-2-datasheet.pdf
27  * http://www.intel.com/content/www/us/en/processors/xeon/xeon-e3-1200-family-vol-2-datasheet.html
28  * http://www.intel.com/content/www/us/en/processors/core/7th-gen-core-family-mobile-h-processor-lines-datasheet-vol-2.html
29  * https://www.intel.com/content/www/us/en/products/docs/processors/core/8th-gen-core-family-datasheet-vol-2.html
30  *
31  * According to the above datasheet (p.16):
32  * "
33  * 6. Software must not access B0/D0/F0 32-bit memory-mapped registers with
34  * requests that cross a DW boundary.
35  * "
36  *
37  * Thus, we make use of the explicit: lo_hi_readq(), which breaks the readq into
38  * 2 readl() calls. This restriction may be lifted in subsequent chip releases,
39  * but lo_hi_readq() ensures that we are safe across all e3-1200 processors.
40  */
41 
42 #include <linux/module.h>
43 #include <linux/init.h>
44 #include <linux/pci.h>
45 #include <linux/pci_ids.h>
46 #include <linux/edac.h>
47 
48 #include <linux/io-64-nonatomic-lo-hi.h>
49 #include "edac_module.h"
50 
51 #define EDAC_MOD_STR "ie31200_edac"
52 
53 #define ie31200_printk(level, fmt, arg...) \
54 	edac_printk(level, "ie31200", fmt, ##arg)
55 
56 #define PCI_DEVICE_ID_INTEL_IE31200_HB_1 0x0108
57 #define PCI_DEVICE_ID_INTEL_IE31200_HB_2 0x010c
58 #define PCI_DEVICE_ID_INTEL_IE31200_HB_3 0x0150
59 #define PCI_DEVICE_ID_INTEL_IE31200_HB_4 0x0158
60 #define PCI_DEVICE_ID_INTEL_IE31200_HB_5 0x015c
61 #define PCI_DEVICE_ID_INTEL_IE31200_HB_6 0x0c04
62 #define PCI_DEVICE_ID_INTEL_IE31200_HB_7 0x0c08
63 #define PCI_DEVICE_ID_INTEL_IE31200_HB_8 0x1918
64 #define PCI_DEVICE_ID_INTEL_IE31200_HB_9 0x5918
65 
66 /* Coffee Lake-S */
67 #define PCI_DEVICE_ID_INTEL_IE31200_HB_CFL_MASK 0x3e00
68 #define PCI_DEVICE_ID_INTEL_IE31200_HB_CFL_1    0x3e0f
69 #define PCI_DEVICE_ID_INTEL_IE31200_HB_CFL_2    0x3e18
70 #define PCI_DEVICE_ID_INTEL_IE31200_HB_CFL_3    0x3e1f
71 #define PCI_DEVICE_ID_INTEL_IE31200_HB_CFL_4    0x3e30
72 #define PCI_DEVICE_ID_INTEL_IE31200_HB_CFL_5    0x3e31
73 #define PCI_DEVICE_ID_INTEL_IE31200_HB_CFL_6    0x3e32
74 #define PCI_DEVICE_ID_INTEL_IE31200_HB_CFL_7    0x3e33
75 #define PCI_DEVICE_ID_INTEL_IE31200_HB_CFL_8    0x3ec2
76 #define PCI_DEVICE_ID_INTEL_IE31200_HB_CFL_9    0x3ec6
77 #define PCI_DEVICE_ID_INTEL_IE31200_HB_CFL_10   0x3eca
78 
79 /* Test if HB is for Skylake or later. */
80 #define DEVICE_ID_SKYLAKE_OR_LATER(did)                                        \
81 	(((did) == PCI_DEVICE_ID_INTEL_IE31200_HB_8) ||                        \
82 	 ((did) == PCI_DEVICE_ID_INTEL_IE31200_HB_9) ||                        \
83 	 (((did) & PCI_DEVICE_ID_INTEL_IE31200_HB_CFL_MASK) ==                 \
84 	  PCI_DEVICE_ID_INTEL_IE31200_HB_CFL_MASK))
85 
86 #define IE31200_DIMMS			4
87 #define IE31200_RANKS			8
88 #define IE31200_RANKS_PER_CHANNEL	4
89 #define IE31200_DIMMS_PER_CHANNEL	2
90 #define IE31200_CHANNELS		2
91 
92 /* Intel IE31200 register addresses - device 0 function 0 - DRAM Controller */
93 #define IE31200_MCHBAR_LOW		0x48
94 #define IE31200_MCHBAR_HIGH		0x4c
95 #define IE31200_MCHBAR_MASK		GENMASK_ULL(38, 15)
96 #define IE31200_MMR_WINDOW_SIZE		BIT(15)
97 
98 /*
99  * Error Status Register (16b)
100  *
101  * 15    reserved
102  * 14    Isochronous TBWRR Run Behind FIFO Full
103  *       (ITCV)
104  * 13    Isochronous TBWRR Run Behind FIFO Put
105  *       (ITSTV)
106  * 12    reserved
107  * 11    MCH Thermal Sensor Event
108  *       for SMI/SCI/SERR (GTSE)
109  * 10    reserved
110  *  9    LOCK to non-DRAM Memory Flag (LCKF)
111  *  8    reserved
112  *  7    DRAM Throttle Flag (DTF)
113  *  6:2  reserved
114  *  1    Multi-bit DRAM ECC Error Flag (DMERR)
115  *  0    Single-bit DRAM ECC Error Flag (DSERR)
116  */
117 #define IE31200_ERRSTS			0xc8
118 #define IE31200_ERRSTS_UE		BIT(1)
119 #define IE31200_ERRSTS_CE		BIT(0)
120 #define IE31200_ERRSTS_BITS		(IE31200_ERRSTS_UE | IE31200_ERRSTS_CE)
121 
122 /*
123  * Channel 0 ECC Error Log (64b)
124  *
125  * 63:48 Error Column Address (ERRCOL)
126  * 47:32 Error Row Address (ERRROW)
127  * 31:29 Error Bank Address (ERRBANK)
128  * 28:27 Error Rank Address (ERRRANK)
129  * 26:24 reserved
130  * 23:16 Error Syndrome (ERRSYND)
131  * 15: 2 reserved
132  *    1  Multiple Bit Error Status (MERRSTS)
133  *    0  Correctable Error Status (CERRSTS)
134  */
135 
136 #define IE31200_C0ECCERRLOG			0x40c8
137 #define IE31200_C1ECCERRLOG			0x44c8
138 #define IE31200_C0ECCERRLOG_SKL			0x4048
139 #define IE31200_C1ECCERRLOG_SKL			0x4448
140 #define IE31200_ECCERRLOG_CE			BIT(0)
141 #define IE31200_ECCERRLOG_UE			BIT(1)
142 #define IE31200_ECCERRLOG_RANK_BITS		GENMASK_ULL(28, 27)
143 #define IE31200_ECCERRLOG_RANK_SHIFT		27
144 #define IE31200_ECCERRLOG_SYNDROME_BITS		GENMASK_ULL(23, 16)
145 #define IE31200_ECCERRLOG_SYNDROME_SHIFT	16
146 
147 #define IE31200_ECCERRLOG_SYNDROME(log)		   \
148 	((log & IE31200_ECCERRLOG_SYNDROME_BITS) >> \
149 	 IE31200_ECCERRLOG_SYNDROME_SHIFT)
150 
151 #define IE31200_CAPID0			0xe4
152 #define IE31200_CAPID0_PDCD		BIT(4)
153 #define IE31200_CAPID0_DDPCD		BIT(6)
154 #define IE31200_CAPID0_ECC		BIT(1)
155 
156 #define IE31200_MAD_DIMM_0_OFFSET		0x5004
157 #define IE31200_MAD_DIMM_0_OFFSET_SKL		0x500C
158 #define IE31200_MAD_DIMM_SIZE			GENMASK_ULL(7, 0)
159 #define IE31200_MAD_DIMM_A_RANK			BIT(17)
160 #define IE31200_MAD_DIMM_A_RANK_SHIFT		17
161 #define IE31200_MAD_DIMM_A_RANK_SKL		BIT(10)
162 #define IE31200_MAD_DIMM_A_RANK_SKL_SHIFT	10
163 #define IE31200_MAD_DIMM_A_WIDTH		BIT(19)
164 #define IE31200_MAD_DIMM_A_WIDTH_SHIFT		19
165 #define IE31200_MAD_DIMM_A_WIDTH_SKL		GENMASK_ULL(9, 8)
166 #define IE31200_MAD_DIMM_A_WIDTH_SKL_SHIFT	8
167 
168 /* Skylake reports 1GB increments, everything else is 256MB */
169 #define IE31200_PAGES(n, skl)	\
170 	(n << (28 + (2 * skl) - PAGE_SHIFT))
171 
172 static int nr_channels;
173 static struct pci_dev *mci_pdev;
174 static int ie31200_registered = 1;
175 
176 struct ie31200_priv {
177 	void __iomem *window;
178 	void __iomem *c0errlog;
179 	void __iomem *c1errlog;
180 };
181 
182 enum ie31200_chips {
183 	IE31200 = 0,
184 };
185 
186 struct ie31200_dev_info {
187 	const char *ctl_name;
188 };
189 
190 struct ie31200_error_info {
191 	u16 errsts;
192 	u16 errsts2;
193 	u64 eccerrlog[IE31200_CHANNELS];
194 };
195 
196 static const struct ie31200_dev_info ie31200_devs[] = {
197 	[IE31200] = {
198 		.ctl_name = "IE31200"
199 	},
200 };
201 
202 struct dimm_data {
203 	u8 size; /* in multiples of 256MB, except Skylake is 1GB */
204 	u8 dual_rank : 1,
205 	   x16_width : 2; /* 0 means x8 width */
206 };
207 
208 static int how_many_channels(struct pci_dev *pdev)
209 {
210 	int n_channels;
211 	unsigned char capid0_2b; /* 2nd byte of CAPID0 */
212 
213 	pci_read_config_byte(pdev, IE31200_CAPID0 + 1, &capid0_2b);
214 
215 	/* check PDCD: Dual Channel Disable */
216 	if (capid0_2b & IE31200_CAPID0_PDCD) {
217 		edac_dbg(0, "In single channel mode\n");
218 		n_channels = 1;
219 	} else {
220 		edac_dbg(0, "In dual channel mode\n");
221 		n_channels = 2;
222 	}
223 
224 	/* check DDPCD - check if both channels are filled */
225 	if (capid0_2b & IE31200_CAPID0_DDPCD)
226 		edac_dbg(0, "2 DIMMS per channel disabled\n");
227 	else
228 		edac_dbg(0, "2 DIMMS per channel enabled\n");
229 
230 	return n_channels;
231 }
232 
233 static bool ecc_capable(struct pci_dev *pdev)
234 {
235 	unsigned char capid0_4b; /* 4th byte of CAPID0 */
236 
237 	pci_read_config_byte(pdev, IE31200_CAPID0 + 3, &capid0_4b);
238 	if (capid0_4b & IE31200_CAPID0_ECC)
239 		return false;
240 	return true;
241 }
242 
243 static int eccerrlog_row(u64 log)
244 {
245 	return ((log & IE31200_ECCERRLOG_RANK_BITS) >>
246 				IE31200_ECCERRLOG_RANK_SHIFT);
247 }
248 
249 static void ie31200_clear_error_info(struct mem_ctl_info *mci)
250 {
251 	/*
252 	 * Clear any error bits.
253 	 * (Yes, we really clear bits by writing 1 to them.)
254 	 */
255 	pci_write_bits16(to_pci_dev(mci->pdev), IE31200_ERRSTS,
256 			 IE31200_ERRSTS_BITS, IE31200_ERRSTS_BITS);
257 }
258 
259 static void ie31200_get_and_clear_error_info(struct mem_ctl_info *mci,
260 					     struct ie31200_error_info *info)
261 {
262 	struct pci_dev *pdev;
263 	struct ie31200_priv *priv = mci->pvt_info;
264 
265 	pdev = to_pci_dev(mci->pdev);
266 
267 	/*
268 	 * This is a mess because there is no atomic way to read all the
269 	 * registers at once and the registers can transition from CE being
270 	 * overwritten by UE.
271 	 */
272 	pci_read_config_word(pdev, IE31200_ERRSTS, &info->errsts);
273 	if (!(info->errsts & IE31200_ERRSTS_BITS))
274 		return;
275 
276 	info->eccerrlog[0] = lo_hi_readq(priv->c0errlog);
277 	if (nr_channels == 2)
278 		info->eccerrlog[1] = lo_hi_readq(priv->c1errlog);
279 
280 	pci_read_config_word(pdev, IE31200_ERRSTS, &info->errsts2);
281 
282 	/*
283 	 * If the error is the same for both reads then the first set
284 	 * of reads is valid.  If there is a change then there is a CE
285 	 * with no info and the second set of reads is valid and
286 	 * should be UE info.
287 	 */
288 	if ((info->errsts ^ info->errsts2) & IE31200_ERRSTS_BITS) {
289 		info->eccerrlog[0] = lo_hi_readq(priv->c0errlog);
290 		if (nr_channels == 2)
291 			info->eccerrlog[1] =
292 				lo_hi_readq(priv->c1errlog);
293 	}
294 
295 	ie31200_clear_error_info(mci);
296 }
297 
298 static void ie31200_process_error_info(struct mem_ctl_info *mci,
299 				       struct ie31200_error_info *info)
300 {
301 	int channel;
302 	u64 log;
303 
304 	if (!(info->errsts & IE31200_ERRSTS_BITS))
305 		return;
306 
307 	if ((info->errsts ^ info->errsts2) & IE31200_ERRSTS_BITS) {
308 		edac_mc_handle_error(HW_EVENT_ERR_UNCORRECTED, mci, 1, 0, 0, 0,
309 				     -1, -1, -1, "UE overwrote CE", "");
310 		info->errsts = info->errsts2;
311 	}
312 
313 	for (channel = 0; channel < nr_channels; channel++) {
314 		log = info->eccerrlog[channel];
315 		if (log & IE31200_ECCERRLOG_UE) {
316 			edac_mc_handle_error(HW_EVENT_ERR_UNCORRECTED, mci, 1,
317 					     0, 0, 0,
318 					     eccerrlog_row(log),
319 					     channel, -1,
320 					     "ie31200 UE", "");
321 		} else if (log & IE31200_ECCERRLOG_CE) {
322 			edac_mc_handle_error(HW_EVENT_ERR_CORRECTED, mci, 1,
323 					     0, 0,
324 					     IE31200_ECCERRLOG_SYNDROME(log),
325 					     eccerrlog_row(log),
326 					     channel, -1,
327 					     "ie31200 CE", "");
328 		}
329 	}
330 }
331 
332 static void ie31200_check(struct mem_ctl_info *mci)
333 {
334 	struct ie31200_error_info info;
335 
336 	edac_dbg(1, "MC%d\n", mci->mc_idx);
337 	ie31200_get_and_clear_error_info(mci, &info);
338 	ie31200_process_error_info(mci, &info);
339 }
340 
341 static void __iomem *ie31200_map_mchbar(struct pci_dev *pdev)
342 {
343 	union {
344 		u64 mchbar;
345 		struct {
346 			u32 mchbar_low;
347 			u32 mchbar_high;
348 		};
349 	} u;
350 	void __iomem *window;
351 
352 	pci_read_config_dword(pdev, IE31200_MCHBAR_LOW, &u.mchbar_low);
353 	pci_read_config_dword(pdev, IE31200_MCHBAR_HIGH, &u.mchbar_high);
354 	u.mchbar &= IE31200_MCHBAR_MASK;
355 
356 	if (u.mchbar != (resource_size_t)u.mchbar) {
357 		ie31200_printk(KERN_ERR, "mmio space beyond accessible range (0x%llx)\n",
358 			       (unsigned long long)u.mchbar);
359 		return NULL;
360 	}
361 
362 	window = ioremap(u.mchbar, IE31200_MMR_WINDOW_SIZE);
363 	if (!window)
364 		ie31200_printk(KERN_ERR, "Cannot map mmio space at 0x%llx\n",
365 			       (unsigned long long)u.mchbar);
366 
367 	return window;
368 }
369 
370 static void __skl_populate_dimm_info(struct dimm_data *dd, u32 addr_decode,
371 				     int chan)
372 {
373 	dd->size = (addr_decode >> (chan << 4)) & IE31200_MAD_DIMM_SIZE;
374 	dd->dual_rank = (addr_decode & (IE31200_MAD_DIMM_A_RANK_SKL << (chan << 4))) ? 1 : 0;
375 	dd->x16_width = ((addr_decode & (IE31200_MAD_DIMM_A_WIDTH_SKL << (chan << 4))) >>
376 				(IE31200_MAD_DIMM_A_WIDTH_SKL_SHIFT + (chan << 4)));
377 }
378 
379 static void __populate_dimm_info(struct dimm_data *dd, u32 addr_decode,
380 				 int chan)
381 {
382 	dd->size = (addr_decode >> (chan << 3)) & IE31200_MAD_DIMM_SIZE;
383 	dd->dual_rank = (addr_decode & (IE31200_MAD_DIMM_A_RANK << chan)) ? 1 : 0;
384 	dd->x16_width = (addr_decode & (IE31200_MAD_DIMM_A_WIDTH << chan)) ? 1 : 0;
385 }
386 
387 static void populate_dimm_info(struct dimm_data *dd, u32 addr_decode, int chan,
388 			       bool skl)
389 {
390 	if (skl)
391 		__skl_populate_dimm_info(dd, addr_decode, chan);
392 	else
393 		__populate_dimm_info(dd, addr_decode, chan);
394 }
395 
396 
397 static int ie31200_probe1(struct pci_dev *pdev, int dev_idx)
398 {
399 	int i, j, ret;
400 	struct mem_ctl_info *mci = NULL;
401 	struct edac_mc_layer layers[2];
402 	struct dimm_data dimm_info[IE31200_CHANNELS][IE31200_DIMMS_PER_CHANNEL];
403 	void __iomem *window;
404 	struct ie31200_priv *priv;
405 	u32 addr_decode, mad_offset;
406 
407 	/*
408 	 * Kaby Lake, Coffee Lake seem to work like Skylake. Please re-visit
409 	 * this logic when adding new CPU support.
410 	 */
411 	bool skl = DEVICE_ID_SKYLAKE_OR_LATER(pdev->device);
412 
413 	edac_dbg(0, "MC:\n");
414 
415 	if (!ecc_capable(pdev)) {
416 		ie31200_printk(KERN_INFO, "No ECC support\n");
417 		return -ENODEV;
418 	}
419 
420 	nr_channels = how_many_channels(pdev);
421 	layers[0].type = EDAC_MC_LAYER_CHIP_SELECT;
422 	layers[0].size = IE31200_DIMMS;
423 	layers[0].is_virt_csrow = true;
424 	layers[1].type = EDAC_MC_LAYER_CHANNEL;
425 	layers[1].size = nr_channels;
426 	layers[1].is_virt_csrow = false;
427 	mci = edac_mc_alloc(0, ARRAY_SIZE(layers), layers,
428 			    sizeof(struct ie31200_priv));
429 	if (!mci)
430 		return -ENOMEM;
431 
432 	window = ie31200_map_mchbar(pdev);
433 	if (!window) {
434 		ret = -ENODEV;
435 		goto fail_free;
436 	}
437 
438 	edac_dbg(3, "MC: init mci\n");
439 	mci->pdev = &pdev->dev;
440 	if (skl)
441 		mci->mtype_cap = MEM_FLAG_DDR4;
442 	else
443 		mci->mtype_cap = MEM_FLAG_DDR3;
444 	mci->edac_ctl_cap = EDAC_FLAG_SECDED;
445 	mci->edac_cap = EDAC_FLAG_SECDED;
446 	mci->mod_name = EDAC_MOD_STR;
447 	mci->ctl_name = ie31200_devs[dev_idx].ctl_name;
448 	mci->dev_name = pci_name(pdev);
449 	mci->edac_check = ie31200_check;
450 	mci->ctl_page_to_phys = NULL;
451 	priv = mci->pvt_info;
452 	priv->window = window;
453 	if (skl) {
454 		priv->c0errlog = window + IE31200_C0ECCERRLOG_SKL;
455 		priv->c1errlog = window + IE31200_C1ECCERRLOG_SKL;
456 		mad_offset = IE31200_MAD_DIMM_0_OFFSET_SKL;
457 	} else {
458 		priv->c0errlog = window + IE31200_C0ECCERRLOG;
459 		priv->c1errlog = window + IE31200_C1ECCERRLOG;
460 		mad_offset = IE31200_MAD_DIMM_0_OFFSET;
461 	}
462 
463 	/* populate DIMM info */
464 	for (i = 0; i < IE31200_CHANNELS; i++) {
465 		addr_decode = readl(window + mad_offset +
466 					(i * 4));
467 		edac_dbg(0, "addr_decode: 0x%x\n", addr_decode);
468 		for (j = 0; j < IE31200_DIMMS_PER_CHANNEL; j++) {
469 			populate_dimm_info(&dimm_info[i][j], addr_decode, j,
470 					   skl);
471 			edac_dbg(0, "size: 0x%x, rank: %d, width: %d\n",
472 				 dimm_info[i][j].size,
473 				 dimm_info[i][j].dual_rank,
474 				 dimm_info[i][j].x16_width);
475 		}
476 	}
477 
478 	/*
479 	 * The dram rank boundary (DRB) reg values are boundary addresses
480 	 * for each DRAM rank with a granularity of 64MB.  DRB regs are
481 	 * cumulative; the last one will contain the total memory
482 	 * contained in all ranks.
483 	 */
484 	for (i = 0; i < IE31200_DIMMS_PER_CHANNEL; i++) {
485 		for (j = 0; j < IE31200_CHANNELS; j++) {
486 			struct dimm_info *dimm;
487 			unsigned long nr_pages;
488 
489 			nr_pages = IE31200_PAGES(dimm_info[j][i].size, skl);
490 			if (nr_pages == 0)
491 				continue;
492 
493 			if (dimm_info[j][i].dual_rank) {
494 				nr_pages = nr_pages / 2;
495 				dimm = edac_get_dimm(mci, (i * 2) + 1, j, 0);
496 				dimm->nr_pages = nr_pages;
497 				edac_dbg(0, "set nr pages: 0x%lx\n", nr_pages);
498 				dimm->grain = 8; /* just a guess */
499 				if (skl)
500 					dimm->mtype = MEM_DDR4;
501 				else
502 					dimm->mtype = MEM_DDR3;
503 				dimm->dtype = DEV_UNKNOWN;
504 				dimm->edac_mode = EDAC_UNKNOWN;
505 			}
506 			dimm = edac_get_dimm(mci, i * 2, j, 0);
507 			dimm->nr_pages = nr_pages;
508 			edac_dbg(0, "set nr pages: 0x%lx\n", nr_pages);
509 			dimm->grain = 8; /* same guess */
510 			if (skl)
511 				dimm->mtype = MEM_DDR4;
512 			else
513 				dimm->mtype = MEM_DDR3;
514 			dimm->dtype = DEV_UNKNOWN;
515 			dimm->edac_mode = EDAC_UNKNOWN;
516 		}
517 	}
518 
519 	ie31200_clear_error_info(mci);
520 
521 	if (edac_mc_add_mc(mci)) {
522 		edac_dbg(3, "MC: failed edac_mc_add_mc()\n");
523 		ret = -ENODEV;
524 		goto fail_unmap;
525 	}
526 
527 	/* get this far and it's successful */
528 	edac_dbg(3, "MC: success\n");
529 	return 0;
530 
531 fail_unmap:
532 	iounmap(window);
533 
534 fail_free:
535 	edac_mc_free(mci);
536 
537 	return ret;
538 }
539 
540 static int ie31200_init_one(struct pci_dev *pdev,
541 			    const struct pci_device_id *ent)
542 {
543 	int rc;
544 
545 	edac_dbg(0, "MC:\n");
546 	if (pci_enable_device(pdev) < 0)
547 		return -EIO;
548 	rc = ie31200_probe1(pdev, ent->driver_data);
549 	if (rc == 0 && !mci_pdev)
550 		mci_pdev = pci_dev_get(pdev);
551 
552 	return rc;
553 }
554 
555 static void ie31200_remove_one(struct pci_dev *pdev)
556 {
557 	struct mem_ctl_info *mci;
558 	struct ie31200_priv *priv;
559 
560 	edac_dbg(0, "\n");
561 	pci_dev_put(mci_pdev);
562 	mci_pdev = NULL;
563 	mci = edac_mc_del_mc(&pdev->dev);
564 	if (!mci)
565 		return;
566 	priv = mci->pvt_info;
567 	iounmap(priv->window);
568 	edac_mc_free(mci);
569 }
570 
571 static const struct pci_device_id ie31200_pci_tbl[] = {
572 	{ PCI_VEND_DEV(INTEL, IE31200_HB_1),      PCI_ANY_ID, PCI_ANY_ID, 0, 0, IE31200 },
573 	{ PCI_VEND_DEV(INTEL, IE31200_HB_2),      PCI_ANY_ID, PCI_ANY_ID, 0, 0, IE31200 },
574 	{ PCI_VEND_DEV(INTEL, IE31200_HB_3),      PCI_ANY_ID, PCI_ANY_ID, 0, 0, IE31200 },
575 	{ PCI_VEND_DEV(INTEL, IE31200_HB_4),      PCI_ANY_ID, PCI_ANY_ID, 0, 0, IE31200 },
576 	{ PCI_VEND_DEV(INTEL, IE31200_HB_5),      PCI_ANY_ID, PCI_ANY_ID, 0, 0, IE31200 },
577 	{ PCI_VEND_DEV(INTEL, IE31200_HB_6),      PCI_ANY_ID, PCI_ANY_ID, 0, 0, IE31200 },
578 	{ PCI_VEND_DEV(INTEL, IE31200_HB_7),      PCI_ANY_ID, PCI_ANY_ID, 0, 0, IE31200 },
579 	{ PCI_VEND_DEV(INTEL, IE31200_HB_8),      PCI_ANY_ID, PCI_ANY_ID, 0, 0, IE31200 },
580 	{ PCI_VEND_DEV(INTEL, IE31200_HB_9),      PCI_ANY_ID, PCI_ANY_ID, 0, 0, IE31200 },
581 	{ PCI_VEND_DEV(INTEL, IE31200_HB_CFL_1),  PCI_ANY_ID, PCI_ANY_ID, 0, 0, IE31200 },
582 	{ PCI_VEND_DEV(INTEL, IE31200_HB_CFL_2),  PCI_ANY_ID, PCI_ANY_ID, 0, 0, IE31200 },
583 	{ PCI_VEND_DEV(INTEL, IE31200_HB_CFL_3),  PCI_ANY_ID, PCI_ANY_ID, 0, 0, IE31200 },
584 	{ PCI_VEND_DEV(INTEL, IE31200_HB_CFL_4),  PCI_ANY_ID, PCI_ANY_ID, 0, 0, IE31200 },
585 	{ PCI_VEND_DEV(INTEL, IE31200_HB_CFL_5),  PCI_ANY_ID, PCI_ANY_ID, 0, 0, IE31200 },
586 	{ PCI_VEND_DEV(INTEL, IE31200_HB_CFL_6),  PCI_ANY_ID, PCI_ANY_ID, 0, 0, IE31200 },
587 	{ PCI_VEND_DEV(INTEL, IE31200_HB_CFL_7),  PCI_ANY_ID, PCI_ANY_ID, 0, 0, IE31200 },
588 	{ PCI_VEND_DEV(INTEL, IE31200_HB_CFL_8),  PCI_ANY_ID, PCI_ANY_ID, 0, 0, IE31200 },
589 	{ PCI_VEND_DEV(INTEL, IE31200_HB_CFL_9),  PCI_ANY_ID, PCI_ANY_ID, 0, 0, IE31200 },
590 	{ PCI_VEND_DEV(INTEL, IE31200_HB_CFL_10), PCI_ANY_ID, PCI_ANY_ID, 0, 0, IE31200 },
591 	{ 0, } /* 0 terminated list. */
592 };
593 MODULE_DEVICE_TABLE(pci, ie31200_pci_tbl);
594 
595 static struct pci_driver ie31200_driver = {
596 	.name = EDAC_MOD_STR,
597 	.probe = ie31200_init_one,
598 	.remove = ie31200_remove_one,
599 	.id_table = ie31200_pci_tbl,
600 };
601 
602 static int __init ie31200_init(void)
603 {
604 	int pci_rc, i;
605 
606 	edac_dbg(3, "MC:\n");
607 	/* Ensure that the OPSTATE is set correctly for POLL or NMI */
608 	opstate_init();
609 
610 	pci_rc = pci_register_driver(&ie31200_driver);
611 	if (pci_rc < 0)
612 		goto fail0;
613 
614 	if (!mci_pdev) {
615 		ie31200_registered = 0;
616 		for (i = 0; ie31200_pci_tbl[i].vendor != 0; i++) {
617 			mci_pdev = pci_get_device(ie31200_pci_tbl[i].vendor,
618 						  ie31200_pci_tbl[i].device,
619 						  NULL);
620 			if (mci_pdev)
621 				break;
622 		}
623 		if (!mci_pdev) {
624 			edac_dbg(0, "ie31200 pci_get_device fail\n");
625 			pci_rc = -ENODEV;
626 			goto fail1;
627 		}
628 		pci_rc = ie31200_init_one(mci_pdev, &ie31200_pci_tbl[i]);
629 		if (pci_rc < 0) {
630 			edac_dbg(0, "ie31200 init fail\n");
631 			pci_rc = -ENODEV;
632 			goto fail1;
633 		}
634 	}
635 	return 0;
636 
637 fail1:
638 	pci_unregister_driver(&ie31200_driver);
639 fail0:
640 	pci_dev_put(mci_pdev);
641 
642 	return pci_rc;
643 }
644 
645 static void __exit ie31200_exit(void)
646 {
647 	edac_dbg(3, "MC:\n");
648 	pci_unregister_driver(&ie31200_driver);
649 	if (!ie31200_registered)
650 		ie31200_remove_one(mci_pdev);
651 }
652 
653 module_init(ie31200_init);
654 module_exit(ie31200_exit);
655 
656 MODULE_LICENSE("GPL");
657 MODULE_AUTHOR("Jason Baron <jbaron@akamai.com>");
658 MODULE_DESCRIPTION("MC support for Intel Processor E31200 memory hub controllers");
659