]>
Commit | Line | Data |
---|---|---|
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 |
13 | struct qfprom_priv { |
14 | void __iomem *base; | |
15 | }; | |
16 | ||
382c62f7 SK |
17 | static 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 | ||
382c62f7 SK |
30 | static struct nvmem_config econfig = { |
31 | .name = "qfprom", | |
01d0d2c4 | 32 | .stride = 1, |
382c62f7 SK |
33 | .word_size = 1, |
34 | .reg_read = qfprom_reg_read, | |
382c62f7 SK |
35 | }; |
36 | ||
4ab11996 SK |
37 | static int qfprom_probe(struct platform_device *pdev) |
38 | { | |
39 | struct device *dev = &pdev->dev; | |
40 | struct resource *res; | |
41 | struct nvmem_device *nvmem; | |
ec3672b8 MY |
42 | struct qfprom_priv *priv; |
43 | ||
44 | priv = devm_kzalloc(dev, sizeof(*priv), GFP_KERNEL); | |
45 | if (!priv) | |
46 | return -ENOMEM; | |
4ab11996 SK |
47 | |
48 | res = platform_get_resource(pdev, IORESOURCE_MEM, 0); | |
ec3672b8 MY |
49 | priv->base = devm_ioremap_resource(dev, res); |
50 | if (IS_ERR(priv->base)) | |
51 | return PTR_ERR(priv->base); | |
4ab11996 | 52 | |
382c62f7 | 53 | econfig.size = resource_size(res); |
4ab11996 | 54 | econfig.dev = dev; |
ec3672b8 | 55 | econfig.priv = priv; |
382c62f7 | 56 | |
e5692efe | 57 | nvmem = devm_nvmem_register(dev, &econfig); |
4ab11996 | 58 | |
e5692efe | 59 | return PTR_ERR_OR_ZERO(nvmem); |
4ab11996 SK |
60 | } |
61 | ||
62 | static const struct of_device_id qfprom_of_match[] = { | |
63 | { .compatible = "qcom,qfprom",}, | |
64 | {/* sentinel */}, | |
65 | }; | |
66 | MODULE_DEVICE_TABLE(of, qfprom_of_match); | |
67 | ||
68 | static struct platform_driver qfprom_driver = { | |
69 | .probe = qfprom_probe, | |
4ab11996 SK |
70 | .driver = { |
71 | .name = "qcom,qfprom", | |
72 | .of_match_table = qfprom_of_match, | |
73 | }, | |
74 | }; | |
75 | module_platform_driver(qfprom_driver); | |
76 | MODULE_AUTHOR("Srinivas Kandagatla <srinivas.kandagatla@linaro.org>"); | |
77 | MODULE_DESCRIPTION("Qualcomm QFPROM driver"); | |
78 | MODULE_LICENSE("GPL v2"); |