171719760SOliver O'Halloran // SPDX-License-Identifier: GPL-2.0+
271719760SOliver O'Halloran
371719760SOliver O'Halloran #define pr_fmt(fmt) "of_pmem: " fmt
471719760SOliver O'Halloran
5fd774e36SRob Herring #include <linux/of.h>
671719760SOliver O'Halloran #include <linux/libnvdimm.h>
771719760SOliver O'Halloran #include <linux/module.h>
871719760SOliver O'Halloran #include <linux/ioport.h>
9fd774e36SRob Herring #include <linux/platform_device.h>
1071719760SOliver O'Halloran #include <linux/slab.h>
1171719760SOliver O'Halloran
1271719760SOliver O'Halloran struct of_pmem_private {
1371719760SOliver O'Halloran struct nvdimm_bus_descriptor bus_desc;
1471719760SOliver O'Halloran struct nvdimm_bus *bus;
1571719760SOliver O'Halloran };
1671719760SOliver O'Halloran
of_pmem_region_probe(struct platform_device * pdev)1771719760SOliver O'Halloran static int of_pmem_region_probe(struct platform_device *pdev)
1871719760SOliver O'Halloran {
1971719760SOliver O'Halloran struct of_pmem_private *priv;
2071719760SOliver O'Halloran struct device_node *np;
2171719760SOliver O'Halloran struct nvdimm_bus *bus;
2271719760SOliver O'Halloran bool is_volatile;
2371719760SOliver O'Halloran int i;
2471719760SOliver O'Halloran
2571719760SOliver O'Halloran np = dev_of_node(&pdev->dev);
2671719760SOliver O'Halloran if (!np)
2771719760SOliver O'Halloran return -ENXIO;
2871719760SOliver O'Halloran
2971719760SOliver O'Halloran priv = kzalloc(sizeof(*priv), GFP_KERNEL);
3071719760SOliver O'Halloran if (!priv)
3171719760SOliver O'Halloran return -ENOMEM;
3271719760SOliver O'Halloran
33*cc5f6993SChen Ni priv->bus_desc.provider_name = devm_kstrdup(&pdev->dev, pdev->name,
34*cc5f6993SChen Ni GFP_KERNEL);
35*cc5f6993SChen Ni if (!priv->bus_desc.provider_name) {
36*cc5f6993SChen Ni kfree(priv);
37*cc5f6993SChen Ni return -ENOMEM;
38*cc5f6993SChen Ni }
39*cc5f6993SChen Ni
4071719760SOliver O'Halloran priv->bus_desc.module = THIS_MODULE;
4171719760SOliver O'Halloran priv->bus_desc.of_node = np;
4271719760SOliver O'Halloran
4371719760SOliver O'Halloran priv->bus = bus = nvdimm_bus_register(&pdev->dev, &priv->bus_desc);
4471719760SOliver O'Halloran if (!bus) {
4571719760SOliver O'Halloran kfree(priv);
4671719760SOliver O'Halloran return -ENODEV;
4771719760SOliver O'Halloran }
4871719760SOliver O'Halloran platform_set_drvdata(pdev, priv);
4971719760SOliver O'Halloran
5071719760SOliver O'Halloran is_volatile = !!of_find_property(np, "volatile", NULL);
5171719760SOliver O'Halloran dev_dbg(&pdev->dev, "Registering %s regions from %pOF\n",
5271719760SOliver O'Halloran is_volatile ? "volatile" : "non-volatile", np);
5371719760SOliver O'Halloran
5471719760SOliver O'Halloran for (i = 0; i < pdev->num_resources; i++) {
5571719760SOliver O'Halloran struct nd_region_desc ndr_desc;
5671719760SOliver O'Halloran struct nd_region *region;
5771719760SOliver O'Halloran
5871719760SOliver O'Halloran /*
5971719760SOliver O'Halloran * NB: libnvdimm copies the data from ndr_desc into it's own
6071719760SOliver O'Halloran * structures so passing a stack pointer is fine.
6171719760SOliver O'Halloran */
6271719760SOliver O'Halloran memset(&ndr_desc, 0, sizeof(ndr_desc));
63df3f1264SRob Herring ndr_desc.numa_node = dev_to_node(&pdev->dev);
648fc5c735SDan Williams ndr_desc.target_node = ndr_desc.numa_node;
6571719760SOliver O'Halloran ndr_desc.res = &pdev->resource[i];
6671719760SOliver O'Halloran ndr_desc.of_node = np;
6771719760SOliver O'Halloran set_bit(ND_REGION_PAGEMAP, &ndr_desc.flags);
6871719760SOliver O'Halloran
6971719760SOliver O'Halloran if (is_volatile)
7071719760SOliver O'Halloran region = nvdimm_volatile_region_create(bus, &ndr_desc);
71338f6dacSAneesh Kumar K.V else {
72338f6dacSAneesh Kumar K.V set_bit(ND_REGION_PERSIST_MEMCTRL, &ndr_desc.flags);
7371719760SOliver O'Halloran region = nvdimm_pmem_region_create(bus, &ndr_desc);
74338f6dacSAneesh Kumar K.V }
7571719760SOliver O'Halloran
7671719760SOliver O'Halloran if (!region)
7771719760SOliver O'Halloran dev_warn(&pdev->dev, "Unable to register region %pR from %pOF\n",
7871719760SOliver O'Halloran ndr_desc.res, np);
7971719760SOliver O'Halloran else
8071719760SOliver O'Halloran dev_dbg(&pdev->dev, "Registered region %pR from %pOF\n",
8171719760SOliver O'Halloran ndr_desc.res, np);
8271719760SOliver O'Halloran }
8371719760SOliver O'Halloran
8471719760SOliver O'Halloran return 0;
8571719760SOliver O'Halloran }
8671719760SOliver O'Halloran
of_pmem_region_remove(struct platform_device * pdev)8771719760SOliver O'Halloran static int of_pmem_region_remove(struct platform_device *pdev)
8871719760SOliver O'Halloran {
8971719760SOliver O'Halloran struct of_pmem_private *priv = platform_get_drvdata(pdev);
9071719760SOliver O'Halloran
9171719760SOliver O'Halloran nvdimm_bus_unregister(priv->bus);
9271719760SOliver O'Halloran kfree(priv);
9371719760SOliver O'Halloran
9471719760SOliver O'Halloran return 0;
9571719760SOliver O'Halloran }
9671719760SOliver O'Halloran
9771719760SOliver O'Halloran static const struct of_device_id of_pmem_region_match[] = {
9871719760SOliver O'Halloran { .compatible = "pmem-region" },
998c26ab72SAneesh Kumar K.V { .compatible = "pmem-region-v2" },
10071719760SOliver O'Halloran { },
10171719760SOliver O'Halloran };
10271719760SOliver O'Halloran
10371719760SOliver O'Halloran static struct platform_driver of_pmem_region_driver = {
10471719760SOliver O'Halloran .probe = of_pmem_region_probe,
10571719760SOliver O'Halloran .remove = of_pmem_region_remove,
10671719760SOliver O'Halloran .driver = {
10771719760SOliver O'Halloran .name = "of_pmem",
10871719760SOliver O'Halloran .of_match_table = of_pmem_region_match,
10971719760SOliver O'Halloran },
11071719760SOliver O'Halloran };
11171719760SOliver O'Halloran
11271719760SOliver O'Halloran module_platform_driver(of_pmem_region_driver);
11371719760SOliver O'Halloran MODULE_DEVICE_TABLE(of, of_pmem_region_match);
11471719760SOliver O'Halloran MODULE_LICENSE("GPL");
11571719760SOliver O'Halloran MODULE_AUTHOR("IBM Corporation");
116