xref: /OK3568_Linux_fs/kernel/drivers/edac/i3200_edac.c (revision 4882a59341e53eb6f0b4789bf948001014eff981)
1*4882a593Smuzhiyun /*
2*4882a593Smuzhiyun  * Intel 3200/3210 Memory Controller kernel module
3*4882a593Smuzhiyun  * Copyright (C) 2008-2009 Akamai Technologies, Inc.
4*4882a593Smuzhiyun  * Portions by Hitoshi Mitake <h.mitake@gmail.com>.
5*4882a593Smuzhiyun  *
6*4882a593Smuzhiyun  * This file may be distributed under the terms of the
7*4882a593Smuzhiyun  * GNU General Public License.
8*4882a593Smuzhiyun  */
9*4882a593Smuzhiyun 
10*4882a593Smuzhiyun #include <linux/module.h>
11*4882a593Smuzhiyun #include <linux/init.h>
12*4882a593Smuzhiyun #include <linux/pci.h>
13*4882a593Smuzhiyun #include <linux/pci_ids.h>
14*4882a593Smuzhiyun #include <linux/edac.h>
15*4882a593Smuzhiyun #include <linux/io.h>
16*4882a593Smuzhiyun #include "edac_module.h"
17*4882a593Smuzhiyun 
18*4882a593Smuzhiyun #include <linux/io-64-nonatomic-lo-hi.h>
19*4882a593Smuzhiyun 
20*4882a593Smuzhiyun #define EDAC_MOD_STR        "i3200_edac"
21*4882a593Smuzhiyun 
22*4882a593Smuzhiyun #define PCI_DEVICE_ID_INTEL_3200_HB    0x29f0
23*4882a593Smuzhiyun 
24*4882a593Smuzhiyun #define I3200_DIMMS		4
25*4882a593Smuzhiyun #define I3200_RANKS		8
26*4882a593Smuzhiyun #define I3200_RANKS_PER_CHANNEL	4
27*4882a593Smuzhiyun #define I3200_CHANNELS		2
28*4882a593Smuzhiyun 
29*4882a593Smuzhiyun /* Intel 3200 register addresses - device 0 function 0 - DRAM Controller */
30*4882a593Smuzhiyun 
31*4882a593Smuzhiyun #define I3200_MCHBAR_LOW	0x48	/* MCH Memory Mapped Register BAR */
32*4882a593Smuzhiyun #define I3200_MCHBAR_HIGH	0x4c
33*4882a593Smuzhiyun #define I3200_MCHBAR_MASK	0xfffffc000ULL	/* bits 35:14 */
34*4882a593Smuzhiyun #define I3200_MMR_WINDOW_SIZE	16384
35*4882a593Smuzhiyun 
36*4882a593Smuzhiyun #define I3200_TOM		0xa0	/* Top of Memory (16b)
37*4882a593Smuzhiyun 		 *
38*4882a593Smuzhiyun 		 * 15:10 reserved
39*4882a593Smuzhiyun 		 *  9:0  total populated physical memory
40*4882a593Smuzhiyun 		 */
41*4882a593Smuzhiyun #define I3200_TOM_MASK		0x3ff	/* bits 9:0 */
42*4882a593Smuzhiyun #define I3200_TOM_SHIFT		26	/* 64MiB grain */
43*4882a593Smuzhiyun 
44*4882a593Smuzhiyun #define I3200_ERRSTS		0xc8	/* Error Status Register (16b)
45*4882a593Smuzhiyun 		 *
46*4882a593Smuzhiyun 		 * 15    reserved
47*4882a593Smuzhiyun 		 * 14    Isochronous TBWRR Run Behind FIFO Full
48*4882a593Smuzhiyun 		 *       (ITCV)
49*4882a593Smuzhiyun 		 * 13    Isochronous TBWRR Run Behind FIFO Put
50*4882a593Smuzhiyun 		 *       (ITSTV)
51*4882a593Smuzhiyun 		 * 12    reserved
52*4882a593Smuzhiyun 		 * 11    MCH Thermal Sensor Event
53*4882a593Smuzhiyun 		 *       for SMI/SCI/SERR (GTSE)
54*4882a593Smuzhiyun 		 * 10    reserved
55*4882a593Smuzhiyun 		 *  9    LOCK to non-DRAM Memory Flag (LCKF)
56*4882a593Smuzhiyun 		 *  8    reserved
57*4882a593Smuzhiyun 		 *  7    DRAM Throttle Flag (DTF)
58*4882a593Smuzhiyun 		 *  6:2  reserved
59*4882a593Smuzhiyun 		 *  1    Multi-bit DRAM ECC Error Flag (DMERR)
60*4882a593Smuzhiyun 		 *  0    Single-bit DRAM ECC Error Flag (DSERR)
61*4882a593Smuzhiyun 		 */
62*4882a593Smuzhiyun #define I3200_ERRSTS_UE		0x0002
63*4882a593Smuzhiyun #define I3200_ERRSTS_CE		0x0001
64*4882a593Smuzhiyun #define I3200_ERRSTS_BITS	(I3200_ERRSTS_UE | I3200_ERRSTS_CE)
65*4882a593Smuzhiyun 
66*4882a593Smuzhiyun 
67*4882a593Smuzhiyun /* Intel  MMIO register space - device 0 function 0 - MMR space */
68*4882a593Smuzhiyun 
69*4882a593Smuzhiyun #define I3200_C0DRB	0x200	/* Channel 0 DRAM Rank Boundary (16b x 4)
70*4882a593Smuzhiyun 		 *
71*4882a593Smuzhiyun 		 * 15:10 reserved
72*4882a593Smuzhiyun 		 *  9:0  Channel 0 DRAM Rank Boundary Address
73*4882a593Smuzhiyun 		 */
74*4882a593Smuzhiyun #define I3200_C1DRB	0x600	/* Channel 1 DRAM Rank Boundary (16b x 4) */
75*4882a593Smuzhiyun #define I3200_DRB_MASK	0x3ff	/* bits 9:0 */
76*4882a593Smuzhiyun #define I3200_DRB_SHIFT	26	/* 64MiB grain */
77*4882a593Smuzhiyun 
78*4882a593Smuzhiyun #define I3200_C0ECCERRLOG	0x280	/* Channel 0 ECC Error Log (64b)
79*4882a593Smuzhiyun 		 *
80*4882a593Smuzhiyun 		 * 63:48 Error Column Address (ERRCOL)
81*4882a593Smuzhiyun 		 * 47:32 Error Row Address (ERRROW)
82*4882a593Smuzhiyun 		 * 31:29 Error Bank Address (ERRBANK)
83*4882a593Smuzhiyun 		 * 28:27 Error Rank Address (ERRRANK)
84*4882a593Smuzhiyun 		 * 26:24 reserved
85*4882a593Smuzhiyun 		 * 23:16 Error Syndrome (ERRSYND)
86*4882a593Smuzhiyun 		 * 15: 2 reserved
87*4882a593Smuzhiyun 		 *    1  Multiple Bit Error Status (MERRSTS)
88*4882a593Smuzhiyun 		 *    0  Correctable Error Status (CERRSTS)
89*4882a593Smuzhiyun 		 */
90*4882a593Smuzhiyun #define I3200_C1ECCERRLOG		0x680	/* Chan 1 ECC Error Log (64b) */
91*4882a593Smuzhiyun #define I3200_ECCERRLOG_CE		0x1
92*4882a593Smuzhiyun #define I3200_ECCERRLOG_UE		0x2
93*4882a593Smuzhiyun #define I3200_ECCERRLOG_RANK_BITS	0x18000000
94*4882a593Smuzhiyun #define I3200_ECCERRLOG_RANK_SHIFT	27
95*4882a593Smuzhiyun #define I3200_ECCERRLOG_SYNDROME_BITS	0xff0000
96*4882a593Smuzhiyun #define I3200_ECCERRLOG_SYNDROME_SHIFT	16
97*4882a593Smuzhiyun #define I3200_CAPID0			0xe0	/* P.95 of spec for details */
98*4882a593Smuzhiyun 
99*4882a593Smuzhiyun struct i3200_priv {
100*4882a593Smuzhiyun 	void __iomem *window;
101*4882a593Smuzhiyun };
102*4882a593Smuzhiyun 
103*4882a593Smuzhiyun static int nr_channels;
104*4882a593Smuzhiyun 
how_many_channels(struct pci_dev * pdev)105*4882a593Smuzhiyun static int how_many_channels(struct pci_dev *pdev)
106*4882a593Smuzhiyun {
107*4882a593Smuzhiyun 	int n_channels;
108*4882a593Smuzhiyun 
109*4882a593Smuzhiyun 	unsigned char capid0_8b; /* 8th byte of CAPID0 */
110*4882a593Smuzhiyun 
111*4882a593Smuzhiyun 	pci_read_config_byte(pdev, I3200_CAPID0 + 8, &capid0_8b);
112*4882a593Smuzhiyun 
113*4882a593Smuzhiyun 	if (capid0_8b & 0x20) { /* check DCD: Dual Channel Disable */
114*4882a593Smuzhiyun 		edac_dbg(0, "In single channel mode\n");
115*4882a593Smuzhiyun 		n_channels = 1;
116*4882a593Smuzhiyun 	} else {
117*4882a593Smuzhiyun 		edac_dbg(0, "In dual channel mode\n");
118*4882a593Smuzhiyun 		n_channels = 2;
119*4882a593Smuzhiyun 	}
120*4882a593Smuzhiyun 
121*4882a593Smuzhiyun 	if (capid0_8b & 0x10) /* check if both channels are filled */
122*4882a593Smuzhiyun 		edac_dbg(0, "2 DIMMS per channel disabled\n");
123*4882a593Smuzhiyun 	else
124*4882a593Smuzhiyun 		edac_dbg(0, "2 DIMMS per channel enabled\n");
125*4882a593Smuzhiyun 
126*4882a593Smuzhiyun 	return n_channels;
127*4882a593Smuzhiyun }
128*4882a593Smuzhiyun 
eccerrlog_syndrome(u64 log)129*4882a593Smuzhiyun static unsigned long eccerrlog_syndrome(u64 log)
130*4882a593Smuzhiyun {
131*4882a593Smuzhiyun 	return (log & I3200_ECCERRLOG_SYNDROME_BITS) >>
132*4882a593Smuzhiyun 		I3200_ECCERRLOG_SYNDROME_SHIFT;
133*4882a593Smuzhiyun }
134*4882a593Smuzhiyun 
eccerrlog_row(int channel,u64 log)135*4882a593Smuzhiyun static int eccerrlog_row(int channel, u64 log)
136*4882a593Smuzhiyun {
137*4882a593Smuzhiyun 	u64 rank = ((log & I3200_ECCERRLOG_RANK_BITS) >>
138*4882a593Smuzhiyun 		I3200_ECCERRLOG_RANK_SHIFT);
139*4882a593Smuzhiyun 	return rank | (channel * I3200_RANKS_PER_CHANNEL);
140*4882a593Smuzhiyun }
141*4882a593Smuzhiyun 
142*4882a593Smuzhiyun enum i3200_chips {
143*4882a593Smuzhiyun 	I3200 = 0,
144*4882a593Smuzhiyun };
145*4882a593Smuzhiyun 
146*4882a593Smuzhiyun struct i3200_dev_info {
147*4882a593Smuzhiyun 	const char *ctl_name;
148*4882a593Smuzhiyun };
149*4882a593Smuzhiyun 
150*4882a593Smuzhiyun struct i3200_error_info {
151*4882a593Smuzhiyun 	u16 errsts;
152*4882a593Smuzhiyun 	u16 errsts2;
153*4882a593Smuzhiyun 	u64 eccerrlog[I3200_CHANNELS];
154*4882a593Smuzhiyun };
155*4882a593Smuzhiyun 
156*4882a593Smuzhiyun static const struct i3200_dev_info i3200_devs[] = {
157*4882a593Smuzhiyun 	[I3200] = {
158*4882a593Smuzhiyun 		.ctl_name = "i3200"
159*4882a593Smuzhiyun 	},
160*4882a593Smuzhiyun };
161*4882a593Smuzhiyun 
162*4882a593Smuzhiyun static struct pci_dev *mci_pdev;
163*4882a593Smuzhiyun static int i3200_registered = 1;
164*4882a593Smuzhiyun 
165*4882a593Smuzhiyun 
i3200_clear_error_info(struct mem_ctl_info * mci)166*4882a593Smuzhiyun static void i3200_clear_error_info(struct mem_ctl_info *mci)
167*4882a593Smuzhiyun {
168*4882a593Smuzhiyun 	struct pci_dev *pdev;
169*4882a593Smuzhiyun 
170*4882a593Smuzhiyun 	pdev = to_pci_dev(mci->pdev);
171*4882a593Smuzhiyun 
172*4882a593Smuzhiyun 	/*
173*4882a593Smuzhiyun 	 * Clear any error bits.
174*4882a593Smuzhiyun 	 * (Yes, we really clear bits by writing 1 to them.)
175*4882a593Smuzhiyun 	 */
176*4882a593Smuzhiyun 	pci_write_bits16(pdev, I3200_ERRSTS, I3200_ERRSTS_BITS,
177*4882a593Smuzhiyun 		I3200_ERRSTS_BITS);
178*4882a593Smuzhiyun }
179*4882a593Smuzhiyun 
i3200_get_and_clear_error_info(struct mem_ctl_info * mci,struct i3200_error_info * info)180*4882a593Smuzhiyun static void i3200_get_and_clear_error_info(struct mem_ctl_info *mci,
181*4882a593Smuzhiyun 		struct i3200_error_info *info)
182*4882a593Smuzhiyun {
183*4882a593Smuzhiyun 	struct pci_dev *pdev;
184*4882a593Smuzhiyun 	struct i3200_priv *priv = mci->pvt_info;
185*4882a593Smuzhiyun 	void __iomem *window = priv->window;
186*4882a593Smuzhiyun 
187*4882a593Smuzhiyun 	pdev = to_pci_dev(mci->pdev);
188*4882a593Smuzhiyun 
189*4882a593Smuzhiyun 	/*
190*4882a593Smuzhiyun 	 * This is a mess because there is no atomic way to read all the
191*4882a593Smuzhiyun 	 * registers at once and the registers can transition from CE being
192*4882a593Smuzhiyun 	 * overwritten by UE.
193*4882a593Smuzhiyun 	 */
194*4882a593Smuzhiyun 	pci_read_config_word(pdev, I3200_ERRSTS, &info->errsts);
195*4882a593Smuzhiyun 	if (!(info->errsts & I3200_ERRSTS_BITS))
196*4882a593Smuzhiyun 		return;
197*4882a593Smuzhiyun 
198*4882a593Smuzhiyun 	info->eccerrlog[0] = readq(window + I3200_C0ECCERRLOG);
199*4882a593Smuzhiyun 	if (nr_channels == 2)
200*4882a593Smuzhiyun 		info->eccerrlog[1] = readq(window + I3200_C1ECCERRLOG);
201*4882a593Smuzhiyun 
202*4882a593Smuzhiyun 	pci_read_config_word(pdev, I3200_ERRSTS, &info->errsts2);
203*4882a593Smuzhiyun 
204*4882a593Smuzhiyun 	/*
205*4882a593Smuzhiyun 	 * If the error is the same for both reads then the first set
206*4882a593Smuzhiyun 	 * of reads is valid.  If there is a change then there is a CE
207*4882a593Smuzhiyun 	 * with no info and the second set of reads is valid and
208*4882a593Smuzhiyun 	 * should be UE info.
209*4882a593Smuzhiyun 	 */
210*4882a593Smuzhiyun 	if ((info->errsts ^ info->errsts2) & I3200_ERRSTS_BITS) {
211*4882a593Smuzhiyun 		info->eccerrlog[0] = readq(window + I3200_C0ECCERRLOG);
212*4882a593Smuzhiyun 		if (nr_channels == 2)
213*4882a593Smuzhiyun 			info->eccerrlog[1] = readq(window + I3200_C1ECCERRLOG);
214*4882a593Smuzhiyun 	}
215*4882a593Smuzhiyun 
216*4882a593Smuzhiyun 	i3200_clear_error_info(mci);
217*4882a593Smuzhiyun }
218*4882a593Smuzhiyun 
i3200_process_error_info(struct mem_ctl_info * mci,struct i3200_error_info * info)219*4882a593Smuzhiyun static void i3200_process_error_info(struct mem_ctl_info *mci,
220*4882a593Smuzhiyun 		struct i3200_error_info *info)
221*4882a593Smuzhiyun {
222*4882a593Smuzhiyun 	int channel;
223*4882a593Smuzhiyun 	u64 log;
224*4882a593Smuzhiyun 
225*4882a593Smuzhiyun 	if (!(info->errsts & I3200_ERRSTS_BITS))
226*4882a593Smuzhiyun 		return;
227*4882a593Smuzhiyun 
228*4882a593Smuzhiyun 	if ((info->errsts ^ info->errsts2) & I3200_ERRSTS_BITS) {
229*4882a593Smuzhiyun 		edac_mc_handle_error(HW_EVENT_ERR_UNCORRECTED, mci, 1, 0, 0, 0,
230*4882a593Smuzhiyun 				     -1, -1, -1, "UE overwrote CE", "");
231*4882a593Smuzhiyun 		info->errsts = info->errsts2;
232*4882a593Smuzhiyun 	}
233*4882a593Smuzhiyun 
234*4882a593Smuzhiyun 	for (channel = 0; channel < nr_channels; channel++) {
235*4882a593Smuzhiyun 		log = info->eccerrlog[channel];
236*4882a593Smuzhiyun 		if (log & I3200_ECCERRLOG_UE) {
237*4882a593Smuzhiyun 			edac_mc_handle_error(HW_EVENT_ERR_UNCORRECTED, mci, 1,
238*4882a593Smuzhiyun 					     0, 0, 0,
239*4882a593Smuzhiyun 					     eccerrlog_row(channel, log),
240*4882a593Smuzhiyun 					     -1, -1,
241*4882a593Smuzhiyun 					     "i3000 UE", "");
242*4882a593Smuzhiyun 		} else if (log & I3200_ECCERRLOG_CE) {
243*4882a593Smuzhiyun 			edac_mc_handle_error(HW_EVENT_ERR_CORRECTED, mci, 1,
244*4882a593Smuzhiyun 					     0, 0, eccerrlog_syndrome(log),
245*4882a593Smuzhiyun 					     eccerrlog_row(channel, log),
246*4882a593Smuzhiyun 					     -1, -1,
247*4882a593Smuzhiyun 					     "i3000 CE", "");
248*4882a593Smuzhiyun 		}
249*4882a593Smuzhiyun 	}
250*4882a593Smuzhiyun }
251*4882a593Smuzhiyun 
i3200_check(struct mem_ctl_info * mci)252*4882a593Smuzhiyun static void i3200_check(struct mem_ctl_info *mci)
253*4882a593Smuzhiyun {
254*4882a593Smuzhiyun 	struct i3200_error_info info;
255*4882a593Smuzhiyun 
256*4882a593Smuzhiyun 	edac_dbg(1, "MC%d\n", mci->mc_idx);
257*4882a593Smuzhiyun 	i3200_get_and_clear_error_info(mci, &info);
258*4882a593Smuzhiyun 	i3200_process_error_info(mci, &info);
259*4882a593Smuzhiyun }
260*4882a593Smuzhiyun 
i3200_map_mchbar(struct pci_dev * pdev)261*4882a593Smuzhiyun static void __iomem *i3200_map_mchbar(struct pci_dev *pdev)
262*4882a593Smuzhiyun {
263*4882a593Smuzhiyun 	union {
264*4882a593Smuzhiyun 		u64 mchbar;
265*4882a593Smuzhiyun 		struct {
266*4882a593Smuzhiyun 			u32 mchbar_low;
267*4882a593Smuzhiyun 			u32 mchbar_high;
268*4882a593Smuzhiyun 		};
269*4882a593Smuzhiyun 	} u;
270*4882a593Smuzhiyun 	void __iomem *window;
271*4882a593Smuzhiyun 
272*4882a593Smuzhiyun 	pci_read_config_dword(pdev, I3200_MCHBAR_LOW, &u.mchbar_low);
273*4882a593Smuzhiyun 	pci_read_config_dword(pdev, I3200_MCHBAR_HIGH, &u.mchbar_high);
274*4882a593Smuzhiyun 	u.mchbar &= I3200_MCHBAR_MASK;
275*4882a593Smuzhiyun 
276*4882a593Smuzhiyun 	if (u.mchbar != (resource_size_t)u.mchbar) {
277*4882a593Smuzhiyun 		printk(KERN_ERR
278*4882a593Smuzhiyun 			"i3200: mmio space beyond accessible range (0x%llx)\n",
279*4882a593Smuzhiyun 			(unsigned long long)u.mchbar);
280*4882a593Smuzhiyun 		return NULL;
281*4882a593Smuzhiyun 	}
282*4882a593Smuzhiyun 
283*4882a593Smuzhiyun 	window = ioremap(u.mchbar, I3200_MMR_WINDOW_SIZE);
284*4882a593Smuzhiyun 	if (!window)
285*4882a593Smuzhiyun 		printk(KERN_ERR "i3200: cannot map mmio space at 0x%llx\n",
286*4882a593Smuzhiyun 			(unsigned long long)u.mchbar);
287*4882a593Smuzhiyun 
288*4882a593Smuzhiyun 	return window;
289*4882a593Smuzhiyun }
290*4882a593Smuzhiyun 
291*4882a593Smuzhiyun 
i3200_get_drbs(void __iomem * window,u16 drbs[I3200_CHANNELS][I3200_RANKS_PER_CHANNEL])292*4882a593Smuzhiyun static void i3200_get_drbs(void __iomem *window,
293*4882a593Smuzhiyun 	u16 drbs[I3200_CHANNELS][I3200_RANKS_PER_CHANNEL])
294*4882a593Smuzhiyun {
295*4882a593Smuzhiyun 	int i;
296*4882a593Smuzhiyun 
297*4882a593Smuzhiyun 	for (i = 0; i < I3200_RANKS_PER_CHANNEL; i++) {
298*4882a593Smuzhiyun 		drbs[0][i] = readw(window + I3200_C0DRB + 2*i) & I3200_DRB_MASK;
299*4882a593Smuzhiyun 		drbs[1][i] = readw(window + I3200_C1DRB + 2*i) & I3200_DRB_MASK;
300*4882a593Smuzhiyun 
301*4882a593Smuzhiyun 		edac_dbg(0, "drb[0][%d] = %d, drb[1][%d] = %d\n", i, drbs[0][i], i, drbs[1][i]);
302*4882a593Smuzhiyun 	}
303*4882a593Smuzhiyun }
304*4882a593Smuzhiyun 
i3200_is_stacked(struct pci_dev * pdev,u16 drbs[I3200_CHANNELS][I3200_RANKS_PER_CHANNEL])305*4882a593Smuzhiyun static bool i3200_is_stacked(struct pci_dev *pdev,
306*4882a593Smuzhiyun 	u16 drbs[I3200_CHANNELS][I3200_RANKS_PER_CHANNEL])
307*4882a593Smuzhiyun {
308*4882a593Smuzhiyun 	u16 tom;
309*4882a593Smuzhiyun 
310*4882a593Smuzhiyun 	pci_read_config_word(pdev, I3200_TOM, &tom);
311*4882a593Smuzhiyun 	tom &= I3200_TOM_MASK;
312*4882a593Smuzhiyun 
313*4882a593Smuzhiyun 	return drbs[I3200_CHANNELS - 1][I3200_RANKS_PER_CHANNEL - 1] == tom;
314*4882a593Smuzhiyun }
315*4882a593Smuzhiyun 
drb_to_nr_pages(u16 drbs[I3200_CHANNELS][I3200_RANKS_PER_CHANNEL],bool stacked,int channel,int rank)316*4882a593Smuzhiyun static unsigned long drb_to_nr_pages(
317*4882a593Smuzhiyun 	u16 drbs[I3200_CHANNELS][I3200_RANKS_PER_CHANNEL], bool stacked,
318*4882a593Smuzhiyun 	int channel, int rank)
319*4882a593Smuzhiyun {
320*4882a593Smuzhiyun 	int n;
321*4882a593Smuzhiyun 
322*4882a593Smuzhiyun 	n = drbs[channel][rank];
323*4882a593Smuzhiyun 	if (!n)
324*4882a593Smuzhiyun 		return 0;
325*4882a593Smuzhiyun 
326*4882a593Smuzhiyun 	if (rank > 0)
327*4882a593Smuzhiyun 		n -= drbs[channel][rank - 1];
328*4882a593Smuzhiyun 	if (stacked && (channel == 1) &&
329*4882a593Smuzhiyun 	drbs[channel][rank] == drbs[channel][I3200_RANKS_PER_CHANNEL - 1])
330*4882a593Smuzhiyun 		n -= drbs[0][I3200_RANKS_PER_CHANNEL - 1];
331*4882a593Smuzhiyun 
332*4882a593Smuzhiyun 	n <<= (I3200_DRB_SHIFT - PAGE_SHIFT);
333*4882a593Smuzhiyun 	return n;
334*4882a593Smuzhiyun }
335*4882a593Smuzhiyun 
i3200_probe1(struct pci_dev * pdev,int dev_idx)336*4882a593Smuzhiyun static int i3200_probe1(struct pci_dev *pdev, int dev_idx)
337*4882a593Smuzhiyun {
338*4882a593Smuzhiyun 	int rc;
339*4882a593Smuzhiyun 	int i, j;
340*4882a593Smuzhiyun 	struct mem_ctl_info *mci = NULL;
341*4882a593Smuzhiyun 	struct edac_mc_layer layers[2];
342*4882a593Smuzhiyun 	u16 drbs[I3200_CHANNELS][I3200_RANKS_PER_CHANNEL];
343*4882a593Smuzhiyun 	bool stacked;
344*4882a593Smuzhiyun 	void __iomem *window;
345*4882a593Smuzhiyun 	struct i3200_priv *priv;
346*4882a593Smuzhiyun 
347*4882a593Smuzhiyun 	edac_dbg(0, "MC:\n");
348*4882a593Smuzhiyun 
349*4882a593Smuzhiyun 	window = i3200_map_mchbar(pdev);
350*4882a593Smuzhiyun 	if (!window)
351*4882a593Smuzhiyun 		return -ENODEV;
352*4882a593Smuzhiyun 
353*4882a593Smuzhiyun 	i3200_get_drbs(window, drbs);
354*4882a593Smuzhiyun 	nr_channels = how_many_channels(pdev);
355*4882a593Smuzhiyun 
356*4882a593Smuzhiyun 	layers[0].type = EDAC_MC_LAYER_CHIP_SELECT;
357*4882a593Smuzhiyun 	layers[0].size = I3200_DIMMS;
358*4882a593Smuzhiyun 	layers[0].is_virt_csrow = true;
359*4882a593Smuzhiyun 	layers[1].type = EDAC_MC_LAYER_CHANNEL;
360*4882a593Smuzhiyun 	layers[1].size = nr_channels;
361*4882a593Smuzhiyun 	layers[1].is_virt_csrow = false;
362*4882a593Smuzhiyun 	mci = edac_mc_alloc(0, ARRAY_SIZE(layers), layers,
363*4882a593Smuzhiyun 			    sizeof(struct i3200_priv));
364*4882a593Smuzhiyun 	if (!mci)
365*4882a593Smuzhiyun 		return -ENOMEM;
366*4882a593Smuzhiyun 
367*4882a593Smuzhiyun 	edac_dbg(3, "MC: init mci\n");
368*4882a593Smuzhiyun 
369*4882a593Smuzhiyun 	mci->pdev = &pdev->dev;
370*4882a593Smuzhiyun 	mci->mtype_cap = MEM_FLAG_DDR2;
371*4882a593Smuzhiyun 
372*4882a593Smuzhiyun 	mci->edac_ctl_cap = EDAC_FLAG_SECDED;
373*4882a593Smuzhiyun 	mci->edac_cap = EDAC_FLAG_SECDED;
374*4882a593Smuzhiyun 
375*4882a593Smuzhiyun 	mci->mod_name = EDAC_MOD_STR;
376*4882a593Smuzhiyun 	mci->ctl_name = i3200_devs[dev_idx].ctl_name;
377*4882a593Smuzhiyun 	mci->dev_name = pci_name(pdev);
378*4882a593Smuzhiyun 	mci->edac_check = i3200_check;
379*4882a593Smuzhiyun 	mci->ctl_page_to_phys = NULL;
380*4882a593Smuzhiyun 	priv = mci->pvt_info;
381*4882a593Smuzhiyun 	priv->window = window;
382*4882a593Smuzhiyun 
383*4882a593Smuzhiyun 	stacked = i3200_is_stacked(pdev, drbs);
384*4882a593Smuzhiyun 
385*4882a593Smuzhiyun 	/*
386*4882a593Smuzhiyun 	 * The dram rank boundary (DRB) reg values are boundary addresses
387*4882a593Smuzhiyun 	 * for each DRAM rank with a granularity of 64MB.  DRB regs are
388*4882a593Smuzhiyun 	 * cumulative; the last one will contain the total memory
389*4882a593Smuzhiyun 	 * contained in all ranks.
390*4882a593Smuzhiyun 	 */
391*4882a593Smuzhiyun 	for (i = 0; i < I3200_DIMMS; i++) {
392*4882a593Smuzhiyun 		unsigned long nr_pages;
393*4882a593Smuzhiyun 
394*4882a593Smuzhiyun 		for (j = 0; j < nr_channels; j++) {
395*4882a593Smuzhiyun 			struct dimm_info *dimm = edac_get_dimm(mci, i, j, 0);
396*4882a593Smuzhiyun 
397*4882a593Smuzhiyun 			nr_pages = drb_to_nr_pages(drbs, stacked, j, i);
398*4882a593Smuzhiyun 			if (nr_pages == 0)
399*4882a593Smuzhiyun 				continue;
400*4882a593Smuzhiyun 
401*4882a593Smuzhiyun 			edac_dbg(0, "csrow %d, channel %d%s, size = %ld MiB\n", i, j,
402*4882a593Smuzhiyun 				 stacked ? " (stacked)" : "", PAGES_TO_MiB(nr_pages));
403*4882a593Smuzhiyun 
404*4882a593Smuzhiyun 			dimm->nr_pages = nr_pages;
405*4882a593Smuzhiyun 			dimm->grain = nr_pages << PAGE_SHIFT;
406*4882a593Smuzhiyun 			dimm->mtype = MEM_DDR2;
407*4882a593Smuzhiyun 			dimm->dtype = DEV_UNKNOWN;
408*4882a593Smuzhiyun 			dimm->edac_mode = EDAC_UNKNOWN;
409*4882a593Smuzhiyun 		}
410*4882a593Smuzhiyun 	}
411*4882a593Smuzhiyun 
412*4882a593Smuzhiyun 	i3200_clear_error_info(mci);
413*4882a593Smuzhiyun 
414*4882a593Smuzhiyun 	rc = -ENODEV;
415*4882a593Smuzhiyun 	if (edac_mc_add_mc(mci)) {
416*4882a593Smuzhiyun 		edac_dbg(3, "MC: failed edac_mc_add_mc()\n");
417*4882a593Smuzhiyun 		goto fail;
418*4882a593Smuzhiyun 	}
419*4882a593Smuzhiyun 
420*4882a593Smuzhiyun 	/* get this far and it's successful */
421*4882a593Smuzhiyun 	edac_dbg(3, "MC: success\n");
422*4882a593Smuzhiyun 	return 0;
423*4882a593Smuzhiyun 
424*4882a593Smuzhiyun fail:
425*4882a593Smuzhiyun 	iounmap(window);
426*4882a593Smuzhiyun 	if (mci)
427*4882a593Smuzhiyun 		edac_mc_free(mci);
428*4882a593Smuzhiyun 
429*4882a593Smuzhiyun 	return rc;
430*4882a593Smuzhiyun }
431*4882a593Smuzhiyun 
i3200_init_one(struct pci_dev * pdev,const struct pci_device_id * ent)432*4882a593Smuzhiyun static int i3200_init_one(struct pci_dev *pdev, const struct pci_device_id *ent)
433*4882a593Smuzhiyun {
434*4882a593Smuzhiyun 	int rc;
435*4882a593Smuzhiyun 
436*4882a593Smuzhiyun 	edac_dbg(0, "MC:\n");
437*4882a593Smuzhiyun 
438*4882a593Smuzhiyun 	if (pci_enable_device(pdev) < 0)
439*4882a593Smuzhiyun 		return -EIO;
440*4882a593Smuzhiyun 
441*4882a593Smuzhiyun 	rc = i3200_probe1(pdev, ent->driver_data);
442*4882a593Smuzhiyun 	if (!mci_pdev)
443*4882a593Smuzhiyun 		mci_pdev = pci_dev_get(pdev);
444*4882a593Smuzhiyun 
445*4882a593Smuzhiyun 	return rc;
446*4882a593Smuzhiyun }
447*4882a593Smuzhiyun 
i3200_remove_one(struct pci_dev * pdev)448*4882a593Smuzhiyun static void i3200_remove_one(struct pci_dev *pdev)
449*4882a593Smuzhiyun {
450*4882a593Smuzhiyun 	struct mem_ctl_info *mci;
451*4882a593Smuzhiyun 	struct i3200_priv *priv;
452*4882a593Smuzhiyun 
453*4882a593Smuzhiyun 	edac_dbg(0, "\n");
454*4882a593Smuzhiyun 
455*4882a593Smuzhiyun 	mci = edac_mc_del_mc(&pdev->dev);
456*4882a593Smuzhiyun 	if (!mci)
457*4882a593Smuzhiyun 		return;
458*4882a593Smuzhiyun 
459*4882a593Smuzhiyun 	priv = mci->pvt_info;
460*4882a593Smuzhiyun 	iounmap(priv->window);
461*4882a593Smuzhiyun 
462*4882a593Smuzhiyun 	edac_mc_free(mci);
463*4882a593Smuzhiyun 
464*4882a593Smuzhiyun 	pci_disable_device(pdev);
465*4882a593Smuzhiyun }
466*4882a593Smuzhiyun 
467*4882a593Smuzhiyun static const struct pci_device_id i3200_pci_tbl[] = {
468*4882a593Smuzhiyun 	{
469*4882a593Smuzhiyun 		PCI_VEND_DEV(INTEL, 3200_HB), PCI_ANY_ID, PCI_ANY_ID, 0, 0,
470*4882a593Smuzhiyun 		I3200},
471*4882a593Smuzhiyun 	{
472*4882a593Smuzhiyun 		0,
473*4882a593Smuzhiyun 	}            /* 0 terminated list. */
474*4882a593Smuzhiyun };
475*4882a593Smuzhiyun 
476*4882a593Smuzhiyun MODULE_DEVICE_TABLE(pci, i3200_pci_tbl);
477*4882a593Smuzhiyun 
478*4882a593Smuzhiyun static struct pci_driver i3200_driver = {
479*4882a593Smuzhiyun 	.name = EDAC_MOD_STR,
480*4882a593Smuzhiyun 	.probe = i3200_init_one,
481*4882a593Smuzhiyun 	.remove = i3200_remove_one,
482*4882a593Smuzhiyun 	.id_table = i3200_pci_tbl,
483*4882a593Smuzhiyun };
484*4882a593Smuzhiyun 
i3200_init(void)485*4882a593Smuzhiyun static int __init i3200_init(void)
486*4882a593Smuzhiyun {
487*4882a593Smuzhiyun 	int pci_rc;
488*4882a593Smuzhiyun 
489*4882a593Smuzhiyun 	edac_dbg(3, "MC:\n");
490*4882a593Smuzhiyun 
491*4882a593Smuzhiyun 	/* Ensure that the OPSTATE is set correctly for POLL or NMI */
492*4882a593Smuzhiyun 	opstate_init();
493*4882a593Smuzhiyun 
494*4882a593Smuzhiyun 	pci_rc = pci_register_driver(&i3200_driver);
495*4882a593Smuzhiyun 	if (pci_rc < 0)
496*4882a593Smuzhiyun 		goto fail0;
497*4882a593Smuzhiyun 
498*4882a593Smuzhiyun 	if (!mci_pdev) {
499*4882a593Smuzhiyun 		i3200_registered = 0;
500*4882a593Smuzhiyun 		mci_pdev = pci_get_device(PCI_VENDOR_ID_INTEL,
501*4882a593Smuzhiyun 				PCI_DEVICE_ID_INTEL_3200_HB, NULL);
502*4882a593Smuzhiyun 		if (!mci_pdev) {
503*4882a593Smuzhiyun 			edac_dbg(0, "i3200 pci_get_device fail\n");
504*4882a593Smuzhiyun 			pci_rc = -ENODEV;
505*4882a593Smuzhiyun 			goto fail1;
506*4882a593Smuzhiyun 		}
507*4882a593Smuzhiyun 
508*4882a593Smuzhiyun 		pci_rc = i3200_init_one(mci_pdev, i3200_pci_tbl);
509*4882a593Smuzhiyun 		if (pci_rc < 0) {
510*4882a593Smuzhiyun 			edac_dbg(0, "i3200 init fail\n");
511*4882a593Smuzhiyun 			pci_rc = -ENODEV;
512*4882a593Smuzhiyun 			goto fail1;
513*4882a593Smuzhiyun 		}
514*4882a593Smuzhiyun 	}
515*4882a593Smuzhiyun 
516*4882a593Smuzhiyun 	return 0;
517*4882a593Smuzhiyun 
518*4882a593Smuzhiyun fail1:
519*4882a593Smuzhiyun 	pci_unregister_driver(&i3200_driver);
520*4882a593Smuzhiyun 
521*4882a593Smuzhiyun fail0:
522*4882a593Smuzhiyun 	pci_dev_put(mci_pdev);
523*4882a593Smuzhiyun 
524*4882a593Smuzhiyun 	return pci_rc;
525*4882a593Smuzhiyun }
526*4882a593Smuzhiyun 
i3200_exit(void)527*4882a593Smuzhiyun static void __exit i3200_exit(void)
528*4882a593Smuzhiyun {
529*4882a593Smuzhiyun 	edac_dbg(3, "MC:\n");
530*4882a593Smuzhiyun 
531*4882a593Smuzhiyun 	pci_unregister_driver(&i3200_driver);
532*4882a593Smuzhiyun 	if (!i3200_registered) {
533*4882a593Smuzhiyun 		i3200_remove_one(mci_pdev);
534*4882a593Smuzhiyun 		pci_dev_put(mci_pdev);
535*4882a593Smuzhiyun 	}
536*4882a593Smuzhiyun }
537*4882a593Smuzhiyun 
538*4882a593Smuzhiyun module_init(i3200_init);
539*4882a593Smuzhiyun module_exit(i3200_exit);
540*4882a593Smuzhiyun 
541*4882a593Smuzhiyun MODULE_LICENSE("GPL");
542*4882a593Smuzhiyun MODULE_AUTHOR("Akamai Technologies, Inc.");
543*4882a593Smuzhiyun MODULE_DESCRIPTION("MC support for Intel 3200 memory hub controllers");
544*4882a593Smuzhiyun 
545*4882a593Smuzhiyun module_param(edac_op_state, int, 0444);
546*4882a593Smuzhiyun MODULE_PARM_DESC(edac_op_state, "EDAC Error Reporting state: 0=Poll,1=NMI");
547