1// SPDX-License-Identifier: GPL-2.0+
2
3#define pr_fmt(fmt) "of_pmem: " fmt
4
5#include <linux/of_platform.h>
6#include <linux/of_address.h>
7#include <linux/libnvdimm.h>
8#include <linux/module.h>
9#include <linux/ioport.h>
10#include <linux/slab.h>
11
12static const struct attribute_group *region_attr_groups[] = {
13 &nd_region_attribute_group,
14 &nd_device_attribute_group,
15 NULL,
16};
17
18static const struct attribute_group *bus_attr_groups[] = {
19 &nvdimm_bus_attribute_group,
20 NULL,
21};
22
23struct of_pmem_private {
24 struct nvdimm_bus_descriptor bus_desc;
25 struct nvdimm_bus *bus;
26};
27
28static int of_pmem_region_probe(struct platform_device *pdev)
29{
30 struct of_pmem_private *priv;
31 struct device_node *np;
32 struct nvdimm_bus *bus;
33 bool is_volatile;
34 int i;
35
36 np = dev_of_node(&pdev->dev);
37 if (!np)
38 return -ENXIO;
39
40 priv = kzalloc(sizeof(*priv), GFP_KERNEL);
41 if (!priv)
42 return -ENOMEM;
43
44 priv->bus_desc.attr_groups = bus_attr_groups;
45 priv->bus_desc.provider_name = "of_pmem";
46 priv->bus_desc.module = THIS_MODULE;
47 priv->bus_desc.of_node = np;
48
49 priv->bus = bus = nvdimm_bus_register(&pdev->dev, &priv->bus_desc);
50 if (!bus) {
51 kfree(priv);
52 return -ENODEV;
53 }
54 platform_set_drvdata(pdev, priv);
55
56 is_volatile = !!of_find_property(np, "volatile", NULL);
57 dev_dbg(&pdev->dev, "Registering %s regions from %pOF\n",
58 is_volatile ? "volatile" : "non-volatile", np);
59
60 for (i = 0; i < pdev->num_resources; i++) {
61 struct nd_region_desc ndr_desc;
62 struct nd_region *region;
63
64 /*
65 * NB: libnvdimm copies the data from ndr_desc into it's own
66 * structures so passing a stack pointer is fine.
67 */
68 memset(&ndr_desc, 0, sizeof(ndr_desc));
69 ndr_desc.attr_groups = region_attr_groups;
70 ndr_desc.numa_node = dev_to_node(&pdev->dev);
71 ndr_desc.target_node = ndr_desc.numa_node;
72 ndr_desc.res = &pdev->resource[i];
73 ndr_desc.of_node = np;
74 set_bit(ND_REGION_PAGEMAP, &ndr_desc.flags);
75
76 if (is_volatile)
77 region = nvdimm_volatile_region_create(bus, &ndr_desc);
78 else
79 region = nvdimm_pmem_region_create(bus, &ndr_desc);
80
81 if (!region)
82 dev_warn(&pdev->dev, "Unable to register region %pR from %pOF\n",
83 ndr_desc.res, np);
84 else
85 dev_dbg(&pdev->dev, "Registered region %pR from %pOF\n",
86 ndr_desc.res, np);
87 }
88
89 return 0;
90}
91
92static int of_pmem_region_remove(struct platform_device *pdev)
93{
94 struct of_pmem_private *priv = platform_get_drvdata(pdev);
95
96 nvdimm_bus_unregister(priv->bus);
97 kfree(priv);
98
99 return 0;
100}
101
102static const struct of_device_id of_pmem_region_match[] = {
103 { .compatible = "pmem-region" },
104 { },
105};
106
107static struct platform_driver of_pmem_region_driver = {
108 .probe = of_pmem_region_probe,
109 .remove = of_pmem_region_remove,
110 .driver = {
111 .name = "of_pmem",
112 .of_match_table = of_pmem_region_match,
113 },
114};
115
116module_platform_driver(of_pmem_region_driver);
117MODULE_DEVICE_TABLE(of, of_pmem_region_match);
118MODULE_LICENSE("GPL");
119MODULE_AUTHOR("IBM Corporation");
120