LXR linux/drivers/edac/sifive

   1// SPDX-License-Identifier: GPL-2.0
   2/*
   3 * SiFive Platform EDAC Driver
   4 *
   5 * Copyright (C) 2018-2019 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_l2_cache.h>
  14
  15#define DRVNAME "sifive_edac"
  16
  17struct 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 */
  27static
  28int 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_L2_ERR_TYPE_UE)
  36                edac_device_handle_ue(p->dci, 0, 0, msg);
  37        else if (event == SIFIVE_L2_ERR_TYPE_CE)
  38                edac_device_handle_ce(p->dci, 0, 0, msg);
  39
  40        return NOTIFY_OK;
  41}
  42
  43static 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, NULL, 0,
  56                                            edac_device_alloc_index());
  57        if (!p->dci)
  58                return -ENOMEM;
  59
  60        p->dci->dev = &pdev->dev;
  61        p->dci->mod_name = "Sifive ECC Manager";
  62        p->dci->ctl_name = dev_name(&pdev->dev);
  63        p->dci->dev_name = dev_name(&pdev->dev);
  64
  65        if (edac_device_add_device(p->dci)) {
  66                dev_err(p->dci->dev, "failed to register with EDAC core\n");
  67                goto err;
  68        }
  69
  70        register_sifive_l2_error_notifier(&p->notifier);
  71
  72        return 0;
  73
  74err:
  75        edac_device_free_ctl_info(p->dci);
  76
  77        return -ENXIO;
  78}
  79
  80static int ecc_unregister(struct platform_device *pdev)
  81{
  82        struct sifive_edac_priv *p = platform_get_drvdata(pdev);
  83
  84        unregister_sifive_l2_error_notifier(&p->notifier);
  85        edac_device_del_device(&pdev->dev);
  86        edac_device_free_ctl_info(p->dci);
  87
  88        return 0;
  89}
  90
  91static struct platform_device *sifive_pdev;
  92
  93static int __init sifive_edac_init(void)
  94{
  95        int ret;
  96
  97        sifive_pdev = platform_device_register_simple(DRVNAME, 0, NULL, 0);
  98        if (IS_ERR(sifive_pdev))
  99                return PTR_ERR(sifive_pdev);
 100
 101        ret = ecc_register(sifive_pdev);
 102        if (ret)
 103                platform_device_unregister(sifive_pdev);
 104
 105        return ret;
 106}
 107
 108static void __exit sifive_edac_exit(void)
 109{
 110        ecc_unregister(sifive_pdev);
 111        platform_device_unregister(sifive_pdev);
 112}
 113
 114module_init(sifive_edac_init);
 115module_exit(sifive_edac_exit);
 116
 117MODULE_AUTHOR("SiFive Inc.");
 118MODULE_DESCRIPTION("SiFive platform EDAC driver");
 119MODULE_LICENSE("GPL v2");
 120