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