1
2
3
4
5#include <linux/libnvdimm.h>
6#include <linux/badblocks.h>
7#include <linux/export.h>
8#include <linux/module.h>
9#include <linux/blkdev.h>
10#include <linux/device.h>
11#include <linux/ctype.h>
12#include <linux/ndctl.h>
13#include <linux/mutex.h>
14#include <linux/slab.h>
15#include <linux/io.h>
16#include "nd-core.h"
17#include "nd.h"
18
19LIST_HEAD(nvdimm_bus_list);
20DEFINE_MUTEX(nvdimm_bus_list_mutex);
21
22void nvdimm_bus_lock(struct device *dev)
23{
24 struct nvdimm_bus *nvdimm_bus = walk_to_nvdimm_bus(dev);
25
26 if (!nvdimm_bus)
27 return;
28 mutex_lock(&nvdimm_bus->reconfig_mutex);
29}
30EXPORT_SYMBOL(nvdimm_bus_lock);
31
32void nvdimm_bus_unlock(struct device *dev)
33{
34 struct nvdimm_bus *nvdimm_bus = walk_to_nvdimm_bus(dev);
35
36 if (!nvdimm_bus)
37 return;
38 mutex_unlock(&nvdimm_bus->reconfig_mutex);
39}
40EXPORT_SYMBOL(nvdimm_bus_unlock);
41
42bool is_nvdimm_bus_locked(struct device *dev)
43{
44 struct nvdimm_bus *nvdimm_bus = walk_to_nvdimm_bus(dev);
45
46 if (!nvdimm_bus)
47 return false;
48 return mutex_is_locked(&nvdimm_bus->reconfig_mutex);
49}
50EXPORT_SYMBOL(is_nvdimm_bus_locked);
51
52struct nvdimm_map {
53 struct nvdimm_bus *nvdimm_bus;
54 struct list_head list;
55 resource_size_t offset;
56 unsigned long flags;
57 size_t size;
58 union {
59 void *mem;
60 void __iomem *iomem;
61 };
62 struct kref kref;
63};
64
65static struct nvdimm_map *find_nvdimm_map(struct device *dev,
66 resource_size_t offset)
67{
68 struct nvdimm_bus *nvdimm_bus = walk_to_nvdimm_bus(dev);
69 struct nvdimm_map *nvdimm_map;
70
71 list_for_each_entry(nvdimm_map, &nvdimm_bus->mapping_list, list)
72 if (nvdimm_map->offset == offset)
73 return nvdimm_map;
74 return NULL;
75}
76
77static struct nvdimm_map *alloc_nvdimm_map(struct device *dev,
78 resource_size_t offset, size_t size, unsigned long flags)
79{
80 struct nvdimm_bus *nvdimm_bus = walk_to_nvdimm_bus(dev);
81 struct nvdimm_map *nvdimm_map;
82
83 nvdimm_map = kzalloc(sizeof(*nvdimm_map), GFP_KERNEL);
84 if (!nvdimm_map)
85 return NULL;
86
87 INIT_LIST_HEAD(&nvdimm_map->list);
88 nvdimm_map->nvdimm_bus = nvdimm_bus;
89 nvdimm_map->offset = offset;
90 nvdimm_map->flags = flags;
91 nvdimm_map->size = size;
92 kref_init(&nvdimm_map->kref);
93
94 if (!request_mem_region(offset, size, dev_name(&nvdimm_bus->dev))) {
95 dev_err(&nvdimm_bus->dev, "failed to request %pa + %zd for %s\n",
96 &offset, size, dev_name(dev));
97 goto err_request_region;
98 }
99
100 if (flags)
101 nvdimm_map->mem = memremap(offset, size, flags);
102 else
103 nvdimm_map->iomem = ioremap(offset, size);
104
105 if (!nvdimm_map->mem)
106 goto err_map;
107
108 dev_WARN_ONCE(dev, !is_nvdimm_bus_locked(dev), "%s: bus unlocked!",
109 __func__);
110 list_add(&nvdimm_map->list, &nvdimm_bus->mapping_list);
111
112 return nvdimm_map;
113
114 err_map:
115 release_mem_region(offset, size);
116 err_request_region:
117 kfree(nvdimm_map);
118 return NULL;
119}
120
121static void nvdimm_map_release(struct kref *kref)
122{
123 struct nvdimm_bus *nvdimm_bus;
124 struct nvdimm_map *nvdimm_map;
125
126 nvdimm_map = container_of(kref, struct nvdimm_map, kref);
127 nvdimm_bus = nvdimm_map->nvdimm_bus;
128
129 dev_dbg(&nvdimm_bus->dev, "%pa\n", &nvdimm_map->offset);
130 list_del(&nvdimm_map->list);
131 if (nvdimm_map->flags)
132 memunmap(nvdimm_map->mem);
133 else
134 iounmap(nvdimm_map->iomem);
135 release_mem_region(nvdimm_map->offset, nvdimm_map->size);
136 kfree(nvdimm_map);
137}
138
139static void nvdimm_map_put(void *data)
140{
141 struct nvdimm_map *nvdimm_map = data;
142 struct nvdimm_bus *nvdimm_bus = nvdimm_map->nvdimm_bus;
143
144 nvdimm_bus_lock(&nvdimm_bus->dev);
145 kref_put(&nvdimm_map->kref, nvdimm_map_release);
146 nvdimm_bus_unlock(&nvdimm_bus->dev);
147}
148
149
150
151
152
153
154
155
156void *devm_nvdimm_memremap(struct device *dev, resource_size_t offset,
157 size_t size, unsigned long flags)
158{
159 struct nvdimm_map *nvdimm_map;
160
161 nvdimm_bus_lock(dev);
162 nvdimm_map = find_nvdimm_map(dev, offset);
163 if (!nvdimm_map)
164 nvdimm_map = alloc_nvdimm_map(dev, offset, size, flags);
165 else
166 kref_get(&nvdimm_map->kref);
167 nvdimm_bus_unlock(dev);
168
169 if (!nvdimm_map)
170 return NULL;
171
172 if (devm_add_action_or_reset(dev, nvdimm_map_put, nvdimm_map))
173 return NULL;
174
175 return nvdimm_map->mem;
176}
177EXPORT_SYMBOL_GPL(devm_nvdimm_memremap);
178
179u64 nd_fletcher64(void *addr, size_t len, bool le)
180{
181 u32 *buf = addr;
182 u32 lo32 = 0;
183 u64 hi32 = 0;
184 int i;
185
186 for (i = 0; i < len / sizeof(u32); i++) {
187 lo32 += le ? le32_to_cpu((__le32) buf[i]) : buf[i];
188 hi32 += lo32;
189 }
190
191 return hi32 << 32 | lo32;
192}
193EXPORT_SYMBOL_GPL(nd_fletcher64);
194
195struct nvdimm_bus_descriptor *to_nd_desc(struct nvdimm_bus *nvdimm_bus)
196{
197
198 return nvdimm_bus->nd_desc;
199}
200EXPORT_SYMBOL_GPL(to_nd_desc);
201
202struct device *to_nvdimm_bus_dev(struct nvdimm_bus *nvdimm_bus)
203{
204
205 return &nvdimm_bus->dev;
206}
207EXPORT_SYMBOL_GPL(to_nvdimm_bus_dev);
208
209static bool is_uuid_sep(char sep)
210{
211 if (sep == '\n' || sep == '-' || sep == ':' || sep == '\0')
212 return true;
213 return false;
214}
215
216static int nd_uuid_parse(struct device *dev, u8 *uuid_out, const char *buf,
217 size_t len)
218{
219 const char *str = buf;
220 u8 uuid[16];
221 int i;
222
223 for (i = 0; i < 16; i++) {
224 if (!isxdigit(str[0]) || !isxdigit(str[1])) {
225 dev_dbg(dev, "pos: %d buf[%zd]: %c buf[%zd]: %c\n",
226 i, str - buf, str[0],
227 str + 1 - buf, str[1]);
228 return -EINVAL;
229 }
230
231 uuid[i] = (hex_to_bin(str[0]) << 4) | hex_to_bin(str[1]);
232 str += 2;
233 if (is_uuid_sep(*str))
234 str++;
235 }
236
237 memcpy(uuid_out, uuid, sizeof(uuid));
238 return 0;
239}
240
241
242
243
244
245
246
247
248
249
250
251int nd_uuid_store(struct device *dev, u8 **uuid_out, const char *buf,
252 size_t len)
253{
254 u8 uuid[16];
255 int rc;
256
257 if (dev->driver)
258 return -EBUSY;
259
260 rc = nd_uuid_parse(dev, uuid, buf, len);
261 if (rc)
262 return rc;
263
264 kfree(*uuid_out);
265 *uuid_out = kmemdup(uuid, sizeof(uuid), GFP_KERNEL);
266 if (!(*uuid_out))
267 return -ENOMEM;
268
269 return 0;
270}
271
272ssize_t nd_size_select_show(unsigned long current_size,
273 const unsigned long *supported, char *buf)
274{
275 ssize_t len = 0;
276 int i;
277
278 for (i = 0; supported[i]; i++)
279 if (current_size == supported[i])
280 len += sprintf(buf + len, "[%ld] ", supported[i]);
281 else
282 len += sprintf(buf + len, "%ld ", supported[i]);
283 len += sprintf(buf + len, "\n");
284 return len;
285}
286
287ssize_t nd_size_select_store(struct device *dev, const char *buf,
288 unsigned long *current_size, const unsigned long *supported)
289{
290 unsigned long lbasize;
291 int rc, i;
292
293 if (dev->driver)
294 return -EBUSY;
295
296 rc = kstrtoul(buf, 0, &lbasize);
297 if (rc)
298 return rc;
299
300 for (i = 0; supported[i]; i++)
301 if (lbasize == supported[i])
302 break;
303
304 if (supported[i]) {
305 *current_size = lbasize;
306 return 0;
307 } else {
308 return -EINVAL;
309 }
310}
311
312static ssize_t commands_show(struct device *dev,
313 struct device_attribute *attr, char *buf)
314{
315 int cmd, len = 0;
316 struct nvdimm_bus *nvdimm_bus = to_nvdimm_bus(dev);
317 struct nvdimm_bus_descriptor *nd_desc = nvdimm_bus->nd_desc;
318
319 for_each_set_bit(cmd, &nd_desc->cmd_mask, BITS_PER_LONG)
320 len += sprintf(buf + len, "%s ", nvdimm_bus_cmd_name(cmd));
321 len += sprintf(buf + len, "\n");
322 return len;
323}
324static DEVICE_ATTR_RO(commands);
325
326static const char *nvdimm_bus_provider(struct nvdimm_bus *nvdimm_bus)
327{
328 struct nvdimm_bus_descriptor *nd_desc = nvdimm_bus->nd_desc;
329 struct device *parent = nvdimm_bus->dev.parent;
330
331 if (nd_desc->provider_name)
332 return nd_desc->provider_name;
333 else if (parent)
334 return dev_name(parent);
335 else
336 return "unknown";
337}
338
339static ssize_t provider_show(struct device *dev,
340 struct device_attribute *attr, char *buf)
341{
342 struct nvdimm_bus *nvdimm_bus = to_nvdimm_bus(dev);
343
344 return sprintf(buf, "%s\n", nvdimm_bus_provider(nvdimm_bus));
345}
346static DEVICE_ATTR_RO(provider);
347
348static int flush_namespaces(struct device *dev, void *data)
349{
350 nd_device_lock(dev);
351 nd_device_unlock(dev);
352 return 0;
353}
354
355static int flush_regions_dimms(struct device *dev, void *data)
356{
357 nd_device_lock(dev);
358 nd_device_unlock(dev);
359 device_for_each_child(dev, NULL, flush_namespaces);
360 return 0;
361}
362
363static ssize_t wait_probe_show(struct device *dev,
364 struct device_attribute *attr, char *buf)
365{
366 struct nvdimm_bus *nvdimm_bus = to_nvdimm_bus(dev);
367 struct nvdimm_bus_descriptor *nd_desc = nvdimm_bus->nd_desc;
368 int rc;
369
370 if (nd_desc->flush_probe) {
371 rc = nd_desc->flush_probe(nd_desc);
372 if (rc)
373 return rc;
374 }
375 nd_synchronize();
376 device_for_each_child(dev, NULL, flush_regions_dimms);
377 return sprintf(buf, "1\n");
378}
379static DEVICE_ATTR_RO(wait_probe);
380
381static struct attribute *nvdimm_bus_attributes[] = {
382 &dev_attr_commands.attr,
383 &dev_attr_wait_probe.attr,
384 &dev_attr_provider.attr,
385 NULL,
386};
387
388struct attribute_group nvdimm_bus_attribute_group = {
389 .attrs = nvdimm_bus_attributes,
390};
391EXPORT_SYMBOL_GPL(nvdimm_bus_attribute_group);
392
393int nvdimm_bus_add_badrange(struct nvdimm_bus *nvdimm_bus, u64 addr, u64 length)
394{
395 return badrange_add(&nvdimm_bus->badrange, addr, length);
396}
397EXPORT_SYMBOL_GPL(nvdimm_bus_add_badrange);
398
399#ifdef CONFIG_BLK_DEV_INTEGRITY
400int nd_integrity_init(struct gendisk *disk, unsigned long meta_size)
401{
402 struct blk_integrity bi;
403
404 if (meta_size == 0)
405 return 0;
406
407 memset(&bi, 0, sizeof(bi));
408
409 bi.tuple_size = meta_size;
410 bi.tag_size = meta_size;
411
412 blk_integrity_register(disk, &bi);
413 blk_queue_max_integrity_segments(disk->queue, 1);
414
415 return 0;
416}
417EXPORT_SYMBOL(nd_integrity_init);
418
419#else
420int nd_integrity_init(struct gendisk *disk, unsigned long meta_size)
421{
422 return 0;
423}
424EXPORT_SYMBOL(nd_integrity_init);
425
426#endif
427
428static __init int libnvdimm_init(void)
429{
430 int rc;
431
432 rc = nvdimm_bus_init();
433 if (rc)
434 return rc;
435 rc = nvdimm_init();
436 if (rc)
437 goto err_dimm;
438 rc = nd_region_init();
439 if (rc)
440 goto err_region;
441
442 nd_label_init();
443
444 return 0;
445 err_region:
446 nvdimm_exit();
447 err_dimm:
448 nvdimm_bus_exit();
449 return rc;
450}
451
452static __exit void libnvdimm_exit(void)
453{
454 WARN_ON(!list_empty(&nvdimm_bus_list));
455 nd_region_exit();
456 nvdimm_exit();
457 nvdimm_bus_exit();
458 nd_region_devs_exit();
459 nvdimm_devs_exit();
460}
461
462MODULE_LICENSE("GPL v2");
463MODULE_AUTHOR("Intel Corporation");
464subsys_initcall(libnvdimm_init);
465module_exit(libnvdimm_exit);
466