1 // SPDX-License-Identifier: GPL-2.0-only
2 /*
3  * Copyright(c) 2013-2015 Intel Corporation. All rights reserved.
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 
19 LIST_HEAD(nvdimm_bus_list);
20 DEFINE_MUTEX(nvdimm_bus_list_mutex);
21 
nvdimm_bus_lock(struct device * dev)22 void 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 }
30 EXPORT_SYMBOL(nvdimm_bus_lock);
31 
nvdimm_bus_unlock(struct device * dev)32 void 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 }
40 EXPORT_SYMBOL(nvdimm_bus_unlock);
41 
is_nvdimm_bus_locked(struct device * dev)42 bool 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 }
50 EXPORT_SYMBOL(is_nvdimm_bus_locked);
51 
52 struct 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 
find_nvdimm_map(struct device * dev,resource_size_t offset)65 static 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 
alloc_nvdimm_map(struct device * dev,resource_size_t offset,size_t size,unsigned long flags)77 static 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 
nvdimm_map_release(struct kref * kref)121 static 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 
nvdimm_map_put(void * data)139 static 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  * devm_nvdimm_memremap - map a resource that is shared across regions
151  * @dev: device that will own a reference to the shared mapping
152  * @offset: physical base address of the mapping
153  * @size: mapping size
154  * @flags: memremap flags, or, if zero, perform an ioremap instead
155  */
devm_nvdimm_memremap(struct device * dev,resource_size_t offset,size_t size,unsigned long flags)156 void *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 }
177 EXPORT_SYMBOL_GPL(devm_nvdimm_memremap);
178 
nd_fletcher64(void * addr,size_t len,bool le)179 u64 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 }
193 EXPORT_SYMBOL_GPL(nd_fletcher64);
194 
to_nd_desc(struct nvdimm_bus * nvdimm_bus)195 struct nvdimm_bus_descriptor *to_nd_desc(struct nvdimm_bus *nvdimm_bus)
196 {
197 	/* struct nvdimm_bus definition is private to libnvdimm */
198 	return nvdimm_bus->nd_desc;
199 }
200 EXPORT_SYMBOL_GPL(to_nd_desc);
201 
to_nvdimm_bus_dev(struct nvdimm_bus * nvdimm_bus)202 struct device *to_nvdimm_bus_dev(struct nvdimm_bus *nvdimm_bus)
203 {
204 	/* struct nvdimm_bus definition is private to libnvdimm */
205 	return &nvdimm_bus->dev;
206 }
207 EXPORT_SYMBOL_GPL(to_nvdimm_bus_dev);
208 
is_uuid_sep(char sep)209 static bool is_uuid_sep(char sep)
210 {
211 	if (sep == '\n' || sep == '-' || sep == ':' || sep == '\0')
212 		return true;
213 	return false;
214 }
215 
nd_uuid_parse(struct device * dev,u8 * uuid_out,const char * buf,size_t len)216 static 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  * nd_uuid_store: common implementation for writing 'uuid' sysfs attributes
243  * @dev: container device for the uuid property
244  * @uuid_out: uuid buffer to replace
245  * @buf: raw sysfs buffer to parse
246  *
247  * Enforce that uuids can only be changed while the device is disabled
248  * (driver detached)
249  * LOCKING: expects nd_device_lock() is held on entry
250  */
nd_uuid_store(struct device * dev,u8 ** uuid_out,const char * buf,size_t len)251 int 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 
nd_size_select_show(unsigned long current_size,const unsigned long * supported,char * buf)272 ssize_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 
nd_size_select_store(struct device * dev,const char * buf,unsigned long * current_size,const unsigned long * supported)287 ssize_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 
commands_show(struct device * dev,struct device_attribute * attr,char * buf)312 static 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 }
324 static DEVICE_ATTR_RO(commands);
325 
nvdimm_bus_provider(struct nvdimm_bus * nvdimm_bus)326 static 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 
provider_show(struct device * dev,struct device_attribute * attr,char * buf)339 static 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 }
346 static DEVICE_ATTR_RO(provider);
347 
flush_namespaces(struct device * dev,void * data)348 static int flush_namespaces(struct device *dev, void *data)
349 {
350 	nd_device_lock(dev);
351 	nd_device_unlock(dev);
352 	return 0;
353 }
354 
flush_regions_dimms(struct device * dev,void * data)355 static 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 
wait_probe_show(struct device * dev,struct device_attribute * attr,char * buf)363 static 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 }
379 static DEVICE_ATTR_RO(wait_probe);
380 
381 static 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 
388 struct attribute_group nvdimm_bus_attribute_group = {
389 	.attrs = nvdimm_bus_attributes,
390 };
391 EXPORT_SYMBOL_GPL(nvdimm_bus_attribute_group);
392 
nvdimm_bus_add_badrange(struct nvdimm_bus * nvdimm_bus,u64 addr,u64 length)393 int nvdimm_bus_add_badrange(struct nvdimm_bus *nvdimm_bus, u64 addr, u64 length)
394 {
395 	return badrange_add(&nvdimm_bus->badrange, addr, length);
396 }
397 EXPORT_SYMBOL_GPL(nvdimm_bus_add_badrange);
398 
399 #ifdef CONFIG_BLK_DEV_INTEGRITY
nd_integrity_init(struct gendisk * disk,unsigned long meta_size)400 int 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 }
417 EXPORT_SYMBOL(nd_integrity_init);
418 
419 #else /* CONFIG_BLK_DEV_INTEGRITY */
nd_integrity_init(struct gendisk * disk,unsigned long meta_size)420 int nd_integrity_init(struct gendisk *disk, unsigned long meta_size)
421 {
422 	return 0;
423 }
424 EXPORT_SYMBOL(nd_integrity_init);
425 
426 #endif
427 
libnvdimm_init(void)428 static __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 
libnvdimm_exit(void)452 static __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 
462 MODULE_LICENSE("GPL v2");
463 MODULE_AUTHOR("Intel Corporation");
464 subsys_initcall(libnvdimm_init);
465 module_exit(libnvdimm_exit);
466