| /* | |
| * Copyright(c) 2013-2015 Intel Corporation. All rights reserved. | |
| * | |
| * This program is free software; you can redistribute it and/or modify | |
| * it under the terms of version 2 of the GNU General Public License as | |
| * published by the Free Software Foundation. | |
| * | |
| * This program is distributed in the hope that it will be useful, but | |
| * WITHOUT ANY WARRANTY; without even the implied warranty of | |
| * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU | |
| * General Public License for more details. | |
| */ | |
| #include <linux/device.h> | |
| #include <linux/ndctl.h> | |
| #include <linux/slab.h> | |
| #include <linux/io.h> | |
| #include <linux/nd.h> | |
| #include "nd-core.h" | |
| #include "label.h" | |
| #include "nd.h" | |
| static u32 best_seq(u32 a, u32 b) | |
| { | |
| a &= NSINDEX_SEQ_MASK; | |
| b &= NSINDEX_SEQ_MASK; | |
| if (a == 0 || a == b) | |
| return b; | |
| else if (b == 0) | |
| return a; | |
| else if (nd_inc_seq(a) == b) | |
| return b; | |
| else | |
| return a; | |
| } | |
| size_t sizeof_namespace_index(struct nvdimm_drvdata *ndd) | |
| { | |
| u32 index_span; | |
| if (ndd->nsindex_size) | |
| return ndd->nsindex_size; | |
| /* | |
| * The minimum index space is 512 bytes, with that amount of | |
| * index we can describe ~1400 labels which is less than a byte | |
| * of overhead per label. Round up to a byte of overhead per | |
| * label and determine the size of the index region. Yes, this | |
| * starts to waste space at larger config_sizes, but it's | |
| * unlikely we'll ever see anything but 128K. | |
| */ | |
| index_span = ndd->nsarea.config_size / 129; | |
| index_span /= NSINDEX_ALIGN * 2; | |
| ndd->nsindex_size = index_span * NSINDEX_ALIGN; | |
| return ndd->nsindex_size; | |
| } | |
| int nvdimm_num_label_slots(struct nvdimm_drvdata *ndd) | |
| { | |
| return ndd->nsarea.config_size / 129; | |
| } | |
| int nd_label_validate(struct nvdimm_drvdata *ndd) | |
| { | |
| /* | |
| * On media label format consists of two index blocks followed | |
| * by an array of labels. None of these structures are ever | |
| * updated in place. A sequence number tracks the current | |
| * active index and the next one to write, while labels are | |
| * written to free slots. | |
| * | |
| * +------------+ | |
| * | | | |
| * | nsindex0 | | |
| * | | | |
| * +------------+ | |
| * | | | |
| * | nsindex1 | | |
| * | | | |
| * +------------+ | |
| * | label0 | | |
| * +------------+ | |
| * | label1 | | |
| * +------------+ | |
| * | | | |
| * ....nslot... | |
| * | | | |
| * +------------+ | |
| * | labelN | | |
| * +------------+ | |
| */ | |
| struct nd_namespace_index *nsindex[] = { | |
| to_namespace_index(ndd, 0), | |
| to_namespace_index(ndd, 1), | |
| }; | |
| const int num_index = ARRAY_SIZE(nsindex); | |
| struct device *dev = ndd->dev; | |
| bool valid[2] = { 0 }; | |
| int i, num_valid = 0; | |
| u32 seq; | |
| for (i = 0; i < num_index; i++) { | |
| u32 nslot; | |
| u8 sig[NSINDEX_SIG_LEN]; | |
| u64 sum_save, sum, size; | |
| memcpy(sig, nsindex[i]->sig, NSINDEX_SIG_LEN); | |
| if (memcmp(sig, NSINDEX_SIGNATURE, NSINDEX_SIG_LEN) != 0) { | |
| dev_dbg(dev, "%s: nsindex%d signature invalid\n", | |
| __func__, i); | |
| continue; | |
| } | |
| sum_save = __le64_to_cpu(nsindex[i]->checksum); | |
| nsindex[i]->checksum = __cpu_to_le64(0); | |
| sum = nd_fletcher64(nsindex[i], sizeof_namespace_index(ndd), 1); | |
| nsindex[i]->checksum = __cpu_to_le64(sum_save); | |
| if (sum != sum_save) { | |
| dev_dbg(dev, "%s: nsindex%d checksum invalid\n", | |
| __func__, i); | |
| continue; | |
| } | |
| seq = __le32_to_cpu(nsindex[i]->seq); | |
| if ((seq & NSINDEX_SEQ_MASK) == 0) { | |
| dev_dbg(dev, "%s: nsindex%d sequence: %#x invalid\n", | |
| __func__, i, seq); | |
| continue; | |
| } | |
| /* sanity check the index against expected values */ | |
| if (__le64_to_cpu(nsindex[i]->myoff) | |
| != i * sizeof_namespace_index(ndd)) { | |
| dev_dbg(dev, "%s: nsindex%d myoff: %#llx invalid\n", | |
| __func__, i, (unsigned long long) | |
| __le64_to_cpu(nsindex[i]->myoff)); | |
| continue; | |
| } | |
| if (__le64_to_cpu(nsindex[i]->otheroff) | |
| != (!i) * sizeof_namespace_index(ndd)) { | |
| dev_dbg(dev, "%s: nsindex%d otheroff: %#llx invalid\n", | |
| __func__, i, (unsigned long long) | |
| __le64_to_cpu(nsindex[i]->otheroff)); | |
| continue; | |
| } | |
| size = __le64_to_cpu(nsindex[i]->mysize); | |
| if (size > sizeof_namespace_index(ndd) | |
| || size < sizeof(struct nd_namespace_index)) { | |
| dev_dbg(dev, "%s: nsindex%d mysize: %#llx invalid\n", | |
| __func__, i, size); | |
| continue; | |
| } | |
| nslot = __le32_to_cpu(nsindex[i]->nslot); | |
| if (nslot * sizeof(struct nd_namespace_label) | |
| + 2 * sizeof_namespace_index(ndd) | |
| > ndd->nsarea.config_size) { | |
| dev_dbg(dev, "%s: nsindex%d nslot: %u invalid, config_size: %#x\n", | |
| __func__, i, nslot, | |
| ndd->nsarea.config_size); | |
| continue; | |
| } | |
| valid[i] = true; | |
| num_valid++; | |
| } | |
| switch (num_valid) { | |
| case 0: | |
| break; | |
| case 1: | |
| for (i = 0; i < num_index; i++) | |
| if (valid[i]) | |
| return i; | |
| /* can't have num_valid > 0 but valid[] = { false, false } */ | |
| WARN_ON(1); | |
| break; | |
| default: | |
| /* pick the best index... */ | |
| seq = best_seq(__le32_to_cpu(nsindex[0]->seq), | |
| __le32_to_cpu(nsindex[1]->seq)); | |
| if (seq == (__le32_to_cpu(nsindex[1]->seq) & NSINDEX_SEQ_MASK)) | |
| return 1; | |
| else | |
| return 0; | |
| break; | |
| } | |
| return -1; | |
| } | |
| void nd_label_copy(struct nvdimm_drvdata *ndd, struct nd_namespace_index *dst, | |
| struct nd_namespace_index *src) | |
| { | |
| if (dst && src) | |
| /* pass */; | |
| else | |
| return; | |
| memcpy(dst, src, sizeof_namespace_index(ndd)); | |
| } | |
| static struct nd_namespace_label *nd_label_base(struct nvdimm_drvdata *ndd) | |
| { | |
| void *base = to_namespace_index(ndd, 0); | |
| return base + 2 * sizeof_namespace_index(ndd); | |
| } | |
| static int to_slot(struct nvdimm_drvdata *ndd, | |
| struct nd_namespace_label *nd_label) | |
| { | |
| return nd_label - nd_label_base(ndd); | |
| } | |
| #define for_each_clear_bit_le(bit, addr, size) \ | |
| for ((bit) = find_next_zero_bit_le((addr), (size), 0); \ | |
| (bit) < (size); \ | |
| (bit) = find_next_zero_bit_le((addr), (size), (bit) + 1)) | |
| /** | |
| * preamble_index - common variable initialization for nd_label_* routines | |
| * @ndd: dimm container for the relevant label set | |
| * @idx: namespace_index index | |
| * @nsindex_out: on return set to the currently active namespace index | |
| * @free: on return set to the free label bitmap in the index | |
| * @nslot: on return set to the number of slots in the label space | |
| */ | |
| static bool preamble_index(struct nvdimm_drvdata *ndd, int idx, | |
| struct nd_namespace_index **nsindex_out, | |
| unsigned long **free, u32 *nslot) | |
| { | |
| struct nd_namespace_index *nsindex; | |
| nsindex = to_namespace_index(ndd, idx); | |
| if (nsindex == NULL) | |
| return false; | |
| *free = (unsigned long *) nsindex->free; | |
| *nslot = __le32_to_cpu(nsindex->nslot); | |
| *nsindex_out = nsindex; | |
| return true; | |
| } | |
| char *nd_label_gen_id(struct nd_label_id *label_id, u8 *uuid, u32 flags) | |
| { | |
| if (!label_id || !uuid) | |
| return NULL; | |
| snprintf(label_id->id, ND_LABEL_ID_SIZE, "%s-%pUb", | |
| flags & NSLABEL_FLAG_LOCAL ? "blk" : "pmem", uuid); | |
| return label_id->id; | |
| } | |
| static bool preamble_current(struct nvdimm_drvdata *ndd, | |
| struct nd_namespace_index **nsindex, | |
| unsigned long **free, u32 *nslot) | |
| { | |
| return preamble_index(ndd, ndd->ns_current, nsindex, | |
| free, nslot); | |
| } | |
| static bool preamble_next(struct nvdimm_drvdata *ndd, | |
| struct nd_namespace_index **nsindex, | |
| unsigned long **free, u32 *nslot) | |
| { | |
| return preamble_index(ndd, ndd->ns_next, nsindex, | |
| free, nslot); | |
| } | |
| static bool slot_valid(struct nd_namespace_label *nd_label, u32 slot) | |
| { | |
| /* check that we are written where we expect to be written */ | |
| if (slot != __le32_to_cpu(nd_label->slot)) | |
| return false; | |
| /* check that DPA allocations are page aligned */ | |
| if ((__le64_to_cpu(nd_label->dpa) | |
| | __le64_to_cpu(nd_label->rawsize)) % SZ_4K) | |
| return false; | |
| return true; | |
| } | |
| int nd_label_reserve_dpa(struct nvdimm_drvdata *ndd) | |
| { | |
| struct nd_namespace_index *nsindex; | |
| unsigned long *free; | |
| u32 nslot, slot; | |
| if (!preamble_current(ndd, &nsindex, &free, &nslot)) | |
| return 0; /* no label, nothing to reserve */ | |
| for_each_clear_bit_le(slot, free, nslot) { | |
| struct nd_namespace_label *nd_label; | |
| struct nd_region *nd_region = NULL; | |
| u8 label_uuid[NSLABEL_UUID_LEN]; | |
| struct nd_label_id label_id; | |
| struct resource *res; | |
| u32 flags; | |
| nd_label = nd_label_base(ndd) + slot; | |
| if (!slot_valid(nd_label, slot)) | |
| continue; | |
| memcpy(label_uuid, nd_label->uuid, NSLABEL_UUID_LEN); | |
| flags = __le32_to_cpu(nd_label->flags); | |
| nd_label_gen_id(&label_id, label_uuid, flags); | |
| res = nvdimm_allocate_dpa(ndd, &label_id, | |
| __le64_to_cpu(nd_label->dpa), | |
| __le64_to_cpu(nd_label->rawsize)); | |
| nd_dbg_dpa(nd_region, ndd, res, "reserve\n"); | |
| if (!res) | |
| return -EBUSY; | |
| } | |
| return 0; | |
| } | |
| int nd_label_active_count(struct nvdimm_drvdata *ndd) | |
| { | |
| struct nd_namespace_index *nsindex; | |
| unsigned long *free; | |
| u32 nslot, slot; | |
| int count = 0; | |
| if (!preamble_current(ndd, &nsindex, &free, &nslot)) | |
| return 0; | |
| for_each_clear_bit_le(slot, free, nslot) { | |
| struct nd_namespace_label *nd_label; | |
| nd_label = nd_label_base(ndd) + slot; | |
| if (!slot_valid(nd_label, slot)) { | |
| u32 label_slot = __le32_to_cpu(nd_label->slot); | |
| u64 size = __le64_to_cpu(nd_label->rawsize); | |
| u64 dpa = __le64_to_cpu(nd_label->dpa); | |
| dev_dbg(ndd->dev, | |
| "%s: slot%d invalid slot: %d dpa: %llx size: %llx\n", | |
| __func__, slot, label_slot, dpa, size); | |
| continue; | |
| } | |
| count++; | |
| } | |
| return count; | |
| } | |
| struct nd_namespace_label *nd_label_active(struct nvdimm_drvdata *ndd, int n) | |
| { | |
| struct nd_namespace_index *nsindex; | |
| unsigned long *free; | |
| u32 nslot, slot; | |
| if (!preamble_current(ndd, &nsindex, &free, &nslot)) | |
| return NULL; | |
| for_each_clear_bit_le(slot, free, nslot) { | |
| struct nd_namespace_label *nd_label; | |
| nd_label = nd_label_base(ndd) + slot; | |
| if (!slot_valid(nd_label, slot)) | |
| continue; | |
| if (n-- == 0) | |
| return nd_label_base(ndd) + slot; | |
| } | |
| return NULL; | |
| } | |
| u32 nd_label_alloc_slot(struct nvdimm_drvdata *ndd) | |
| { | |
| struct nd_namespace_index *nsindex; | |
| unsigned long *free; | |
| u32 nslot, slot; | |
| if (!preamble_next(ndd, &nsindex, &free, &nslot)) | |
| return UINT_MAX; | |
| WARN_ON(!is_nvdimm_bus_locked(ndd->dev)); | |
| slot = find_next_bit_le(free, nslot, 0); | |
| if (slot == nslot) | |
| return UINT_MAX; | |
| clear_bit_le(slot, free); | |
| return slot; | |
| } | |
| bool nd_label_free_slot(struct nvdimm_drvdata *ndd, u32 slot) | |
| { | |
| struct nd_namespace_index *nsindex; | |
| unsigned long *free; | |
| u32 nslot; | |
| if (!preamble_next(ndd, &nsindex, &free, &nslot)) | |
| return false; | |
| WARN_ON(!is_nvdimm_bus_locked(ndd->dev)); | |
| if (slot < nslot) | |
| return !test_and_set_bit_le(slot, free); | |
| return false; | |
| } | |
| u32 nd_label_nfree(struct nvdimm_drvdata *ndd) | |
| { | |
| struct nd_namespace_index *nsindex; | |
| unsigned long *free; | |
| u32 nslot; | |
| WARN_ON(!is_nvdimm_bus_locked(ndd->dev)); | |
| if (!preamble_next(ndd, &nsindex, &free, &nslot)) | |
| return nvdimm_num_label_slots(ndd); | |
| return bitmap_weight(free, nslot); | |
| } | |
| static int nd_label_write_index(struct nvdimm_drvdata *ndd, int index, u32 seq, | |
| unsigned long flags) | |
| { | |
| struct nd_namespace_index *nsindex; | |
| unsigned long offset; | |
| u64 checksum; | |
| u32 nslot; | |
| int rc; | |
| nsindex = to_namespace_index(ndd, index); | |
| if (flags & ND_NSINDEX_INIT) | |
| nslot = nvdimm_num_label_slots(ndd); | |
| else | |
| nslot = __le32_to_cpu(nsindex->nslot); | |
| memcpy(nsindex->sig, NSINDEX_SIGNATURE, NSINDEX_SIG_LEN); | |
| nsindex->flags = __cpu_to_le32(0); | |
| nsindex->seq = __cpu_to_le32(seq); | |
| offset = (unsigned long) nsindex | |
| - (unsigned long) to_namespace_index(ndd, 0); | |
| nsindex->myoff = __cpu_to_le64(offset); | |
| nsindex->mysize = __cpu_to_le64(sizeof_namespace_index(ndd)); | |
| offset = (unsigned long) to_namespace_index(ndd, | |
| nd_label_next_nsindex(index)) | |
| - (unsigned long) to_namespace_index(ndd, 0); | |
| nsindex->otheroff = __cpu_to_le64(offset); | |
| offset = (unsigned long) nd_label_base(ndd) | |
| - (unsigned long) to_namespace_index(ndd, 0); | |
| nsindex->labeloff = __cpu_to_le64(offset); | |
| nsindex->nslot = __cpu_to_le32(nslot); | |
| nsindex->major = __cpu_to_le16(1); | |
| nsindex->minor = __cpu_to_le16(1); | |
| nsindex->checksum = __cpu_to_le64(0); | |
| if (flags & ND_NSINDEX_INIT) { | |
| unsigned long *free = (unsigned long *) nsindex->free; | |
| u32 nfree = ALIGN(nslot, BITS_PER_LONG); | |
| int last_bits, i; | |
| memset(nsindex->free, 0xff, nfree / 8); | |
| for (i = 0, last_bits = nfree - nslot; i < last_bits; i++) | |
| clear_bit_le(nslot + i, free); | |
| } | |
| checksum = nd_fletcher64(nsindex, sizeof_namespace_index(ndd), 1); | |
| nsindex->checksum = __cpu_to_le64(checksum); | |
| rc = nvdimm_set_config_data(ndd, __le64_to_cpu(nsindex->myoff), | |
| nsindex, sizeof_namespace_index(ndd)); | |
| if (rc < 0) | |
| return rc; | |
| if (flags & ND_NSINDEX_INIT) | |
| return 0; | |
| /* copy the index we just wrote to the new 'next' */ | |
| WARN_ON(index != ndd->ns_next); | |
| nd_label_copy(ndd, to_current_namespace_index(ndd), nsindex); | |
| ndd->ns_current = nd_label_next_nsindex(ndd->ns_current); | |
| ndd->ns_next = nd_label_next_nsindex(ndd->ns_next); | |
| WARN_ON(ndd->ns_current == ndd->ns_next); | |
| return 0; | |
| } | |
| static unsigned long nd_label_offset(struct nvdimm_drvdata *ndd, | |
| struct nd_namespace_label *nd_label) | |
| { | |
| return (unsigned long) nd_label | |
| - (unsigned long) to_namespace_index(ndd, 0); | |
| } | |
| static int __pmem_label_update(struct nd_region *nd_region, | |
| struct nd_mapping *nd_mapping, struct nd_namespace_pmem *nspm, | |
| int pos) | |
| { | |
| u64 cookie = nd_region_interleave_set_cookie(nd_region), rawsize; | |
| struct nvdimm_drvdata *ndd = to_ndd(nd_mapping); | |
| struct nd_namespace_label *victim_label; | |
| struct nd_namespace_label *nd_label; | |
| struct nd_namespace_index *nsindex; | |
| unsigned long *free; | |
| u32 nslot, slot; | |
| size_t offset; | |
| int rc; | |
| if (!preamble_next(ndd, &nsindex, &free, &nslot)) | |
| return -ENXIO; | |
| /* allocate and write the label to the staging (next) index */ | |
| slot = nd_label_alloc_slot(ndd); | |
| if (slot == UINT_MAX) | |
| return -ENXIO; | |
| dev_dbg(ndd->dev, "%s: allocated: %d\n", __func__, slot); | |
| nd_label = nd_label_base(ndd) + slot; | |
| memset(nd_label, 0, sizeof(struct nd_namespace_label)); | |
| memcpy(nd_label->uuid, nspm->uuid, NSLABEL_UUID_LEN); | |
| if (nspm->alt_name) | |
| memcpy(nd_label->name, nspm->alt_name, NSLABEL_NAME_LEN); | |
| nd_label->flags = __cpu_to_le32(NSLABEL_FLAG_UPDATING); | |
| nd_label->nlabel = __cpu_to_le16(nd_region->ndr_mappings); | |
| nd_label->position = __cpu_to_le16(pos); | |
| nd_label->isetcookie = __cpu_to_le64(cookie); | |
| rawsize = div_u64(resource_size(&nspm->nsio.res), | |
| nd_region->ndr_mappings); | |
| nd_label->rawsize = __cpu_to_le64(rawsize); | |
| nd_label->dpa = __cpu_to_le64(nd_mapping->start); | |
| nd_label->slot = __cpu_to_le32(slot); | |
| /* update label */ | |
| offset = nd_label_offset(ndd, nd_label); | |
| rc = nvdimm_set_config_data(ndd, offset, nd_label, | |
| sizeof(struct nd_namespace_label)); | |
| if (rc < 0) | |
| return rc; | |
| /* Garbage collect the previous label */ | |
| victim_label = nd_mapping->labels[0]; | |
| if (victim_label) { | |
| slot = to_slot(ndd, victim_label); | |
| nd_label_free_slot(ndd, slot); | |
| dev_dbg(ndd->dev, "%s: free: %d\n", __func__, slot); | |
| } | |
| /* update index */ | |
| rc = nd_label_write_index(ndd, ndd->ns_next, | |
| nd_inc_seq(__le32_to_cpu(nsindex->seq)), 0); | |
| if (rc < 0) | |
| return rc; | |
| nd_mapping->labels[0] = nd_label; | |
| return 0; | |
| } | |
| static void del_label(struct nd_mapping *nd_mapping, int l) | |
| { | |
| struct nd_namespace_label *next_label, *nd_label; | |
| struct nvdimm_drvdata *ndd = to_ndd(nd_mapping); | |
| unsigned int slot; | |
| int j; | |
| nd_label = nd_mapping->labels[l]; | |
| slot = to_slot(ndd, nd_label); | |
| dev_vdbg(ndd->dev, "%s: clear: %d\n", __func__, slot); | |
| for (j = l; (next_label = nd_mapping->labels[j + 1]); j++) | |
| nd_mapping->labels[j] = next_label; | |
| nd_mapping->labels[j] = NULL; | |
| } | |
| static bool is_old_resource(struct resource *res, struct resource **list, int n) | |
| { | |
| int i; | |
| if (res->flags & DPA_RESOURCE_ADJUSTED) | |
| return false; | |
| for (i = 0; i < n; i++) | |
| if (res == list[i]) | |
| return true; | |
| return false; | |
| } | |
| static struct resource *to_resource(struct nvdimm_drvdata *ndd, | |
| struct nd_namespace_label *nd_label) | |
| { | |
| struct resource *res; | |
| for_each_dpa_resource(ndd, res) { | |
| if (res->start != __le64_to_cpu(nd_label->dpa)) | |
| continue; | |
| if (resource_size(res) != __le64_to_cpu(nd_label->rawsize)) | |
| continue; | |
| return res; | |
| } | |
| return NULL; | |
| } | |
| /* | |
| * 1/ Account all the labels that can be freed after this update | |
| * 2/ Allocate and write the label to the staging (next) index | |
| * 3/ Record the resources in the namespace device | |
| */ | |
| static int __blk_label_update(struct nd_region *nd_region, | |
| struct nd_mapping *nd_mapping, struct nd_namespace_blk *nsblk, | |
| int num_labels) | |
| { | |
| int i, l, alloc, victims, nfree, old_num_resources, nlabel, rc = -ENXIO; | |
| struct nvdimm_drvdata *ndd = to_ndd(nd_mapping); | |
| struct nd_namespace_label *nd_label; | |
| struct nd_namespace_index *nsindex; | |
| unsigned long *free, *victim_map = NULL; | |
| struct resource *res, **old_res_list; | |
| struct nd_label_id label_id; | |
| u8 uuid[NSLABEL_UUID_LEN]; | |
| u32 nslot, slot; | |
| if (!preamble_next(ndd, &nsindex, &free, &nslot)) | |
| return -ENXIO; | |
| old_res_list = nsblk->res; | |
| nfree = nd_label_nfree(ndd); | |
| old_num_resources = nsblk->num_resources; | |
| nd_label_gen_id(&label_id, nsblk->uuid, NSLABEL_FLAG_LOCAL); | |
| /* | |
| * We need to loop over the old resources a few times, which seems a | |
| * bit inefficient, but we need to know that we have the label | |
| * space before we start mutating the tracking structures. | |
| * Otherwise the recovery method of last resort for userspace is | |
| * disable and re-enable the parent region. | |
| */ | |
| alloc = 0; | |
| for_each_dpa_resource(ndd, res) { | |
| if (strcmp(res->name, label_id.id) != 0) | |
| continue; | |
| if (!is_old_resource(res, old_res_list, old_num_resources)) | |
| alloc++; | |
| } | |
| victims = 0; | |
| if (old_num_resources) { | |
| /* convert old local-label-map to dimm-slot victim-map */ | |
| victim_map = kcalloc(BITS_TO_LONGS(nslot), sizeof(long), | |
| GFP_KERNEL); | |
| if (!victim_map) | |
| return -ENOMEM; | |
| /* mark unused labels for garbage collection */ | |
| for_each_clear_bit_le(slot, free, nslot) { | |
| nd_label = nd_label_base(ndd) + slot; | |
| memcpy(uuid, nd_label->uuid, NSLABEL_UUID_LEN); | |
| if (memcmp(uuid, nsblk->uuid, NSLABEL_UUID_LEN) != 0) | |
| continue; | |
| res = to_resource(ndd, nd_label); | |
| if (res && is_old_resource(res, old_res_list, | |
| old_num_resources)) | |
| continue; | |
| slot = to_slot(ndd, nd_label); | |
| set_bit(slot, victim_map); | |
| victims++; | |
| } | |
| } | |
| /* don't allow updates that consume the last label */ | |
| if (nfree - alloc < 0 || nfree - alloc + victims < 1) { | |
| dev_info(&nsblk->common.dev, "insufficient label space\n"); | |
| kfree(victim_map); | |
| return -ENOSPC; | |
| } | |
| /* from here on we need to abort on error */ | |
| /* assign all resources to the namespace before writing the labels */ | |
| nsblk->res = NULL; | |
| nsblk->num_resources = 0; | |
| for_each_dpa_resource(ndd, res) { | |
| if (strcmp(res->name, label_id.id) != 0) | |
| continue; | |
| if (!nsblk_add_resource(nd_region, ndd, nsblk, res->start)) { | |
| rc = -ENOMEM; | |
| goto abort; | |
| } | |
| } | |
| for (i = 0; i < nsblk->num_resources; i++) { | |
| size_t offset; | |
| res = nsblk->res[i]; | |
| if (is_old_resource(res, old_res_list, old_num_resources)) | |
| continue; /* carry-over */ | |
| slot = nd_label_alloc_slot(ndd); | |
| if (slot == UINT_MAX) | |
| goto abort; | |
| dev_dbg(ndd->dev, "%s: allocated: %d\n", __func__, slot); | |
| nd_label = nd_label_base(ndd) + slot; | |
| memset(nd_label, 0, sizeof(struct nd_namespace_label)); | |
| memcpy(nd_label->uuid, nsblk->uuid, NSLABEL_UUID_LEN); | |
| if (nsblk->alt_name) | |
| memcpy(nd_label->name, nsblk->alt_name, | |
| NSLABEL_NAME_LEN); | |
| nd_label->flags = __cpu_to_le32(NSLABEL_FLAG_LOCAL); | |
| nd_label->nlabel = __cpu_to_le16(0); /* N/A */ | |
| nd_label->position = __cpu_to_le16(0); /* N/A */ | |
| nd_label->isetcookie = __cpu_to_le64(0); /* N/A */ | |
| nd_label->dpa = __cpu_to_le64(res->start); | |
| nd_label->rawsize = __cpu_to_le64(resource_size(res)); | |
| nd_label->lbasize = __cpu_to_le64(nsblk->lbasize); | |
| nd_label->slot = __cpu_to_le32(slot); | |
| /* update label */ | |
| offset = nd_label_offset(ndd, nd_label); | |
| rc = nvdimm_set_config_data(ndd, offset, nd_label, | |
| sizeof(struct nd_namespace_label)); | |
| if (rc < 0) | |
| goto abort; | |
| } | |
| /* free up now unused slots in the new index */ | |
| for_each_set_bit(slot, victim_map, victim_map ? nslot : 0) { | |
| dev_dbg(ndd->dev, "%s: free: %d\n", __func__, slot); | |
| nd_label_free_slot(ndd, slot); | |
| } | |
| /* update index */ | |
| rc = nd_label_write_index(ndd, ndd->ns_next, | |
| nd_inc_seq(__le32_to_cpu(nsindex->seq)), 0); | |
| if (rc) | |
| goto abort; | |
| /* | |
| * Now that the on-dimm labels are up to date, fix up the tracking | |
| * entries in nd_mapping->labels | |
| */ | |
| nlabel = 0; | |
| for_each_label(l, nd_label, nd_mapping->labels) { | |
| nlabel++; | |
| memcpy(uuid, nd_label->uuid, NSLABEL_UUID_LEN); | |
| if (memcmp(uuid, nsblk->uuid, NSLABEL_UUID_LEN) != 0) | |
| continue; | |
| nlabel--; | |
| del_label(nd_mapping, l); | |
| l--; /* retry with the new label at this index */ | |
| } | |
| if (nlabel + nsblk->num_resources > num_labels) { | |
| /* | |
| * Bug, we can't end up with more resources than | |
| * available labels | |
| */ | |
| WARN_ON_ONCE(1); | |
| rc = -ENXIO; | |
| goto out; | |
| } | |
| for_each_clear_bit_le(slot, free, nslot) { | |
| nd_label = nd_label_base(ndd) + slot; | |
| memcpy(uuid, nd_label->uuid, NSLABEL_UUID_LEN); | |
| if (memcmp(uuid, nsblk->uuid, NSLABEL_UUID_LEN) != 0) | |
| continue; | |
| res = to_resource(ndd, nd_label); | |
| res->flags &= ~DPA_RESOURCE_ADJUSTED; | |
| dev_vdbg(&nsblk->common.dev, "assign label[%d] slot: %d\n", | |
| l, slot); | |
| nd_mapping->labels[l++] = nd_label; | |
| } | |
| nd_mapping->labels[l] = NULL; | |
| out: | |
| kfree(old_res_list); | |
| kfree(victim_map); | |
| return rc; | |
| abort: | |
| /* | |
| * 1/ repair the allocated label bitmap in the index | |
| * 2/ restore the resource list | |
| */ | |
| nd_label_copy(ndd, nsindex, to_current_namespace_index(ndd)); | |
| kfree(nsblk->res); | |
| nsblk->res = old_res_list; | |
| nsblk->num_resources = old_num_resources; | |
| old_res_list = NULL; | |
| goto out; | |
| } | |
| static int init_labels(struct nd_mapping *nd_mapping, int num_labels) | |
| { | |
| int i, l, old_num_labels = 0; | |
| struct nd_namespace_index *nsindex; | |
| struct nd_namespace_label *nd_label; | |
| struct nvdimm_drvdata *ndd = to_ndd(nd_mapping); | |
| size_t size = (num_labels + 1) * sizeof(struct nd_namespace_label *); | |
| for_each_label(l, nd_label, nd_mapping->labels) | |
| old_num_labels++; | |
| /* | |
| * We need to preserve all the old labels for the mapping so | |
| * they can be garbage collected after writing the new labels. | |
| */ | |
| if (num_labels > old_num_labels) { | |
| struct nd_namespace_label **labels; | |
| labels = krealloc(nd_mapping->labels, size, GFP_KERNEL); | |
| if (!labels) | |
| return -ENOMEM; | |
| nd_mapping->labels = labels; | |
| } | |
| if (!nd_mapping->labels) | |
| return -ENOMEM; | |
| for (i = old_num_labels; i <= num_labels; i++) | |
| nd_mapping->labels[i] = NULL; | |
| if (ndd->ns_current == -1 || ndd->ns_next == -1) | |
| /* pass */; | |
| else | |
| return max(num_labels, old_num_labels); | |
| nsindex = to_namespace_index(ndd, 0); | |
| memset(nsindex, 0, ndd->nsarea.config_size); | |
| for (i = 0; i < 2; i++) { | |
| int rc = nd_label_write_index(ndd, i, i*2, ND_NSINDEX_INIT); | |
| if (rc) | |
| return rc; | |
| } | |
| ndd->ns_next = 1; | |
| ndd->ns_current = 0; | |
| return max(num_labels, old_num_labels); | |
| } | |
| static int del_labels(struct nd_mapping *nd_mapping, u8 *uuid) | |
| { | |
| struct nvdimm_drvdata *ndd = to_ndd(nd_mapping); | |
| struct nd_namespace_label *nd_label; | |
| struct nd_namespace_index *nsindex; | |
| u8 label_uuid[NSLABEL_UUID_LEN]; | |
| int l, num_freed = 0; | |
| unsigned long *free; | |
| u32 nslot, slot; | |
| if (!uuid) | |
| return 0; | |
| /* no index || no labels == nothing to delete */ | |
| if (!preamble_next(ndd, &nsindex, &free, &nslot) | |
| || !nd_mapping->labels) | |
| return 0; | |
| for_each_label(l, nd_label, nd_mapping->labels) { | |
| memcpy(label_uuid, nd_label->uuid, NSLABEL_UUID_LEN); | |
| if (memcmp(label_uuid, uuid, NSLABEL_UUID_LEN) != 0) | |
| continue; | |
| slot = to_slot(ndd, nd_label); | |
| nd_label_free_slot(ndd, slot); | |
| dev_dbg(ndd->dev, "%s: free: %d\n", __func__, slot); | |
| del_label(nd_mapping, l); | |
| num_freed++; | |
| l--; /* retry with new label at this index */ | |
| } | |
| if (num_freed > l) { | |
| /* | |
| * num_freed will only ever be > l when we delete the last | |
| * label | |
| */ | |
| kfree(nd_mapping->labels); | |
| nd_mapping->labels = NULL; | |
| dev_dbg(ndd->dev, "%s: no more labels\n", __func__); | |
| } | |
| return nd_label_write_index(ndd, ndd->ns_next, | |
| nd_inc_seq(__le32_to_cpu(nsindex->seq)), 0); | |
| } | |
| int nd_pmem_namespace_label_update(struct nd_region *nd_region, | |
| struct nd_namespace_pmem *nspm, resource_size_t size) | |
| { | |
| int i; | |
| for (i = 0; i < nd_region->ndr_mappings; i++) { | |
| struct nd_mapping *nd_mapping = &nd_region->mapping[i]; | |
| int rc; | |
| if (size == 0) { | |
| rc = del_labels(nd_mapping, nspm->uuid); | |
| if (rc) | |
| return rc; | |
| continue; | |
| } | |
| rc = init_labels(nd_mapping, 1); | |
| if (rc < 0) | |
| return rc; | |
| rc = __pmem_label_update(nd_region, nd_mapping, nspm, i); | |
| if (rc) | |
| return rc; | |
| } | |
| return 0; | |
| } | |
| int nd_blk_namespace_label_update(struct nd_region *nd_region, | |
| struct nd_namespace_blk *nsblk, resource_size_t size) | |
| { | |
| struct nd_mapping *nd_mapping = &nd_region->mapping[0]; | |
| struct resource *res; | |
| int count = 0; | |
| if (size == 0) | |
| return del_labels(nd_mapping, nsblk->uuid); | |
| for_each_dpa_resource(to_ndd(nd_mapping), res) | |
| count++; | |
| count = init_labels(nd_mapping, count); | |
| if (count < 0) | |
| return count; | |
| return __blk_label_update(nd_region, nd_mapping, nsblk, count); | |
| } |