i7core_edac: Add an EDAC memory controller driver for Nehalem chipsets

This driver is meant to support i7 core/i7core extreme desktop
processors and Xeon 35xx/55xx series with integrated memory controller.
It is likely that it can be expanded in the future to work with other
processor series based at the same Memory Controller design.

For now, it has just a few MCH status reads.

Signed-off-by: Mauro Carvalho Chehab <mchehab@redhat.com>

4 files changed, 486 insertions, 0 deletions

diff --git a/drivers/edac/Kconfig b/drivers/edac/Kconfig
index 55c9c59b3f71..391ddbfb2a34 100644
--- a/drivers/edac/Kconfig
+++ b/drivers/edac/Kconfig
@@ -166,6 +166,13 @@ config EDAC_I5400
           Support for error detection and correction the Intel
           i5400 MCH chipset (Seaburg).
 
+config EDAC_I7CORE
+        tristate "Intel i7 Core (Nehalem) processors"
+        depends on EDAC_MM_EDAC && PCI && X86
+        help
+          Support for error detection and correction the Intel
+          i7 Core (Nehalem) Integrated Memory Controller
+
 config EDAC_I82860
         tristate "Intel 82860"
         depends on EDAC_MM_EDAC && PCI && X86_32
diff --git a/drivers/edac/Makefile b/drivers/edac/Makefile
index bc5dc232a0fb..b9996195b233 100644
--- a/drivers/edac/Makefile
+++ b/drivers/edac/Makefile
@@ -23,6 +23,7 @@ obj-$(CONFIG_EDAC_CPC925)		+= cpc925_edac.o
 obj-$(CONFIG_EDAC_I5000)                += i5000_edac.o
 obj-$(CONFIG_EDAC_I5100)                += i5100_edac.o
 obj-$(CONFIG_EDAC_I5400)                += i5400_edac.o
+obj-$(CONFIG_EDAC_I7CORE)               += i7core_edac.o
 obj-$(CONFIG_EDAC_E7XXX)                += e7xxx_edac.o
 obj-$(CONFIG_EDAC_E752X)                += e752x_edac.o
 obj-$(CONFIG_EDAC_I82443BXGX)           += i82443bxgx_edac.o
diff --git a/drivers/edac/i7core_edac.c b/drivers/edac/i7core_edac.c
new file mode 100644
index 000000000000..7ecf15e66a3f
--- /dev/null
+++ b/drivers/edac/i7core_edac.c
@@ -0,0 +1,462 @@
+/* Intel 7 core  Memory Controller kernel module (Nehalem)
+ *
+ * This file may be distributed under the terms of the
+ * GNU General Public License version 2 only.
+ *
+ * Copyright (c) 2009 by:
+ *       Mauro Carvalho Chehab <mchehab@redhat.com>
+ *
+ * Red Hat Inc. http://www.redhat.com
+ *
+ * Forked and adapted from the i5400_edac driver
+ *
+ * Based on the following public Intel datasheets:
+ * Intel Core i7 Processor Extreme Edition and Intel Core i7 Processor
+ * Datasheet, Volume 2:
+ *      http://download.intel.com/design/processor/datashts/320835.pdf
+ * Intel Xeon Processor 5500 Series Datasheet Volume 2
+ *      http://www.intel.com/Assets/PDF/datasheet/321322.pdf
+ * also available at:
+ *      http://www.arrownac.com/manufacturers/intel/s/nehalem/5500-datasheet-v2.pdf
+ */
+
+
+#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 <linux/mmzone.h>
+
+#include "edac_core.h"
+
+
+/*
+ * Alter this version for the module when modifications are made
+ */
+#define I7CORE_REVISION    " Ver: 1.0.0 " __DATE__
+#define EDAC_MOD_STR      "i7core_edac"
+
+/* HACK: temporary, just to enable all logs, for now */
+#undef debugf0
+#define debugf0(fmt, arg...)  edac_printk(KERN_INFO, "i7core", fmt, ##arg)
+
+/*
+ * Debug macros
+ */
+#define i7core_printk(level, fmt, arg...)                       \
+        edac_printk(level, "i7core", fmt, ##arg)
+
+#define i7core_mc_printk(mci, level, fmt, arg...)               \
+        edac_mc_chipset_printk(mci, level, "i7core", fmt, ##arg)
+
+/*
+ * i7core Memory Controller Registers
+ */
+
+        /* OFFSETS for Device 3 Function 0 */
+
+#define MC_CONTROL      0x48
+#define MC_STATUS       0x4c
+#define MC_MAX_DOD      0x64
+
+        /* OFFSETS for Devices 4,5 and 6 Function 0 */
+
+#define MC_CHANNEL_ADDR_MATCH   0xf0
+
+#define MC_MASK_DIMM    (1 << 41)
+#define MC_MASK_RANK    (1 << 40)
+#define MC_MASK_BANK    (1 << 39)
+#define MC_MASK_PAGE    (1 << 38)
+#define MC_MASK_COL     (1 << 37)
+
+/*
+ * i7core structs
+ */
+
+#define NUM_CHANS 3
+#define NUM_FUNCS 1
+
+struct i7core_info {
+        u32     mc_control;
+        u32     mc_status;
+        u32     max_dod;
+};
+
+struct i7core_pvt {
+        struct pci_dev          *pci_mcr;       /* Dev 3:0 */
+        struct pci_dev          *pci_ch[NUM_CHANS][NUM_FUNCS];
+        struct i7core_info      info;
+};
+
+/* Device name and register DID (Device ID) */
+struct i7core_dev_info {
+        const char *ctl_name;   /* name for this device */
+        u16 fsb_mapping_errors; /* DID for the branchmap,control */
+};
+
+static int chan_pci_ids[NUM_CHANS] = {
+        PCI_DEVICE_ID_INTEL_I7_MC_CH0_CTRL,     /* Dev 4 */
+        PCI_DEVICE_ID_INTEL_I7_MC_CH1_CTRL,     /* Dev 5 */
+        PCI_DEVICE_ID_INTEL_I7_MC_CH2_CTRL,     /* Dev 6 */
+};
+
+/* Table of devices attributes supported by this driver */
+static const struct i7core_dev_info i7core_devs[] = {
+        {
+                .ctl_name = "i7 Core",
+                .fsb_mapping_errors = PCI_DEVICE_ID_INTEL_I7_MCR,
+        },
+};
+
+static struct edac_pci_ctl_info *i7core_pci;
+
+/****************************************************************************
+                        Anciliary status routines
+ ****************************************************************************/
+
+        /* MC_CONTROL bits */
+#define CH2_ACTIVE(pvt)         ((pvt)->info.mc_control & 1 << 10)
+#define CH1_ACTIVE(pvt)         ((pvt)->info.mc_control & 1 << 9)
+#define CH0_ACTIVE(pvt)         ((pvt)->info.mc_control & 1 << 8)
+#define ECCx8(pvt)              ((pvt)->info.mc_control & 1 << 1)
+
+        /* MC_STATUS bits */
+#define ECC_ENABLED(pvt)        ((pvt)->info.mc_status & 1 << 3)
+#define CH2_DISABLED(pvt)       ((pvt)->info.mc_status & 1 << 2)
+#define CH1_DISABLED(pvt)       ((pvt)->info.mc_status & 1 << 1)
+#define CH0_DISABLED(pvt)       ((pvt)->info.mc_status & 1 << 0)
+
+        /* MC_MAX_DOD read functions */
+static inline int maxnumdimms(struct i7core_pvt *pvt)
+{
+        return (pvt->info.max_dod & 0x3) + 1;
+}
+
+static inline int maxnumrank(struct i7core_pvt *pvt)
+{
+        static int ranks[4] = { 1, 2, 4, -EINVAL };
+
+        return ranks[(pvt->info.max_dod >> 2) & 0x3];
+}
+
+static inline int maxnumbank(struct i7core_pvt *pvt)
+{
+        static int banks[4] = { 4, 8, 16, -EINVAL };
+
+        return banks[(pvt->info.max_dod >> 4) & 0x3];
+}
+
+static inline int maxnumrow(struct i7core_pvt *pvt)
+{
+        static int rows[8] = {
+                1 << 12, 1 << 13, 1 << 14, 1 << 15,
+                1 << 16, -EINVAL, -EINVAL, -EINVAL,
+        };
+
+        return rows[((pvt->info.max_dod >> 6) & 0x7)];
+}
+
+static inline int maxnumcol(struct i7core_pvt *pvt)
+{
+        static int cols[8] = {
+                1 << 10, 1 << 11, 1 << 12, -EINVAL,
+        };
+        return cols[((pvt->info.max_dod >> 9) & 0x3) << 12];
+}
+
+/****************************************************************************
+                        Memory check routines
+ ****************************************************************************/
+static int get_dimm_config(struct mem_ctl_info *mci)
+{
+        struct i7core_pvt *pvt = mci->pvt_info;
+
+        pci_read_config_dword(pvt->pci_mcr, MC_CONTROL, &pvt->info.mc_control);
+        pci_read_config_dword(pvt->pci_mcr, MC_STATUS, &pvt->info.mc_status);
+        pci_read_config_dword(pvt->pci_mcr, MC_MAX_DOD, &pvt->info.max_dod);
+
+        debugf0("Channels  active [%c][%c][%c] - enabled [%c][%c][%c]\n",
+                CH0_ACTIVE(pvt)?'0':'-',
+                CH1_ACTIVE(pvt)?'1':'-',
+                CH2_ACTIVE(pvt)?'2':'-',
+                CH0_DISABLED(pvt)?'-':'0',
+                CH1_DISABLED(pvt)?'-':'1',
+                CH2_DISABLED(pvt)?'-':'2');
+
+        if (ECC_ENABLED(pvt))
+                debugf0("ECC enabled with x%d SDCC\n", ECCx8(pvt)?8:4);
+        else
+                debugf0("ECC disabled\n");
+
+        /* FIXME: need to handle the error codes */
+        debugf0("DOD Maximum limits: DIMMS: %d, %d-ranked, %d-banked\n",
+                maxnumdimms(pvt), maxnumrank(pvt), maxnumbank(pvt));
+        debugf0("DOD Maximum rows x colums = 0x%x x 0x%x\n",
+                maxnumrow(pvt), maxnumcol(pvt));
+
+        return 0;
+}
+
+/****************************************************************************
+        Device initialization routines: put/get, init/exit
+ ****************************************************************************/
+
+/*
+ *      i7core_put_devices      'put' all the devices that we have
+ *                              reserved via 'get'
+ */
+static void i7core_put_devices(struct mem_ctl_info *mci)
+{
+        struct i7core_pvt *pvt = mci->pvt_info;
+        int i, n;
+
+        pci_dev_put(pvt->pci_mcr);
+
+        /* Release all PCI device functions at MTR channel controllers */
+        for (i = 0; i < NUM_CHANS; i++)
+                for (n = 0; n < NUM_FUNCS; n++)
+                        pci_dev_put(pvt->pci_ch[i][n]);
+}
+
+/*
+ *      i7core_get_devices      Find and perform 'get' operation on the MCH's
+ *                      device/functions we want to reference for this driver
+ *
+ *                      Need to 'get' device 16 func 1 and func 2
+ */
+static int i7core_get_devices(struct mem_ctl_info *mci, int dev_idx)
+{
+        struct i7core_pvt *pvt;
+        struct pci_dev *pdev;
+        int i, n, func;
+
+        pvt = mci->pvt_info;
+        memset(pvt, 0, sizeof(*pvt));
+
+        pdev = pci_get_device(PCI_VENDOR_ID_INTEL, PCI_DEVICE_ID_INTEL_I7_MCR,
+                              NULL);
+        if (!pdev) {
+                i7core_printk(KERN_ERR,
+                        "Couldn't get PCI ID %04x:%04x function 0\n",
+                        PCI_VENDOR_ID_INTEL, PCI_DEVICE_ID_INTEL_I7_MCR);
+                return -ENODEV;
+        }
+        pvt->pci_mcr=pdev;
+
+        /* Get dimm basic config */
+        get_dimm_config(mci);
+
+        /* Retrieve all needed functions at MTR channel controllers */
+        for (i = 0; i < NUM_CHANS; i++) {
+                pdev = NULL;
+                for (n = 0; n < NUM_FUNCS; n++) {
+                        pdev = pci_get_device(PCI_VENDOR_ID_INTEL,
+                                              chan_pci_ids[i], pdev);
+                        if (!pdev) {
+                                /* End of list, leave */
+                                i7core_printk(KERN_ERR,
+                                        "Device not found: PCI ID %04x:%04x "
+                                        "found only %d functions "
+                                        "(broken BIOS?)\n",
+                                        PCI_VENDOR_ID_INTEL,
+                                        chan_pci_ids[i], n);
+                                i7core_put_devices(mci);
+                                return -ENODEV;
+                        }
+                        func = PCI_FUNC(pdev->devfn);
+                        pvt->pci_ch[i][func] = pdev;
+                }
+        }
+        i7core_printk(KERN_INFO, "Driver loaded.\n");
+
+        return 0;
+}
+
+/*
+ *      i7core_probe    Probe for ONE instance of device to see if it is
+ *                      present.
+ *      return:
+ *              0 for FOUND a device
+ *              < 0 for error code
+ */
+static int __devinit i7core_probe(struct pci_dev *pdev,
+                                  const struct pci_device_id *id)
+{
+        struct mem_ctl_info *mci;
+        struct i7core_pvt *pvt;
+        int rc;
+        int num_channels;
+        int num_csrows;
+        int num_dimms_per_channel;
+        int dev_idx = id->driver_data;
+
+        if (dev_idx >= ARRAY_SIZE(i7core_devs))
+                return -EINVAL;
+
+        /* wake up device */
+        rc = pci_enable_device(pdev);
+        if (rc == -EIO)
+                return rc;
+
+        debugf0("MC: " __FILE__ ": %s(), pdev bus %u dev=0x%x fn=0x%x\n",
+                __func__,
+                pdev->bus->number,
+                PCI_SLOT(pdev->devfn), PCI_FUNC(pdev->devfn));
+
+        /* We only are looking for func 0 of the set */
+        if (PCI_FUNC(pdev->devfn) != 0)
+                return -ENODEV;
+
+        num_channels = NUM_CHANS;
+
+        /* FIXME: FAKE data, since we currently don't now how to get this */
+        num_dimms_per_channel = 4;
+        num_csrows = num_dimms_per_channel;
+
+        /* allocate a new MC control structure */
+        mci = edac_mc_alloc(sizeof(*pvt), num_csrows, num_channels, 0);
+        if (mci == NULL)
+                return -ENOMEM;
+
+        debugf0("MC: " __FILE__ ": %s(): mci = %p\n", __func__, mci);
+
+        mci->dev = &pdev->dev;  /* record ptr  to the generic device */
+        dev_set_drvdata(mci->dev, mci);
+
+        pvt = mci->pvt_info;
+//      pvt->system_address = pdev;     /* Record this device in our private */
+//      pvt->maxch = num_channels;
+//      pvt->maxdimmperch = num_dimms_per_channel;
+
+        /* 'get' the pci devices we want to reserve for our use */
+        if (i7core_get_devices(mci, dev_idx))
+                goto fail0;
+
+        mci->mc_idx = 0;
+        mci->mtype_cap = MEM_FLAG_FB_DDR2;      /* FIXME: it uses DDR3 */
+        mci->edac_ctl_cap = EDAC_FLAG_NONE;
+        mci->edac_cap = EDAC_FLAG_NONE;
+        mci->mod_name = "i7core_edac.c";
+        mci->mod_ver = I7CORE_REVISION;
+        mci->ctl_name = i7core_devs[dev_idx].ctl_name;
+        mci->dev_name = pci_name(pdev);
+        mci->ctl_page_to_phys = NULL;
+
+        /* add this new MC control structure to EDAC's list of MCs */
+        if (edac_mc_add_mc(mci)) {
+                debugf0("MC: " __FILE__
+                        ": %s(): failed edac_mc_add_mc()\n", __func__);
+                /* FIXME: perhaps some code should go here that disables error
+                 * reporting if we just enabled it
+                 */
+                goto fail1;
+        }
+
+        /* allocating generic PCI control info */
+        i7core_pci = edac_pci_create_generic_ctl(&pdev->dev, EDAC_MOD_STR);
+        if (!i7core_pci) {
+                printk(KERN_WARNING
+                        "%s(): Unable to create PCI control\n",
+                        __func__);
+                printk(KERN_WARNING
+                        "%s(): PCI error report via EDAC not setup\n",
+                        __func__);
+        }
+
+        return 0;
+
+fail1:
+        i7core_put_devices(mci);
+
+fail0:
+        edac_mc_free(mci);
+        return -ENODEV;
+}
+
+/*
+ *      i7core_remove   destructor for one instance of device
+ *
+ */
+static void __devexit i7core_remove(struct pci_dev *pdev)
+{
+        struct mem_ctl_info *mci;
+
+        debugf0(__FILE__ ": %s()\n", __func__);
+
+        if (i7core_pci)
+                edac_pci_release_generic_ctl(i7core_pci);
+
+        mci = edac_mc_del_mc(&pdev->dev);
+        if (!mci)
+                return;
+
+        /* retrieve references to resources, and free those resources */
+        i7core_put_devices(mci);
+
+        edac_mc_free(mci);
+}
+
+/*
+ *      pci_device_id   table for which devices we are looking for
+ *
+ *      The "E500P" device is the first device supported.
+ */
+static const struct pci_device_id i7core_pci_tbl[] __devinitdata = {
+        {PCI_DEVICE(PCI_VENDOR_ID_INTEL, PCI_DEVICE_ID_INTEL_I7_MCR)},
+        {0,}                    /* 0 terminated list. */
+};
+
+MODULE_DEVICE_TABLE(pci, i7core_pci_tbl);
+
+/*
+ *      i7core_driver   pci_driver structure for this module
+ *
+ */
+static struct pci_driver i7core_driver = {
+        .name     = "i7core_edac",
+        .probe    = i7core_probe,
+        .remove   = __devexit_p(i7core_remove),
+        .id_table = i7core_pci_tbl,
+};
+
+/*
+ *      i7core_init             Module entry function
+ *                      Try to initialize this module for its devices
+ */
+static int __init i7core_init(void)
+{
+        int pci_rc;
+
+        debugf2("MC: " __FILE__ ": %s()\n", __func__);
+
+        /* Ensure that the OPSTATE is set correctly for POLL or NMI */
+        opstate_init();
+
+        pci_rc = pci_register_driver(&i7core_driver);
+
+        return (pci_rc < 0) ? pci_rc : 0;
+}
+
+/*
+ *      i7core_exit()   Module exit function
+ *                      Unregister the driver
+ */
+static void __exit i7core_exit(void)
+{
+        debugf2("MC: " __FILE__ ": %s()\n", __func__);
+        pci_unregister_driver(&i7core_driver);
+}
+
+module_init(i7core_init);
+module_exit(i7core_exit);
+
+MODULE_LICENSE("GPL");
+MODULE_AUTHOR("Mauro Carvalho Chehab <mchehab@redhat.com>");
+MODULE_AUTHOR("Red Hat Inc. (http://www.redhat.com)");
+MODULE_DESCRIPTION("MC Driver for Intel i7 Core memory controllers - "
+                   I7CORE_REVISION);
+
+module_param(edac_op_state, int, 0444);
+MODULE_PARM_DESC(edac_op_state, "EDAC Error Reporting state: 0=Poll,1=NMI");
diff --git a/include/linux/pci_ids.h b/include/linux/pci_ids.h
index 9f688d243b86..c5dd0994bd7c 100644
--- a/include/linux/pci_ids.h
+++ b/include/linux/pci_ids.h
@@ -2532,6 +2532,22 @@
 #define PCI_DEVICE_ID_INTEL_ICH9_6      0x2930
 #define PCI_DEVICE_ID_INTEL_ICH9_7      0x2916
 #define PCI_DEVICE_ID_INTEL_ICH9_8      0x2918
+#define PCI_DEVICE_ID_INTEL_I7_MCR      0x2c18
+#define PCI_DEVICE_ID_INTEL_I7_MC_TAD   0x2c19
+#define PCI_DEVICE_ID_INTEL_I7_MC_RAS   0x2c1a
+#define PCI_DEVICE_ID_INTEL_I7_MC_TEST  0x2c1c
+#define PCI_DEVICE_ID_INTEL_I7_MC_CH0_CTRL  0x2c20
+#define PCI_DEVICE_ID_INTEL_I7_MC_CH0_ADDR  0x2c21
+#define PCI_DEVICE_ID_INTEL_I7_MC_CH0_RANK  0x2c22
+#define PCI_DEVICE_ID_INTEL_I7_MC_CH0_TC    0x2c23
+#define PCI_DEVICE_ID_INTEL_I7_MC_CH1_CTRL  0x2c28
+#define PCI_DEVICE_ID_INTEL_I7_MC_CH1_ADDR  0x2c29
+#define PCI_DEVICE_ID_INTEL_I7_MC_CH1_RANK  0x2c2a
+#define PCI_DEVICE_ID_INTEL_I7_MC_CH1_TC    0x2c2b
+#define PCI_DEVICE_ID_INTEL_I7_MC_CH2_CTRL  0x2c30
+#define PCI_DEVICE_ID_INTEL_I7_MC_CH2_ADDR  0x2c31
+#define PCI_DEVICE_ID_INTEL_I7_MC_CH2_RANK  0x2c32
+#define PCI_DEVICE_ID_INTEL_I7_MC_CH2_TC    0x2c33
 #define PCI_DEVICE_ID_INTEL_82855PM_HB  0x3340
 #define PCI_DEVICE_ID_INTEL_IOAT_TBG4   0x3429
 #define PCI_DEVICE_ID_INTEL_IOAT_TBG5   0x342a