Blame view

kernel/linux-rt-4.4.41/drivers/edac/pasemi_edac.c 8.58 KB
5113f6f70   김현기   kernel add
1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
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
112
113
114
115
116
117
118
119
120
121
122
123
124
125
126
127
128
129
130
131
132
133
134
135
136
137
138
139
140
141
142
143
144
145
146
147
148
149
150
151
152
153
154
155
156
157
158
159
160
161
162
163
164
165
166
167
168
169
170
171
172
173
174
175
176
177
178
179
180
181
182
183
184
185
186
187
188
189
190
191
192
193
194
195
196
197
198
199
200
201
202
203
204
205
206
207
208
209
210
211
212
213
214
215
216
217
218
219
220
221
222
223
224
225
226
227
228
229
230
231
232
233
234
235
236
237
238
239
240
241
242
243
244
245
246
247
248
249
250
251
252
253
254
255
256
257
258
259
260
261
262
263
264
265
266
267
268
269
270
271
272
273
274
275
276
277
278
279
280
281
282
283
284
285
286
287
288
289
290
291
292
293
294
295
296
297
298
299
300
301
302
303
304
305
306
307
308
309
310
311
312
313
314
315
  /*
   * Copyright (C) 2006-2007 PA Semi, Inc
   *
   * Author: Egor Martovetsky <egor@pasemi.com>
   * Maintained by: Olof Johansson <olof@lixom.net>
   *
   * Driver for the PWRficient onchip memory controllers
   *
   * This program is free software; you can redistribute it and/or modify
   * it under the terms of the GNU General Public License version 2 as
   * published by the Free Software Foundation.
   *
   * This program is distributed in the hope that it will be useful,
   * but WITHOUT ANY WARRANTY; without even the implied warranty of
   * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
   * GNU General Public License for more details.
   *
   * You should have received a copy of the GNU General Public License
   * along with this program; if not, write to the Free Software
   * Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA  02111-1307 USA
   */
  
  
  #include <linux/module.h>
  #include <linux/init.h>
  #include <linux/pci.h>
  #include <linux/pci_ids.h>
  #include <linux/edac.h>
  #include "edac_core.h"
  
  #define MODULE_NAME "pasemi_edac"
  
  #define MCCFG_MCEN				0x300
  #define   MCCFG_MCEN_MMC_EN			0x00000001
  #define MCCFG_ERRCOR				0x388
  #define   MCCFG_ERRCOR_RNK_FAIL_DET_EN		0x00000100
  #define   MCCFG_ERRCOR_ECC_GEN_EN		0x00000010
  #define   MCCFG_ERRCOR_ECC_CRR_EN		0x00000001
  #define MCCFG_SCRUB				0x384
  #define   MCCFG_SCRUB_RGLR_SCRB_EN		0x00000001
  #define MCDEBUG_ERRCTL1				0x728
  #define   MCDEBUG_ERRCTL1_RFL_LOG_EN		0x00080000
  #define   MCDEBUG_ERRCTL1_MBE_LOG_EN		0x00040000
  #define   MCDEBUG_ERRCTL1_SBE_LOG_EN		0x00020000
  #define MCDEBUG_ERRSTA				0x730
  #define   MCDEBUG_ERRSTA_RFL_STATUS		0x00000004
  #define   MCDEBUG_ERRSTA_MBE_STATUS		0x00000002
  #define   MCDEBUG_ERRSTA_SBE_STATUS		0x00000001
  #define MCDEBUG_ERRCNT1				0x734
  #define   MCDEBUG_ERRCNT1_SBE_CNT_OVRFLO	0x00000080
  #define MCDEBUG_ERRLOG1A			0x738
  #define   MCDEBUG_ERRLOG1A_MERR_TYPE_M		0x30000000
  #define   MCDEBUG_ERRLOG1A_MERR_TYPE_NONE	0x00000000
  #define   MCDEBUG_ERRLOG1A_MERR_TYPE_SBE	0x10000000
  #define   MCDEBUG_ERRLOG1A_MERR_TYPE_MBE	0x20000000
  #define   MCDEBUG_ERRLOG1A_MERR_TYPE_RFL	0x30000000
  #define   MCDEBUG_ERRLOG1A_MERR_BA_M		0x00700000
  #define   MCDEBUG_ERRLOG1A_MERR_BA_S		20
  #define   MCDEBUG_ERRLOG1A_MERR_CS_M		0x00070000
  #define   MCDEBUG_ERRLOG1A_MERR_CS_S		16
  #define   MCDEBUG_ERRLOG1A_SYNDROME_M		0x0000ffff
  #define MCDRAM_RANKCFG				0x114
  #define   MCDRAM_RANKCFG_EN			0x00000001
  #define   MCDRAM_RANKCFG_TYPE_SIZE_M		0x000001c0
  #define   MCDRAM_RANKCFG_TYPE_SIZE_S		6
  
  #define PASEMI_EDAC_NR_CSROWS			8
  #define PASEMI_EDAC_NR_CHANS			1
  #define PASEMI_EDAC_ERROR_GRAIN			64
  
  static int last_page_in_mmc;
  static int system_mmc_id;
  
  
  static u32 pasemi_edac_get_error_info(struct mem_ctl_info *mci)
  {
  	struct pci_dev *pdev = to_pci_dev(mci->pdev);
  	u32 tmp;
  
  	pci_read_config_dword(pdev, MCDEBUG_ERRSTA,
  			      &tmp);
  
  	tmp &= (MCDEBUG_ERRSTA_RFL_STATUS | MCDEBUG_ERRSTA_MBE_STATUS
  		| MCDEBUG_ERRSTA_SBE_STATUS);
  
  	if (tmp) {
  		if (tmp & MCDEBUG_ERRSTA_SBE_STATUS)
  			pci_write_config_dword(pdev, MCDEBUG_ERRCNT1,
  					       MCDEBUG_ERRCNT1_SBE_CNT_OVRFLO);
  		pci_write_config_dword(pdev, MCDEBUG_ERRSTA, tmp);
  	}
  
  	return tmp;
  }
  
  static void pasemi_edac_process_error_info(struct mem_ctl_info *mci, u32 errsta)
  {
  	struct pci_dev *pdev = to_pci_dev(mci->pdev);
  	u32 errlog1a;
  	u32 cs;
  
  	if (!errsta)
  		return;
  
  	pci_read_config_dword(pdev, MCDEBUG_ERRLOG1A, &errlog1a);
  
  	cs = (errlog1a & MCDEBUG_ERRLOG1A_MERR_CS_M) >>
  		MCDEBUG_ERRLOG1A_MERR_CS_S;
  
  	/* uncorrectable/multi-bit errors */
  	if (errsta & (MCDEBUG_ERRSTA_MBE_STATUS |
  		      MCDEBUG_ERRSTA_RFL_STATUS)) {
  		edac_mc_handle_error(HW_EVENT_ERR_UNCORRECTED, mci, 1,
  				     mci->csrows[cs]->first_page, 0, 0,
  				     cs, 0, -1, mci->ctl_name, "");
  	}
  
  	/* correctable/single-bit errors */
  	if (errsta & MCDEBUG_ERRSTA_SBE_STATUS)
  		edac_mc_handle_error(HW_EVENT_ERR_CORRECTED, mci, 1,
  				     mci->csrows[cs]->first_page, 0, 0,
  				     cs, 0, -1, mci->ctl_name, "");
  }
  
  static void pasemi_edac_check(struct mem_ctl_info *mci)
  {
  	u32 errsta;
  
  	errsta = pasemi_edac_get_error_info(mci);
  	if (errsta)
  		pasemi_edac_process_error_info(mci, errsta);
  }
  
  static int pasemi_edac_init_csrows(struct mem_ctl_info *mci,
  				   struct pci_dev *pdev,
  				   enum edac_type edac_mode)
  {
  	struct csrow_info *csrow;
  	struct dimm_info *dimm;
  	u32 rankcfg;
  	int index;
  
  	for (index = 0; index < mci->nr_csrows; index++) {
  		csrow = mci->csrows[index];
  		dimm = csrow->channels[0]->dimm;
  
  		pci_read_config_dword(pdev,
  				      MCDRAM_RANKCFG + (index * 12),
  				      &rankcfg);
  
  		if (!(rankcfg & MCDRAM_RANKCFG_EN))
  			continue;
  
  		switch ((rankcfg & MCDRAM_RANKCFG_TYPE_SIZE_M) >>
  			MCDRAM_RANKCFG_TYPE_SIZE_S) {
  		case 0:
  			dimm->nr_pages = 128 << (20 - PAGE_SHIFT);
  			break;
  		case 1:
  			dimm->nr_pages = 256 << (20 - PAGE_SHIFT);
  			break;
  		case 2:
  		case 3:
  			dimm->nr_pages = 512 << (20 - PAGE_SHIFT);
  			break;
  		case 4:
  			dimm->nr_pages = 1024 << (20 - PAGE_SHIFT);
  			break;
  		case 5:
  			dimm->nr_pages = 2048 << (20 - PAGE_SHIFT);
  			break;
  		default:
  			edac_mc_printk(mci, KERN_ERR,
  				"Unrecognized Rank Config. rankcfg=%u
  ",
  				rankcfg);
  			return -EINVAL;
  		}
  
  		csrow->first_page = last_page_in_mmc;
  		csrow->last_page = csrow->first_page + dimm->nr_pages - 1;
  		last_page_in_mmc += dimm->nr_pages;
  		csrow->page_mask = 0;
  		dimm->grain = PASEMI_EDAC_ERROR_GRAIN;
  		dimm->mtype = MEM_DDR;
  		dimm->dtype = DEV_UNKNOWN;
  		dimm->edac_mode = edac_mode;
  	}
  	return 0;
  }
  
  static int pasemi_edac_probe(struct pci_dev *pdev,
  			     const struct pci_device_id *ent)
  {
  	struct mem_ctl_info *mci = NULL;
  	struct edac_mc_layer layers[2];
  	u32 errctl1, errcor, scrub, mcen;
  
  	pci_read_config_dword(pdev, MCCFG_MCEN, &mcen);
  	if (!(mcen & MCCFG_MCEN_MMC_EN))
  		return -ENODEV;
  
  	/*
  	 * We should think about enabling other error detection later on
  	 */
  
  	pci_read_config_dword(pdev, MCDEBUG_ERRCTL1, &errctl1);
  	errctl1 |= MCDEBUG_ERRCTL1_SBE_LOG_EN |
  		MCDEBUG_ERRCTL1_MBE_LOG_EN |
  		MCDEBUG_ERRCTL1_RFL_LOG_EN;
  	pci_write_config_dword(pdev, MCDEBUG_ERRCTL1, errctl1);
  
  	layers[0].type = EDAC_MC_LAYER_CHIP_SELECT;
  	layers[0].size = PASEMI_EDAC_NR_CSROWS;
  	layers[0].is_virt_csrow = true;
  	layers[1].type = EDAC_MC_LAYER_CHANNEL;
  	layers[1].size = PASEMI_EDAC_NR_CHANS;
  	layers[1].is_virt_csrow = false;
  	mci = edac_mc_alloc(system_mmc_id++, ARRAY_SIZE(layers), layers,
  			    0);
  	if (mci == NULL)
  		return -ENOMEM;
  
  	pci_read_config_dword(pdev, MCCFG_ERRCOR, &errcor);
  	errcor |= MCCFG_ERRCOR_RNK_FAIL_DET_EN |
  		MCCFG_ERRCOR_ECC_GEN_EN |
  		MCCFG_ERRCOR_ECC_CRR_EN;
  
  	mci->pdev = &pdev->dev;
  	mci->mtype_cap = MEM_FLAG_DDR | MEM_FLAG_RDDR;
  	mci->edac_ctl_cap = EDAC_FLAG_NONE | EDAC_FLAG_EC | EDAC_FLAG_SECDED;
  	mci->edac_cap = (errcor & MCCFG_ERRCOR_ECC_GEN_EN) ?
  		((errcor & MCCFG_ERRCOR_ECC_CRR_EN) ?
  		 (EDAC_FLAG_EC | EDAC_FLAG_SECDED) : EDAC_FLAG_EC) :
  		EDAC_FLAG_NONE;
  	mci->mod_name = MODULE_NAME;
  	mci->dev_name = pci_name(pdev);
  	mci->ctl_name = "pasemi,pwrficient-mc";
  	mci->edac_check = pasemi_edac_check;
  	mci->ctl_page_to_phys = NULL;
  	pci_read_config_dword(pdev, MCCFG_SCRUB, &scrub);
  	mci->scrub_cap = SCRUB_FLAG_HW_PROG | SCRUB_FLAG_HW_SRC;
  	mci->scrub_mode =
  		((errcor & MCCFG_ERRCOR_ECC_CRR_EN) ? SCRUB_FLAG_HW_SRC : 0) |
  		((scrub & MCCFG_SCRUB_RGLR_SCRB_EN) ? SCRUB_FLAG_HW_PROG : 0);
  
  	if (pasemi_edac_init_csrows(mci, pdev,
  				    (mci->edac_cap & EDAC_FLAG_SECDED) ?
  				    EDAC_SECDED :
  				    ((mci->edac_cap & EDAC_FLAG_EC) ?
  				     EDAC_EC : EDAC_NONE)))
  		goto fail;
  
  	/*
  	 * Clear status
  	 */
  	pasemi_edac_get_error_info(mci);
  
  	if (edac_mc_add_mc(mci))
  		goto fail;
  
  	/* get this far and it's successful */
  	return 0;
  
  fail:
  	edac_mc_free(mci);
  	return -ENODEV;
  }
  
  static void pasemi_edac_remove(struct pci_dev *pdev)
  {
  	struct mem_ctl_info *mci = edac_mc_del_mc(&pdev->dev);
  
  	if (!mci)
  		return;
  
  	edac_mc_free(mci);
  }
  
  
  static const struct pci_device_id pasemi_edac_pci_tbl[] = {
  	{ PCI_DEVICE(PCI_VENDOR_ID_PASEMI, 0xa00a) },
  	{ }
  };
  
  MODULE_DEVICE_TABLE(pci, pasemi_edac_pci_tbl);
  
  static struct pci_driver pasemi_edac_driver = {
  	.name = MODULE_NAME,
  	.probe = pasemi_edac_probe,
  	.remove = pasemi_edac_remove,
  	.id_table = pasemi_edac_pci_tbl,
  };
  
  static int __init pasemi_edac_init(void)
  {
         /* Ensure that the OPSTATE is set correctly for POLL or NMI */
         opstate_init();
  
  	return pci_register_driver(&pasemi_edac_driver);
  }
  
  static void __exit pasemi_edac_exit(void)
  {
  	pci_unregister_driver(&pasemi_edac_driver);
  }
  
  module_init(pasemi_edac_init);
  module_exit(pasemi_edac_exit);
  
  MODULE_LICENSE("GPL");
  MODULE_AUTHOR("Egor Martovetsky <egor@pasemi.com>");
  MODULE_DESCRIPTION("MC support for PA Semi PWRficient memory controller");
  module_param(edac_op_state, int, 0444);
  MODULE_PARM_DESC(edac_op_state, "EDAC Error Reporting state: 0=Poll,1=NMI");