1 // SPDX-License-Identifier: GPL-2.0 2 /* 3 * SiFive Platform EDAC Driver 4 * 5 * Copyright (C) 2018-2022 SiFive, Inc. 6 * 7 * This driver is partially based on octeon_edac-pc.c 8 * 9 */ 10 #include <linux/edac.h> 11 #include <linux/platform_device.h> 12 #include "edac_module.h" 13 #include <soc/sifive/sifive_ccache.h> 14 15 #define DRVNAME "sifive_edac" 16 17 struct sifive_edac_priv { 18 struct notifier_block notifier; 19 struct edac_device_ctl_info *dci; 20 }; 21 22 /* 23 * EDAC error callback 24 * 25 * @event: non-zero if unrecoverable. 26 */ 27 static 28 int ecc_err_event(struct notifier_block *this, unsigned long event, void *ptr) 29 { 30 const char *msg = (char *)ptr; 31 struct sifive_edac_priv *p; 32 33 p = container_of(this, struct sifive_edac_priv, notifier); 34 35 if (event == SIFIVE_CCACHE_ERR_TYPE_UE) 36 edac_device_handle_ue(p->dci, 0, 0, msg); 37 else if (event == SIFIVE_CCACHE_ERR_TYPE_CE) 38 edac_device_handle_ce(p->dci, 0, 0, msg); 39 40 return NOTIFY_OK; 41 } 42 43 static int ecc_register(struct platform_device *pdev) 44 { 45 struct sifive_edac_priv *p; 46 47 p = devm_kzalloc(&pdev->dev, sizeof(*p), GFP_KERNEL); 48 if (!p) 49 return -ENOMEM; 50 51 p->notifier.notifier_call = ecc_err_event; 52 platform_set_drvdata(pdev, p); 53 54 p->dci = edac_device_alloc_ctl_info(0, "sifive_ecc", 1, "sifive_ecc", 55 1, 1, edac_device_alloc_index()); 56 if (!p->dci) 57 return -ENOMEM; 58 59 p->dci->dev = &pdev->dev; 60 p->dci->mod_name = "Sifive ECC Manager"; 61 p->dci->ctl_name = dev_name(&pdev->dev); 62 p->dci->dev_name = dev_name(&pdev->dev); 63 64 if (edac_device_add_device(p->dci)) { 65 dev_err(p->dci->dev, "failed to register with EDAC core\n"); 66 goto err; 67 } 68 69 register_sifive_ccache_error_notifier(&p->notifier); 70 71 return 0; 72 73 err: 74 edac_device_free_ctl_info(p->dci); 75 76 return -ENXIO; 77 } 78 79 static int ecc_unregister(struct platform_device *pdev) 80 { 81 struct sifive_edac_priv *p = platform_get_drvdata(pdev); 82 83 unregister_sifive_ccache_error_notifier(&p->notifier); 84 edac_device_del_device(&pdev->dev); 85 edac_device_free_ctl_info(p->dci); 86 87 return 0; 88 } 89 90 static struct platform_device *sifive_pdev; 91 92 static int __init sifive_edac_init(void) 93 { 94 int ret; 95 96 sifive_pdev = platform_device_register_simple(DRVNAME, 0, NULL, 0); 97 if (IS_ERR(sifive_pdev)) 98 return PTR_ERR(sifive_pdev); 99 100 ret = ecc_register(sifive_pdev); 101 if (ret) 102 platform_device_unregister(sifive_pdev); 103 104 return ret; 105 } 106 107 static void __exit sifive_edac_exit(void) 108 { 109 ecc_unregister(sifive_pdev); 110 platform_device_unregister(sifive_pdev); 111 } 112 113 module_init(sifive_edac_init); 114 module_exit(sifive_edac_exit); 115 116 MODULE_AUTHOR("SiFive Inc."); 117 MODULE_DESCRIPTION("SiFive platform EDAC driver"); 118 MODULE_LICENSE("GPL v2"); 119