1 // SPDX-License-Identifier: GPL-2.0-only
2 /*
3 * Copyright(c) 2013-2015 Intel Corporation. All rights reserved.
4 */
5 #include <linux/device.h>
6 #include <linux/ndctl.h>
7 #include <linux/uuid.h>
8 #include <linux/slab.h>
9 #include <linux/io.h>
10 #include <linux/nd.h>
11 #include "nd-core.h"
12 #include "label.h"
13 #include "nd.h"
14
15 static guid_t nvdimm_btt_guid;
16 static guid_t nvdimm_btt2_guid;
17 static guid_t nvdimm_pfn_guid;
18 static guid_t nvdimm_dax_guid;
19
20 static uuid_t nvdimm_btt_uuid;
21 static uuid_t nvdimm_btt2_uuid;
22 static uuid_t nvdimm_pfn_uuid;
23 static uuid_t nvdimm_dax_uuid;
24
25 static uuid_t cxl_region_uuid;
26 static uuid_t cxl_namespace_uuid;
27
28 static const char NSINDEX_SIGNATURE[] = "NAMESPACE_INDEX\0";
29
best_seq(u32 a,u32 b)30 static u32 best_seq(u32 a, u32 b)
31 {
32 a &= NSINDEX_SEQ_MASK;
33 b &= NSINDEX_SEQ_MASK;
34
35 if (a == 0 || a == b)
36 return b;
37 else if (b == 0)
38 return a;
39 else if (nd_inc_seq(a) == b)
40 return b;
41 else
42 return a;
43 }
44
sizeof_namespace_label(struct nvdimm_drvdata * ndd)45 unsigned sizeof_namespace_label(struct nvdimm_drvdata *ndd)
46 {
47 return ndd->nslabel_size;
48 }
49
__sizeof_namespace_index(u32 nslot)50 static size_t __sizeof_namespace_index(u32 nslot)
51 {
52 return ALIGN(sizeof(struct nd_namespace_index) + DIV_ROUND_UP(nslot, 8),
53 NSINDEX_ALIGN);
54 }
55
__nvdimm_num_label_slots(struct nvdimm_drvdata * ndd,size_t index_size)56 static int __nvdimm_num_label_slots(struct nvdimm_drvdata *ndd,
57 size_t index_size)
58 {
59 return (ndd->nsarea.config_size - index_size * 2) /
60 sizeof_namespace_label(ndd);
61 }
62
nvdimm_num_label_slots(struct nvdimm_drvdata * ndd)63 int nvdimm_num_label_slots(struct nvdimm_drvdata *ndd)
64 {
65 u32 tmp_nslot, n;
66
67 tmp_nslot = ndd->nsarea.config_size / sizeof_namespace_label(ndd);
68 n = __sizeof_namespace_index(tmp_nslot) / NSINDEX_ALIGN;
69
70 return __nvdimm_num_label_slots(ndd, NSINDEX_ALIGN * n);
71 }
72
sizeof_namespace_index(struct nvdimm_drvdata * ndd)73 size_t sizeof_namespace_index(struct nvdimm_drvdata *ndd)
74 {
75 u32 nslot, space, size;
76
77 /*
78 * Per UEFI 2.7, the minimum size of the Label Storage Area is large
79 * enough to hold 2 index blocks and 2 labels. The minimum index
80 * block size is 256 bytes. The label size is 128 for namespaces
81 * prior to version 1.2 and at minimum 256 for version 1.2 and later.
82 */
83 nslot = nvdimm_num_label_slots(ndd);
84 space = ndd->nsarea.config_size - nslot * sizeof_namespace_label(ndd);
85 size = __sizeof_namespace_index(nslot) * 2;
86 if (size <= space && nslot >= 2)
87 return size / 2;
88
89 dev_err(ndd->dev, "label area (%d) too small to host (%d byte) labels\n",
90 ndd->nsarea.config_size, sizeof_namespace_label(ndd));
91 return 0;
92 }
93
__nd_label_validate(struct nvdimm_drvdata * ndd)94 static int __nd_label_validate(struct nvdimm_drvdata *ndd)
95 {
96 /*
97 * On media label format consists of two index blocks followed
98 * by an array of labels. None of these structures are ever
99 * updated in place. A sequence number tracks the current
100 * active index and the next one to write, while labels are
101 * written to free slots.
102 *
103 * +------------+
104 * | |
105 * | nsindex0 |
106 * | |
107 * +------------+
108 * | |
109 * | nsindex1 |
110 * | |
111 * +------------+
112 * | label0 |
113 * +------------+
114 * | label1 |
115 * +------------+
116 * | |
117 * ....nslot...
118 * | |
119 * +------------+
120 * | labelN |
121 * +------------+
122 */
123 struct nd_namespace_index *nsindex[] = {
124 to_namespace_index(ndd, 0),
125 to_namespace_index(ndd, 1),
126 };
127 const int num_index = ARRAY_SIZE(nsindex);
128 struct device *dev = ndd->dev;
129 bool valid[2] = { 0 };
130 int i, num_valid = 0;
131 u32 seq;
132
133 for (i = 0; i < num_index; i++) {
134 u32 nslot;
135 u8 sig[NSINDEX_SIG_LEN];
136 u64 sum_save, sum, size;
137 unsigned int version, labelsize;
138
139 memcpy(sig, nsindex[i]->sig, NSINDEX_SIG_LEN);
140 if (memcmp(sig, NSINDEX_SIGNATURE, NSINDEX_SIG_LEN) != 0) {
141 dev_dbg(dev, "nsindex%d signature invalid\n", i);
142 continue;
143 }
144
145 /* label sizes larger than 128 arrived with v1.2 */
146 version = __le16_to_cpu(nsindex[i]->major) * 100
147 + __le16_to_cpu(nsindex[i]->minor);
148 if (version >= 102)
149 labelsize = 1 << (7 + nsindex[i]->labelsize);
150 else
151 labelsize = 128;
152
153 if (labelsize != sizeof_namespace_label(ndd)) {
154 dev_dbg(dev, "nsindex%d labelsize %d invalid\n",
155 i, nsindex[i]->labelsize);
156 continue;
157 }
158
159 sum_save = __le64_to_cpu(nsindex[i]->checksum);
160 nsindex[i]->checksum = __cpu_to_le64(0);
161 sum = nd_fletcher64(nsindex[i], sizeof_namespace_index(ndd), 1);
162 nsindex[i]->checksum = __cpu_to_le64(sum_save);
163 if (sum != sum_save) {
164 dev_dbg(dev, "nsindex%d checksum invalid\n", i);
165 continue;
166 }
167
168 seq = __le32_to_cpu(nsindex[i]->seq);
169 if ((seq & NSINDEX_SEQ_MASK) == 0) {
170 dev_dbg(dev, "nsindex%d sequence: %#x invalid\n", i, seq);
171 continue;
172 }
173
174 /* sanity check the index against expected values */
175 if (__le64_to_cpu(nsindex[i]->myoff)
176 != i * sizeof_namespace_index(ndd)) {
177 dev_dbg(dev, "nsindex%d myoff: %#llx invalid\n",
178 i, (unsigned long long)
179 __le64_to_cpu(nsindex[i]->myoff));
180 continue;
181 }
182 if (__le64_to_cpu(nsindex[i]->otheroff)
183 != (!i) * sizeof_namespace_index(ndd)) {
184 dev_dbg(dev, "nsindex%d otheroff: %#llx invalid\n",
185 i, (unsigned long long)
186 __le64_to_cpu(nsindex[i]->otheroff));
187 continue;
188 }
189 if (__le64_to_cpu(nsindex[i]->labeloff)
190 != 2 * sizeof_namespace_index(ndd)) {
191 dev_dbg(dev, "nsindex%d labeloff: %#llx invalid\n",
192 i, (unsigned long long)
193 __le64_to_cpu(nsindex[i]->labeloff));
194 continue;
195 }
196
197 size = __le64_to_cpu(nsindex[i]->mysize);
198 if (size > sizeof_namespace_index(ndd)
199 || size < sizeof(struct nd_namespace_index)) {
200 dev_dbg(dev, "nsindex%d mysize: %#llx invalid\n", i, size);
201 continue;
202 }
203
204 nslot = __le32_to_cpu(nsindex[i]->nslot);
205 if (nslot * sizeof_namespace_label(ndd)
206 + 2 * sizeof_namespace_index(ndd)
207 > ndd->nsarea.config_size) {
208 dev_dbg(dev, "nsindex%d nslot: %u invalid, config_size: %#x\n",
209 i, nslot, ndd->nsarea.config_size);
210 continue;
211 }
212 valid[i] = true;
213 num_valid++;
214 }
215
216 switch (num_valid) {
217 case 0:
218 break;
219 case 1:
220 for (i = 0; i < num_index; i++)
221 if (valid[i])
222 return i;
223 /* can't have num_valid > 0 but valid[] = { false, false } */
224 WARN_ON(1);
225 break;
226 default:
227 /* pick the best index... */
228 seq = best_seq(__le32_to_cpu(nsindex[0]->seq),
229 __le32_to_cpu(nsindex[1]->seq));
230 if (seq == (__le32_to_cpu(nsindex[1]->seq) & NSINDEX_SEQ_MASK))
231 return 1;
232 else
233 return 0;
234 break;
235 }
236
237 return -1;
238 }
239
nd_label_validate(struct nvdimm_drvdata * ndd)240 static int nd_label_validate(struct nvdimm_drvdata *ndd)
241 {
242 /*
243 * In order to probe for and validate namespace index blocks we
244 * need to know the size of the labels, and we can't trust the
245 * size of the labels until we validate the index blocks.
246 * Resolve this dependency loop by probing for known label
247 * sizes, but default to v1.2 256-byte namespace labels if
248 * discovery fails.
249 */
250 int label_size[] = { 128, 256 };
251 int i, rc;
252
253 for (i = 0; i < ARRAY_SIZE(label_size); i++) {
254 ndd->nslabel_size = label_size[i];
255 rc = __nd_label_validate(ndd);
256 if (rc >= 0)
257 return rc;
258 }
259
260 return -1;
261 }
262
nd_label_copy(struct nvdimm_drvdata * ndd,struct nd_namespace_index * dst,struct nd_namespace_index * src)263 static void nd_label_copy(struct nvdimm_drvdata *ndd,
264 struct nd_namespace_index *dst,
265 struct nd_namespace_index *src)
266 {
267 /* just exit if either destination or source is NULL */
268 if (!dst || !src)
269 return;
270
271 memcpy(dst, src, sizeof_namespace_index(ndd));
272 }
273
nd_label_base(struct nvdimm_drvdata * ndd)274 static struct nd_namespace_label *nd_label_base(struct nvdimm_drvdata *ndd)
275 {
276 void *base = to_namespace_index(ndd, 0);
277
278 return base + 2 * sizeof_namespace_index(ndd);
279 }
280
to_slot(struct nvdimm_drvdata * ndd,struct nd_namespace_label * nd_label)281 static int to_slot(struct nvdimm_drvdata *ndd,
282 struct nd_namespace_label *nd_label)
283 {
284 unsigned long label, base;
285
286 label = (unsigned long) nd_label;
287 base = (unsigned long) nd_label_base(ndd);
288
289 return (label - base) / sizeof_namespace_label(ndd);
290 }
291
to_label(struct nvdimm_drvdata * ndd,int slot)292 static struct nd_namespace_label *to_label(struct nvdimm_drvdata *ndd, int slot)
293 {
294 unsigned long label, base;
295
296 base = (unsigned long) nd_label_base(ndd);
297 label = base + sizeof_namespace_label(ndd) * slot;
298
299 return (struct nd_namespace_label *) label;
300 }
301
302 #define for_each_clear_bit_le(bit, addr, size) \
303 for ((bit) = find_next_zero_bit_le((addr), (size), 0); \
304 (bit) < (size); \
305 (bit) = find_next_zero_bit_le((addr), (size), (bit) + 1))
306
307 /**
308 * preamble_index - common variable initialization for nd_label_* routines
309 * @ndd: dimm container for the relevant label set
310 * @idx: namespace_index index
311 * @nsindex_out: on return set to the currently active namespace index
312 * @free: on return set to the free label bitmap in the index
313 * @nslot: on return set to the number of slots in the label space
314 */
preamble_index(struct nvdimm_drvdata * ndd,int idx,struct nd_namespace_index ** nsindex_out,unsigned long ** free,u32 * nslot)315 static bool preamble_index(struct nvdimm_drvdata *ndd, int idx,
316 struct nd_namespace_index **nsindex_out,
317 unsigned long **free, u32 *nslot)
318 {
319 struct nd_namespace_index *nsindex;
320
321 nsindex = to_namespace_index(ndd, idx);
322 if (nsindex == NULL)
323 return false;
324
325 *free = (unsigned long *) nsindex->free;
326 *nslot = __le32_to_cpu(nsindex->nslot);
327 *nsindex_out = nsindex;
328
329 return true;
330 }
331
nd_label_gen_id(struct nd_label_id * label_id,const uuid_t * uuid,u32 flags)332 char *nd_label_gen_id(struct nd_label_id *label_id, const uuid_t *uuid,
333 u32 flags)
334 {
335 if (!label_id || !uuid)
336 return NULL;
337 snprintf(label_id->id, ND_LABEL_ID_SIZE, "%s-%pUb",
338 flags & NSLABEL_FLAG_LOCAL ? "blk" : "pmem", uuid);
339 return label_id->id;
340 }
341
preamble_current(struct nvdimm_drvdata * ndd,struct nd_namespace_index ** nsindex,unsigned long ** free,u32 * nslot)342 static bool preamble_current(struct nvdimm_drvdata *ndd,
343 struct nd_namespace_index **nsindex,
344 unsigned long **free, u32 *nslot)
345 {
346 return preamble_index(ndd, ndd->ns_current, nsindex,
347 free, nslot);
348 }
349
preamble_next(struct nvdimm_drvdata * ndd,struct nd_namespace_index ** nsindex,unsigned long ** free,u32 * nslot)350 static bool preamble_next(struct nvdimm_drvdata *ndd,
351 struct nd_namespace_index **nsindex,
352 unsigned long **free, u32 *nslot)
353 {
354 return preamble_index(ndd, ndd->ns_next, nsindex,
355 free, nslot);
356 }
357
nsl_validate_checksum(struct nvdimm_drvdata * ndd,struct nd_namespace_label * nd_label)358 static bool nsl_validate_checksum(struct nvdimm_drvdata *ndd,
359 struct nd_namespace_label *nd_label)
360 {
361 u64 sum, sum_save;
362
363 if (!ndd->cxl && !efi_namespace_label_has(ndd, checksum))
364 return true;
365
366 sum_save = nsl_get_checksum(ndd, nd_label);
367 nsl_set_checksum(ndd, nd_label, 0);
368 sum = nd_fletcher64(nd_label, sizeof_namespace_label(ndd), 1);
369 nsl_set_checksum(ndd, nd_label, sum_save);
370 return sum == sum_save;
371 }
372
nsl_calculate_checksum(struct nvdimm_drvdata * ndd,struct nd_namespace_label * nd_label)373 static void nsl_calculate_checksum(struct nvdimm_drvdata *ndd,
374 struct nd_namespace_label *nd_label)
375 {
376 u64 sum;
377
378 if (!ndd->cxl && !efi_namespace_label_has(ndd, checksum))
379 return;
380 nsl_set_checksum(ndd, nd_label, 0);
381 sum = nd_fletcher64(nd_label, sizeof_namespace_label(ndd), 1);
382 nsl_set_checksum(ndd, nd_label, sum);
383 }
384
slot_valid(struct nvdimm_drvdata * ndd,struct nd_namespace_label * nd_label,u32 slot)385 static bool slot_valid(struct nvdimm_drvdata *ndd,
386 struct nd_namespace_label *nd_label, u32 slot)
387 {
388 bool valid;
389
390 /* check that we are written where we expect to be written */
391 if (slot != nsl_get_slot(ndd, nd_label))
392 return false;
393 valid = nsl_validate_checksum(ndd, nd_label);
394 if (!valid)
395 dev_dbg(ndd->dev, "fail checksum. slot: %d\n", slot);
396 return valid;
397 }
398
nd_label_reserve_dpa(struct nvdimm_drvdata * ndd)399 int nd_label_reserve_dpa(struct nvdimm_drvdata *ndd)
400 {
401 struct nd_namespace_index *nsindex;
402 unsigned long *free;
403 u32 nslot, slot;
404
405 if (!preamble_current(ndd, &nsindex, &free, &nslot))
406 return 0; /* no label, nothing to reserve */
407
408 for_each_clear_bit_le(slot, free, nslot) {
409 struct nvdimm *nvdimm = to_nvdimm(ndd->dev);
410 struct nd_namespace_label *nd_label;
411 struct nd_region *nd_region = NULL;
412 struct nd_label_id label_id;
413 struct resource *res;
414 uuid_t label_uuid;
415 u32 flags;
416
417 nd_label = to_label(ndd, slot);
418
419 if (!slot_valid(ndd, nd_label, slot))
420 continue;
421
422 nsl_get_uuid(ndd, nd_label, &label_uuid);
423 flags = nsl_get_flags(ndd, nd_label);
424 if (test_bit(NDD_NOBLK, &nvdimm->flags))
425 flags &= ~NSLABEL_FLAG_LOCAL;
426 nd_label_gen_id(&label_id, &label_uuid, flags);
427 res = nvdimm_allocate_dpa(ndd, &label_id,
428 nsl_get_dpa(ndd, nd_label),
429 nsl_get_rawsize(ndd, nd_label));
430 nd_dbg_dpa(nd_region, ndd, res, "reserve\n");
431 if (!res)
432 return -EBUSY;
433 }
434
435 return 0;
436 }
437
nd_label_data_init(struct nvdimm_drvdata * ndd)438 int nd_label_data_init(struct nvdimm_drvdata *ndd)
439 {
440 size_t config_size, read_size, max_xfer, offset;
441 struct nd_namespace_index *nsindex;
442 unsigned int i;
443 int rc = 0;
444 u32 nslot;
445
446 if (ndd->data)
447 return 0;
448
449 if (ndd->nsarea.status || ndd->nsarea.max_xfer == 0) {
450 dev_dbg(ndd->dev, "failed to init config data area: (%u:%u)\n",
451 ndd->nsarea.max_xfer, ndd->nsarea.config_size);
452 return -ENXIO;
453 }
454
455 /*
456 * We need to determine the maximum index area as this is the section
457 * we must read and validate before we can start processing labels.
458 *
459 * If the area is too small to contain the two indexes and 2 labels
460 * then we abort.
461 *
462 * Start at a label size of 128 as this should result in the largest
463 * possible namespace index size.
464 */
465 ndd->nslabel_size = 128;
466 read_size = sizeof_namespace_index(ndd) * 2;
467 if (!read_size)
468 return -ENXIO;
469
470 /* Allocate config data */
471 config_size = ndd->nsarea.config_size;
472 ndd->data = kvzalloc(config_size, GFP_KERNEL);
473 if (!ndd->data)
474 return -ENOMEM;
475
476 /*
477 * We want to guarantee as few reads as possible while conserving
478 * memory. To do that we figure out how much unused space will be left
479 * in the last read, divide that by the total number of reads it is
480 * going to take given our maximum transfer size, and then reduce our
481 * maximum transfer size based on that result.
482 */
483 max_xfer = min_t(size_t, ndd->nsarea.max_xfer, config_size);
484 if (read_size < max_xfer) {
485 /* trim waste */
486 max_xfer -= ((max_xfer - 1) - (config_size - 1) % max_xfer) /
487 DIV_ROUND_UP(config_size, max_xfer);
488 /* make certain we read indexes in exactly 1 read */
489 if (max_xfer < read_size)
490 max_xfer = read_size;
491 }
492
493 /* Make our initial read size a multiple of max_xfer size */
494 read_size = min(DIV_ROUND_UP(read_size, max_xfer) * max_xfer,
495 config_size);
496
497 /* Read the index data */
498 rc = nvdimm_get_config_data(ndd, ndd->data, 0, read_size);
499 if (rc)
500 goto out_err;
501
502 /* Validate index data, if not valid assume all labels are invalid */
503 ndd->ns_current = nd_label_validate(ndd);
504 if (ndd->ns_current < 0)
505 return 0;
506
507 /* Record our index values */
508 ndd->ns_next = nd_label_next_nsindex(ndd->ns_current);
509
510 /* Copy "current" index on top of the "next" index */
511 nsindex = to_current_namespace_index(ndd);
512 nd_label_copy(ndd, to_next_namespace_index(ndd), nsindex);
513
514 /* Determine starting offset for label data */
515 offset = __le64_to_cpu(nsindex->labeloff);
516 nslot = __le32_to_cpu(nsindex->nslot);
517
518 /* Loop through the free list pulling in any active labels */
519 for (i = 0; i < nslot; i++, offset += ndd->nslabel_size) {
520 size_t label_read_size;
521
522 /* zero out the unused labels */
523 if (test_bit_le(i, nsindex->free)) {
524 memset(ndd->data + offset, 0, ndd->nslabel_size);
525 continue;
526 }
527
528 /* if we already read past here then just continue */
529 if (offset + ndd->nslabel_size <= read_size)
530 continue;
531
532 /* if we haven't read in a while reset our read_size offset */
533 if (read_size < offset)
534 read_size = offset;
535
536 /* determine how much more will be read after this next call. */
537 label_read_size = offset + ndd->nslabel_size - read_size;
538 label_read_size = DIV_ROUND_UP(label_read_size, max_xfer) *
539 max_xfer;
540
541 /* truncate last read if needed */
542 if (read_size + label_read_size > config_size)
543 label_read_size = config_size - read_size;
544
545 /* Read the label data */
546 rc = nvdimm_get_config_data(ndd, ndd->data + read_size,
547 read_size, label_read_size);
548 if (rc)
549 goto out_err;
550
551 /* push read_size to next read offset */
552 read_size += label_read_size;
553 }
554
555 dev_dbg(ndd->dev, "len: %zu rc: %d\n", offset, rc);
556 out_err:
557 return rc;
558 }
559
nd_label_active_count(struct nvdimm_drvdata * ndd)560 int nd_label_active_count(struct nvdimm_drvdata *ndd)
561 {
562 struct nd_namespace_index *nsindex;
563 unsigned long *free;
564 u32 nslot, slot;
565 int count = 0;
566
567 if (!preamble_current(ndd, &nsindex, &free, &nslot))
568 return 0;
569
570 for_each_clear_bit_le(slot, free, nslot) {
571 struct nd_namespace_label *nd_label;
572
573 nd_label = to_label(ndd, slot);
574
575 if (!slot_valid(ndd, nd_label, slot)) {
576 u32 label_slot = nsl_get_slot(ndd, nd_label);
577 u64 size = nsl_get_rawsize(ndd, nd_label);
578 u64 dpa = nsl_get_dpa(ndd, nd_label);
579
580 dev_dbg(ndd->dev,
581 "slot%d invalid slot: %d dpa: %llx size: %llx\n",
582 slot, label_slot, dpa, size);
583 continue;
584 }
585 count++;
586 }
587 return count;
588 }
589
nd_label_active(struct nvdimm_drvdata * ndd,int n)590 struct nd_namespace_label *nd_label_active(struct nvdimm_drvdata *ndd, int n)
591 {
592 struct nd_namespace_index *nsindex;
593 unsigned long *free;
594 u32 nslot, slot;
595
596 if (!preamble_current(ndd, &nsindex, &free, &nslot))
597 return NULL;
598
599 for_each_clear_bit_le(slot, free, nslot) {
600 struct nd_namespace_label *nd_label;
601
602 nd_label = to_label(ndd, slot);
603 if (!slot_valid(ndd, nd_label, slot))
604 continue;
605
606 if (n-- == 0)
607 return to_label(ndd, slot);
608 }
609
610 return NULL;
611 }
612
nd_label_alloc_slot(struct nvdimm_drvdata * ndd)613 u32 nd_label_alloc_slot(struct nvdimm_drvdata *ndd)
614 {
615 struct nd_namespace_index *nsindex;
616 unsigned long *free;
617 u32 nslot, slot;
618
619 if (!preamble_next(ndd, &nsindex, &free, &nslot))
620 return UINT_MAX;
621
622 WARN_ON(!is_nvdimm_bus_locked(ndd->dev));
623
624 slot = find_next_bit_le(free, nslot, 0);
625 if (slot == nslot)
626 return UINT_MAX;
627
628 clear_bit_le(slot, free);
629
630 return slot;
631 }
632
nd_label_free_slot(struct nvdimm_drvdata * ndd,u32 slot)633 bool nd_label_free_slot(struct nvdimm_drvdata *ndd, u32 slot)
634 {
635 struct nd_namespace_index *nsindex;
636 unsigned long *free;
637 u32 nslot;
638
639 if (!preamble_next(ndd, &nsindex, &free, &nslot))
640 return false;
641
642 WARN_ON(!is_nvdimm_bus_locked(ndd->dev));
643
644 if (slot < nslot)
645 return !test_and_set_bit_le(slot, free);
646 return false;
647 }
648
nd_label_nfree(struct nvdimm_drvdata * ndd)649 u32 nd_label_nfree(struct nvdimm_drvdata *ndd)
650 {
651 struct nd_namespace_index *nsindex;
652 unsigned long *free;
653 u32 nslot;
654
655 WARN_ON(!is_nvdimm_bus_locked(ndd->dev));
656
657 if (!preamble_next(ndd, &nsindex, &free, &nslot))
658 return nvdimm_num_label_slots(ndd);
659
660 return bitmap_weight(free, nslot);
661 }
662
nd_label_write_index(struct nvdimm_drvdata * ndd,int index,u32 seq,unsigned long flags)663 static int nd_label_write_index(struct nvdimm_drvdata *ndd, int index, u32 seq,
664 unsigned long flags)
665 {
666 struct nd_namespace_index *nsindex;
667 unsigned long offset;
668 u64 checksum;
669 u32 nslot;
670 int rc;
671
672 nsindex = to_namespace_index(ndd, index);
673 if (flags & ND_NSINDEX_INIT)
674 nslot = nvdimm_num_label_slots(ndd);
675 else
676 nslot = __le32_to_cpu(nsindex->nslot);
677
678 memcpy(nsindex->sig, NSINDEX_SIGNATURE, NSINDEX_SIG_LEN);
679 memset(&nsindex->flags, 0, 3);
680 nsindex->labelsize = sizeof_namespace_label(ndd) >> 8;
681 nsindex->seq = __cpu_to_le32(seq);
682 offset = (unsigned long) nsindex
683 - (unsigned long) to_namespace_index(ndd, 0);
684 nsindex->myoff = __cpu_to_le64(offset);
685 nsindex->mysize = __cpu_to_le64(sizeof_namespace_index(ndd));
686 offset = (unsigned long) to_namespace_index(ndd,
687 nd_label_next_nsindex(index))
688 - (unsigned long) to_namespace_index(ndd, 0);
689 nsindex->otheroff = __cpu_to_le64(offset);
690 offset = (unsigned long) nd_label_base(ndd)
691 - (unsigned long) to_namespace_index(ndd, 0);
692 nsindex->labeloff = __cpu_to_le64(offset);
693 nsindex->nslot = __cpu_to_le32(nslot);
694 nsindex->major = __cpu_to_le16(1);
695 if (sizeof_namespace_label(ndd) < 256)
696 nsindex->minor = __cpu_to_le16(1);
697 else
698 nsindex->minor = __cpu_to_le16(2);
699 nsindex->checksum = __cpu_to_le64(0);
700 if (flags & ND_NSINDEX_INIT) {
701 unsigned long *free = (unsigned long *) nsindex->free;
702 u32 nfree = ALIGN(nslot, BITS_PER_LONG);
703 int last_bits, i;
704
705 memset(nsindex->free, 0xff, nfree / 8);
706 for (i = 0, last_bits = nfree - nslot; i < last_bits; i++)
707 clear_bit_le(nslot + i, free);
708 }
709 checksum = nd_fletcher64(nsindex, sizeof_namespace_index(ndd), 1);
710 nsindex->checksum = __cpu_to_le64(checksum);
711 rc = nvdimm_set_config_data(ndd, __le64_to_cpu(nsindex->myoff),
712 nsindex, sizeof_namespace_index(ndd));
713 if (rc < 0)
714 return rc;
715
716 if (flags & ND_NSINDEX_INIT)
717 return 0;
718
719 /* copy the index we just wrote to the new 'next' */
720 WARN_ON(index != ndd->ns_next);
721 nd_label_copy(ndd, to_current_namespace_index(ndd), nsindex);
722 ndd->ns_current = nd_label_next_nsindex(ndd->ns_current);
723 ndd->ns_next = nd_label_next_nsindex(ndd->ns_next);
724 WARN_ON(ndd->ns_current == ndd->ns_next);
725
726 return 0;
727 }
728
nd_label_offset(struct nvdimm_drvdata * ndd,struct nd_namespace_label * nd_label)729 static unsigned long nd_label_offset(struct nvdimm_drvdata *ndd,
730 struct nd_namespace_label *nd_label)
731 {
732 return (unsigned long) nd_label
733 - (unsigned long) to_namespace_index(ndd, 0);
734 }
735
guid_to_nvdimm_cclass(guid_t * guid)736 static enum nvdimm_claim_class guid_to_nvdimm_cclass(guid_t *guid)
737 {
738 if (guid_equal(guid, &nvdimm_btt_guid))
739 return NVDIMM_CCLASS_BTT;
740 else if (guid_equal(guid, &nvdimm_btt2_guid))
741 return NVDIMM_CCLASS_BTT2;
742 else if (guid_equal(guid, &nvdimm_pfn_guid))
743 return NVDIMM_CCLASS_PFN;
744 else if (guid_equal(guid, &nvdimm_dax_guid))
745 return NVDIMM_CCLASS_DAX;
746 else if (guid_equal(guid, &guid_null))
747 return NVDIMM_CCLASS_NONE;
748
749 return NVDIMM_CCLASS_UNKNOWN;
750 }
751
752 /* CXL labels store UUIDs instead of GUIDs for the same data */
uuid_to_nvdimm_cclass(uuid_t * uuid)753 static enum nvdimm_claim_class uuid_to_nvdimm_cclass(uuid_t *uuid)
754 {
755 if (uuid_equal(uuid, &nvdimm_btt_uuid))
756 return NVDIMM_CCLASS_BTT;
757 else if (uuid_equal(uuid, &nvdimm_btt2_uuid))
758 return NVDIMM_CCLASS_BTT2;
759 else if (uuid_equal(uuid, &nvdimm_pfn_uuid))
760 return NVDIMM_CCLASS_PFN;
761 else if (uuid_equal(uuid, &nvdimm_dax_uuid))
762 return NVDIMM_CCLASS_DAX;
763 else if (uuid_equal(uuid, &uuid_null))
764 return NVDIMM_CCLASS_NONE;
765
766 return NVDIMM_CCLASS_UNKNOWN;
767 }
768
to_abstraction_guid(enum nvdimm_claim_class claim_class,guid_t * target)769 static const guid_t *to_abstraction_guid(enum nvdimm_claim_class claim_class,
770 guid_t *target)
771 {
772 if (claim_class == NVDIMM_CCLASS_BTT)
773 return &nvdimm_btt_guid;
774 else if (claim_class == NVDIMM_CCLASS_BTT2)
775 return &nvdimm_btt2_guid;
776 else if (claim_class == NVDIMM_CCLASS_PFN)
777 return &nvdimm_pfn_guid;
778 else if (claim_class == NVDIMM_CCLASS_DAX)
779 return &nvdimm_dax_guid;
780 else if (claim_class == NVDIMM_CCLASS_UNKNOWN) {
781 /*
782 * If we're modifying a namespace for which we don't
783 * know the claim_class, don't touch the existing guid.
784 */
785 return target;
786 } else
787 return &guid_null;
788 }
789
790 /* CXL labels store UUIDs instead of GUIDs for the same data */
to_abstraction_uuid(enum nvdimm_claim_class claim_class,uuid_t * target)791 static const uuid_t *to_abstraction_uuid(enum nvdimm_claim_class claim_class,
792 uuid_t *target)
793 {
794 if (claim_class == NVDIMM_CCLASS_BTT)
795 return &nvdimm_btt_uuid;
796 else if (claim_class == NVDIMM_CCLASS_BTT2)
797 return &nvdimm_btt2_uuid;
798 else if (claim_class == NVDIMM_CCLASS_PFN)
799 return &nvdimm_pfn_uuid;
800 else if (claim_class == NVDIMM_CCLASS_DAX)
801 return &nvdimm_dax_uuid;
802 else if (claim_class == NVDIMM_CCLASS_UNKNOWN) {
803 /*
804 * If we're modifying a namespace for which we don't
805 * know the claim_class, don't touch the existing uuid.
806 */
807 return target;
808 } else
809 return &uuid_null;
810 }
811
reap_victim(struct nd_mapping * nd_mapping,struct nd_label_ent * victim)812 static void reap_victim(struct nd_mapping *nd_mapping,
813 struct nd_label_ent *victim)
814 {
815 struct nvdimm_drvdata *ndd = to_ndd(nd_mapping);
816 u32 slot = to_slot(ndd, victim->label);
817
818 dev_dbg(ndd->dev, "free: %d\n", slot);
819 nd_label_free_slot(ndd, slot);
820 victim->label = NULL;
821 }
822
nsl_set_type_guid(struct nvdimm_drvdata * ndd,struct nd_namespace_label * nd_label,guid_t * guid)823 static void nsl_set_type_guid(struct nvdimm_drvdata *ndd,
824 struct nd_namespace_label *nd_label, guid_t *guid)
825 {
826 if (efi_namespace_label_has(ndd, type_guid))
827 guid_copy(&nd_label->efi.type_guid, guid);
828 }
829
nsl_validate_type_guid(struct nvdimm_drvdata * ndd,struct nd_namespace_label * nd_label,guid_t * guid)830 bool nsl_validate_type_guid(struct nvdimm_drvdata *ndd,
831 struct nd_namespace_label *nd_label, guid_t *guid)
832 {
833 if (ndd->cxl || !efi_namespace_label_has(ndd, type_guid))
834 return true;
835 if (!guid_equal(&nd_label->efi.type_guid, guid)) {
836 dev_dbg(ndd->dev, "expect type_guid %pUb got %pUb\n", guid,
837 &nd_label->efi.type_guid);
838 return false;
839 }
840 return true;
841 }
842
nsl_set_claim_class(struct nvdimm_drvdata * ndd,struct nd_namespace_label * nd_label,enum nvdimm_claim_class claim_class)843 static void nsl_set_claim_class(struct nvdimm_drvdata *ndd,
844 struct nd_namespace_label *nd_label,
845 enum nvdimm_claim_class claim_class)
846 {
847 if (ndd->cxl) {
848 uuid_t uuid;
849
850 import_uuid(&uuid, nd_label->cxl.abstraction_uuid);
851 export_uuid(nd_label->cxl.abstraction_uuid,
852 to_abstraction_uuid(claim_class, &uuid));
853 return;
854 }
855
856 if (!efi_namespace_label_has(ndd, abstraction_guid))
857 return;
858 guid_copy(&nd_label->efi.abstraction_guid,
859 to_abstraction_guid(claim_class,
860 &nd_label->efi.abstraction_guid));
861 }
862
nsl_get_claim_class(struct nvdimm_drvdata * ndd,struct nd_namespace_label * nd_label)863 enum nvdimm_claim_class nsl_get_claim_class(struct nvdimm_drvdata *ndd,
864 struct nd_namespace_label *nd_label)
865 {
866 if (ndd->cxl) {
867 uuid_t uuid;
868
869 import_uuid(&uuid, nd_label->cxl.abstraction_uuid);
870 return uuid_to_nvdimm_cclass(&uuid);
871 }
872 if (!efi_namespace_label_has(ndd, abstraction_guid))
873 return NVDIMM_CCLASS_NONE;
874 return guid_to_nvdimm_cclass(&nd_label->efi.abstraction_guid);
875 }
876
__pmem_label_update(struct nd_region * nd_region,struct nd_mapping * nd_mapping,struct nd_namespace_pmem * nspm,int pos,unsigned long flags)877 static int __pmem_label_update(struct nd_region *nd_region,
878 struct nd_mapping *nd_mapping, struct nd_namespace_pmem *nspm,
879 int pos, unsigned long flags)
880 {
881 struct nd_namespace_common *ndns = &nspm->nsio.common;
882 struct nd_interleave_set *nd_set = nd_region->nd_set;
883 struct nvdimm_drvdata *ndd = to_ndd(nd_mapping);
884 struct nd_namespace_label *nd_label;
885 struct nd_namespace_index *nsindex;
886 struct nd_label_ent *label_ent;
887 struct nd_label_id label_id;
888 struct resource *res;
889 unsigned long *free;
890 u32 nslot, slot;
891 size_t offset;
892 u64 cookie;
893 int rc;
894
895 if (!preamble_next(ndd, &nsindex, &free, &nslot))
896 return -ENXIO;
897
898 cookie = nd_region_interleave_set_cookie(nd_region, nsindex);
899 nd_label_gen_id(&label_id, nspm->uuid, 0);
900 for_each_dpa_resource(ndd, res)
901 if (strcmp(res->name, label_id.id) == 0)
902 break;
903
904 if (!res) {
905 WARN_ON_ONCE(1);
906 return -ENXIO;
907 }
908
909 /* allocate and write the label to the staging (next) index */
910 slot = nd_label_alloc_slot(ndd);
911 if (slot == UINT_MAX)
912 return -ENXIO;
913 dev_dbg(ndd->dev, "allocated: %d\n", slot);
914
915 nd_label = to_label(ndd, slot);
916 memset(nd_label, 0, sizeof_namespace_label(ndd));
917 nsl_set_uuid(ndd, nd_label, nspm->uuid);
918 nsl_set_name(ndd, nd_label, nspm->alt_name);
919 nsl_set_flags(ndd, nd_label, flags);
920 nsl_set_nlabel(ndd, nd_label, nd_region->ndr_mappings);
921 nsl_set_nrange(ndd, nd_label, 1);
922 nsl_set_position(ndd, nd_label, pos);
923 nsl_set_isetcookie(ndd, nd_label, cookie);
924 nsl_set_rawsize(ndd, nd_label, resource_size(res));
925 nsl_set_lbasize(ndd, nd_label, nspm->lbasize);
926 nsl_set_dpa(ndd, nd_label, res->start);
927 nsl_set_slot(ndd, nd_label, slot);
928 nsl_set_type_guid(ndd, nd_label, &nd_set->type_guid);
929 nsl_set_claim_class(ndd, nd_label, ndns->claim_class);
930 nsl_calculate_checksum(ndd, nd_label);
931 nd_dbg_dpa(nd_region, ndd, res, "\n");
932
933 /* update label */
934 offset = nd_label_offset(ndd, nd_label);
935 rc = nvdimm_set_config_data(ndd, offset, nd_label,
936 sizeof_namespace_label(ndd));
937 if (rc < 0)
938 return rc;
939
940 /* Garbage collect the previous label */
941 mutex_lock(&nd_mapping->lock);
942 list_for_each_entry(label_ent, &nd_mapping->labels, list) {
943 if (!label_ent->label)
944 continue;
945 if (test_and_clear_bit(ND_LABEL_REAP, &label_ent->flags) ||
946 nsl_uuid_equal(ndd, label_ent->label, nspm->uuid))
947 reap_victim(nd_mapping, label_ent);
948 }
949
950 /* update index */
951 rc = nd_label_write_index(ndd, ndd->ns_next,
952 nd_inc_seq(__le32_to_cpu(nsindex->seq)), 0);
953 if (rc == 0) {
954 list_for_each_entry(label_ent, &nd_mapping->labels, list)
955 if (!label_ent->label) {
956 label_ent->label = nd_label;
957 nd_label = NULL;
958 break;
959 }
960 dev_WARN_ONCE(&nspm->nsio.common.dev, nd_label,
961 "failed to track label: %d\n",
962 to_slot(ndd, nd_label));
963 if (nd_label)
964 rc = -ENXIO;
965 }
966 mutex_unlock(&nd_mapping->lock);
967
968 return rc;
969 }
970
is_old_resource(struct resource * res,struct resource ** list,int n)971 static bool is_old_resource(struct resource *res, struct resource **list, int n)
972 {
973 int i;
974
975 if (res->flags & DPA_RESOURCE_ADJUSTED)
976 return false;
977 for (i = 0; i < n; i++)
978 if (res == list[i])
979 return true;
980 return false;
981 }
982
to_resource(struct nvdimm_drvdata * ndd,struct nd_namespace_label * nd_label)983 static struct resource *to_resource(struct nvdimm_drvdata *ndd,
984 struct nd_namespace_label *nd_label)
985 {
986 struct resource *res;
987
988 for_each_dpa_resource(ndd, res) {
989 if (res->start != nsl_get_dpa(ndd, nd_label))
990 continue;
991 if (resource_size(res) != nsl_get_rawsize(ndd, nd_label))
992 continue;
993 return res;
994 }
995
996 return NULL;
997 }
998
999 /*
1000 * Use the presence of the type_guid as a flag to determine isetcookie
1001 * usage and nlabel + position policy for blk-aperture namespaces.
1002 */
nsl_set_blk_isetcookie(struct nvdimm_drvdata * ndd,struct nd_namespace_label * nd_label,u64 isetcookie)1003 static void nsl_set_blk_isetcookie(struct nvdimm_drvdata *ndd,
1004 struct nd_namespace_label *nd_label,
1005 u64 isetcookie)
1006 {
1007 if (efi_namespace_label_has(ndd, type_guid)) {
1008 nsl_set_isetcookie(ndd, nd_label, isetcookie);
1009 return;
1010 }
1011 nsl_set_isetcookie(ndd, nd_label, 0); /* N/A */
1012 }
1013
nsl_validate_blk_isetcookie(struct nvdimm_drvdata * ndd,struct nd_namespace_label * nd_label,u64 isetcookie)1014 bool nsl_validate_blk_isetcookie(struct nvdimm_drvdata *ndd,
1015 struct nd_namespace_label *nd_label,
1016 u64 isetcookie)
1017 {
1018 if (!efi_namespace_label_has(ndd, type_guid))
1019 return true;
1020
1021 if (nsl_get_isetcookie(ndd, nd_label) != isetcookie) {
1022 dev_dbg(ndd->dev, "expect cookie %#llx got %#llx\n", isetcookie,
1023 nsl_get_isetcookie(ndd, nd_label));
1024 return false;
1025 }
1026
1027 return true;
1028 }
1029
nsl_set_blk_nlabel(struct nvdimm_drvdata * ndd,struct nd_namespace_label * nd_label,int nlabel,bool first)1030 static void nsl_set_blk_nlabel(struct nvdimm_drvdata *ndd,
1031 struct nd_namespace_label *nd_label, int nlabel,
1032 bool first)
1033 {
1034 if (!efi_namespace_label_has(ndd, type_guid)) {
1035 nsl_set_nlabel(ndd, nd_label, 0); /* N/A */
1036 return;
1037 }
1038 nsl_set_nlabel(ndd, nd_label, first ? nlabel : 0xffff);
1039 }
1040
nsl_set_blk_position(struct nvdimm_drvdata * ndd,struct nd_namespace_label * nd_label,bool first)1041 static void nsl_set_blk_position(struct nvdimm_drvdata *ndd,
1042 struct nd_namespace_label *nd_label,
1043 bool first)
1044 {
1045 if (!efi_namespace_label_has(ndd, type_guid)) {
1046 nsl_set_position(ndd, nd_label, 0);
1047 return;
1048 }
1049 nsl_set_position(ndd, nd_label, first ? 0 : 0xffff);
1050 }
1051
1052 /*
1053 * 1/ Account all the labels that can be freed after this update
1054 * 2/ Allocate and write the label to the staging (next) index
1055 * 3/ Record the resources in the namespace device
1056 */
__blk_label_update(struct nd_region * nd_region,struct nd_mapping * nd_mapping,struct nd_namespace_blk * nsblk,int num_labels)1057 static int __blk_label_update(struct nd_region *nd_region,
1058 struct nd_mapping *nd_mapping, struct nd_namespace_blk *nsblk,
1059 int num_labels)
1060 {
1061 int i, alloc, victims, nfree, old_num_resources, nlabel, rc = -ENXIO;
1062 struct nd_interleave_set *nd_set = nd_region->nd_set;
1063 struct nd_namespace_common *ndns = &nsblk->common;
1064 struct nvdimm_drvdata *ndd = to_ndd(nd_mapping);
1065 struct nd_namespace_label *nd_label;
1066 struct nd_label_ent *label_ent, *e;
1067 struct nd_namespace_index *nsindex;
1068 unsigned long *free, *victim_map = NULL;
1069 struct resource *res, **old_res_list;
1070 struct nd_label_id label_id;
1071 int min_dpa_idx = 0;
1072 LIST_HEAD(list);
1073 u32 nslot, slot;
1074
1075 if (!preamble_next(ndd, &nsindex, &free, &nslot))
1076 return -ENXIO;
1077
1078 old_res_list = nsblk->res;
1079 nfree = nd_label_nfree(ndd);
1080 old_num_resources = nsblk->num_resources;
1081 nd_label_gen_id(&label_id, nsblk->uuid, NSLABEL_FLAG_LOCAL);
1082
1083 /*
1084 * We need to loop over the old resources a few times, which seems a
1085 * bit inefficient, but we need to know that we have the label
1086 * space before we start mutating the tracking structures.
1087 * Otherwise the recovery method of last resort for userspace is
1088 * disable and re-enable the parent region.
1089 */
1090 alloc = 0;
1091 for_each_dpa_resource(ndd, res) {
1092 if (strcmp(res->name, label_id.id) != 0)
1093 continue;
1094 if (!is_old_resource(res, old_res_list, old_num_resources))
1095 alloc++;
1096 }
1097
1098 victims = 0;
1099 if (old_num_resources) {
1100 /* convert old local-label-map to dimm-slot victim-map */
1101 victim_map = bitmap_zalloc(nslot, GFP_KERNEL);
1102 if (!victim_map)
1103 return -ENOMEM;
1104
1105 /* mark unused labels for garbage collection */
1106 for_each_clear_bit_le(slot, free, nslot) {
1107 nd_label = to_label(ndd, slot);
1108 if (!nsl_uuid_equal(ndd, nd_label, nsblk->uuid))
1109 continue;
1110 res = to_resource(ndd, nd_label);
1111 if (res && is_old_resource(res, old_res_list,
1112 old_num_resources))
1113 continue;
1114 slot = to_slot(ndd, nd_label);
1115 set_bit(slot, victim_map);
1116 victims++;
1117 }
1118 }
1119
1120 /* don't allow updates that consume the last label */
1121 if (nfree - alloc < 0 || nfree - alloc + victims < 1) {
1122 dev_info(&nsblk->common.dev, "insufficient label space\n");
1123 bitmap_free(victim_map);
1124 return -ENOSPC;
1125 }
1126 /* from here on we need to abort on error */
1127
1128
1129 /* assign all resources to the namespace before writing the labels */
1130 nsblk->res = NULL;
1131 nsblk->num_resources = 0;
1132 for_each_dpa_resource(ndd, res) {
1133 if (strcmp(res->name, label_id.id) != 0)
1134 continue;
1135 if (!nsblk_add_resource(nd_region, ndd, nsblk, res->start)) {
1136 rc = -ENOMEM;
1137 goto abort;
1138 }
1139 }
1140
1141 /* release slots associated with any invalidated UUIDs */
1142 mutex_lock(&nd_mapping->lock);
1143 list_for_each_entry_safe(label_ent, e, &nd_mapping->labels, list)
1144 if (test_and_clear_bit(ND_LABEL_REAP, &label_ent->flags)) {
1145 reap_victim(nd_mapping, label_ent);
1146 list_move(&label_ent->list, &list);
1147 }
1148 mutex_unlock(&nd_mapping->lock);
1149
1150 /*
1151 * Find the resource associated with the first label in the set
1152 * per the v1.2 namespace specification.
1153 */
1154 for (i = 0; i < nsblk->num_resources; i++) {
1155 struct resource *min = nsblk->res[min_dpa_idx];
1156
1157 res = nsblk->res[i];
1158 if (res->start < min->start)
1159 min_dpa_idx = i;
1160 }
1161
1162 for (i = 0; i < nsblk->num_resources; i++) {
1163 size_t offset;
1164
1165 res = nsblk->res[i];
1166 if (is_old_resource(res, old_res_list, old_num_resources))
1167 continue; /* carry-over */
1168 slot = nd_label_alloc_slot(ndd);
1169 if (slot == UINT_MAX) {
1170 rc = -ENXIO;
1171 goto abort;
1172 }
1173 dev_dbg(ndd->dev, "allocated: %d\n", slot);
1174
1175 nd_label = to_label(ndd, slot);
1176 memset(nd_label, 0, sizeof_namespace_label(ndd));
1177 nsl_set_uuid(ndd, nd_label, nsblk->uuid);
1178 nsl_set_name(ndd, nd_label, nsblk->alt_name);
1179 nsl_set_flags(ndd, nd_label, NSLABEL_FLAG_LOCAL);
1180
1181 nsl_set_blk_nlabel(ndd, nd_label, nsblk->num_resources,
1182 i == min_dpa_idx);
1183 nsl_set_blk_position(ndd, nd_label, i == min_dpa_idx);
1184 nsl_set_blk_isetcookie(ndd, nd_label, nd_set->cookie2);
1185
1186 nsl_set_dpa(ndd, nd_label, res->start);
1187 nsl_set_rawsize(ndd, nd_label, resource_size(res));
1188 nsl_set_lbasize(ndd, nd_label, nsblk->lbasize);
1189 nsl_set_slot(ndd, nd_label, slot);
1190 nsl_set_type_guid(ndd, nd_label, &nd_set->type_guid);
1191 nsl_set_claim_class(ndd, nd_label, ndns->claim_class);
1192 nsl_calculate_checksum(ndd, nd_label);
1193
1194 /* update label */
1195 offset = nd_label_offset(ndd, nd_label);
1196 rc = nvdimm_set_config_data(ndd, offset, nd_label,
1197 sizeof_namespace_label(ndd));
1198 if (rc < 0)
1199 goto abort;
1200 }
1201
1202 /* free up now unused slots in the new index */
1203 for_each_set_bit(slot, victim_map, victim_map ? nslot : 0) {
1204 dev_dbg(ndd->dev, "free: %d\n", slot);
1205 nd_label_free_slot(ndd, slot);
1206 }
1207
1208 /* update index */
1209 rc = nd_label_write_index(ndd, ndd->ns_next,
1210 nd_inc_seq(__le32_to_cpu(nsindex->seq)), 0);
1211 if (rc)
1212 goto abort;
1213
1214 /*
1215 * Now that the on-dimm labels are up to date, fix up the tracking
1216 * entries in nd_mapping->labels
1217 */
1218 nlabel = 0;
1219 mutex_lock(&nd_mapping->lock);
1220 list_for_each_entry_safe(label_ent, e, &nd_mapping->labels, list) {
1221 nd_label = label_ent->label;
1222 if (!nd_label)
1223 continue;
1224 nlabel++;
1225 if (!nsl_uuid_equal(ndd, nd_label, nsblk->uuid))
1226 continue;
1227 nlabel--;
1228 list_move(&label_ent->list, &list);
1229 label_ent->label = NULL;
1230 }
1231 list_splice_tail_init(&list, &nd_mapping->labels);
1232 mutex_unlock(&nd_mapping->lock);
1233
1234 if (nlabel + nsblk->num_resources > num_labels) {
1235 /*
1236 * Bug, we can't end up with more resources than
1237 * available labels
1238 */
1239 WARN_ON_ONCE(1);
1240 rc = -ENXIO;
1241 goto out;
1242 }
1243
1244 mutex_lock(&nd_mapping->lock);
1245 label_ent = list_first_entry_or_null(&nd_mapping->labels,
1246 typeof(*label_ent), list);
1247 if (!label_ent) {
1248 WARN_ON(1);
1249 mutex_unlock(&nd_mapping->lock);
1250 rc = -ENXIO;
1251 goto out;
1252 }
1253 for_each_clear_bit_le(slot, free, nslot) {
1254 nd_label = to_label(ndd, slot);
1255 if (!nsl_uuid_equal(ndd, nd_label, nsblk->uuid))
1256 continue;
1257 res = to_resource(ndd, nd_label);
1258 res->flags &= ~DPA_RESOURCE_ADJUSTED;
1259 dev_vdbg(&nsblk->common.dev, "assign label slot: %d\n", slot);
1260 list_for_each_entry_from(label_ent, &nd_mapping->labels, list) {
1261 if (label_ent->label)
1262 continue;
1263 label_ent->label = nd_label;
1264 nd_label = NULL;
1265 break;
1266 }
1267 if (nd_label)
1268 dev_WARN(&nsblk->common.dev,
1269 "failed to track label slot%d\n", slot);
1270 }
1271 mutex_unlock(&nd_mapping->lock);
1272
1273 out:
1274 kfree(old_res_list);
1275 bitmap_free(victim_map);
1276 return rc;
1277
1278 abort:
1279 /*
1280 * 1/ repair the allocated label bitmap in the index
1281 * 2/ restore the resource list
1282 */
1283 nd_label_copy(ndd, nsindex, to_current_namespace_index(ndd));
1284 kfree(nsblk->res);
1285 nsblk->res = old_res_list;
1286 nsblk->num_resources = old_num_resources;
1287 old_res_list = NULL;
1288 goto out;
1289 }
1290
init_labels(struct nd_mapping * nd_mapping,int num_labels)1291 static int init_labels(struct nd_mapping *nd_mapping, int num_labels)
1292 {
1293 int i, old_num_labels = 0;
1294 struct nd_label_ent *label_ent;
1295 struct nd_namespace_index *nsindex;
1296 struct nvdimm_drvdata *ndd = to_ndd(nd_mapping);
1297
1298 mutex_lock(&nd_mapping->lock);
1299 list_for_each_entry(label_ent, &nd_mapping->labels, list)
1300 old_num_labels++;
1301 mutex_unlock(&nd_mapping->lock);
1302
1303 /*
1304 * We need to preserve all the old labels for the mapping so
1305 * they can be garbage collected after writing the new labels.
1306 */
1307 for (i = old_num_labels; i < num_labels; i++) {
1308 label_ent = kzalloc(sizeof(*label_ent), GFP_KERNEL);
1309 if (!label_ent)
1310 return -ENOMEM;
1311 mutex_lock(&nd_mapping->lock);
1312 list_add_tail(&label_ent->list, &nd_mapping->labels);
1313 mutex_unlock(&nd_mapping->lock);
1314 }
1315
1316 if (ndd->ns_current == -1 || ndd->ns_next == -1)
1317 /* pass */;
1318 else
1319 return max(num_labels, old_num_labels);
1320
1321 nsindex = to_namespace_index(ndd, 0);
1322 memset(nsindex, 0, ndd->nsarea.config_size);
1323 for (i = 0; i < 2; i++) {
1324 int rc = nd_label_write_index(ndd, i, 3 - i, ND_NSINDEX_INIT);
1325
1326 if (rc)
1327 return rc;
1328 }
1329 ndd->ns_next = 1;
1330 ndd->ns_current = 0;
1331
1332 return max(num_labels, old_num_labels);
1333 }
1334
del_labels(struct nd_mapping * nd_mapping,uuid_t * uuid)1335 static int del_labels(struct nd_mapping *nd_mapping, uuid_t *uuid)
1336 {
1337 struct nvdimm_drvdata *ndd = to_ndd(nd_mapping);
1338 struct nd_label_ent *label_ent, *e;
1339 struct nd_namespace_index *nsindex;
1340 unsigned long *free;
1341 LIST_HEAD(list);
1342 u32 nslot, slot;
1343 int active = 0;
1344
1345 if (!uuid)
1346 return 0;
1347
1348 /* no index || no labels == nothing to delete */
1349 if (!preamble_next(ndd, &nsindex, &free, &nslot))
1350 return 0;
1351
1352 mutex_lock(&nd_mapping->lock);
1353 list_for_each_entry_safe(label_ent, e, &nd_mapping->labels, list) {
1354 struct nd_namespace_label *nd_label = label_ent->label;
1355
1356 if (!nd_label)
1357 continue;
1358 active++;
1359 if (!nsl_uuid_equal(ndd, nd_label, uuid))
1360 continue;
1361 active--;
1362 slot = to_slot(ndd, nd_label);
1363 nd_label_free_slot(ndd, slot);
1364 dev_dbg(ndd->dev, "free: %d\n", slot);
1365 list_move_tail(&label_ent->list, &list);
1366 label_ent->label = NULL;
1367 }
1368 list_splice_tail_init(&list, &nd_mapping->labels);
1369
1370 if (active == 0) {
1371 nd_mapping_free_labels(nd_mapping);
1372 dev_dbg(ndd->dev, "no more active labels\n");
1373 }
1374 mutex_unlock(&nd_mapping->lock);
1375
1376 return nd_label_write_index(ndd, ndd->ns_next,
1377 nd_inc_seq(__le32_to_cpu(nsindex->seq)), 0);
1378 }
1379
nd_pmem_namespace_label_update(struct nd_region * nd_region,struct nd_namespace_pmem * nspm,resource_size_t size)1380 int nd_pmem_namespace_label_update(struct nd_region *nd_region,
1381 struct nd_namespace_pmem *nspm, resource_size_t size)
1382 {
1383 int i, rc;
1384
1385 for (i = 0; i < nd_region->ndr_mappings; i++) {
1386 struct nd_mapping *nd_mapping = &nd_region->mapping[i];
1387 struct nvdimm_drvdata *ndd = to_ndd(nd_mapping);
1388 struct resource *res;
1389 int count = 0;
1390
1391 if (size == 0) {
1392 rc = del_labels(nd_mapping, nspm->uuid);
1393 if (rc)
1394 return rc;
1395 continue;
1396 }
1397
1398 for_each_dpa_resource(ndd, res)
1399 if (strncmp(res->name, "pmem", 4) == 0)
1400 count++;
1401 WARN_ON_ONCE(!count);
1402
1403 rc = init_labels(nd_mapping, count);
1404 if (rc < 0)
1405 return rc;
1406
1407 rc = __pmem_label_update(nd_region, nd_mapping, nspm, i,
1408 NSLABEL_FLAG_UPDATING);
1409 if (rc)
1410 return rc;
1411 }
1412
1413 if (size == 0)
1414 return 0;
1415
1416 /* Clear the UPDATING flag per UEFI 2.7 expectations */
1417 for (i = 0; i < nd_region->ndr_mappings; i++) {
1418 struct nd_mapping *nd_mapping = &nd_region->mapping[i];
1419
1420 rc = __pmem_label_update(nd_region, nd_mapping, nspm, i, 0);
1421 if (rc)
1422 return rc;
1423 }
1424
1425 return 0;
1426 }
1427
nd_blk_namespace_label_update(struct nd_region * nd_region,struct nd_namespace_blk * nsblk,resource_size_t size)1428 int nd_blk_namespace_label_update(struct nd_region *nd_region,
1429 struct nd_namespace_blk *nsblk, resource_size_t size)
1430 {
1431 struct nd_mapping *nd_mapping = &nd_region->mapping[0];
1432 struct resource *res;
1433 int count = 0;
1434
1435 if (size == 0)
1436 return del_labels(nd_mapping, nsblk->uuid);
1437
1438 for_each_dpa_resource(to_ndd(nd_mapping), res)
1439 count++;
1440
1441 count = init_labels(nd_mapping, count);
1442 if (count < 0)
1443 return count;
1444
1445 return __blk_label_update(nd_region, nd_mapping, nsblk, count);
1446 }
1447
nd_label_init(void)1448 int __init nd_label_init(void)
1449 {
1450 WARN_ON(guid_parse(NVDIMM_BTT_GUID, &nvdimm_btt_guid));
1451 WARN_ON(guid_parse(NVDIMM_BTT2_GUID, &nvdimm_btt2_guid));
1452 WARN_ON(guid_parse(NVDIMM_PFN_GUID, &nvdimm_pfn_guid));
1453 WARN_ON(guid_parse(NVDIMM_DAX_GUID, &nvdimm_dax_guid));
1454
1455 WARN_ON(uuid_parse(NVDIMM_BTT_GUID, &nvdimm_btt_uuid));
1456 WARN_ON(uuid_parse(NVDIMM_BTT2_GUID, &nvdimm_btt2_uuid));
1457 WARN_ON(uuid_parse(NVDIMM_PFN_GUID, &nvdimm_pfn_uuid));
1458 WARN_ON(uuid_parse(NVDIMM_DAX_GUID, &nvdimm_dax_uuid));
1459
1460 WARN_ON(uuid_parse(CXL_REGION_UUID, &cxl_region_uuid));
1461 WARN_ON(uuid_parse(CXL_NAMESPACE_UUID, &cxl_namespace_uuid));
1462
1463 return 0;
1464 }
1465