drivers/edac/sifive_edac.c

   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");