| /* | 
 |  * 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\n", | 
 | 				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"); | 
 |  |