[linux-block.git] / drivers / edac / sifive_edac.c

// SPDX-License-Identifier: GPL-2.0
/*
 * SiFive Platform EDAC Driver
 *
 * Copyright (C) 2018-2022 SiFive, Inc.
 *
 * This driver is partially based on octeon_edac-pc.c
 *
 */
#include <linux/edac.h>
#include <linux/platform_device.h>
#include "edac_module.h"
#include <soc/sifive/sifive_ccache.h>

#define DRVNAME "sifive_edac"

struct sifive_edac_priv {
	struct notifier_block notifier;
	struct edac_device_ctl_info *dci;
};

/*
 * EDAC error callback
 *
 * @event: non-zero if unrecoverable.
 */
static
int ecc_err_event(struct notifier_block *this, unsigned long event, void *ptr)
{
	const char *msg = (char *)ptr;
	struct sifive_edac_priv *p;

	p = container_of(this, struct sifive_edac_priv, notifier);

	if (event == SIFIVE_CCACHE_ERR_TYPE_UE)
		edac_device_handle_ue(p->dci, 0, 0, msg);
	else if (event == SIFIVE_CCACHE_ERR_TYPE_CE)
		edac_device_handle_ce(p->dci, 0, 0, msg);

	return NOTIFY_OK;
}

static int ecc_register(struct platform_device *pdev)
{
	struct sifive_edac_priv *p;

	p = devm_kzalloc(&pdev->dev, sizeof(*p), GFP_KERNEL);
	if (!p)
		return -ENOMEM;

	p->notifier.notifier_call = ecc_err_event;
	platform_set_drvdata(pdev, p);

	p->dci = edac_device_alloc_ctl_info(0, "sifive_ecc", 1, "sifive_ecc",
					    1, 1, NULL, 0,
					    edac_device_alloc_index());
	if (!p->dci)
		return -ENOMEM;

	p->dci->dev = &pdev->dev;
	p->dci->mod_name = "Sifive ECC Manager";
	p->dci->ctl_name = dev_name(&pdev->dev);
	p->dci->dev_name = dev_name(&pdev->dev);

	if (edac_device_add_device(p->dci)) {
		dev_err(p->dci->dev, "failed to register with EDAC core\n");
		goto err;
	}

	register_sifive_ccache_error_notifier(&p->notifier);

	return 0;

err:
	edac_device_free_ctl_info(p->dci);

	return -ENXIO;
}

static int ecc_unregister(struct platform_device *pdev)
{
	struct sifive_edac_priv *p = platform_get_drvdata(pdev);

	unregister_sifive_ccache_error_notifier(&p->notifier);
	edac_device_del_device(&pdev->dev);
	edac_device_free_ctl_info(p->dci);

	return 0;
}

static struct platform_device *sifive_pdev;

static int __init sifive_edac_init(void)
{
	int ret;

	sifive_pdev = platform_device_register_simple(DRVNAME, 0, NULL, 0);
	if (IS_ERR(sifive_pdev))
		return PTR_ERR(sifive_pdev);

	ret = ecc_register(sifive_pdev);
	if (ret)
		platform_device_unregister(sifive_pdev);

	return ret;
}

static void __exit sifive_edac_exit(void)
{
	ecc_unregister(sifive_pdev);
	platform_device_unregister(sifive_pdev);
}

module_init(sifive_edac_init);
module_exit(sifive_edac_exit);

MODULE_AUTHOR("SiFive Inc.");
MODULE_DESCRIPTION("SiFive platform EDAC driver");
MODULE_LICENSE("GPL v2");
Commit	Line	Data
91abaeaa YS	1	// SPDX-License-Identifier: GPL-2.0
	2	/*
	3	* SiFive Platform EDAC Driver
	4	*
ca120a79	5	* Copyright (C) 2018-2022 SiFive, Inc.
91abaeaa YS	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"
ca120a79	13	#include <soc/sifive/sifive_ccache.h>
91abaeaa YS	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
ad2c302b	22	/*
91abaeaa YS	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
ca120a79	35	if (event == SIFIVE_CCACHE_ERR_TYPE_UE)
91abaeaa	36	edac_device_handle_ue(p->dci, 0, 0, msg);
ca120a79	37	else if (event == SIFIVE_CCACHE_ERR_TYPE_CE)
91abaeaa YS	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, NULL, 0,
	56	edac_device_alloc_index());
6cd18453 WY	57	if (!p->dci)
6cd18453 WY	58	return -ENOMEM;
91abaeaa YS	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
ca120a79	70	register_sifive_ccache_error_notifier(&p->notifier);
91abaeaa YS	71
	72	return 0;
	73
	74	err:
	75	edac_device_free_ctl_info(p->dci);
	76
	77	return -ENXIO;
	78	}
	79
	80	static int ecc_unregister(struct platform_device *pdev)
	81	{
	82	struct sifive_edac_priv *p = platform_get_drvdata(pdev);
	83
ca120a79	84	unregister_sifive_ccache_error_notifier(&p->notifier);
91abaeaa YS	85	edac_device_del_device(&pdev->dev);
	86	edac_device_free_ctl_info(p->dci);
	87
	88	return 0;
	89	}
	90
	91	static struct platform_device *sifive_pdev;
	92
	93	static 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
	108	static void __exit sifive_edac_exit(void)
	109	{
	110	ecc_unregister(sifive_pdev);
	111	platform_device_unregister(sifive_pdev);
	112	}
	113
	114	module_init(sifive_edac_init);
	115	module_exit(sifive_edac_exit);
	116
	117	MODULE_AUTHOR("SiFive Inc.");
	118	MODULE_DESCRIPTION("SiFive platform EDAC driver");
	119	MODULE_LICENSE("GPL v2");