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