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 12 static const struct attribute_group *region_attr_groups[] = { 13 &nd_region_attribute_group, 14 &nd_device_attribute_group, 15 NULL, 16 }; 17 18 static const struct attribute_group *bus_attr_groups[] = { 19 &nvdimm_bus_attribute_group, 20 NULL, 21 }; 22 23 struct of_pmem_private { 24 struct nvdimm_bus_descriptor bus_desc; 25 struct nvdimm_bus *bus; 26 }; 27 28 static 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 = kstrdup(pdev->name, GFP_KERNEL); 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 92 static 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 102 static const struct of_device_id of_pmem_region_match[] = { 103 { .compatible = "pmem-region" }, 104 { }, 105 }; 106 107 static 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 116 module_platform_driver(of_pmem_region_driver); 117 MODULE_DEVICE_TABLE(of, of_pmem_region_match); 118 MODULE_LICENSE("GPL"); 119 MODULE_AUTHOR("IBM Corporation"); 120