Linux Audio

Check our new training course

Loading...
v5.9
  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/suspend.h>
  8#include <linux/export.h>
  9#include <linux/module.h>
 10#include <linux/blkdev.h>
 11#include <linux/device.h>
 12#include <linux/ctype.h>
 13#include <linux/ndctl.h>
 14#include <linux/mutex.h>
 15#include <linux/slab.h>
 16#include <linux/io.h>
 17#include "nd-core.h"
 18#include "nd.h"
 19
 20LIST_HEAD(nvdimm_bus_list);
 21DEFINE_MUTEX(nvdimm_bus_list_mutex);
 22
 23void nvdimm_bus_lock(struct device *dev)
 24{
 25	struct nvdimm_bus *nvdimm_bus = walk_to_nvdimm_bus(dev);
 26
 27	if (!nvdimm_bus)
 28		return;
 29	mutex_lock(&nvdimm_bus->reconfig_mutex);
 30}
 31EXPORT_SYMBOL(nvdimm_bus_lock);
 32
 33void nvdimm_bus_unlock(struct device *dev)
 34{
 35	struct nvdimm_bus *nvdimm_bus = walk_to_nvdimm_bus(dev);
 36
 37	if (!nvdimm_bus)
 38		return;
 39	mutex_unlock(&nvdimm_bus->reconfig_mutex);
 40}
 41EXPORT_SYMBOL(nvdimm_bus_unlock);
 42
 43bool is_nvdimm_bus_locked(struct device *dev)
 44{
 45	struct nvdimm_bus *nvdimm_bus = walk_to_nvdimm_bus(dev);
 46
 47	if (!nvdimm_bus)
 48		return false;
 49	return mutex_is_locked(&nvdimm_bus->reconfig_mutex);
 50}
 51EXPORT_SYMBOL(is_nvdimm_bus_locked);
 52
 53struct nvdimm_map {
 54	struct nvdimm_bus *nvdimm_bus;
 55	struct list_head list;
 56	resource_size_t offset;
 57	unsigned long flags;
 58	size_t size;
 59	union {
 60		void *mem;
 61		void __iomem *iomem;
 62	};
 63	struct kref kref;
 64};
 65
 66static struct nvdimm_map *find_nvdimm_map(struct device *dev,
 67		resource_size_t offset)
 68{
 69	struct nvdimm_bus *nvdimm_bus = walk_to_nvdimm_bus(dev);
 70	struct nvdimm_map *nvdimm_map;
 71
 72	list_for_each_entry(nvdimm_map, &nvdimm_bus->mapping_list, list)
 73		if (nvdimm_map->offset == offset)
 74			return nvdimm_map;
 75	return NULL;
 76}
 77
 78static struct nvdimm_map *alloc_nvdimm_map(struct device *dev,
 79		resource_size_t offset, size_t size, unsigned long flags)
 80{
 81	struct nvdimm_bus *nvdimm_bus = walk_to_nvdimm_bus(dev);
 82	struct nvdimm_map *nvdimm_map;
 83
 84	nvdimm_map = kzalloc(sizeof(*nvdimm_map), GFP_KERNEL);
 85	if (!nvdimm_map)
 86		return NULL;
 87
 88	INIT_LIST_HEAD(&nvdimm_map->list);
 89	nvdimm_map->nvdimm_bus = nvdimm_bus;
 90	nvdimm_map->offset = offset;
 91	nvdimm_map->flags = flags;
 92	nvdimm_map->size = size;
 93	kref_init(&nvdimm_map->kref);
 94
 95	if (!request_mem_region(offset, size, dev_name(&nvdimm_bus->dev))) {
 96		dev_err(&nvdimm_bus->dev, "failed to request %pa + %zd for %s\n",
 97				&offset, size, dev_name(dev));
 98		goto err_request_region;
 99	}
100
101	if (flags)
102		nvdimm_map->mem = memremap(offset, size, flags);
103	else
104		nvdimm_map->iomem = ioremap(offset, size);
105
106	if (!nvdimm_map->mem)
107		goto err_map;
108
109	dev_WARN_ONCE(dev, !is_nvdimm_bus_locked(dev), "%s: bus unlocked!",
110			__func__);
111	list_add(&nvdimm_map->list, &nvdimm_bus->mapping_list);
112
113	return nvdimm_map;
114
115 err_map:
116	release_mem_region(offset, size);
117 err_request_region:
118	kfree(nvdimm_map);
119	return NULL;
120}
121
122static void nvdimm_map_release(struct kref *kref)
123{
124	struct nvdimm_bus *nvdimm_bus;
125	struct nvdimm_map *nvdimm_map;
126
127	nvdimm_map = container_of(kref, struct nvdimm_map, kref);
128	nvdimm_bus = nvdimm_map->nvdimm_bus;
129
130	dev_dbg(&nvdimm_bus->dev, "%pa\n", &nvdimm_map->offset);
131	list_del(&nvdimm_map->list);
132	if (nvdimm_map->flags)
133		memunmap(nvdimm_map->mem);
134	else
135		iounmap(nvdimm_map->iomem);
136	release_mem_region(nvdimm_map->offset, nvdimm_map->size);
137	kfree(nvdimm_map);
138}
139
140static void nvdimm_map_put(void *data)
141{
142	struct nvdimm_map *nvdimm_map = data;
143	struct nvdimm_bus *nvdimm_bus = nvdimm_map->nvdimm_bus;
144
145	nvdimm_bus_lock(&nvdimm_bus->dev);
146	kref_put(&nvdimm_map->kref, nvdimm_map_release);
147	nvdimm_bus_unlock(&nvdimm_bus->dev);
148}
149
150/**
151 * devm_nvdimm_memremap - map a resource that is shared across regions
152 * @dev: device that will own a reference to the shared mapping
153 * @offset: physical base address of the mapping
154 * @size: mapping size
155 * @flags: memremap flags, or, if zero, perform an ioremap instead
156 */
157void *devm_nvdimm_memremap(struct device *dev, resource_size_t offset,
158		size_t size, unsigned long flags)
159{
160	struct nvdimm_map *nvdimm_map;
161
162	nvdimm_bus_lock(dev);
163	nvdimm_map = find_nvdimm_map(dev, offset);
164	if (!nvdimm_map)
165		nvdimm_map = alloc_nvdimm_map(dev, offset, size, flags);
166	else
167		kref_get(&nvdimm_map->kref);
168	nvdimm_bus_unlock(dev);
169
170	if (!nvdimm_map)
171		return NULL;
172
173	if (devm_add_action_or_reset(dev, nvdimm_map_put, nvdimm_map))
174		return NULL;
175
176	return nvdimm_map->mem;
177}
178EXPORT_SYMBOL_GPL(devm_nvdimm_memremap);
179
180u64 nd_fletcher64(void *addr, size_t len, bool le)
181{
182	u32 *buf = addr;
183	u32 lo32 = 0;
184	u64 hi32 = 0;
185	int i;
186
187	for (i = 0; i < len / sizeof(u32); i++) {
188		lo32 += le ? le32_to_cpu((__le32) buf[i]) : buf[i];
189		hi32 += lo32;
190	}
191
192	return hi32 << 32 | lo32;
193}
194EXPORT_SYMBOL_GPL(nd_fletcher64);
195
196struct nvdimm_bus_descriptor *to_nd_desc(struct nvdimm_bus *nvdimm_bus)
197{
198	/* struct nvdimm_bus definition is private to libnvdimm */
199	return nvdimm_bus->nd_desc;
200}
201EXPORT_SYMBOL_GPL(to_nd_desc);
202
203struct device *to_nvdimm_bus_dev(struct nvdimm_bus *nvdimm_bus)
204{
205	/* struct nvdimm_bus definition is private to libnvdimm */
206	return &nvdimm_bus->dev;
207}
208EXPORT_SYMBOL_GPL(to_nvdimm_bus_dev);
209
210static bool is_uuid_sep(char sep)
211{
212	if (sep == '\n' || sep == '-' || sep == ':' || sep == '\0')
213		return true;
214	return false;
215}
216
217static int nd_uuid_parse(struct device *dev, u8 *uuid_out, const char *buf,
218		size_t len)
219{
220	const char *str = buf;
221	u8 uuid[16];
222	int i;
223
224	for (i = 0; i < 16; i++) {
225		if (!isxdigit(str[0]) || !isxdigit(str[1])) {
226			dev_dbg(dev, "pos: %d buf[%zd]: %c buf[%zd]: %c\n",
227					i, str - buf, str[0],
228					str + 1 - buf, str[1]);
229			return -EINVAL;
230		}
231
232		uuid[i] = (hex_to_bin(str[0]) << 4) | hex_to_bin(str[1]);
233		str += 2;
234		if (is_uuid_sep(*str))
235			str++;
236	}
237
238	memcpy(uuid_out, uuid, sizeof(uuid));
239	return 0;
240}
241
242/**
243 * nd_uuid_store: common implementation for writing 'uuid' sysfs attributes
244 * @dev: container device for the uuid property
245 * @uuid_out: uuid buffer to replace
246 * @buf: raw sysfs buffer to parse
247 *
248 * Enforce that uuids can only be changed while the device is disabled
249 * (driver detached)
250 * LOCKING: expects nd_device_lock() is held on entry
251 */
252int nd_uuid_store(struct device *dev, u8 **uuid_out, const char *buf,
253		size_t len)
254{
255	u8 uuid[16];
256	int rc;
257
258	if (dev->driver)
259		return -EBUSY;
260
261	rc = nd_uuid_parse(dev, uuid, buf, len);
262	if (rc)
263		return rc;
264
265	kfree(*uuid_out);
266	*uuid_out = kmemdup(uuid, sizeof(uuid), GFP_KERNEL);
267	if (!(*uuid_out))
268		return -ENOMEM;
269
270	return 0;
271}
272
273ssize_t nd_size_select_show(unsigned long current_size,
274		const unsigned long *supported, char *buf)
275{
276	ssize_t len = 0;
277	int i;
278
279	for (i = 0; supported[i]; i++)
280		if (current_size == supported[i])
281			len += sprintf(buf + len, "[%ld] ", supported[i]);
282		else
283			len += sprintf(buf + len, "%ld ", supported[i]);
284	len += sprintf(buf + len, "\n");
285	return len;
286}
287
288ssize_t nd_size_select_store(struct device *dev, const char *buf,
289		unsigned long *current_size, const unsigned long *supported)
290{
291	unsigned long lbasize;
292	int rc, i;
293
294	if (dev->driver)
295		return -EBUSY;
296
297	rc = kstrtoul(buf, 0, &lbasize);
298	if (rc)
299		return rc;
300
301	for (i = 0; supported[i]; i++)
302		if (lbasize == supported[i])
303			break;
304
305	if (supported[i]) {
306		*current_size = lbasize;
307		return 0;
308	} else {
309		return -EINVAL;
310	}
311}
312
313static ssize_t commands_show(struct device *dev,
314		struct device_attribute *attr, char *buf)
315{
316	int cmd, len = 0;
317	struct nvdimm_bus *nvdimm_bus = to_nvdimm_bus(dev);
318	struct nvdimm_bus_descriptor *nd_desc = nvdimm_bus->nd_desc;
319
320	for_each_set_bit(cmd, &nd_desc->cmd_mask, BITS_PER_LONG)
321		len += sprintf(buf + len, "%s ", nvdimm_bus_cmd_name(cmd));
322	len += sprintf(buf + len, "\n");
323	return len;
324}
325static DEVICE_ATTR_RO(commands);
326
327static const char *nvdimm_bus_provider(struct nvdimm_bus *nvdimm_bus)
328{
329	struct nvdimm_bus_descriptor *nd_desc = nvdimm_bus->nd_desc;
330	struct device *parent = nvdimm_bus->dev.parent;
331
332	if (nd_desc->provider_name)
333		return nd_desc->provider_name;
334	else if (parent)
335		return dev_name(parent);
336	else
337		return "unknown";
338}
339
340static ssize_t provider_show(struct device *dev,
341		struct device_attribute *attr, char *buf)
342{
343	struct nvdimm_bus *nvdimm_bus = to_nvdimm_bus(dev);
344
345	return sprintf(buf, "%s\n", nvdimm_bus_provider(nvdimm_bus));
346}
347static DEVICE_ATTR_RO(provider);
348
349static int flush_namespaces(struct device *dev, void *data)
350{
351	nd_device_lock(dev);
352	nd_device_unlock(dev);
353	return 0;
354}
355
356static int flush_regions_dimms(struct device *dev, void *data)
357{
358	nd_device_lock(dev);
359	nd_device_unlock(dev);
360	device_for_each_child(dev, NULL, flush_namespaces);
361	return 0;
362}
363
364static ssize_t wait_probe_show(struct device *dev,
365		struct device_attribute *attr, char *buf)
366{
367	struct nvdimm_bus *nvdimm_bus = to_nvdimm_bus(dev);
368	struct nvdimm_bus_descriptor *nd_desc = nvdimm_bus->nd_desc;
369	int rc;
370
371	if (nd_desc->flush_probe) {
372		rc = nd_desc->flush_probe(nd_desc);
373		if (rc)
374			return rc;
375	}
376	nd_synchronize();
377	device_for_each_child(dev, NULL, flush_regions_dimms);
378	return sprintf(buf, "1\n");
379}
380static DEVICE_ATTR_RO(wait_probe);
381
382static struct attribute *nvdimm_bus_attributes[] = {
383	&dev_attr_commands.attr,
384	&dev_attr_wait_probe.attr,
385	&dev_attr_provider.attr,
386	NULL,
387};
388
389static const struct attribute_group nvdimm_bus_attribute_group = {
390	.attrs = nvdimm_bus_attributes,
391};
 
392
393static ssize_t capability_show(struct device *dev,
394		struct device_attribute *attr, char *buf)
395{
396	struct nvdimm_bus *nvdimm_bus = to_nvdimm_bus(dev);
397	struct nvdimm_bus_descriptor *nd_desc = nvdimm_bus->nd_desc;
398	enum nvdimm_fwa_capability cap;
399
400	if (!nd_desc->fw_ops)
401		return -EOPNOTSUPP;
402
403	nvdimm_bus_lock(dev);
404	cap = nd_desc->fw_ops->capability(nd_desc);
405	nvdimm_bus_unlock(dev);
406
407	switch (cap) {
408	case NVDIMM_FWA_CAP_QUIESCE:
409		return sprintf(buf, "quiesce\n");
410	case NVDIMM_FWA_CAP_LIVE:
411		return sprintf(buf, "live\n");
412	default:
413		return -EOPNOTSUPP;
414	}
415}
416
417static DEVICE_ATTR_RO(capability);
418
419static ssize_t activate_show(struct device *dev,
420		struct device_attribute *attr, char *buf)
 
 
 
 
 
 
 
421{
422	struct nvdimm_bus *nvdimm_bus = to_nvdimm_bus(dev);
423	struct nvdimm_bus_descriptor *nd_desc = nvdimm_bus->nd_desc;
424	enum nvdimm_fwa_capability cap;
425	enum nvdimm_fwa_state state;
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
426
427	if (!nd_desc->fw_ops)
428		return -EOPNOTSUPP;
 
 
429
430	nvdimm_bus_lock(dev);
431	cap = nd_desc->fw_ops->capability(nd_desc);
432	state = nd_desc->fw_ops->activate_state(nd_desc);
433	nvdimm_bus_unlock(dev);
434
435	if (cap < NVDIMM_FWA_CAP_QUIESCE)
436		return -EOPNOTSUPP;
437
438	switch (state) {
439	case NVDIMM_FWA_IDLE:
440		return sprintf(buf, "idle\n");
441	case NVDIMM_FWA_BUSY:
442		return sprintf(buf, "busy\n");
443	case NVDIMM_FWA_ARMED:
444		return sprintf(buf, "armed\n");
445	case NVDIMM_FWA_ARM_OVERFLOW:
446		return sprintf(buf, "overflow\n");
447	default:
448		return -ENXIO;
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
449	}
450}
451
452static int exec_firmware_activate(void *data)
 
 
 
 
 
 
 
 
 
 
 
 
453{
454	struct nvdimm_bus_descriptor *nd_desc = data;
 
455
456	return nd_desc->fw_ops->activate(nd_desc);
 
 
 
 
 
 
 
 
 
 
457}
 
458
459static ssize_t activate_store(struct device *dev,
460		struct device_attribute *attr, const char *buf, size_t len)
461{
462	struct nvdimm_bus *nvdimm_bus = to_nvdimm_bus(dev);
463	struct nvdimm_bus_descriptor *nd_desc = nvdimm_bus->nd_desc;
464	enum nvdimm_fwa_state state;
465	bool quiesce;
466	ssize_t rc;
467
468	if (!nd_desc->fw_ops)
469		return -EOPNOTSUPP;
470
471	if (sysfs_streq(buf, "live"))
472		quiesce = false;
473	else if (sysfs_streq(buf, "quiesce"))
474		quiesce = true;
475	else
476		return -EINVAL;
477
478	nvdimm_bus_lock(dev);
479	state = nd_desc->fw_ops->activate_state(nd_desc);
 
480
481	switch (state) {
482	case NVDIMM_FWA_BUSY:
483		rc = -EBUSY;
484		break;
485	case NVDIMM_FWA_ARMED:
486	case NVDIMM_FWA_ARM_OVERFLOW:
487		if (quiesce)
488			rc = hibernate_quiet_exec(exec_firmware_activate, nd_desc);
489		else
490			rc = nd_desc->fw_ops->activate(nd_desc);
491		break;
492	case NVDIMM_FWA_IDLE:
493	default:
494		rc = -ENXIO;
495	}
496	nvdimm_bus_unlock(dev);
497
498	if (rc == 0)
499		rc = len;
500	return rc;
501}
502
503static DEVICE_ATTR_ADMIN_RW(activate);
504
505static umode_t nvdimm_bus_firmware_visible(struct kobject *kobj, struct attribute *a, int n)
506{
507	struct device *dev = container_of(kobj, typeof(*dev), kobj);
508	struct nvdimm_bus *nvdimm_bus = to_nvdimm_bus(dev);
509	struct nvdimm_bus_descriptor *nd_desc = nvdimm_bus->nd_desc;
510	enum nvdimm_fwa_capability cap;
511
512	/*
513	 * Both 'activate' and 'capability' disappear when no ops
514	 * detected, or a negative capability is indicated.
 
515	 */
516	if (!nd_desc->fw_ops)
517		return 0;
 
 
 
 
 
518
519	nvdimm_bus_lock(dev);
520	cap = nd_desc->fw_ops->capability(nd_desc);
521	nvdimm_bus_unlock(dev);
 
 
 
 
522
523	if (cap < NVDIMM_FWA_CAP_QUIESCE)
524		return 0;
 
 
 
 
 
525
526	return a->mode;
527}
528static struct attribute *nvdimm_bus_firmware_attributes[] = {
529	&dev_attr_activate.attr,
530	&dev_attr_capability.attr,
531	NULL,
532};
533
534static const struct attribute_group nvdimm_bus_firmware_attribute_group = {
535	.name = "firmware",
536	.attrs = nvdimm_bus_firmware_attributes,
537	.is_visible = nvdimm_bus_firmware_visible,
538};
 
539
540const struct attribute_group *nvdimm_bus_attribute_groups[] = {
541	&nvdimm_bus_attribute_group,
542	&nvdimm_bus_firmware_attribute_group,
543	NULL,
544};
545
546int nvdimm_bus_add_badrange(struct nvdimm_bus *nvdimm_bus, u64 addr, u64 length)
547{
548	return badrange_add(&nvdimm_bus->badrange, addr, length);
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
549}
550EXPORT_SYMBOL_GPL(nvdimm_bus_add_badrange);
551
552#ifdef CONFIG_BLK_DEV_INTEGRITY
553int nd_integrity_init(struct gendisk *disk, unsigned long meta_size)
554{
555	struct blk_integrity bi;
556
557	if (meta_size == 0)
558		return 0;
559
560	memset(&bi, 0, sizeof(bi));
561
562	bi.tuple_size = meta_size;
563	bi.tag_size = meta_size;
564
565	blk_integrity_register(disk, &bi);
566	blk_queue_max_integrity_segments(disk->queue, 1);
567
568	return 0;
569}
570EXPORT_SYMBOL(nd_integrity_init);
571
572#else /* CONFIG_BLK_DEV_INTEGRITY */
573int nd_integrity_init(struct gendisk *disk, unsigned long meta_size)
574{
575	return 0;
576}
577EXPORT_SYMBOL(nd_integrity_init);
578
579#endif
580
581static __init int libnvdimm_init(void)
582{
583	int rc;
584
585	rc = nvdimm_bus_init();
586	if (rc)
587		return rc;
588	rc = nvdimm_init();
589	if (rc)
590		goto err_dimm;
591	rc = nd_region_init();
592	if (rc)
593		goto err_region;
594
595	nd_label_init();
596
597	return 0;
598 err_region:
599	nvdimm_exit();
600 err_dimm:
601	nvdimm_bus_exit();
602	return rc;
603}
604
605static __exit void libnvdimm_exit(void)
606{
607	WARN_ON(!list_empty(&nvdimm_bus_list));
608	nd_region_exit();
609	nvdimm_exit();
610	nvdimm_bus_exit();
 
611	nvdimm_devs_exit();
612}
613
614MODULE_LICENSE("GPL v2");
615MODULE_AUTHOR("Intel Corporation");
616subsys_initcall(libnvdimm_init);
617module_exit(libnvdimm_exit);
v4.10.11
 
  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/libnvdimm.h>
 14#include <linux/badblocks.h>
 
 15#include <linux/export.h>
 16#include <linux/module.h>
 17#include <linux/blkdev.h>
 18#include <linux/device.h>
 19#include <linux/ctype.h>
 20#include <linux/ndctl.h>
 21#include <linux/mutex.h>
 22#include <linux/slab.h>
 23#include <linux/io.h>
 24#include "nd-core.h"
 25#include "nd.h"
 26
 27LIST_HEAD(nvdimm_bus_list);
 28DEFINE_MUTEX(nvdimm_bus_list_mutex);
 29
 30void nvdimm_bus_lock(struct device *dev)
 31{
 32	struct nvdimm_bus *nvdimm_bus = walk_to_nvdimm_bus(dev);
 33
 34	if (!nvdimm_bus)
 35		return;
 36	mutex_lock(&nvdimm_bus->reconfig_mutex);
 37}
 38EXPORT_SYMBOL(nvdimm_bus_lock);
 39
 40void nvdimm_bus_unlock(struct device *dev)
 41{
 42	struct nvdimm_bus *nvdimm_bus = walk_to_nvdimm_bus(dev);
 43
 44	if (!nvdimm_bus)
 45		return;
 46	mutex_unlock(&nvdimm_bus->reconfig_mutex);
 47}
 48EXPORT_SYMBOL(nvdimm_bus_unlock);
 49
 50bool is_nvdimm_bus_locked(struct device *dev)
 51{
 52	struct nvdimm_bus *nvdimm_bus = walk_to_nvdimm_bus(dev);
 53
 54	if (!nvdimm_bus)
 55		return false;
 56	return mutex_is_locked(&nvdimm_bus->reconfig_mutex);
 57}
 58EXPORT_SYMBOL(is_nvdimm_bus_locked);
 59
 60struct nvdimm_map {
 61	struct nvdimm_bus *nvdimm_bus;
 62	struct list_head list;
 63	resource_size_t offset;
 64	unsigned long flags;
 65	size_t size;
 66	union {
 67		void *mem;
 68		void __iomem *iomem;
 69	};
 70	struct kref kref;
 71};
 72
 73static struct nvdimm_map *find_nvdimm_map(struct device *dev,
 74		resource_size_t offset)
 75{
 76	struct nvdimm_bus *nvdimm_bus = walk_to_nvdimm_bus(dev);
 77	struct nvdimm_map *nvdimm_map;
 78
 79	list_for_each_entry(nvdimm_map, &nvdimm_bus->mapping_list, list)
 80		if (nvdimm_map->offset == offset)
 81			return nvdimm_map;
 82	return NULL;
 83}
 84
 85static struct nvdimm_map *alloc_nvdimm_map(struct device *dev,
 86		resource_size_t offset, size_t size, unsigned long flags)
 87{
 88	struct nvdimm_bus *nvdimm_bus = walk_to_nvdimm_bus(dev);
 89	struct nvdimm_map *nvdimm_map;
 90
 91	nvdimm_map = kzalloc(sizeof(*nvdimm_map), GFP_KERNEL);
 92	if (!nvdimm_map)
 93		return NULL;
 94
 95	INIT_LIST_HEAD(&nvdimm_map->list);
 96	nvdimm_map->nvdimm_bus = nvdimm_bus;
 97	nvdimm_map->offset = offset;
 98	nvdimm_map->flags = flags;
 99	nvdimm_map->size = size;
100	kref_init(&nvdimm_map->kref);
101
102	if (!request_mem_region(offset, size, dev_name(&nvdimm_bus->dev))) {
103		dev_err(&nvdimm_bus->dev, "failed to request %pa + %zd for %s\n",
104				&offset, size, dev_name(dev));
105		goto err_request_region;
106	}
107
108	if (flags)
109		nvdimm_map->mem = memremap(offset, size, flags);
110	else
111		nvdimm_map->iomem = ioremap(offset, size);
112
113	if (!nvdimm_map->mem)
114		goto err_map;
115
116	dev_WARN_ONCE(dev, !is_nvdimm_bus_locked(dev), "%s: bus unlocked!",
117			__func__);
118	list_add(&nvdimm_map->list, &nvdimm_bus->mapping_list);
119
120	return nvdimm_map;
121
122 err_map:
123	release_mem_region(offset, size);
124 err_request_region:
125	kfree(nvdimm_map);
126	return NULL;
127}
128
129static void nvdimm_map_release(struct kref *kref)
130{
131	struct nvdimm_bus *nvdimm_bus;
132	struct nvdimm_map *nvdimm_map;
133
134	nvdimm_map = container_of(kref, struct nvdimm_map, kref);
135	nvdimm_bus = nvdimm_map->nvdimm_bus;
136
137	dev_dbg(&nvdimm_bus->dev, "%s: %pa\n", __func__, &nvdimm_map->offset);
138	list_del(&nvdimm_map->list);
139	if (nvdimm_map->flags)
140		memunmap(nvdimm_map->mem);
141	else
142		iounmap(nvdimm_map->iomem);
143	release_mem_region(nvdimm_map->offset, nvdimm_map->size);
144	kfree(nvdimm_map);
145}
146
147static void nvdimm_map_put(void *data)
148{
149	struct nvdimm_map *nvdimm_map = data;
150	struct nvdimm_bus *nvdimm_bus = nvdimm_map->nvdimm_bus;
151
152	nvdimm_bus_lock(&nvdimm_bus->dev);
153	kref_put(&nvdimm_map->kref, nvdimm_map_release);
154	nvdimm_bus_unlock(&nvdimm_bus->dev);
155}
156
157/**
158 * devm_nvdimm_memremap - map a resource that is shared across regions
159 * @dev: device that will own a reference to the shared mapping
160 * @offset: physical base address of the mapping
161 * @size: mapping size
162 * @flags: memremap flags, or, if zero, perform an ioremap instead
163 */
164void *devm_nvdimm_memremap(struct device *dev, resource_size_t offset,
165		size_t size, unsigned long flags)
166{
167	struct nvdimm_map *nvdimm_map;
168
169	nvdimm_bus_lock(dev);
170	nvdimm_map = find_nvdimm_map(dev, offset);
171	if (!nvdimm_map)
172		nvdimm_map = alloc_nvdimm_map(dev, offset, size, flags);
173	else
174		kref_get(&nvdimm_map->kref);
175	nvdimm_bus_unlock(dev);
176
177	if (!nvdimm_map)
178		return NULL;
179
180	if (devm_add_action_or_reset(dev, nvdimm_map_put, nvdimm_map))
181		return NULL;
182
183	return nvdimm_map->mem;
184}
185EXPORT_SYMBOL_GPL(devm_nvdimm_memremap);
186
187u64 nd_fletcher64(void *addr, size_t len, bool le)
188{
189	u32 *buf = addr;
190	u32 lo32 = 0;
191	u64 hi32 = 0;
192	int i;
193
194	for (i = 0; i < len / sizeof(u32); i++) {
195		lo32 += le ? le32_to_cpu((__le32) buf[i]) : buf[i];
196		hi32 += lo32;
197	}
198
199	return hi32 << 32 | lo32;
200}
201EXPORT_SYMBOL_GPL(nd_fletcher64);
202
203struct nvdimm_bus_descriptor *to_nd_desc(struct nvdimm_bus *nvdimm_bus)
204{
205	/* struct nvdimm_bus definition is private to libnvdimm */
206	return nvdimm_bus->nd_desc;
207}
208EXPORT_SYMBOL_GPL(to_nd_desc);
209
210struct device *to_nvdimm_bus_dev(struct nvdimm_bus *nvdimm_bus)
211{
212	/* struct nvdimm_bus definition is private to libnvdimm */
213	return &nvdimm_bus->dev;
214}
215EXPORT_SYMBOL_GPL(to_nvdimm_bus_dev);
216
217static bool is_uuid_sep(char sep)
218{
219	if (sep == '\n' || sep == '-' || sep == ':' || sep == '\0')
220		return true;
221	return false;
222}
223
224static int nd_uuid_parse(struct device *dev, u8 *uuid_out, const char *buf,
225		size_t len)
226{
227	const char *str = buf;
228	u8 uuid[16];
229	int i;
230
231	for (i = 0; i < 16; i++) {
232		if (!isxdigit(str[0]) || !isxdigit(str[1])) {
233			dev_dbg(dev, "%s: pos: %d buf[%zd]: %c buf[%zd]: %c\n",
234					__func__, i, str - buf, str[0],
235					str + 1 - buf, str[1]);
236			return -EINVAL;
237		}
238
239		uuid[i] = (hex_to_bin(str[0]) << 4) | hex_to_bin(str[1]);
240		str += 2;
241		if (is_uuid_sep(*str))
242			str++;
243	}
244
245	memcpy(uuid_out, uuid, sizeof(uuid));
246	return 0;
247}
248
249/**
250 * nd_uuid_store: common implementation for writing 'uuid' sysfs attributes
251 * @dev: container device for the uuid property
252 * @uuid_out: uuid buffer to replace
253 * @buf: raw sysfs buffer to parse
254 *
255 * Enforce that uuids can only be changed while the device is disabled
256 * (driver detached)
257 * LOCKING: expects device_lock() is held on entry
258 */
259int nd_uuid_store(struct device *dev, u8 **uuid_out, const char *buf,
260		size_t len)
261{
262	u8 uuid[16];
263	int rc;
264
265	if (dev->driver)
266		return -EBUSY;
267
268	rc = nd_uuid_parse(dev, uuid, buf, len);
269	if (rc)
270		return rc;
271
272	kfree(*uuid_out);
273	*uuid_out = kmemdup(uuid, sizeof(uuid), GFP_KERNEL);
274	if (!(*uuid_out))
275		return -ENOMEM;
276
277	return 0;
278}
279
280ssize_t nd_sector_size_show(unsigned long current_lbasize,
281		const unsigned long *supported, char *buf)
282{
283	ssize_t len = 0;
284	int i;
285
286	for (i = 0; supported[i]; i++)
287		if (current_lbasize == supported[i])
288			len += sprintf(buf + len, "[%ld] ", supported[i]);
289		else
290			len += sprintf(buf + len, "%ld ", supported[i]);
291	len += sprintf(buf + len, "\n");
292	return len;
293}
294
295ssize_t nd_sector_size_store(struct device *dev, const char *buf,
296		unsigned long *current_lbasize, const unsigned long *supported)
297{
298	unsigned long lbasize;
299	int rc, i;
300
301	if (dev->driver)
302		return -EBUSY;
303
304	rc = kstrtoul(buf, 0, &lbasize);
305	if (rc)
306		return rc;
307
308	for (i = 0; supported[i]; i++)
309		if (lbasize == supported[i])
310			break;
311
312	if (supported[i]) {
313		*current_lbasize = lbasize;
314		return 0;
315	} else {
316		return -EINVAL;
317	}
318}
319
320static ssize_t commands_show(struct device *dev,
321		struct device_attribute *attr, char *buf)
322{
323	int cmd, len = 0;
324	struct nvdimm_bus *nvdimm_bus = to_nvdimm_bus(dev);
325	struct nvdimm_bus_descriptor *nd_desc = nvdimm_bus->nd_desc;
326
327	for_each_set_bit(cmd, &nd_desc->cmd_mask, BITS_PER_LONG)
328		len += sprintf(buf + len, "%s ", nvdimm_bus_cmd_name(cmd));
329	len += sprintf(buf + len, "\n");
330	return len;
331}
332static DEVICE_ATTR_RO(commands);
333
334static const char *nvdimm_bus_provider(struct nvdimm_bus *nvdimm_bus)
335{
336	struct nvdimm_bus_descriptor *nd_desc = nvdimm_bus->nd_desc;
337	struct device *parent = nvdimm_bus->dev.parent;
338
339	if (nd_desc->provider_name)
340		return nd_desc->provider_name;
341	else if (parent)
342		return dev_name(parent);
343	else
344		return "unknown";
345}
346
347static ssize_t provider_show(struct device *dev,
348		struct device_attribute *attr, char *buf)
349{
350	struct nvdimm_bus *nvdimm_bus = to_nvdimm_bus(dev);
351
352	return sprintf(buf, "%s\n", nvdimm_bus_provider(nvdimm_bus));
353}
354static DEVICE_ATTR_RO(provider);
355
356static int flush_namespaces(struct device *dev, void *data)
357{
358	device_lock(dev);
359	device_unlock(dev);
360	return 0;
361}
362
363static int flush_regions_dimms(struct device *dev, void *data)
364{
365	device_lock(dev);
366	device_unlock(dev);
367	device_for_each_child(dev, NULL, flush_namespaces);
368	return 0;
369}
370
371static ssize_t wait_probe_show(struct device *dev,
372		struct device_attribute *attr, char *buf)
373{
374	struct nvdimm_bus *nvdimm_bus = to_nvdimm_bus(dev);
375	struct nvdimm_bus_descriptor *nd_desc = nvdimm_bus->nd_desc;
376	int rc;
377
378	if (nd_desc->flush_probe) {
379		rc = nd_desc->flush_probe(nd_desc);
380		if (rc)
381			return rc;
382	}
383	nd_synchronize();
384	device_for_each_child(dev, NULL, flush_regions_dimms);
385	return sprintf(buf, "1\n");
386}
387static DEVICE_ATTR_RO(wait_probe);
388
389static struct attribute *nvdimm_bus_attributes[] = {
390	&dev_attr_commands.attr,
391	&dev_attr_wait_probe.attr,
392	&dev_attr_provider.attr,
393	NULL,
394};
395
396struct attribute_group nvdimm_bus_attribute_group = {
397	.attrs = nvdimm_bus_attributes,
398};
399EXPORT_SYMBOL_GPL(nvdimm_bus_attribute_group);
400
401static void set_badblock(struct badblocks *bb, sector_t s, int num)
 
402{
403	dev_dbg(bb->dev, "Found a poison range (0x%llx, 0x%llx)\n",
404			(u64) s * 512, (u64) num * 512);
405	/* this isn't an error as the hardware will still throw an exception */
406	if (badblocks_set(bb, s, num, 1))
407		dev_info_once(bb->dev, "%s: failed for sector %llx\n",
408				__func__, (u64) s);
 
 
 
 
 
 
 
 
 
 
 
 
 
409}
410
411/**
412 * __add_badblock_range() - Convert a physical address range to bad sectors
413 * @bb:		badblocks instance to populate
414 * @ns_offset:	namespace offset where the error range begins (in bytes)
415 * @len:	number of bytes of poison to be added
416 *
417 * This assumes that the range provided with (ns_offset, len) is within
418 * the bounds of physical addresses for this namespace, i.e. lies in the
419 * interval [ns_start, ns_start + ns_size)
420 */
421static void __add_badblock_range(struct badblocks *bb, u64 ns_offset, u64 len)
422{
423	const unsigned int sector_size = 512;
424	sector_t start_sector;
425	u64 num_sectors;
426	u32 rem;
427
428	start_sector = div_u64(ns_offset, sector_size);
429	num_sectors = div_u64_rem(len, sector_size, &rem);
430	if (rem)
431		num_sectors++;
432
433	if (unlikely(num_sectors > (u64)INT_MAX)) {
434		u64 remaining = num_sectors;
435		sector_t s = start_sector;
436
437		while (remaining) {
438			int done = min_t(u64, remaining, INT_MAX);
439
440			set_badblock(bb, s, done);
441			remaining -= done;
442			s += done;
443		}
444	} else
445		set_badblock(bb, start_sector, num_sectors);
446}
447
448static void badblocks_populate(struct list_head *poison_list,
449		struct badblocks *bb, const struct resource *res)
450{
451	struct nd_poison *pl;
452
453	if (list_empty(poison_list))
454		return;
 
 
455
456	list_for_each_entry(pl, poison_list, list) {
457		u64 pl_end = pl->start + pl->length - 1;
458
459		/* Discard intervals with no intersection */
460		if (pl_end < res->start)
461			continue;
462		if (pl->start >  res->end)
463			continue;
464		/* Deal with any overlap after start of the namespace */
465		if (pl->start >= res->start) {
466			u64 start = pl->start;
467			u64 len;
468
469			if (pl_end <= res->end)
470				len = pl->length;
471			else
472				len = res->start + resource_size(res)
473					- pl->start;
474			__add_badblock_range(bb, start - res->start, len);
475			continue;
476		}
477		/* Deal with overlap for poison starting before the namespace */
478		if (pl->start < res->start) {
479			u64 len;
480
481			if (pl_end < res->end)
482				len = pl->start + pl->length - res->start;
483			else
484				len = resource_size(res);
485			__add_badblock_range(bb, 0, len);
486		}
487	}
488}
489
490/**
491 * nvdimm_badblocks_populate() - Convert a list of poison ranges to badblocks
492 * @region: parent region of the range to interrogate
493 * @bb: badblocks instance to populate
494 * @res: resource range to consider
495 *
496 * The poison list generated during bus initialization may contain
497 * multiple, possibly overlapping physical address ranges.  Compare each
498 * of these ranges to the resource range currently being initialized,
499 * and add badblocks entries for all matching sub-ranges
500 */
501void nvdimm_badblocks_populate(struct nd_region *nd_region,
502		struct badblocks *bb, const struct resource *res)
503{
504	struct nvdimm_bus *nvdimm_bus;
505	struct list_head *poison_list;
506
507	if (!is_nd_pmem(&nd_region->dev)) {
508		dev_WARN_ONCE(&nd_region->dev, 1,
509				"%s only valid for pmem regions\n", __func__);
510		return;
511	}
512	nvdimm_bus = walk_to_nvdimm_bus(&nd_region->dev);
513	poison_list = &nvdimm_bus->poison_list;
514
515	nvdimm_bus_lock(&nvdimm_bus->dev);
516	badblocks_populate(poison_list, bb, res);
517	nvdimm_bus_unlock(&nvdimm_bus->dev);
518}
519EXPORT_SYMBOL_GPL(nvdimm_badblocks_populate);
520
521static int add_poison(struct nvdimm_bus *nvdimm_bus, u64 addr, u64 length,
522			gfp_t flags)
523{
524	struct nd_poison *pl;
 
 
 
 
 
 
 
 
 
 
 
 
 
 
525
526	pl = kzalloc(sizeof(*pl), flags);
527	if (!pl)
528		return -ENOMEM;
529
530	pl->start = addr;
531	pl->length = length;
532	list_add_tail(&pl->list, &nvdimm_bus->poison_list);
 
 
 
 
 
 
 
 
 
 
 
 
 
533
534	return 0;
 
 
535}
536
537static int bus_add_poison(struct nvdimm_bus *nvdimm_bus, u64 addr, u64 length)
 
 
538{
539	struct nd_poison *pl;
540
541	if (list_empty(&nvdimm_bus->poison_list))
542		return add_poison(nvdimm_bus, addr, length, GFP_KERNEL);
543
544	/*
545	 * There is a chance this is a duplicate, check for those first.
546	 * This will be the common case as ARS_STATUS returns all known
547	 * errors in the SPA space, and we can't query it per region
548	 */
549	list_for_each_entry(pl, &nvdimm_bus->poison_list, list)
550		if (pl->start == addr) {
551			/* If length has changed, update this list entry */
552			if (pl->length != length)
553				pl->length = length;
554			return 0;
555		}
556
557	/*
558	 * If not a duplicate or a simple length update, add the entry as is,
559	 * as any overlapping ranges will get resolved when the list is consumed
560	 * and converted to badblocks
561	 */
562	return add_poison(nvdimm_bus, addr, length, GFP_KERNEL);
563}
564
565int nvdimm_bus_add_poison(struct nvdimm_bus *nvdimm_bus, u64 addr, u64 length)
566{
567	int rc;
568
569	nvdimm_bus_lock(&nvdimm_bus->dev);
570	rc = bus_add_poison(nvdimm_bus, addr, length);
571	nvdimm_bus_unlock(&nvdimm_bus->dev);
572
573	return rc;
574}
575EXPORT_SYMBOL_GPL(nvdimm_bus_add_poison);
 
 
 
 
576
577void nvdimm_clear_from_poison_list(struct nvdimm_bus *nvdimm_bus,
578		phys_addr_t start, unsigned int len)
579{
580	struct list_head *poison_list = &nvdimm_bus->poison_list;
581	u64 clr_end = start + len - 1;
582	struct nd_poison *pl, *next;
583
584	nvdimm_bus_lock(&nvdimm_bus->dev);
585	WARN_ON_ONCE(list_empty(poison_list));
 
 
 
586
587	/*
588	 * [start, clr_end] is the poison interval being cleared.
589	 * [pl->start, pl_end] is the poison_list entry we're comparing
590	 * the above interval against. The poison list entry may need
591	 * to be modified (update either start or length), deleted, or
592	 * split into two based on the overlap characteristics
593	 */
594
595	list_for_each_entry_safe(pl, next, poison_list, list) {
596		u64 pl_end = pl->start + pl->length - 1;
597
598		/* Skip intervals with no intersection */
599		if (pl_end < start)
600			continue;
601		if (pl->start >  clr_end)
602			continue;
603		/* Delete completely overlapped poison entries */
604		if ((pl->start >= start) && (pl_end <= clr_end)) {
605			list_del(&pl->list);
606			kfree(pl);
607			continue;
608		}
609		/* Adjust start point of partially cleared entries */
610		if ((start <= pl->start) && (clr_end > pl->start)) {
611			pl->length -= clr_end - pl->start + 1;
612			pl->start = clr_end + 1;
613			continue;
614		}
615		/* Adjust pl->length for partial clearing at the tail end */
616		if ((pl->start < start) && (pl_end <= clr_end)) {
617			/* pl->start remains the same */
618			pl->length = start - pl->start;
619			continue;
620		}
621		/*
622		 * If clearing in the middle of an entry, we split it into
623		 * two by modifying the current entry to represent one half of
624		 * the split, and adding a new entry for the second half.
625		 */
626		if ((pl->start < start) && (pl_end > clr_end)) {
627			u64 new_start = clr_end + 1;
628			u64 new_len = pl_end - new_start + 1;
629
630			/* Add new entry covering the right half */
631			add_poison(nvdimm_bus, new_start, new_len, GFP_NOIO);
632			/* Adjust this entry to cover the left half */
633			pl->length = start - pl->start;
634			continue;
635		}
636	}
637	nvdimm_bus_unlock(&nvdimm_bus->dev);
638}
639EXPORT_SYMBOL_GPL(nvdimm_clear_from_poison_list);
640
641#ifdef CONFIG_BLK_DEV_INTEGRITY
642int nd_integrity_init(struct gendisk *disk, unsigned long meta_size)
643{
644	struct blk_integrity bi;
645
646	if (meta_size == 0)
647		return 0;
648
649	memset(&bi, 0, sizeof(bi));
650
651	bi.tuple_size = meta_size;
652	bi.tag_size = meta_size;
653
654	blk_integrity_register(disk, &bi);
655	blk_queue_max_integrity_segments(disk->queue, 1);
656
657	return 0;
658}
659EXPORT_SYMBOL(nd_integrity_init);
660
661#else /* CONFIG_BLK_DEV_INTEGRITY */
662int nd_integrity_init(struct gendisk *disk, unsigned long meta_size)
663{
664	return 0;
665}
666EXPORT_SYMBOL(nd_integrity_init);
667
668#endif
669
670static __init int libnvdimm_init(void)
671{
672	int rc;
673
674	rc = nvdimm_bus_init();
675	if (rc)
676		return rc;
677	rc = nvdimm_init();
678	if (rc)
679		goto err_dimm;
680	rc = nd_region_init();
681	if (rc)
682		goto err_region;
 
 
 
683	return 0;
684 err_region:
685	nvdimm_exit();
686 err_dimm:
687	nvdimm_bus_exit();
688	return rc;
689}
690
691static __exit void libnvdimm_exit(void)
692{
693	WARN_ON(!list_empty(&nvdimm_bus_list));
694	nd_region_exit();
695	nvdimm_exit();
696	nvdimm_bus_exit();
697	nd_region_devs_exit();
698	nvdimm_devs_exit();
699}
700
701MODULE_LICENSE("GPL v2");
702MODULE_AUTHOR("Intel Corporation");
703subsys_initcall(libnvdimm_init);
704module_exit(libnvdimm_exit);