| /* Copyright (c) 2016-2017, The Linux Foundation. All rights reserved. |
| * |
| * This program is free software; you can redistribute it and/or modify |
| * it under the terms of the GNU General Public License version 2 and |
| * only 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. |
| */ |
| |
| #include <linux/kernel.h> |
| #include <linux/edac.h> |
| #include <linux/of_device.h> |
| #include <linux/platform_device.h> |
| #include <linux/smp.h> |
| #include <linux/spinlock.h> |
| #include <linux/mfd/syscon.h> |
| #include <linux/regmap.h> |
| #include <linux/interrupt.h> |
| #include "edac_core.h" |
| |
| #ifdef CONFIG_EDAC_QCOM_LLCC_PANIC_ON_CE |
| #define LLCC_ERP_PANIC_ON_CE 1 |
| #else |
| #define LLCC_ERP_PANIC_ON_CE 0 |
| #endif |
| |
| #ifdef CONFIG_EDAC_QCOM_LLCC_PANIC_ON_UE |
| #define LLCC_ERP_PANIC_ON_UE 1 |
| #else |
| #define LLCC_ERP_PANIC_ON_UE 0 |
| #endif |
| |
| #define EDAC_LLCC "qcom_llcc" |
| |
| #define TRP_SYN_REG_CNT 6 |
| |
| #define DRP_SYN_REG_CNT 8 |
| |
| /* single & Double Bit syndrome register offsets */ |
| #define TRP_ECC_SB_ERR_SYN0 0x0002304C |
| #define TRP_ECC_DB_ERR_SYN0 0x00020370 |
| #define DRP_ECC_SB_ERR_SYN0 0x0004204C |
| #define DRP_ECC_DB_ERR_SYN0 0x00042070 |
| |
| /* Error register offsets */ |
| #define TRP_ECC_ERROR_STATUS1 0x00020348 |
| #define TRP_ECC_ERROR_STATUS0 0x00020344 |
| #define DRP_ECC_ERROR_STATUS1 0x00042048 |
| #define DRP_ECC_ERROR_STATUS0 0x00042044 |
| |
| /* TRP, DRP interrupt register offsets */ |
| #define DRP_INTERRUPT_STATUS 0x00041000 |
| #define TRP_INTERRUPT_0_STATUS 0x00020480 |
| #define DRP_INTERRUPT_CLEAR 0x00041008 |
| #define DRP_ECC_ERROR_CNTR_CLEAR 0x00040004 |
| #define TRP_INTERRUPT_0_CLEAR 0x00020484 |
| #define TRP_ECC_ERROR_CNTR_CLEAR 0x00020440 |
| |
| /* Mask and shift macros */ |
| #define ECC_DB_ERR_COUNT_MASK 0x0000001f |
| #define ECC_DB_ERR_WAYS_MASK 0xffff0000 |
| #define ECC_DB_ERR_WAYS_SHIFT 16 |
| |
| #define ECC_SB_ERR_COUNT_MASK 0x00ff0000 |
| #define ECC_SB_ERR_COUNT_SHIFT 16 |
| #define ECC_SB_ERR_WAYS_MASK 0x0000ffff |
| |
| #define SB_ECC_ERROR 0x1 |
| #define DB_ECC_ERROR 0x2 |
| |
| #define DRP_TRP_INT_CLEAR 0x3 |
| #define DRP_TRP_CNT_CLEAR 0x3 |
| |
| static int poll_msec = 5000; |
| module_param(poll_msec, int, 0444); |
| |
| static int interrupt_mode; |
| module_param(interrupt_mode, int, 0444); |
| MODULE_PARM_DESC(interrupt_mode, |
| "Controls whether to use interrupt or poll mode"); |
| |
| enum { |
| LLCC_DRAM_CE = 0, |
| LLCC_DRAM_UE, |
| LLCC_TRAM_CE, |
| LLCC_TRAM_UE, |
| }; |
| |
| struct errors_edac { |
| const char *msg; |
| void (*func)(struct edac_device_ctl_info *edev_ctl, |
| int inst_nr, int block_nr, const char *msg); |
| }; |
| |
| struct erp_drvdata { |
| struct regmap *llcc_map; |
| u32 ecc_irq; |
| }; |
| |
| static const struct errors_edac errors[] = { |
| {"LLCC Data RAM correctable Error", edac_device_handle_ce}, |
| {"LLCC Data RAM uncorrectable Error", edac_device_handle_ue}, |
| {"LLCC Tag RAM correctable Error", edac_device_handle_ce}, |
| {"LLCC Tag RAM uncorrectable Error", edac_device_handle_ue}, |
| }; |
| |
| /* Clear the error interrupt and counter registers */ |
| static void qcom_llcc_clear_errors(int err_type, struct regmap *llcc_map) |
| { |
| switch (err_type) { |
| case LLCC_DRAM_CE: |
| case LLCC_DRAM_UE: |
| /* Clear the interrupt */ |
| regmap_write(llcc_map, DRP_INTERRUPT_CLEAR, DRP_TRP_INT_CLEAR); |
| /* Clear the counters */ |
| regmap_write(llcc_map, DRP_ECC_ERROR_CNTR_CLEAR, |
| DRP_TRP_CNT_CLEAR); |
| break; |
| case LLCC_TRAM_CE: |
| case LLCC_TRAM_UE: |
| regmap_write(llcc_map, TRP_INTERRUPT_0_CLEAR, |
| DRP_TRP_INT_CLEAR); |
| regmap_write(llcc_map, TRP_ECC_ERROR_CNTR_CLEAR, |
| DRP_TRP_CNT_CLEAR); |
| break; |
| } |
| } |
| |
| /* Dump syndrome registers for tag Ram Double bit errors */ |
| static void dump_trp_db_syn_reg(struct regmap *llcc_map) |
| { |
| int i; |
| int db_err_cnt; |
| int db_err_ways; |
| u32 synd_reg; |
| u32 synd_val; |
| |
| for (i = 0; i < TRP_SYN_REG_CNT; i++) { |
| synd_reg = TRP_ECC_DB_ERR_SYN0 + (i * 4); |
| regmap_read(llcc_map, synd_reg, &synd_val); |
| edac_printk(KERN_CRIT, EDAC_LLCC, "TRP_ECC_SYN%d: 0x%8x\n", |
| i, synd_val); |
| } |
| |
| regmap_read(llcc_map, TRP_ECC_ERROR_STATUS1, &db_err_cnt); |
| db_err_cnt = (db_err_cnt & ECC_DB_ERR_COUNT_MASK); |
| edac_printk(KERN_CRIT, EDAC_LLCC, "Double-Bit error count: 0x%4x\n", |
| db_err_cnt); |
| |
| regmap_read(llcc_map, TRP_ECC_ERROR_STATUS0, &db_err_ways); |
| db_err_ways = (db_err_ways & ECC_DB_ERR_WAYS_MASK); |
| db_err_ways >>= ECC_DB_ERR_WAYS_SHIFT; |
| |
| edac_printk(KERN_CRIT, EDAC_LLCC, "Double-Bit error ways: 0x%4x\n", |
| db_err_ways); |
| } |
| |
| /* Dump syndrome register for tag Ram Single Bit Errors */ |
| static void dump_trp_sb_syn_reg(struct regmap *llcc_map) |
| { |
| int i; |
| int sb_err_cnt; |
| int sb_err_ways; |
| u32 synd_reg; |
| u32 synd_val; |
| |
| for (i = 0; i < TRP_SYN_REG_CNT; i++) { |
| synd_reg = TRP_ECC_SB_ERR_SYN0 + (i * 4); |
| regmap_read(llcc_map, synd_reg, &synd_val); |
| edac_printk(KERN_CRIT, EDAC_LLCC, "TRP_ECC_SYN%d: 0x%8x\n", |
| i, synd_val); |
| } |
| |
| regmap_read(llcc_map, TRP_ECC_ERROR_STATUS1, &sb_err_cnt); |
| sb_err_cnt = (sb_err_cnt & ECC_SB_ERR_COUNT_MASK); |
| sb_err_cnt >>= ECC_SB_ERR_COUNT_SHIFT; |
| edac_printk(KERN_CRIT, EDAC_LLCC, "Single-Bit error count: 0x%4x\n", |
| sb_err_cnt); |
| |
| regmap_read(llcc_map, TRP_ECC_ERROR_STATUS0, &sb_err_ways); |
| sb_err_ways = sb_err_ways & ECC_SB_ERR_WAYS_MASK; |
| |
| edac_printk(KERN_CRIT, EDAC_LLCC, "Single-Bit error ways: 0x%4x\n", |
| sb_err_ways); |
| } |
| |
| /* Dump syndrome registers for Data Ram Double bit errors */ |
| static void dump_drp_db_syn_reg(struct regmap *llcc_map) |
| { |
| int i; |
| int db_err_cnt; |
| int db_err_ways; |
| u32 synd_reg; |
| u32 synd_val; |
| |
| for (i = 0; i < DRP_SYN_REG_CNT; i++) { |
| synd_reg = DRP_ECC_DB_ERR_SYN0 + (i * 4); |
| regmap_read(llcc_map, synd_reg, &synd_val); |
| edac_printk(KERN_CRIT, EDAC_LLCC, "DRP_ECC_SYN%d: 0x%8x\n", |
| i, synd_val); |
| } |
| |
| regmap_read(llcc_map, DRP_ECC_ERROR_STATUS1, &db_err_cnt); |
| db_err_cnt = (db_err_cnt & ECC_DB_ERR_COUNT_MASK); |
| edac_printk(KERN_CRIT, EDAC_LLCC, "Double-Bit error count: 0x%4x\n", |
| db_err_cnt); |
| |
| regmap_read(llcc_map, DRP_ECC_ERROR_STATUS0, &db_err_ways); |
| db_err_ways &= ECC_DB_ERR_WAYS_MASK; |
| db_err_ways >>= ECC_DB_ERR_WAYS_SHIFT; |
| edac_printk(KERN_CRIT, EDAC_LLCC, "Double-Bit error ways: 0x%4x\n", |
| db_err_ways); |
| } |
| |
| /* Dump Syndrome registers for Data Ram Single bit errors*/ |
| static void dump_drp_sb_syn_reg(struct regmap *llcc_map) |
| { |
| int i; |
| int sb_err_cnt; |
| int sb_err_ways; |
| u32 synd_reg; |
| u32 synd_val; |
| |
| for (i = 0; i < DRP_SYN_REG_CNT; i++) { |
| synd_reg = DRP_ECC_SB_ERR_SYN0 + (i * 4); |
| regmap_read(llcc_map, synd_reg, &synd_val); |
| edac_printk(KERN_CRIT, EDAC_LLCC, "DRP_ECC_SYN%d: 0x%8x\n", |
| i, synd_val); |
| } |
| |
| regmap_read(llcc_map, DRP_ECC_ERROR_STATUS1, &sb_err_cnt); |
| sb_err_cnt &= ECC_SB_ERR_COUNT_MASK; |
| sb_err_cnt >>= ECC_SB_ERR_COUNT_SHIFT; |
| edac_printk(KERN_CRIT, EDAC_LLCC, "Single-Bit error count: 0x%4x\n", |
| sb_err_cnt); |
| |
| regmap_read(llcc_map, DRP_ECC_ERROR_STATUS0, &sb_err_ways); |
| sb_err_ways = sb_err_ways & ECC_SB_ERR_WAYS_MASK; |
| |
| edac_printk(KERN_CRIT, EDAC_LLCC, "Single-Bit error ways: 0x%4x\n", |
| sb_err_ways); |
| } |
| |
| |
| static void dump_syn_reg(struct edac_device_ctl_info *edev_ctl, |
| int err_type, struct regmap *llcc_map) |
| { |
| switch (err_type) { |
| case LLCC_DRAM_CE: |
| dump_drp_sb_syn_reg(llcc_map); |
| break; |
| case LLCC_DRAM_UE: |
| dump_drp_db_syn_reg(llcc_map); |
| break; |
| case LLCC_TRAM_CE: |
| dump_trp_sb_syn_reg(llcc_map); |
| break; |
| case LLCC_TRAM_UE: |
| dump_trp_db_syn_reg(llcc_map); |
| break; |
| } |
| |
| qcom_llcc_clear_errors(err_type, llcc_map); |
| |
| errors[err_type].func(edev_ctl, 0, 0, errors[err_type].msg); |
| } |
| |
| static void qcom_llcc_check_cache_errors |
| (struct edac_device_ctl_info *edev_ctl) |
| { |
| u32 drp_error; |
| u32 trp_error; |
| struct erp_drvdata *drv = edev_ctl->pvt_info; |
| |
| /* Look for Data RAM errors */ |
| regmap_read(drv->llcc_map, DRP_INTERRUPT_STATUS, &drp_error); |
| |
| if (drp_error & SB_ECC_ERROR) { |
| edac_printk(KERN_CRIT, EDAC_LLCC, |
| "Single Bit Error detected in Data Ram\n"); |
| dump_syn_reg(edev_ctl, LLCC_DRAM_CE, drv->llcc_map); |
| } else if (drp_error & DB_ECC_ERROR) { |
| edac_printk(KERN_CRIT, EDAC_LLCC, |
| "Double Bit Error detected in Data Ram\n"); |
| dump_syn_reg(edev_ctl, LLCC_DRAM_UE, drv->llcc_map); |
| } |
| |
| /* Look for Tag RAM errors */ |
| regmap_read(drv->llcc_map, TRP_INTERRUPT_0_STATUS, &trp_error); |
| if (trp_error & SB_ECC_ERROR) { |
| edac_printk(KERN_CRIT, EDAC_LLCC, |
| "Single Bit Error detected in Tag Ram\n"); |
| dump_syn_reg(edev_ctl, LLCC_TRAM_CE, drv->llcc_map); |
| } else if (trp_error & DB_ECC_ERROR) { |
| edac_printk(KERN_CRIT, EDAC_LLCC, |
| "Double Bit Error detected in Tag Ram\n"); |
| dump_syn_reg(edev_ctl, LLCC_TRAM_UE, drv->llcc_map); |
| } |
| } |
| |
| static void qcom_llcc_poll_cache_errors(struct edac_device_ctl_info *edev_ctl) |
| { |
| qcom_llcc_check_cache_errors(edev_ctl); |
| } |
| |
| static irqreturn_t llcc_ecc_irq_handler |
| (int irq, void *edev_ctl) |
| { |
| qcom_llcc_check_cache_errors(edev_ctl); |
| return IRQ_HANDLED; |
| } |
| |
| static int qcom_llcc_erp_probe(struct platform_device *pdev) |
| { |
| int rc = 0; |
| struct erp_drvdata *drv; |
| struct edac_device_ctl_info *edev_ctl; |
| struct device *dev = &pdev->dev; |
| |
| /* Allocate edac control info */ |
| edev_ctl = edac_device_alloc_ctl_info(sizeof(*drv), "qcom-llcc", 1, |
| NULL, 1, 1, NULL, 0, edac_device_alloc_index()); |
| |
| edev_ctl->dev = dev; |
| edev_ctl->mod_name = dev_name(dev); |
| edev_ctl->dev_name = dev_name(dev); |
| edev_ctl->ctl_name = "llcc"; |
| edev_ctl->poll_msec = poll_msec; |
| edev_ctl->edac_check = qcom_llcc_poll_cache_errors; |
| edev_ctl->defer_work = 1; |
| edev_ctl->panic_on_ce = LLCC_ERP_PANIC_ON_CE; |
| edev_ctl->panic_on_ue = LLCC_ERP_PANIC_ON_UE; |
| |
| drv = edev_ctl->pvt_info; |
| |
| drv->llcc_map = syscon_node_to_regmap(dev->parent->of_node); |
| if (IS_ERR(drv->llcc_map)) { |
| dev_err(dev, "no regmap for syscon llcc parent\n"); |
| rc = -ENOMEM; |
| goto out; |
| } |
| |
| if (interrupt_mode) { |
| drv->ecc_irq = platform_get_irq_byname(pdev, "ecc_irq"); |
| if (!drv->ecc_irq) { |
| rc = -ENODEV; |
| goto out; |
| } |
| |
| rc = devm_request_irq(dev, drv->ecc_irq, llcc_ecc_irq_handler, |
| IRQF_TRIGGER_RISING, "llcc_ecc", edev_ctl); |
| if (rc) { |
| dev_err(dev, "failed to request ecc irq\n"); |
| goto out; |
| } |
| } |
| |
| platform_set_drvdata(pdev, edev_ctl); |
| |
| rc = edac_device_add_device(edev_ctl); |
| out: |
| if (rc) |
| edac_device_free_ctl_info(edev_ctl); |
| |
| return rc; |
| } |
| |
| static int qcom_llcc_erp_remove(struct platform_device *pdev) |
| { |
| struct edac_device_ctl_info *edev_ctl = dev_get_drvdata(&pdev->dev); |
| |
| edac_device_del_device(edev_ctl->dev); |
| edac_device_free_ctl_info(edev_ctl); |
| |
| return 0; |
| } |
| |
| static const struct of_device_id qcom_llcc_erp_match_table[] = { |
| { .compatible = "qcom,llcc-erp" }, |
| { }, |
| }; |
| |
| static struct platform_driver qcom_llcc_erp_driver = { |
| .probe = qcom_llcc_erp_probe, |
| .remove = qcom_llcc_erp_remove, |
| .driver = { |
| .name = "qcom_llcc_erp", |
| .owner = THIS_MODULE, |
| .of_match_table = qcom_llcc_erp_match_table, |
| }, |
| }; |
| |
| static int __init qcom_llcc_erp_init(void) |
| { |
| return platform_driver_register(&qcom_llcc_erp_driver); |
| } |
| module_init(qcom_llcc_erp_init); |
| |
| static void __exit qcom_llcc_erp_exit(void) |
| { |
| platform_driver_unregister(&qcom_llcc_erp_driver); |
| } |
| module_exit(qcom_llcc_erp_exit); |
| |
| MODULE_DESCRIPTION("QCOM LLCC Error Reporting"); |
| MODULE_LICENSE("GPL v2"); |