[linux-2.6-block.git] / drivers / nvmem / mtk-efuse.c

// SPDX-License-Identifier: GPL-2.0-only
/*
 * Copyright (c) 2015 MediaTek Inc.
 * Author: Andrew-CT Chen <andrew-ct.chen@mediatek.com>
 */

#include <linux/device.h>
#include <linux/module.h>
#include <linux/mod_devicetable.h>
#include <linux/io.h>
#include <linux/nvmem-provider.h>
#include <linux/platform_device.h>

struct mtk_efuse_priv {
	void __iomem *base;
};

static int mtk_reg_read(void *context,
			unsigned int reg, void *_val, size_t bytes)
{
	struct mtk_efuse_priv *priv = context;
	void __iomem *addr = priv->base + reg;
	u8 *val = _val;
	int i;

	for (i = 0; i < bytes; i++, val++)
		*val = readb(addr + i);

	return 0;
}

static int mtk_efuse_probe(struct platform_device *pdev)
{
	struct device *dev = &pdev->dev;
	struct resource *res;
	struct nvmem_device *nvmem;
	struct nvmem_config econfig = {};
	struct mtk_efuse_priv *priv;

	priv = devm_kzalloc(dev, sizeof(*priv), GFP_KERNEL);
	if (!priv)
		return -ENOMEM;

	res = platform_get_resource(pdev, IORESOURCE_MEM, 0);
	priv->base = devm_ioremap_resource(dev, res);
	if (IS_ERR(priv->base))
		return PTR_ERR(priv->base);

	econfig.stride = 1;
	econfig.word_size = 1;
	econfig.reg_read = mtk_reg_read;
	econfig.size = resource_size(res);
	econfig.priv = priv;
	econfig.dev = dev;
	nvmem = devm_nvmem_register(dev, &econfig);

	return PTR_ERR_OR_ZERO(nvmem);
}

static const struct of_device_id mtk_efuse_of_match[] = {
	{ .compatible = "mediatek,mt8173-efuse",},
	{ .compatible = "mediatek,efuse",},
	{/* sentinel */},
};
MODULE_DEVICE_TABLE(of, mtk_efuse_of_match);

static struct platform_driver mtk_efuse_driver = {
	.probe = mtk_efuse_probe,
	.driver = {
		.name = "mediatek,efuse",
		.of_match_table = mtk_efuse_of_match,
	},
};

static int __init mtk_efuse_init(void)
{
	int ret;

	ret = platform_driver_register(&mtk_efuse_driver);
	if (ret) {
		pr_err("Failed to register efuse driver\n");
		return ret;
	}

	return 0;
}

static void __exit mtk_efuse_exit(void)
{
	return platform_driver_unregister(&mtk_efuse_driver);
}

subsys_initcall(mtk_efuse_init);
module_exit(mtk_efuse_exit);

MODULE_AUTHOR("Andrew-CT Chen <andrew-ct.chen@mediatek.com>");
MODULE_DESCRIPTION("Mediatek EFUSE driver");
MODULE_LICENSE("GPL v2");
Commit	Line	Data
1802d0be	1	// SPDX-License-Identifier: GPL-2.0-only
4c7e4fe3 ACC	2	/*
	3	* Copyright (c) 2015 MediaTek Inc.
	4	* Author: Andrew-CT Chen <andrew-ct.chen@mediatek.com>
4c7e4fe3 ACC	5	*/
	6
	7	#include <linux/device.h>
	8	#include <linux/module.h>
ac316725	9	#include <linux/mod_devicetable.h>
ba360fd0	10	#include <linux/io.h>
4c7e4fe3 ACC	11	#include <linux/nvmem-provider.h>
4c7e4fe3 ACC	12	#include <linux/platform_device.h>
4c7e4fe3	13
a48f1fff MY	14	struct mtk_efuse_priv {
	15	void __iomem *base;
	16	};
	17
ba360fd0 SK	18	static int mtk_reg_read(void *context,
	19	unsigned int reg, void *_val, size_t bytes)
	20	{
a48f1fff	21	struct mtk_efuse_priv *priv = context;
98e2c4ef CY	22	void __iomem *addr = priv->base + reg;
	23	u8 *val = _val;
	24	int i;
ba360fd0	25
98e2c4ef CY	26	for (i = 0; i < bytes; i++, val++)
98e2c4ef CY	27	*val = readb(addr + i);
ba360fd0 SK	28
	29	return 0;
	30	}
	31
4c7e4fe3 ACC	32	static int mtk_efuse_probe(struct platform_device *pdev)
	33	{
	34	struct device *dev = &pdev->dev;
	35	struct resource *res;
	36	struct nvmem_device *nvmem;
4dd5f60e	37	struct nvmem_config econfig = {};
a48f1fff MY	38	struct mtk_efuse_priv *priv;
	39
	40	priv = devm_kzalloc(dev, sizeof(*priv), GFP_KERNEL);
	41	if (!priv)
	42	return -ENOMEM;
4c7e4fe3 ACC	43
4c7e4fe3 ACC	44	res = platform_get_resource(pdev, IORESOURCE_MEM, 0);
a48f1fff MY	45	priv->base = devm_ioremap_resource(dev, res);
	46	if (IS_ERR(priv->base))
	47	return PTR_ERR(priv->base);
4c7e4fe3	48
98e2c4ef CY	49	econfig.stride = 1;
98e2c4ef CY	50	econfig.word_size = 1;
4dd5f60e	51	econfig.reg_read = mtk_reg_read;
4dd5f60e	52	econfig.size = resource_size(res);
a48f1fff	53	econfig.priv = priv;
4dd5f60e	54	econfig.dev = dev;
7e68a645	55	nvmem = devm_nvmem_register(dev, &econfig);
4c7e4fe3	56
7e68a645	57	return PTR_ERR_OR_ZERO(nvmem);
4c7e4fe3 ACC	58	}
	59
	60	static const struct of_device_id mtk_efuse_of_match[] = {
	61	{ .compatible = "mediatek,mt8173-efuse",},
	62	{ .compatible = "mediatek,efuse",},
	63	{/* sentinel */},
	64	};
	65	MODULE_DEVICE_TABLE(of, mtk_efuse_of_match);
	66
	67	static struct platform_driver mtk_efuse_driver = {
	68	.probe = mtk_efuse_probe,
4c7e4fe3 ACC	69	.driver = {
	70	.name = "mediatek,efuse",
	71	.of_match_table = mtk_efuse_of_match,
	72	},
	73	};
564e7f87 ACC	74
	75	static int __init mtk_efuse_init(void)
	76	{
	77	int ret;
	78
	79	ret = platform_driver_register(&mtk_efuse_driver);
	80	if (ret) {
	81	pr_err("Failed to register efuse driver\n");
	82	return ret;
	83	}
	84
	85	return 0;
	86	}
	87
	88	static void __exit mtk_efuse_exit(void)
	89	{
	90	return platform_driver_unregister(&mtk_efuse_driver);
	91	}
	92
	93	subsys_initcall(mtk_efuse_init);
	94	module_exit(mtk_efuse_exit);
	95
4c7e4fe3 ACC	96	MODULE_AUTHOR("Andrew-CT Chen <andrew-ct.chen@mediatek.com>");
	97	MODULE_DESCRIPTION("Mediatek EFUSE driver");
	98	MODULE_LICENSE("GPL v2");