]> git.ipfire.org Git - thirdparty/kernel/stable.git/blame - drivers/nvmem/qfprom.c
NFS4: Only set creation opendata if O_CREAT
[thirdparty/kernel/stable.git] / drivers / nvmem / qfprom.c
CommitLineData
97fb5e8d 1// SPDX-License-Identifier: GPL-2.0-only
4ab11996
SK
2/*
3 * Copyright (C) 2015 Srinivas Kandagatla <srinivas.kandagatla@linaro.org>
4ab11996
SK
4 */
5
6#include <linux/device.h>
7#include <linux/module.h>
ac316725 8#include <linux/mod_devicetable.h>
382c62f7 9#include <linux/io.h>
4ab11996
SK
10#include <linux/nvmem-provider.h>
11#include <linux/platform_device.h>
4ab11996 12
ec3672b8
MY
13struct qfprom_priv {
14 void __iomem *base;
15};
16
382c62f7
SK
17static int qfprom_reg_read(void *context,
18 unsigned int reg, void *_val, size_t bytes)
19{
ec3672b8 20 struct qfprom_priv *priv = context;
01d0d2c4
VG
21 u8 *val = _val;
22 int i = 0, words = bytes;
4ab11996 23
382c62f7 24 while (words--)
ec3672b8 25 *val++ = readb(priv->base + reg + i++);
382c62f7
SK
26
27 return 0;
28}
29
30static int qfprom_reg_write(void *context,
31 unsigned int reg, void *_val, size_t bytes)
32{
ec3672b8 33 struct qfprom_priv *priv = context;
01d0d2c4
VG
34 u8 *val = _val;
35 int i = 0, words = bytes;
382c62f7
SK
36
37 while (words--)
ec3672b8 38 writeb(*val++, priv->base + reg + i++);
382c62f7
SK
39
40 return 0;
41}
4ab11996 42
382c62f7
SK
43static struct nvmem_config econfig = {
44 .name = "qfprom",
01d0d2c4 45 .stride = 1,
382c62f7
SK
46 .word_size = 1,
47 .reg_read = qfprom_reg_read,
48 .reg_write = qfprom_reg_write,
49};
50
4ab11996
SK
51static int qfprom_probe(struct platform_device *pdev)
52{
53 struct device *dev = &pdev->dev;
54 struct resource *res;
55 struct nvmem_device *nvmem;
ec3672b8
MY
56 struct qfprom_priv *priv;
57
58 priv = devm_kzalloc(dev, sizeof(*priv), GFP_KERNEL);
59 if (!priv)
60 return -ENOMEM;
4ab11996
SK
61
62 res = platform_get_resource(pdev, IORESOURCE_MEM, 0);
ec3672b8
MY
63 priv->base = devm_ioremap_resource(dev, res);
64 if (IS_ERR(priv->base))
65 return PTR_ERR(priv->base);
4ab11996 66
382c62f7 67 econfig.size = resource_size(res);
4ab11996 68 econfig.dev = dev;
ec3672b8 69 econfig.priv = priv;
382c62f7 70
e5692efe 71 nvmem = devm_nvmem_register(dev, &econfig);
4ab11996 72
e5692efe 73 return PTR_ERR_OR_ZERO(nvmem);
4ab11996
SK
74}
75
76static const struct of_device_id qfprom_of_match[] = {
77 { .compatible = "qcom,qfprom",},
78 {/* sentinel */},
79};
80MODULE_DEVICE_TABLE(of, qfprom_of_match);
81
82static struct platform_driver qfprom_driver = {
83 .probe = qfprom_probe,
4ab11996
SK
84 .driver = {
85 .name = "qcom,qfprom",
86 .of_match_table = qfprom_of_match,
87 },
88};
89module_platform_driver(qfprom_driver);
90MODULE_AUTHOR("Srinivas Kandagatla <srinivas.kandagatla@linaro.org>");
91MODULE_DESCRIPTION("Qualcomm QFPROM driver");
92MODULE_LICENSE("GPL v2");