Dan Williams | e145574 | 2015-07-30 17:57:47 -0400 | [diff] [blame] | 1 | /* |
Dan Williams | cd03412 | 2016-03-11 10:15:36 -0800 | [diff] [blame] | 2 | * Copyright(c) 2013-2016 Intel Corporation. All rights reserved. |
Dan Williams | e145574 | 2015-07-30 17:57:47 -0400 | [diff] [blame] | 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 | */ |
Dan Williams | ac515c0 | 2016-03-22 00:29:43 -0700 | [diff] [blame] | 13 | #include <linux/memremap.h> |
Dan Williams | e145574 | 2015-07-30 17:57:47 -0400 | [diff] [blame] | 14 | #include <linux/blkdev.h> |
| 15 | #include <linux/device.h> |
| 16 | #include <linux/genhd.h> |
| 17 | #include <linux/sizes.h> |
| 18 | #include <linux/slab.h> |
| 19 | #include <linux/fs.h> |
| 20 | #include <linux/mm.h> |
| 21 | #include "nd-core.h" |
| 22 | #include "pfn.h" |
| 23 | #include "nd.h" |
| 24 | |
| 25 | static void nd_pfn_release(struct device *dev) |
| 26 | { |
| 27 | struct nd_region *nd_region = to_nd_region(dev->parent); |
| 28 | struct nd_pfn *nd_pfn = to_nd_pfn(dev); |
| 29 | |
| 30 | dev_dbg(dev, "%s\n", __func__); |
| 31 | nd_detach_ndns(&nd_pfn->dev, &nd_pfn->ndns); |
| 32 | ida_simple_remove(&nd_region->pfn_ida, nd_pfn->id); |
| 33 | kfree(nd_pfn->uuid); |
| 34 | kfree(nd_pfn); |
| 35 | } |
| 36 | |
| 37 | static struct device_type nd_pfn_device_type = { |
| 38 | .name = "nd_pfn", |
| 39 | .release = nd_pfn_release, |
| 40 | }; |
| 41 | |
| 42 | bool is_nd_pfn(struct device *dev) |
| 43 | { |
| 44 | return dev ? dev->type == &nd_pfn_device_type : false; |
| 45 | } |
| 46 | EXPORT_SYMBOL(is_nd_pfn); |
| 47 | |
| 48 | struct nd_pfn *to_nd_pfn(struct device *dev) |
| 49 | { |
| 50 | struct nd_pfn *nd_pfn = container_of(dev, struct nd_pfn, dev); |
| 51 | |
| 52 | WARN_ON(!is_nd_pfn(dev)); |
| 53 | return nd_pfn; |
| 54 | } |
| 55 | EXPORT_SYMBOL(to_nd_pfn); |
| 56 | |
| 57 | static ssize_t mode_show(struct device *dev, |
| 58 | struct device_attribute *attr, char *buf) |
| 59 | { |
Dan Williams | cd03412 | 2016-03-11 10:15:36 -0800 | [diff] [blame] | 60 | struct nd_pfn *nd_pfn = to_nd_pfn_safe(dev); |
Dan Williams | e145574 | 2015-07-30 17:57:47 -0400 | [diff] [blame] | 61 | |
| 62 | switch (nd_pfn->mode) { |
| 63 | case PFN_MODE_RAM: |
| 64 | return sprintf(buf, "ram\n"); |
| 65 | case PFN_MODE_PMEM: |
| 66 | return sprintf(buf, "pmem\n"); |
| 67 | default: |
| 68 | return sprintf(buf, "none\n"); |
| 69 | } |
| 70 | } |
| 71 | |
| 72 | static ssize_t mode_store(struct device *dev, |
| 73 | struct device_attribute *attr, const char *buf, size_t len) |
| 74 | { |
Dan Williams | cd03412 | 2016-03-11 10:15:36 -0800 | [diff] [blame] | 75 | struct nd_pfn *nd_pfn = to_nd_pfn_safe(dev); |
Dan Williams | e145574 | 2015-07-30 17:57:47 -0400 | [diff] [blame] | 76 | ssize_t rc = 0; |
| 77 | |
| 78 | device_lock(dev); |
| 79 | nvdimm_bus_lock(dev); |
| 80 | if (dev->driver) |
| 81 | rc = -EBUSY; |
| 82 | else { |
| 83 | size_t n = len - 1; |
| 84 | |
| 85 | if (strncmp(buf, "pmem\n", n) == 0 |
| 86 | || strncmp(buf, "pmem", n) == 0) { |
Dan Williams | d2c0f04 | 2016-01-15 16:56:26 -0800 | [diff] [blame] | 87 | nd_pfn->mode = PFN_MODE_PMEM; |
Dan Williams | e145574 | 2015-07-30 17:57:47 -0400 | [diff] [blame] | 88 | } else if (strncmp(buf, "ram\n", n) == 0 |
| 89 | || strncmp(buf, "ram", n) == 0) |
| 90 | nd_pfn->mode = PFN_MODE_RAM; |
| 91 | else if (strncmp(buf, "none\n", n) == 0 |
| 92 | || strncmp(buf, "none", n) == 0) |
| 93 | nd_pfn->mode = PFN_MODE_NONE; |
| 94 | else |
| 95 | rc = -EINVAL; |
| 96 | } |
| 97 | dev_dbg(dev, "%s: result: %zd wrote: %s%s", __func__, |
| 98 | rc, buf, buf[len - 1] == '\n' ? "" : "\n"); |
| 99 | nvdimm_bus_unlock(dev); |
| 100 | device_unlock(dev); |
| 101 | |
| 102 | return rc ? rc : len; |
| 103 | } |
| 104 | static DEVICE_ATTR_RW(mode); |
| 105 | |
Dan Williams | 315c562 | 2015-12-10 14:45:23 -0800 | [diff] [blame] | 106 | static ssize_t align_show(struct device *dev, |
| 107 | struct device_attribute *attr, char *buf) |
| 108 | { |
Dan Williams | cd03412 | 2016-03-11 10:15:36 -0800 | [diff] [blame] | 109 | struct nd_pfn *nd_pfn = to_nd_pfn_safe(dev); |
Dan Williams | 315c562 | 2015-12-10 14:45:23 -0800 | [diff] [blame] | 110 | |
| 111 | return sprintf(buf, "%lx\n", nd_pfn->align); |
| 112 | } |
| 113 | |
| 114 | static ssize_t __align_store(struct nd_pfn *nd_pfn, const char *buf) |
| 115 | { |
| 116 | unsigned long val; |
| 117 | int rc; |
| 118 | |
| 119 | rc = kstrtoul(buf, 0, &val); |
| 120 | if (rc) |
| 121 | return rc; |
| 122 | |
| 123 | if (!is_power_of_2(val) || val < PAGE_SIZE || val > SZ_1G) |
| 124 | return -EINVAL; |
| 125 | |
| 126 | if (nd_pfn->dev.driver) |
| 127 | return -EBUSY; |
| 128 | else |
| 129 | nd_pfn->align = val; |
| 130 | |
| 131 | return 0; |
| 132 | } |
| 133 | |
| 134 | static ssize_t align_store(struct device *dev, |
| 135 | struct device_attribute *attr, const char *buf, size_t len) |
| 136 | { |
Dan Williams | cd03412 | 2016-03-11 10:15:36 -0800 | [diff] [blame] | 137 | struct nd_pfn *nd_pfn = to_nd_pfn_safe(dev); |
Dan Williams | 315c562 | 2015-12-10 14:45:23 -0800 | [diff] [blame] | 138 | ssize_t rc; |
| 139 | |
| 140 | device_lock(dev); |
| 141 | nvdimm_bus_lock(dev); |
| 142 | rc = __align_store(nd_pfn, buf); |
| 143 | dev_dbg(dev, "%s: result: %zd wrote: %s%s", __func__, |
| 144 | rc, buf, buf[len - 1] == '\n' ? "" : "\n"); |
| 145 | nvdimm_bus_unlock(dev); |
| 146 | device_unlock(dev); |
| 147 | |
| 148 | return rc ? rc : len; |
| 149 | } |
| 150 | static DEVICE_ATTR_RW(align); |
| 151 | |
Dan Williams | e145574 | 2015-07-30 17:57:47 -0400 | [diff] [blame] | 152 | static ssize_t uuid_show(struct device *dev, |
| 153 | struct device_attribute *attr, char *buf) |
| 154 | { |
Dan Williams | cd03412 | 2016-03-11 10:15:36 -0800 | [diff] [blame] | 155 | struct nd_pfn *nd_pfn = to_nd_pfn_safe(dev); |
Dan Williams | e145574 | 2015-07-30 17:57:47 -0400 | [diff] [blame] | 156 | |
| 157 | if (nd_pfn->uuid) |
| 158 | return sprintf(buf, "%pUb\n", nd_pfn->uuid); |
| 159 | return sprintf(buf, "\n"); |
| 160 | } |
| 161 | |
| 162 | static ssize_t uuid_store(struct device *dev, |
| 163 | struct device_attribute *attr, const char *buf, size_t len) |
| 164 | { |
Dan Williams | cd03412 | 2016-03-11 10:15:36 -0800 | [diff] [blame] | 165 | struct nd_pfn *nd_pfn = to_nd_pfn_safe(dev); |
Dan Williams | e145574 | 2015-07-30 17:57:47 -0400 | [diff] [blame] | 166 | ssize_t rc; |
| 167 | |
| 168 | device_lock(dev); |
| 169 | rc = nd_uuid_store(dev, &nd_pfn->uuid, buf, len); |
| 170 | dev_dbg(dev, "%s: result: %zd wrote: %s%s", __func__, |
| 171 | rc, buf, buf[len - 1] == '\n' ? "" : "\n"); |
| 172 | device_unlock(dev); |
| 173 | |
| 174 | return rc ? rc : len; |
| 175 | } |
| 176 | static DEVICE_ATTR_RW(uuid); |
| 177 | |
| 178 | static ssize_t namespace_show(struct device *dev, |
| 179 | struct device_attribute *attr, char *buf) |
| 180 | { |
Dan Williams | cd03412 | 2016-03-11 10:15:36 -0800 | [diff] [blame] | 181 | struct nd_pfn *nd_pfn = to_nd_pfn_safe(dev); |
Dan Williams | e145574 | 2015-07-30 17:57:47 -0400 | [diff] [blame] | 182 | ssize_t rc; |
| 183 | |
| 184 | nvdimm_bus_lock(dev); |
| 185 | rc = sprintf(buf, "%s\n", nd_pfn->ndns |
| 186 | ? dev_name(&nd_pfn->ndns->dev) : ""); |
| 187 | nvdimm_bus_unlock(dev); |
| 188 | return rc; |
| 189 | } |
| 190 | |
| 191 | static ssize_t namespace_store(struct device *dev, |
| 192 | struct device_attribute *attr, const char *buf, size_t len) |
| 193 | { |
Dan Williams | cd03412 | 2016-03-11 10:15:36 -0800 | [diff] [blame] | 194 | struct nd_pfn *nd_pfn = to_nd_pfn_safe(dev); |
Dan Williams | e145574 | 2015-07-30 17:57:47 -0400 | [diff] [blame] | 195 | ssize_t rc; |
| 196 | |
Dan Williams | e145574 | 2015-07-30 17:57:47 -0400 | [diff] [blame] | 197 | device_lock(dev); |
Axel Lin | 4ca8b57a | 2015-09-16 21:25:38 +0800 | [diff] [blame] | 198 | nvdimm_bus_lock(dev); |
Dan Williams | e145574 | 2015-07-30 17:57:47 -0400 | [diff] [blame] | 199 | rc = nd_namespace_store(dev, &nd_pfn->ndns, buf, len); |
| 200 | dev_dbg(dev, "%s: result: %zd wrote: %s%s", __func__, |
| 201 | rc, buf, buf[len - 1] == '\n' ? "" : "\n"); |
Dan Williams | e145574 | 2015-07-30 17:57:47 -0400 | [diff] [blame] | 202 | nvdimm_bus_unlock(dev); |
Axel Lin | 4ca8b57a | 2015-09-16 21:25:38 +0800 | [diff] [blame] | 203 | device_unlock(dev); |
Dan Williams | e145574 | 2015-07-30 17:57:47 -0400 | [diff] [blame] | 204 | |
| 205 | return rc; |
| 206 | } |
| 207 | static DEVICE_ATTR_RW(namespace); |
| 208 | |
Dan Williams | f6ed58c | 2016-03-03 09:46:04 -0800 | [diff] [blame] | 209 | static ssize_t resource_show(struct device *dev, |
| 210 | struct device_attribute *attr, char *buf) |
| 211 | { |
Dan Williams | cd03412 | 2016-03-11 10:15:36 -0800 | [diff] [blame] | 212 | struct nd_pfn *nd_pfn = to_nd_pfn_safe(dev); |
Dan Williams | f6ed58c | 2016-03-03 09:46:04 -0800 | [diff] [blame] | 213 | ssize_t rc; |
| 214 | |
| 215 | device_lock(dev); |
| 216 | if (dev->driver) { |
| 217 | struct nd_pfn_sb *pfn_sb = nd_pfn->pfn_sb; |
| 218 | u64 offset = __le64_to_cpu(pfn_sb->dataoff); |
| 219 | struct nd_namespace_common *ndns = nd_pfn->ndns; |
| 220 | u32 start_pad = __le32_to_cpu(pfn_sb->start_pad); |
| 221 | struct nd_namespace_io *nsio = to_nd_namespace_io(&ndns->dev); |
| 222 | |
| 223 | rc = sprintf(buf, "%#llx\n", (unsigned long long) nsio->res.start |
| 224 | + start_pad + offset); |
| 225 | } else { |
| 226 | /* no address to convey if the pfn instance is disabled */ |
| 227 | rc = -ENXIO; |
| 228 | } |
| 229 | device_unlock(dev); |
| 230 | |
| 231 | return rc; |
| 232 | } |
| 233 | static DEVICE_ATTR_RO(resource); |
| 234 | |
| 235 | static ssize_t size_show(struct device *dev, |
| 236 | struct device_attribute *attr, char *buf) |
| 237 | { |
Dan Williams | cd03412 | 2016-03-11 10:15:36 -0800 | [diff] [blame] | 238 | struct nd_pfn *nd_pfn = to_nd_pfn_safe(dev); |
Dan Williams | f6ed58c | 2016-03-03 09:46:04 -0800 | [diff] [blame] | 239 | ssize_t rc; |
| 240 | |
| 241 | device_lock(dev); |
| 242 | if (dev->driver) { |
| 243 | struct nd_pfn_sb *pfn_sb = nd_pfn->pfn_sb; |
| 244 | u64 offset = __le64_to_cpu(pfn_sb->dataoff); |
| 245 | struct nd_namespace_common *ndns = nd_pfn->ndns; |
| 246 | u32 start_pad = __le32_to_cpu(pfn_sb->start_pad); |
| 247 | u32 end_trunc = __le32_to_cpu(pfn_sb->end_trunc); |
| 248 | struct nd_namespace_io *nsio = to_nd_namespace_io(&ndns->dev); |
| 249 | |
| 250 | rc = sprintf(buf, "%llu\n", (unsigned long long) |
| 251 | resource_size(&nsio->res) - start_pad |
| 252 | - end_trunc - offset); |
| 253 | } else { |
| 254 | /* no size to convey if the pfn instance is disabled */ |
| 255 | rc = -ENXIO; |
| 256 | } |
| 257 | device_unlock(dev); |
| 258 | |
| 259 | return rc; |
| 260 | } |
| 261 | static DEVICE_ATTR_RO(size); |
| 262 | |
Dan Williams | e145574 | 2015-07-30 17:57:47 -0400 | [diff] [blame] | 263 | static struct attribute *nd_pfn_attributes[] = { |
| 264 | &dev_attr_mode.attr, |
| 265 | &dev_attr_namespace.attr, |
| 266 | &dev_attr_uuid.attr, |
Dan Williams | 315c562 | 2015-12-10 14:45:23 -0800 | [diff] [blame] | 267 | &dev_attr_align.attr, |
Dan Williams | f6ed58c | 2016-03-03 09:46:04 -0800 | [diff] [blame] | 268 | &dev_attr_resource.attr, |
| 269 | &dev_attr_size.attr, |
Dan Williams | e145574 | 2015-07-30 17:57:47 -0400 | [diff] [blame] | 270 | NULL, |
| 271 | }; |
| 272 | |
Dan Williams | cd03412 | 2016-03-11 10:15:36 -0800 | [diff] [blame] | 273 | struct attribute_group nd_pfn_attribute_group = { |
Dan Williams | e145574 | 2015-07-30 17:57:47 -0400 | [diff] [blame] | 274 | .attrs = nd_pfn_attributes, |
| 275 | }; |
| 276 | |
| 277 | static const struct attribute_group *nd_pfn_attribute_groups[] = { |
| 278 | &nd_pfn_attribute_group, |
| 279 | &nd_device_attribute_group, |
| 280 | &nd_numa_attribute_group, |
| 281 | NULL, |
| 282 | }; |
| 283 | |
Dan Williams | cd03412 | 2016-03-11 10:15:36 -0800 | [diff] [blame] | 284 | struct device *nd_pfn_devinit(struct nd_pfn *nd_pfn, |
Dan Williams | e145574 | 2015-07-30 17:57:47 -0400 | [diff] [blame] | 285 | struct nd_namespace_common *ndns) |
| 286 | { |
Dan Williams | cd03412 | 2016-03-11 10:15:36 -0800 | [diff] [blame] | 287 | struct device *dev = &nd_pfn->dev; |
| 288 | |
| 289 | if (!nd_pfn) |
| 290 | return NULL; |
| 291 | |
| 292 | nd_pfn->mode = PFN_MODE_NONE; |
| 293 | nd_pfn->align = HPAGE_SIZE; |
| 294 | dev = &nd_pfn->dev; |
| 295 | device_initialize(&nd_pfn->dev); |
| 296 | if (ndns && !__nd_attach_ndns(&nd_pfn->dev, ndns, &nd_pfn->ndns)) { |
| 297 | dev_dbg(&ndns->dev, "%s failed, already claimed by %s\n", |
| 298 | __func__, dev_name(ndns->claim)); |
| 299 | put_device(dev); |
| 300 | return NULL; |
| 301 | } |
| 302 | return dev; |
| 303 | } |
| 304 | |
| 305 | static struct nd_pfn *nd_pfn_alloc(struct nd_region *nd_region) |
| 306 | { |
Dan Williams | e145574 | 2015-07-30 17:57:47 -0400 | [diff] [blame] | 307 | struct nd_pfn *nd_pfn; |
| 308 | struct device *dev; |
| 309 | |
Dan Williams | e145574 | 2015-07-30 17:57:47 -0400 | [diff] [blame] | 310 | nd_pfn = kzalloc(sizeof(*nd_pfn), GFP_KERNEL); |
| 311 | if (!nd_pfn) |
| 312 | return NULL; |
| 313 | |
| 314 | nd_pfn->id = ida_simple_get(&nd_region->pfn_ida, 0, 0, GFP_KERNEL); |
| 315 | if (nd_pfn->id < 0) { |
| 316 | kfree(nd_pfn); |
| 317 | return NULL; |
| 318 | } |
| 319 | |
Dan Williams | e145574 | 2015-07-30 17:57:47 -0400 | [diff] [blame] | 320 | dev = &nd_pfn->dev; |
| 321 | dev_set_name(dev, "pfn%d.%d", nd_region->id, nd_pfn->id); |
Dan Williams | e145574 | 2015-07-30 17:57:47 -0400 | [diff] [blame] | 322 | dev->groups = nd_pfn_attribute_groups; |
Dan Williams | cd03412 | 2016-03-11 10:15:36 -0800 | [diff] [blame] | 323 | dev->type = &nd_pfn_device_type; |
| 324 | dev->parent = &nd_region->dev; |
| 325 | |
| 326 | return nd_pfn; |
Dan Williams | e145574 | 2015-07-30 17:57:47 -0400 | [diff] [blame] | 327 | } |
| 328 | |
| 329 | struct device *nd_pfn_create(struct nd_region *nd_region) |
| 330 | { |
Dan Williams | cd03412 | 2016-03-11 10:15:36 -0800 | [diff] [blame] | 331 | struct nd_pfn *nd_pfn; |
| 332 | struct device *dev; |
Dan Williams | e145574 | 2015-07-30 17:57:47 -0400 | [diff] [blame] | 333 | |
Dan Williams | cd03412 | 2016-03-11 10:15:36 -0800 | [diff] [blame] | 334 | if (!is_nd_pmem(&nd_region->dev)) |
| 335 | return NULL; |
| 336 | |
| 337 | nd_pfn = nd_pfn_alloc(nd_region); |
| 338 | dev = nd_pfn_devinit(nd_pfn, NULL); |
| 339 | |
| 340 | __nd_device_register(dev); |
Dan Williams | e145574 | 2015-07-30 17:57:47 -0400 | [diff] [blame] | 341 | return dev; |
| 342 | } |
| 343 | |
Dan Williams | c5ed926 | 2016-05-18 14:50:12 -0700 | [diff] [blame] | 344 | int nd_pfn_validate(struct nd_pfn *nd_pfn, const char *sig) |
Dan Williams | e145574 | 2015-07-30 17:57:47 -0400 | [diff] [blame] | 345 | { |
Dan Williams | e145574 | 2015-07-30 17:57:47 -0400 | [diff] [blame] | 346 | u64 checksum, offset; |
Dan Williams | 1ee6667 | 2016-06-23 17:50:39 -0700 | [diff] [blame] | 347 | unsigned long align; |
| 348 | enum nd_pfn_mode mode; |
Dan Williams | a34d5e8 | 2015-12-12 16:09:14 -0800 | [diff] [blame] | 349 | struct nd_namespace_io *nsio; |
| 350 | struct nd_pfn_sb *pfn_sb = nd_pfn->pfn_sb; |
| 351 | struct nd_namespace_common *ndns = nd_pfn->ndns; |
| 352 | const u8 *parent_uuid = nd_dev_to_uuid(&ndns->dev); |
Dan Williams | e145574 | 2015-07-30 17:57:47 -0400 | [diff] [blame] | 353 | |
| 354 | if (!pfn_sb || !ndns) |
| 355 | return -ENODEV; |
| 356 | |
| 357 | if (!is_nd_pmem(nd_pfn->dev.parent)) |
| 358 | return -ENODEV; |
| 359 | |
Dan Williams | e145574 | 2015-07-30 17:57:47 -0400 | [diff] [blame] | 360 | if (nvdimm_read_bytes(ndns, SZ_4K, pfn_sb, sizeof(*pfn_sb))) |
| 361 | return -ENXIO; |
| 362 | |
Dan Williams | c5ed926 | 2016-05-18 14:50:12 -0700 | [diff] [blame] | 363 | if (memcmp(pfn_sb->signature, sig, PFN_SIG_LEN) != 0) |
Dan Williams | e145574 | 2015-07-30 17:57:47 -0400 | [diff] [blame] | 364 | return -ENODEV; |
| 365 | |
| 366 | checksum = le64_to_cpu(pfn_sb->checksum); |
| 367 | pfn_sb->checksum = 0; |
| 368 | if (checksum != nd_sb_checksum((struct nd_gen_sb *) pfn_sb)) |
| 369 | return -ENODEV; |
| 370 | pfn_sb->checksum = cpu_to_le64(checksum); |
| 371 | |
Dan Williams | a34d5e8 | 2015-12-12 16:09:14 -0800 | [diff] [blame] | 372 | if (memcmp(pfn_sb->parent_uuid, parent_uuid, 16) != 0) |
| 373 | return -ENODEV; |
| 374 | |
Dan Williams | cfe30b8 | 2016-03-03 09:38:00 -0800 | [diff] [blame] | 375 | if (__le16_to_cpu(pfn_sb->version_minor) < 1) { |
| 376 | pfn_sb->start_pad = 0; |
| 377 | pfn_sb->end_trunc = 0; |
| 378 | } |
| 379 | |
Dan Williams | 45a0dac | 2016-03-31 15:41:18 -0700 | [diff] [blame] | 380 | if (__le16_to_cpu(pfn_sb->version_minor) < 2) |
| 381 | pfn_sb->align = 0; |
| 382 | |
Dan Williams | e145574 | 2015-07-30 17:57:47 -0400 | [diff] [blame] | 383 | switch (le32_to_cpu(pfn_sb->mode)) { |
| 384 | case PFN_MODE_RAM: |
Dan Williams | e145574 | 2015-07-30 17:57:47 -0400 | [diff] [blame] | 385 | case PFN_MODE_PMEM: |
Dan Williams | 45eb570 | 2016-01-29 17:42:51 -0800 | [diff] [blame] | 386 | break; |
Dan Williams | e145574 | 2015-07-30 17:57:47 -0400 | [diff] [blame] | 387 | default: |
| 388 | return -ENXIO; |
| 389 | } |
| 390 | |
Dan Williams | 1ee6667 | 2016-06-23 17:50:39 -0700 | [diff] [blame] | 391 | align = le32_to_cpu(pfn_sb->align); |
| 392 | offset = le64_to_cpu(pfn_sb->dataoff); |
| 393 | if (align == 0) |
| 394 | align = 1UL << ilog2(offset); |
| 395 | mode = le32_to_cpu(pfn_sb->mode); |
| 396 | |
Dan Williams | e145574 | 2015-07-30 17:57:47 -0400 | [diff] [blame] | 397 | if (!nd_pfn->uuid) { |
Dan Williams | 1ee6667 | 2016-06-23 17:50:39 -0700 | [diff] [blame] | 398 | /* |
| 399 | * When probing a namepace via nd_pfn_probe() the uuid |
| 400 | * is NULL (see: nd_pfn_devinit()) we init settings from |
| 401 | * pfn_sb |
| 402 | */ |
Dan Williams | e145574 | 2015-07-30 17:57:47 -0400 | [diff] [blame] | 403 | nd_pfn->uuid = kmemdup(pfn_sb->uuid, 16, GFP_KERNEL); |
| 404 | if (!nd_pfn->uuid) |
| 405 | return -ENOMEM; |
Dan Williams | 1ee6667 | 2016-06-23 17:50:39 -0700 | [diff] [blame] | 406 | nd_pfn->align = align; |
| 407 | nd_pfn->mode = mode; |
Dan Williams | e145574 | 2015-07-30 17:57:47 -0400 | [diff] [blame] | 408 | } else { |
Dan Williams | 1ee6667 | 2016-06-23 17:50:39 -0700 | [diff] [blame] | 409 | /* |
| 410 | * When probing a pfn / dax instance we validate the |
| 411 | * live settings against the pfn_sb |
| 412 | */ |
Dan Williams | e145574 | 2015-07-30 17:57:47 -0400 | [diff] [blame] | 413 | if (memcmp(nd_pfn->uuid, pfn_sb->uuid, 16) != 0) |
Dan Williams | e567056 | 2016-04-07 19:59:27 -0700 | [diff] [blame] | 414 | return -ENODEV; |
Dan Williams | 1ee6667 | 2016-06-23 17:50:39 -0700 | [diff] [blame] | 415 | |
| 416 | /* |
| 417 | * If the uuid validates, but other settings mismatch |
| 418 | * return EINVAL because userspace has managed to change |
| 419 | * the configuration without specifying new |
| 420 | * identification. |
| 421 | */ |
| 422 | if (nd_pfn->align != align || nd_pfn->mode != mode) { |
| 423 | dev_err(&nd_pfn->dev, |
| 424 | "init failed, settings mismatch\n"); |
| 425 | dev_dbg(&nd_pfn->dev, "align: %lx:%lx mode: %d:%d\n", |
| 426 | nd_pfn->align, align, nd_pfn->mode, |
| 427 | mode); |
| 428 | return -EINVAL; |
| 429 | } |
Dan Williams | e145574 | 2015-07-30 17:57:47 -0400 | [diff] [blame] | 430 | } |
| 431 | |
Dan Williams | 1ee6667 | 2016-06-23 17:50:39 -0700 | [diff] [blame] | 432 | if (align > nvdimm_namespace_capacity(ndns)) { |
Dan Williams | 315c562 | 2015-12-10 14:45:23 -0800 | [diff] [blame] | 433 | dev_err(&nd_pfn->dev, "alignment: %lx exceeds capacity %llx\n", |
Dan Williams | 1ee6667 | 2016-06-23 17:50:39 -0700 | [diff] [blame] | 434 | align, nvdimm_namespace_capacity(ndns)); |
Dan Williams | 315c562 | 2015-12-10 14:45:23 -0800 | [diff] [blame] | 435 | return -EINVAL; |
| 436 | } |
| 437 | |
Dan Williams | e145574 | 2015-07-30 17:57:47 -0400 | [diff] [blame] | 438 | /* |
| 439 | * These warnings are verbose because they can only trigger in |
| 440 | * the case where the physical address alignment of the |
| 441 | * namespace has changed since the pfn superblock was |
| 442 | * established. |
| 443 | */ |
Dan Williams | e145574 | 2015-07-30 17:57:47 -0400 | [diff] [blame] | 444 | nsio = to_nd_namespace_io(&ndns->dev); |
Dan Williams | 9f1e8ce | 2015-12-10 15:14:20 -0800 | [diff] [blame] | 445 | if (offset >= resource_size(&nsio->res)) { |
Dan Williams | e145574 | 2015-07-30 17:57:47 -0400 | [diff] [blame] | 446 | dev_err(&nd_pfn->dev, "pfn array size exceeds capacity of %s\n", |
| 447 | dev_name(&ndns->dev)); |
| 448 | return -EBUSY; |
| 449 | } |
| 450 | |
Dan Williams | 1ee6667 | 2016-06-23 17:50:39 -0700 | [diff] [blame] | 451 | if ((align && !IS_ALIGNED(offset, align)) |
Dan Williams | 5e24c9f | 2016-05-21 11:01:41 -0700 | [diff] [blame] | 452 | || !IS_ALIGNED(offset, PAGE_SIZE)) { |
Dan Williams | 1ee6667 | 2016-06-23 17:50:39 -0700 | [diff] [blame] | 453 | dev_err(&nd_pfn->dev, |
| 454 | "bad offset: %#llx dax disabled align: %#lx\n", |
| 455 | offset, align); |
Dan Williams | 315c562 | 2015-12-10 14:45:23 -0800 | [diff] [blame] | 456 | return -ENXIO; |
| 457 | } |
| 458 | |
Dan Williams | e145574 | 2015-07-30 17:57:47 -0400 | [diff] [blame] | 459 | return 0; |
| 460 | } |
Dan Williams | 32ab0a3f | 2015-08-01 02:16:37 -0400 | [diff] [blame] | 461 | EXPORT_SYMBOL(nd_pfn_validate); |
Dan Williams | e145574 | 2015-07-30 17:57:47 -0400 | [diff] [blame] | 462 | |
Dan Williams | 200c79d | 2016-03-22 00:22:16 -0700 | [diff] [blame] | 463 | int nd_pfn_probe(struct device *dev, struct nd_namespace_common *ndns) |
Dan Williams | e145574 | 2015-07-30 17:57:47 -0400 | [diff] [blame] | 464 | { |
| 465 | int rc; |
Dan Williams | e145574 | 2015-07-30 17:57:47 -0400 | [diff] [blame] | 466 | struct nd_pfn *nd_pfn; |
Dan Williams | bd03294 | 2016-03-17 18:16:15 -0700 | [diff] [blame] | 467 | struct device *pfn_dev; |
Dan Williams | e145574 | 2015-07-30 17:57:47 -0400 | [diff] [blame] | 468 | struct nd_pfn_sb *pfn_sb; |
| 469 | struct nd_region *nd_region = to_nd_region(ndns->dev.parent); |
| 470 | |
| 471 | if (ndns->force_raw) |
| 472 | return -ENODEV; |
| 473 | |
| 474 | nvdimm_bus_lock(&ndns->dev); |
Dan Williams | cd03412 | 2016-03-11 10:15:36 -0800 | [diff] [blame] | 475 | nd_pfn = nd_pfn_alloc(nd_region); |
| 476 | pfn_dev = nd_pfn_devinit(nd_pfn, ndns); |
Dan Williams | e145574 | 2015-07-30 17:57:47 -0400 | [diff] [blame] | 477 | nvdimm_bus_unlock(&ndns->dev); |
Dan Williams | bd03294 | 2016-03-17 18:16:15 -0700 | [diff] [blame] | 478 | if (!pfn_dev) |
Dan Williams | e145574 | 2015-07-30 17:57:47 -0400 | [diff] [blame] | 479 | return -ENOMEM; |
Dan Williams | bd03294 | 2016-03-17 18:16:15 -0700 | [diff] [blame] | 480 | pfn_sb = devm_kzalloc(dev, sizeof(*pfn_sb), GFP_KERNEL); |
| 481 | nd_pfn = to_nd_pfn(pfn_dev); |
Dan Williams | e145574 | 2015-07-30 17:57:47 -0400 | [diff] [blame] | 482 | nd_pfn->pfn_sb = pfn_sb; |
Dan Williams | c5ed926 | 2016-05-18 14:50:12 -0700 | [diff] [blame] | 483 | rc = nd_pfn_validate(nd_pfn, PFN_SIG); |
Dan Williams | bd03294 | 2016-03-17 18:16:15 -0700 | [diff] [blame] | 484 | dev_dbg(dev, "%s: pfn: %s\n", __func__, |
| 485 | rc == 0 ? dev_name(pfn_dev) : "<none>"); |
Dan Williams | e145574 | 2015-07-30 17:57:47 -0400 | [diff] [blame] | 486 | if (rc < 0) { |
Dan Williams | bd03294 | 2016-03-17 18:16:15 -0700 | [diff] [blame] | 487 | __nd_detach_ndns(pfn_dev, &nd_pfn->ndns); |
| 488 | put_device(pfn_dev); |
Dan Williams | e145574 | 2015-07-30 17:57:47 -0400 | [diff] [blame] | 489 | } else |
Dan Williams | bd03294 | 2016-03-17 18:16:15 -0700 | [diff] [blame] | 490 | __nd_device_register(pfn_dev); |
Dan Williams | e145574 | 2015-07-30 17:57:47 -0400 | [diff] [blame] | 491 | |
| 492 | return rc; |
| 493 | } |
| 494 | EXPORT_SYMBOL(nd_pfn_probe); |
Dan Williams | ac515c0 | 2016-03-22 00:29:43 -0700 | [diff] [blame] | 495 | |
| 496 | /* |
| 497 | * We hotplug memory at section granularity, pad the reserved area from |
| 498 | * the previous section base to the namespace base address. |
| 499 | */ |
| 500 | static unsigned long init_altmap_base(resource_size_t base) |
| 501 | { |
| 502 | unsigned long base_pfn = PHYS_PFN(base); |
| 503 | |
| 504 | return PFN_SECTION_ALIGN_DOWN(base_pfn); |
| 505 | } |
| 506 | |
| 507 | static unsigned long init_altmap_reserve(resource_size_t base) |
| 508 | { |
| 509 | unsigned long reserve = PHYS_PFN(SZ_8K); |
| 510 | unsigned long base_pfn = PHYS_PFN(base); |
| 511 | |
| 512 | reserve += base_pfn - PFN_SECTION_ALIGN_DOWN(base_pfn); |
| 513 | return reserve; |
| 514 | } |
| 515 | |
| 516 | static struct vmem_altmap *__nvdimm_setup_pfn(struct nd_pfn *nd_pfn, |
| 517 | struct resource *res, struct vmem_altmap *altmap) |
| 518 | { |
| 519 | struct nd_pfn_sb *pfn_sb = nd_pfn->pfn_sb; |
| 520 | u64 offset = le64_to_cpu(pfn_sb->dataoff); |
| 521 | u32 start_pad = __le32_to_cpu(pfn_sb->start_pad); |
| 522 | u32 end_trunc = __le32_to_cpu(pfn_sb->end_trunc); |
| 523 | struct nd_namespace_common *ndns = nd_pfn->ndns; |
| 524 | struct nd_namespace_io *nsio = to_nd_namespace_io(&ndns->dev); |
| 525 | resource_size_t base = nsio->res.start + start_pad; |
| 526 | struct vmem_altmap __altmap = { |
| 527 | .base_pfn = init_altmap_base(base), |
| 528 | .reserve = init_altmap_reserve(base), |
| 529 | }; |
| 530 | |
| 531 | memcpy(res, &nsio->res, sizeof(*res)); |
| 532 | res->start += start_pad; |
| 533 | res->end -= end_trunc; |
| 534 | |
Dan Williams | ac515c0 | 2016-03-22 00:29:43 -0700 | [diff] [blame] | 535 | if (nd_pfn->mode == PFN_MODE_RAM) { |
| 536 | if (offset < SZ_8K) |
| 537 | return ERR_PTR(-EINVAL); |
| 538 | nd_pfn->npfns = le64_to_cpu(pfn_sb->npfns); |
| 539 | altmap = NULL; |
| 540 | } else if (nd_pfn->mode == PFN_MODE_PMEM) { |
| 541 | nd_pfn->npfns = (resource_size(res) - offset) / PAGE_SIZE; |
| 542 | if (le64_to_cpu(nd_pfn->pfn_sb->npfns) > nd_pfn->npfns) |
| 543 | dev_info(&nd_pfn->dev, |
| 544 | "number of pfns truncated from %lld to %ld\n", |
| 545 | le64_to_cpu(nd_pfn->pfn_sb->npfns), |
| 546 | nd_pfn->npfns); |
| 547 | memcpy(altmap, &__altmap, sizeof(*altmap)); |
| 548 | altmap->free = PHYS_PFN(offset - SZ_8K); |
| 549 | altmap->alloc = 0; |
| 550 | } else |
| 551 | return ERR_PTR(-ENXIO); |
| 552 | |
| 553 | return altmap; |
| 554 | } |
| 555 | |
| 556 | static int nd_pfn_init(struct nd_pfn *nd_pfn) |
| 557 | { |
Dan Williams | 52ac23b | 2016-03-31 09:37:11 -0700 | [diff] [blame] | 558 | u32 dax_label_reserve = is_nd_dax(&nd_pfn->dev) ? SZ_128K : 0; |
Dan Williams | ac515c0 | 2016-03-22 00:29:43 -0700 | [diff] [blame] | 559 | struct nd_namespace_common *ndns = nd_pfn->ndns; |
| 560 | u32 start_pad = 0, end_trunc = 0; |
| 561 | resource_size_t start, size; |
| 562 | struct nd_namespace_io *nsio; |
| 563 | struct nd_region *nd_region; |
| 564 | struct nd_pfn_sb *pfn_sb; |
| 565 | unsigned long npfns; |
| 566 | phys_addr_t offset; |
Dan Williams | c5ed926 | 2016-05-18 14:50:12 -0700 | [diff] [blame] | 567 | const char *sig; |
Dan Williams | ac515c0 | 2016-03-22 00:29:43 -0700 | [diff] [blame] | 568 | u64 checksum; |
| 569 | int rc; |
| 570 | |
| 571 | pfn_sb = devm_kzalloc(&nd_pfn->dev, sizeof(*pfn_sb), GFP_KERNEL); |
| 572 | if (!pfn_sb) |
| 573 | return -ENOMEM; |
| 574 | |
| 575 | nd_pfn->pfn_sb = pfn_sb; |
Dan Williams | c5ed926 | 2016-05-18 14:50:12 -0700 | [diff] [blame] | 576 | if (is_nd_dax(&nd_pfn->dev)) |
| 577 | sig = DAX_SIG; |
| 578 | else |
| 579 | sig = PFN_SIG; |
| 580 | rc = nd_pfn_validate(nd_pfn, sig); |
Dan Williams | ac515c0 | 2016-03-22 00:29:43 -0700 | [diff] [blame] | 581 | if (rc != -ENODEV) |
| 582 | return rc; |
| 583 | |
| 584 | /* no info block, do init */; |
| 585 | nd_region = to_nd_region(nd_pfn->dev.parent); |
| 586 | if (nd_region->ro) { |
| 587 | dev_info(&nd_pfn->dev, |
| 588 | "%s is read-only, unable to init metadata\n", |
| 589 | dev_name(&nd_region->dev)); |
| 590 | return -ENXIO; |
| 591 | } |
| 592 | |
| 593 | memset(pfn_sb, 0, sizeof(*pfn_sb)); |
| 594 | |
| 595 | /* |
| 596 | * Check if pmem collides with 'System RAM' when section aligned and |
| 597 | * trim it accordingly |
| 598 | */ |
| 599 | nsio = to_nd_namespace_io(&ndns->dev); |
| 600 | start = PHYS_SECTION_ALIGN_DOWN(nsio->res.start); |
| 601 | size = resource_size(&nsio->res); |
| 602 | if (region_intersects(start, size, IORESOURCE_SYSTEM_RAM, |
| 603 | IORES_DESC_NONE) == REGION_MIXED) { |
| 604 | start = nsio->res.start; |
| 605 | start_pad = PHYS_SECTION_ALIGN_UP(start) - start; |
| 606 | } |
| 607 | |
| 608 | start = nsio->res.start; |
| 609 | size = PHYS_SECTION_ALIGN_UP(start + size) - start; |
| 610 | if (region_intersects(start, size, IORESOURCE_SYSTEM_RAM, |
| 611 | IORES_DESC_NONE) == REGION_MIXED) { |
| 612 | size = resource_size(&nsio->res); |
| 613 | end_trunc = start + size - PHYS_SECTION_ALIGN_DOWN(start + size); |
| 614 | } |
| 615 | |
| 616 | if (start_pad + end_trunc) |
| 617 | dev_info(&nd_pfn->dev, "%s section collision, truncate %d bytes\n", |
| 618 | dev_name(&ndns->dev), start_pad + end_trunc); |
| 619 | |
| 620 | /* |
| 621 | * Note, we use 64 here for the standard size of struct page, |
| 622 | * debugging options may cause it to be larger in which case the |
| 623 | * implementation will limit the pfns advertised through |
| 624 | * ->direct_access() to those that are included in the memmap. |
| 625 | */ |
| 626 | start += start_pad; |
| 627 | size = resource_size(&nsio->res); |
| 628 | npfns = (size - start_pad - end_trunc - SZ_8K) / SZ_4K; |
Dan Williams | 594d6d9 | 2016-05-18 09:59:34 -0700 | [diff] [blame] | 629 | if (nd_pfn->mode == PFN_MODE_PMEM) { |
| 630 | unsigned long memmap_size; |
| 631 | |
| 632 | /* |
| 633 | * vmemmap_populate_hugepages() allocates the memmap array in |
| 634 | * HPAGE_SIZE chunks. |
| 635 | */ |
| 636 | memmap_size = ALIGN(64 * npfns, HPAGE_SIZE); |
| 637 | offset = ALIGN(start + SZ_8K + memmap_size + dax_label_reserve, |
Dan Williams | 52ac23b | 2016-03-31 09:37:11 -0700 | [diff] [blame] | 638 | nd_pfn->align) - start; |
Dan Williams | 594d6d9 | 2016-05-18 09:59:34 -0700 | [diff] [blame] | 639 | } else if (nd_pfn->mode == PFN_MODE_RAM) |
Dan Williams | 52ac23b | 2016-03-31 09:37:11 -0700 | [diff] [blame] | 640 | offset = ALIGN(start + SZ_8K + dax_label_reserve, |
| 641 | nd_pfn->align) - start; |
Dan Williams | ac515c0 | 2016-03-22 00:29:43 -0700 | [diff] [blame] | 642 | else |
| 643 | return -ENXIO; |
| 644 | |
| 645 | if (offset + start_pad + end_trunc >= size) { |
| 646 | dev_err(&nd_pfn->dev, "%s unable to satisfy requested alignment\n", |
| 647 | dev_name(&ndns->dev)); |
| 648 | return -ENXIO; |
| 649 | } |
| 650 | |
| 651 | npfns = (size - offset - start_pad - end_trunc) / SZ_4K; |
| 652 | pfn_sb->mode = cpu_to_le32(nd_pfn->mode); |
| 653 | pfn_sb->dataoff = cpu_to_le64(offset); |
| 654 | pfn_sb->npfns = cpu_to_le64(npfns); |
Dan Williams | c5ed926 | 2016-05-18 14:50:12 -0700 | [diff] [blame] | 655 | memcpy(pfn_sb->signature, sig, PFN_SIG_LEN); |
Dan Williams | ac515c0 | 2016-03-22 00:29:43 -0700 | [diff] [blame] | 656 | memcpy(pfn_sb->uuid, nd_pfn->uuid, 16); |
| 657 | memcpy(pfn_sb->parent_uuid, nd_dev_to_uuid(&ndns->dev), 16); |
| 658 | pfn_sb->version_major = cpu_to_le16(1); |
Dan Williams | 45a0dac | 2016-03-31 15:41:18 -0700 | [diff] [blame] | 659 | pfn_sb->version_minor = cpu_to_le16(2); |
Dan Williams | ac515c0 | 2016-03-22 00:29:43 -0700 | [diff] [blame] | 660 | pfn_sb->start_pad = cpu_to_le32(start_pad); |
| 661 | pfn_sb->end_trunc = cpu_to_le32(end_trunc); |
Dan Williams | 45a0dac | 2016-03-31 15:41:18 -0700 | [diff] [blame] | 662 | pfn_sb->align = cpu_to_le32(nd_pfn->align); |
Dan Williams | ac515c0 | 2016-03-22 00:29:43 -0700 | [diff] [blame] | 663 | checksum = nd_sb_checksum((struct nd_gen_sb *) pfn_sb); |
| 664 | pfn_sb->checksum = cpu_to_le64(checksum); |
| 665 | |
| 666 | return nvdimm_write_bytes(ndns, SZ_4K, pfn_sb, sizeof(*pfn_sb)); |
| 667 | } |
| 668 | |
| 669 | /* |
| 670 | * Determine the effective resource range and vmem_altmap from an nd_pfn |
| 671 | * instance. |
| 672 | */ |
| 673 | struct vmem_altmap *nvdimm_setup_pfn(struct nd_pfn *nd_pfn, |
| 674 | struct resource *res, struct vmem_altmap *altmap) |
| 675 | { |
| 676 | int rc; |
| 677 | |
| 678 | if (!nd_pfn->uuid || !nd_pfn->ndns) |
| 679 | return ERR_PTR(-ENODEV); |
| 680 | |
| 681 | rc = nd_pfn_init(nd_pfn); |
| 682 | if (rc) |
| 683 | return ERR_PTR(rc); |
| 684 | |
| 685 | /* we need a valid pfn_sb before we can init a vmem_altmap */ |
| 686 | return __nvdimm_setup_pfn(nd_pfn, res, altmap); |
| 687 | } |
| 688 | EXPORT_SYMBOL_GPL(nvdimm_setup_pfn); |