Adding pcie error interrupt edac support for mpc85xx, p3041, p4080, and p5020. The mpc85xx uses the legacy interrupt report mechanism - the error interrupts are reported directly to mpic. While, the p3041/ p4080/p5020 attaches the most of error interrupts to interrupt zero. And report error interrupts to mpic via interrupt 0.
This patch can handle both of them. Signed-off-by: Chunhe Lan <chunhe....@freescale.com> --- drivers/edac/mpc85xx_edac.c | 169 ++++++++++++++++++++++++++++++++++++++++--- drivers/edac/mpc85xx_edac.h | 7 ++ 2 files changed, 165 insertions(+), 11 deletions(-) diff --git a/drivers/edac/mpc85xx_edac.c b/drivers/edac/mpc85xx_edac.c index 42a840d..085b6b3 100644 --- a/drivers/edac/mpc85xx_edac.c +++ b/drivers/edac/mpc85xx_edac.c @@ -1,5 +1,6 @@ /* * Freescale MPC85xx Memory Controller kenel module + * Copyright (c) 2013 Freescale Semiconductor, Inc. * * Author: Dave Jiang <dji...@mvista.com> * @@ -196,6 +197,120 @@ static void mpc85xx_pci_check(struct edac_pci_ctl_info *pci) edac_pci_handle_npe(pci, pci->ctl_name); } +static void mpc85xx_pcie_check(struct edac_pci_ctl_info *pci) +{ + struct mpc85xx_pci_pdata *pdata = pci->pvt_info; + u32 err_detect; + + err_detect = in_be32(pdata->pci_vbase + MPC85XX_PCI_ERR_DR); + + pr_err("PCIE error(s) detected\n"); + pr_err("PCIE ERR_DR register: 0x%08x\n", err_detect); + pr_err("PCIE ERR_CAP_STAT register: 0x%08x\n", + in_be32(pdata->pci_vbase + MPC85XX_PCI_GAS_TIMR)); + pr_err("PCIE ERR_CAP_R0 register: 0x%08x\n", + in_be32(pdata->pci_vbase + MPC85XX_PCIE_ERR_CAP_R0)); + pr_err("PCIE ERR_CAP_R1 register: 0x%08x\n", + in_be32(pdata->pci_vbase + MPC85XX_PCIE_ERR_CAP_R1)); + pr_err("PCIE ERR_CAP_R2 register: 0x%08x\n", + in_be32(pdata->pci_vbase + MPC85XX_PCIE_ERR_CAP_R2)); + pr_err("PCIE ERR_CAP_R3 register: 0x%08x\n", + in_be32(pdata->pci_vbase + MPC85XX_PCIE_ERR_CAP_R3)); + + /* clear error bits */ + out_be32(pdata->pci_vbase + MPC85XX_PCI_ERR_DR, err_detect); +} + +/* + * This function is for error interrupt ORed mechanism. + * This mechanism attaches most functions' error interrupts to interrupt 0. + * And report error interrupt to mpic via interrupt 0. + * EIMR0 - Error Interrupt Mask Register 0. + * + * This function check whether the device support error interrupt ORed + * mechanism via device tree. If supported, umask pcie error interrupt + * bit in EIMR0. + */ +static int mpc85xx_err_int_en(struct platform_device *op) +{ + u32 *int_cell; + struct device_node *np; + void __iomem *mpic_base; + u32 reg_tmp; + u32 int_len; + struct resource r; + int res; + + if (!op->dev.of_node) + return -EINVAL; + + /* + * Unmask pcie error interrupt bit in EIMR0. + * Extend interrupt specifier has 4 cells. + * For the 3rd cell: + * 0 -- normal interrupt; + * 1 -- error interrupt. + */ + int_cell = (u32 *)of_get_property(op->dev.of_node, "interrupts", + &int_len); + if ((int_len/sizeof(u32)) == 4) { + /* soc has error interrupt integration handling mechanism */ + if (*(int_cell + 2) == 1) { + np = of_find_node_by_type(NULL, "open-pic"); + + if (of_address_to_resource(np, 0, &r)) { + pr_err("%s: Failed to map mpic regs\n", + __func__); + of_node_put(np); + res = -ENOMEM; + goto err; + } + + if (!request_mem_region(r.start, r.end - r.start + 1, + "mpic")) { + pr_err("%s: Error when requesting mem region\n", + __func__); + res = -EBUSY; + goto err; + } + + mpic_base = ioremap(r.start, r.end - r.start + 1); + if (!mpic_base) { + pr_err("%s: Unable to map mpic regs\n", + __func__); + res = -ENOMEM; + goto err_ioremap; + } + + reg_tmp = in_be32(mpic_base + MPC85XX_MPIC_EIMR0); + out_be32(mpic_base + MPC85XX_MPIC_EIMR0, reg_tmp & + ~(1 << (31 - *(int_cell + 3)))); + iounmap(mpic_base); + release_mem_region(r.start, r.end - r.start + 1); + of_node_put(np); + } + } + + return 0; + +err_ioremap: + release_mem_region(r.start, r.end - r.start + 1); +err: + return res; +} + +static int mpc85xx_pcie_find_capability(struct device_node *np) +{ + struct pci_controller *hose; + + if (!np) + return -EINVAL; + + hose = pci_find_hose_for_OF_device(np); + + return early_find_capability(hose, 0, 0, PCI_CAP_ID_EXP); +} + static irqreturn_t mpc85xx_pci_isr(int irq, void *dev_id) { struct edac_pci_ctl_info *pci = dev_id; @@ -207,7 +322,10 @@ static irqreturn_t mpc85xx_pci_isr(int irq, void *dev_id) if (!err_detect) return IRQ_NONE; - mpc85xx_pci_check(pci); + if (pdata->is_pcie) + mpc85xx_pcie_check(pci); + else + mpc85xx_pci_check(pci); return IRQ_HANDLED; } @@ -239,14 +357,23 @@ int mpc85xx_pci_err_probe(struct platform_device *op) pdata = pci->pvt_info; pdata->name = "mpc85xx_pci_err"; pdata->irq = NO_IRQ; + if (mpc85xx_pcie_find_capability(op->dev.of_node) > 0) + pdata->is_pcie = 1; + else + pdata->is_pcie = 0; + dev_set_drvdata(&op->dev, pci); pci->dev = &op->dev; pci->mod_name = EDAC_MOD_STR; pci->ctl_name = pdata->name; pci->dev_name = dev_name(&op->dev); - if (edac_op_state == EDAC_OPSTATE_POLL) - pci->edac_check = mpc85xx_pci_check; + if (edac_op_state == EDAC_OPSTATE_POLL) { + if (pdata->is_pcie) + pci->edac_check = mpc85xx_pcie_check; + else + pci->edac_check = mpc85xx_pci_check; + } pdata->edac_idx = edac_pci_idx++; @@ -275,16 +402,29 @@ int mpc85xx_pci_err_probe(struct platform_device *op) goto err; } - orig_pci_err_cap_dr = - in_be32(pdata->pci_vbase + MPC85XX_PCI_ERR_CAP_DR); + if (pdata->is_pcie) { + if (mpc85xx_err_int_en(op) < 0) + goto err; - /* PCI master abort is expected during config cycles */ - out_be32(pdata->pci_vbase + MPC85XX_PCI_ERR_CAP_DR, 0x40); + orig_pci_err_cap_dr = + in_be32(pdata->pci_vbase + MPC85XX_PCI_ERR_ADDR); + out_be32(pdata->pci_vbase + MPC85XX_PCI_ERR_ADDR, ~0); + orig_pci_err_en = + in_be32(pdata->pci_vbase + MPC85XX_PCI_ERR_EN); + out_be32(pdata->pci_vbase + MPC85XX_PCI_ERR_EN, 0); + } else { + orig_pci_err_cap_dr = + in_be32(pdata->pci_vbase + MPC85XX_PCI_ERR_CAP_DR); + + /* PCI master abort is expected during config cycles */ + out_be32(pdata->pci_vbase + MPC85XX_PCI_ERR_CAP_DR, 0x40); - orig_pci_err_en = in_be32(pdata->pci_vbase + MPC85XX_PCI_ERR_EN); + orig_pci_err_en = + in_be32(pdata->pci_vbase + MPC85XX_PCI_ERR_EN); - /* disable master abort reporting */ - out_be32(pdata->pci_vbase + MPC85XX_PCI_ERR_EN, ~0x40); + /* disable master abort reporting */ + out_be32(pdata->pci_vbase + MPC85XX_PCI_ERR_EN, ~0x40); + } /* clear error bits */ out_be32(pdata->pci_vbase + MPC85XX_PCI_ERR_DR, ~0); @@ -297,7 +437,8 @@ int mpc85xx_pci_err_probe(struct platform_device *op) if (edac_op_state == EDAC_OPSTATE_INT) { pdata->irq = irq_of_parse_and_map(op->dev.of_node, 0); res = devm_request_irq(&op->dev, pdata->irq, - mpc85xx_pci_isr, IRQF_DISABLED, + mpc85xx_pci_isr, + IRQF_DISABLED | IRQF_SHARED, "[EDAC] PCI err", pci); if (res < 0) { printk(KERN_ERR @@ -312,6 +453,12 @@ int mpc85xx_pci_err_probe(struct platform_device *op) pdata->irq); } + if (pdata->is_pcie) { + /* enable all pcie error interrupt & error detect */ + out_be32(pdata->pci_vbase + MPC85XX_PCI_ERR_EN, ~0); + out_be32(pdata->pci_vbase + MPC85XX_PCI_ERR_ADDR, 0); + } + devres_remove_group(&op->dev, mpc85xx_pci_err_probe); edac_dbg(3, "success\n"); printk(KERN_INFO EDAC_MOD_STR " PCI err registered\n"); diff --git a/drivers/edac/mpc85xx_edac.h b/drivers/edac/mpc85xx_edac.h index 932016f..8ce091a 100644 --- a/drivers/edac/mpc85xx_edac.h +++ b/drivers/edac/mpc85xx_edac.h @@ -141,6 +141,12 @@ #define MPC85XX_PCI_ERR_DH 0x001c #define MPC85XX_PCI_GAS_TIMR 0x0020 #define MPC85XX_PCI_PCIX_TIMR 0x0024 +#define MPC85XX_PCIE_ERR_CAP_R0 0x0028 +#define MPC85XX_PCIE_ERR_CAP_R1 0x002c +#define MPC85XX_PCIE_ERR_CAP_R2 0x0030 +#define MPC85XX_PCIE_ERR_CAP_R3 0x0034 + +#define MPC85XX_MPIC_EIMR0 0x3910 struct mpc85xx_mc_pdata { char *name; @@ -158,6 +164,7 @@ struct mpc85xx_l2_pdata { struct mpc85xx_pci_pdata { char *name; + char is_pcie; int edac_idx; void __iomem *pci_vbase; int irq; -- 1.7.6.5 _______________________________________________ Linuxppc-dev mailing list Linuxppc-dev@lists.ozlabs.org https://lists.ozlabs.org/listinfo/linuxppc-dev