1 /* 2 * Copyright(c) 2013-2015 Intel Corporation. All rights reserved. 3 * 4 * This program is free software; you can redistribute it and/or modify 5 * it under the terms of version 2 of the GNU General Public License as 6 * published by the Free Software Foundation. 7 * 8 * This program is distributed in the hope that it will be useful, but 9 * WITHOUT ANY WARRANTY; without even the implied warranty of 10 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU 11 * General Public License for more details. 12 */ 13 #include <linux/vmalloc.h> 14 #include <linux/module.h> 15 #include <linux/device.h> 16 #include <linux/sizes.h> 17 #include <linux/ndctl.h> 18 #include <linux/slab.h> 19 #include <linux/mm.h> 20 #include <linux/nd.h> 21 #include "label.h" 22 #include "nd.h" 23 24 static int nvdimm_probe(struct device *dev) 25 { 26 struct nvdimm_drvdata *ndd; 27 int rc; 28 29 rc = nvdimm_check_config_data(dev); 30 if (rc) { 31 /* not required for non-aliased nvdimm, ex. NVDIMM-N */ 32 if (rc == -ENOTTY) 33 rc = 0; 34 return rc; 35 } 36 37 ndd = kzalloc(sizeof(*ndd), GFP_KERNEL); 38 if (!ndd) 39 return -ENOMEM; 40 41 dev_set_drvdata(dev, ndd); 42 ndd->dpa.name = dev_name(dev); 43 ndd->ns_current = -1; 44 ndd->ns_next = -1; 45 ndd->dpa.start = 0; 46 ndd->dpa.end = -1; 47 ndd->dev = dev; 48 get_device(dev); 49 kref_init(&ndd->kref); 50 51 rc = nvdimm_init_nsarea(ndd); 52 if (rc == -EACCES) 53 nvdimm_set_locked(dev); 54 if (rc) 55 goto err; 56 57 rc = nvdimm_init_config_data(ndd); 58 if (rc == -EACCES) 59 nvdimm_set_locked(dev); 60 if (rc) 61 goto err; 62 63 dev_dbg(dev, "config data size: %d\n", ndd->nsarea.config_size); 64 65 nvdimm_bus_lock(dev); 66 ndd->ns_current = nd_label_validate(ndd); 67 ndd->ns_next = nd_label_next_nsindex(ndd->ns_current); 68 nd_label_copy(ndd, to_next_namespace_index(ndd), 69 to_current_namespace_index(ndd)); 70 rc = nd_label_reserve_dpa(ndd); 71 if (ndd->ns_current >= 0) 72 nvdimm_set_aliasing(dev); 73 nvdimm_clear_locked(dev); 74 nvdimm_bus_unlock(dev); 75 76 if (rc) 77 goto err; 78 79 return 0; 80 81 err: 82 put_ndd(ndd); 83 return rc; 84 } 85 86 static int nvdimm_remove(struct device *dev) 87 { 88 struct nvdimm_drvdata *ndd = dev_get_drvdata(dev); 89 90 if (!ndd) 91 return 0; 92 93 nvdimm_bus_lock(dev); 94 dev_set_drvdata(dev, NULL); 95 nvdimm_bus_unlock(dev); 96 put_ndd(ndd); 97 98 return 0; 99 } 100 101 static struct nd_device_driver nvdimm_driver = { 102 .probe = nvdimm_probe, 103 .remove = nvdimm_remove, 104 .drv = { 105 .name = "nvdimm", 106 }, 107 .type = ND_DRIVER_DIMM, 108 }; 109 110 int __init nvdimm_init(void) 111 { 112 return nd_driver_register(&nvdimm_driver); 113 } 114 115 void nvdimm_exit(void) 116 { 117 driver_unregister(&nvdimm_driver.drv); 118 } 119 120 MODULE_ALIAS_ND_DEVICE(ND_DEVICE_DIMM); 121