Commit | Line | Data |
---|---|---|
4ab11996 SK |
1 | /* |
2 | * Copyright (C) 2015 Srinivas Kandagatla <srinivas.kandagatla@linaro.org> | |
3 | * | |
4 | * This program is free software; you can redistribute it and/or modify | |
5 | * it under the terms of the GNU General Public License version 2 and | |
6 | * only version 2 as published by the Free Software Foundation. | |
7 | * | |
8 | * This program is distributed in the hope that it will be useful, | |
9 | * but WITHOUT ANY WARRANTY; without even the implied warranty of | |
10 | * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the | |
11 | * GNU General Public License for more details. | |
12 | */ | |
13 | ||
14 | #include <linux/device.h> | |
15 | #include <linux/module.h> | |
16 | #include <linux/nvmem-provider.h> | |
17 | #include <linux/platform_device.h> | |
18 | #include <linux/regmap.h> | |
19 | ||
20 | static struct regmap_config qfprom_regmap_config = { | |
21 | .reg_bits = 32, | |
22 | .val_bits = 8, | |
23 | .reg_stride = 1, | |
24 | }; | |
25 | ||
26 | static struct nvmem_config econfig = { | |
27 | .name = "qfprom", | |
28 | .owner = THIS_MODULE, | |
29 | }; | |
30 | ||
31 | static int qfprom_remove(struct platform_device *pdev) | |
32 | { | |
33 | struct nvmem_device *nvmem = platform_get_drvdata(pdev); | |
34 | ||
35 | return nvmem_unregister(nvmem); | |
36 | } | |
37 | ||
38 | static int qfprom_probe(struct platform_device *pdev) | |
39 | { | |
40 | struct device *dev = &pdev->dev; | |
41 | struct resource *res; | |
42 | struct nvmem_device *nvmem; | |
43 | struct regmap *regmap; | |
44 | void __iomem *base; | |
45 | ||
46 | res = platform_get_resource(pdev, IORESOURCE_MEM, 0); | |
47 | base = devm_ioremap_resource(dev, res); | |
48 | if (IS_ERR(base)) | |
49 | return PTR_ERR(base); | |
50 | ||
51 | qfprom_regmap_config.max_register = resource_size(res) - 1; | |
52 | ||
53 | regmap = devm_regmap_init_mmio(dev, base, &qfprom_regmap_config); | |
54 | if (IS_ERR(regmap)) { | |
55 | dev_err(dev, "regmap init failed\n"); | |
56 | return PTR_ERR(regmap); | |
57 | } | |
58 | econfig.dev = dev; | |
59 | nvmem = nvmem_register(&econfig); | |
60 | if (IS_ERR(nvmem)) | |
61 | return PTR_ERR(nvmem); | |
62 | ||
63 | platform_set_drvdata(pdev, nvmem); | |
64 | ||
65 | return 0; | |
66 | } | |
67 | ||
68 | static const struct of_device_id qfprom_of_match[] = { | |
69 | { .compatible = "qcom,qfprom",}, | |
70 | {/* sentinel */}, | |
71 | }; | |
72 | MODULE_DEVICE_TABLE(of, qfprom_of_match); | |
73 | ||
74 | static struct platform_driver qfprom_driver = { | |
75 | .probe = qfprom_probe, | |
76 | .remove = qfprom_remove, | |
77 | .driver = { | |
78 | .name = "qcom,qfprom", | |
79 | .of_match_table = qfprom_of_match, | |
80 | }, | |
81 | }; | |
82 | module_platform_driver(qfprom_driver); | |
83 | MODULE_AUTHOR("Srinivas Kandagatla <srinivas.kandagatla@linaro.org>"); | |
84 | MODULE_DESCRIPTION("Qualcomm QFPROM driver"); | |
85 | MODULE_LICENSE("GPL v2"); |