308 lines
		
	
	
		
			8.2 KiB
		
	
	
	
		
			C
		
	
	
	
	
	
			
		
		
	
	
			308 lines
		
	
	
		
			8.2 KiB
		
	
	
	
		
			C
		
	
	
	
	
	
/*
 | 
						|
 * 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/slab.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->dev);
 | 
						|
	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->dev);
 | 
						|
	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_ue(mci, mci->csrows[cs].first_page, 0,
 | 
						|
				  cs, mci->ctl_name);
 | 
						|
	}
 | 
						|
 | 
						|
	/* correctable/single-bit errors */
 | 
						|
	if (errsta & MCDEBUG_ERRSTA_SBE_STATUS) {
 | 
						|
		edac_mc_handle_ce(mci, mci->csrows[cs].first_page, 0,
 | 
						|
				  0, cs, 0, 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;
 | 
						|
	u32 rankcfg;
 | 
						|
	int index;
 | 
						|
 | 
						|
	for (index = 0; index < mci->nr_csrows; index++) {
 | 
						|
		csrow = &mci->csrows[index];
 | 
						|
 | 
						|
		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:
 | 
						|
			csrow->nr_pages = 128 << (20 - PAGE_SHIFT);
 | 
						|
			break;
 | 
						|
		case 1:
 | 
						|
			csrow->nr_pages = 256 << (20 - PAGE_SHIFT);
 | 
						|
			break;
 | 
						|
		case 2:
 | 
						|
		case 3:
 | 
						|
			csrow->nr_pages = 512 << (20 - PAGE_SHIFT);
 | 
						|
			break;
 | 
						|
		case 4:
 | 
						|
			csrow->nr_pages = 1024 << (20 - PAGE_SHIFT);
 | 
						|
			break;
 | 
						|
		case 5:
 | 
						|
			csrow->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 + csrow->nr_pages - 1;
 | 
						|
		last_page_in_mmc += csrow->nr_pages;
 | 
						|
		csrow->page_mask = 0;
 | 
						|
		csrow->grain = PASEMI_EDAC_ERROR_GRAIN;
 | 
						|
		csrow->mtype = MEM_DDR;
 | 
						|
		csrow->dtype = DEV_UNKNOWN;
 | 
						|
		csrow->edac_mode = edac_mode;
 | 
						|
	}
 | 
						|
	return 0;
 | 
						|
}
 | 
						|
 | 
						|
static int __devinit pasemi_edac_probe(struct pci_dev *pdev,
 | 
						|
		const struct pci_device_id *ent)
 | 
						|
{
 | 
						|
	struct mem_ctl_info *mci = NULL;
 | 
						|
	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);
 | 
						|
 | 
						|
	mci = edac_mc_alloc(0, PASEMI_EDAC_NR_CSROWS, PASEMI_EDAC_NR_CHANS,
 | 
						|
				system_mmc_id++);
 | 
						|
 | 
						|
	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->dev = &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 __devexit 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 = __devexit_p(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");
 | 
						|
 |