1 // SPDX-License-Identifier: GPL-2.0+ 2 /* 3 * XArray implementation 4 * Copyright (c) 2017-2018 Microsoft Corporation 5 * Copyright (c) 2018-2020 Oracle 6 * Author: Matthew Wilcox <willy@infradead.org> 7 */ 8 9 #include <linux/bitmap.h> 10 #include <linux/export.h> 11 #include <linux/list.h> 12 #include <linux/slab.h> 13 #include <linux/xarray.h> 14 15 #include "radix-tree.h" 16 17 /* 18 * Coding conventions in this file: 19 * 20 * @xa is used to refer to the entire xarray. 21 * @xas is the 'xarray operation state'. It may be either a pointer to 22 * an xa_state, or an xa_state stored on the stack. This is an unfortunate 23 * ambiguity. 24 * @index is the index of the entry being operated on 25 * @mark is an xa_mark_t; a small number indicating one of the mark bits. 26 * @node refers to an xa_node; usually the primary one being operated on by 27 * this function. 28 * @offset is the index into the slots array inside an xa_node. 29 * @parent refers to the @xa_node closer to the head than @node. 30 * @entry refers to something stored in a slot in the xarray 31 */ 32 33 static inline unsigned int xa_lock_type(const struct xarray *xa) 34 { 35 return (__force unsigned int)xa->xa_flags & 3; 36 } 37 38 static inline void xas_lock_type(struct xa_state *xas, unsigned int lock_type) 39 { 40 if (lock_type == XA_LOCK_IRQ) 41 xas_lock_irq(xas); 42 else if (lock_type == XA_LOCK_BH) 43 xas_lock_bh(xas); 44 else 45 xas_lock(xas); 46 } 47 48 static inline void xas_unlock_type(struct xa_state *xas, unsigned int lock_type) 49 { 50 if (lock_type == XA_LOCK_IRQ) 51 xas_unlock_irq(xas); 52 else if (lock_type == XA_LOCK_BH) 53 xas_unlock_bh(xas); 54 else 55 xas_unlock(xas); 56 } 57 58 static inline bool xa_track_free(const struct xarray *xa) 59 { 60 return xa->xa_flags & XA_FLAGS_TRACK_FREE; 61 } 62 63 static inline bool xa_zero_busy(const struct xarray *xa) 64 { 65 return xa->xa_flags & XA_FLAGS_ZERO_BUSY; 66 } 67 68 static inline void xa_mark_set(struct xarray *xa, xa_mark_t mark) 69 { 70 if (!(xa->xa_flags & XA_FLAGS_MARK(mark))) 71 xa->xa_flags |= XA_FLAGS_MARK(mark); 72 } 73 74 static inline void xa_mark_clear(struct xarray *xa, xa_mark_t mark) 75 { 76 if (xa->xa_flags & XA_FLAGS_MARK(mark)) 77 xa->xa_flags &= ~(XA_FLAGS_MARK(mark)); 78 } 79 80 static inline unsigned long *node_marks(struct xa_node *node, xa_mark_t mark) 81 { 82 return node->marks[(__force unsigned)mark]; 83 } 84 85 static inline bool node_get_mark(struct xa_node *node, 86 unsigned int offset, xa_mark_t mark) 87 { 88 return test_bit(offset, node_marks(node, mark)); 89 } 90 91 /* returns true if the bit was set */ 92 static inline bool node_set_mark(struct xa_node *node, unsigned int offset, 93 xa_mark_t mark) 94 { 95 return __test_and_set_bit(offset, node_marks(node, mark)); 96 } 97 98 /* returns true if the bit was set */ 99 static inline bool node_clear_mark(struct xa_node *node, unsigned int offset, 100 xa_mark_t mark) 101 { 102 return __test_and_clear_bit(offset, node_marks(node, mark)); 103 } 104 105 static inline bool node_any_mark(struct xa_node *node, xa_mark_t mark) 106 { 107 return !bitmap_empty(node_marks(node, mark), XA_CHUNK_SIZE); 108 } 109 110 static inline void node_mark_all(struct xa_node *node, xa_mark_t mark) 111 { 112 bitmap_fill(node_marks(node, mark), XA_CHUNK_SIZE); 113 } 114 115 #define mark_inc(mark) do { \ 116 mark = (__force xa_mark_t)((__force unsigned)(mark) + 1); \ 117 } while (0) 118 119 /* 120 * xas_squash_marks() - Merge all marks to the first entry 121 * @xas: Array operation state. 122 * 123 * Set a mark on the first entry if any entry has it set. Clear marks on 124 * all sibling entries. 125 */ 126 static void xas_squash_marks(const struct xa_state *xas) 127 { 128 xa_mark_t mark = 0; 129 unsigned int limit = xas->xa_offset + xas->xa_sibs + 1; 130 131 for (;;) { 132 unsigned long *marks = node_marks(xas->xa_node, mark); 133 134 if (find_next_bit(marks, limit, xas->xa_offset + 1) != limit) { 135 __set_bit(xas->xa_offset, marks); 136 bitmap_clear(marks, xas->xa_offset + 1, xas->xa_sibs); 137 } 138 if (mark == XA_MARK_MAX) 139 break; 140 mark_inc(mark); 141 } 142 } 143 144 /* extracts the offset within this node from the index */ 145 static unsigned int get_offset(unsigned long index, struct xa_node *node) 146 { 147 return (index >> node->shift) & XA_CHUNK_MASK; 148 } 149 150 static void xas_set_offset(struct xa_state *xas) 151 { 152 xas->xa_offset = get_offset(xas->xa_index, xas->xa_node); 153 } 154 155 /* move the index either forwards (find) or backwards (sibling slot) */ 156 static void xas_move_index(struct xa_state *xas, unsigned long offset) 157 { 158 unsigned int shift = xas->xa_node->shift; 159 xas->xa_index &= ~XA_CHUNK_MASK << shift; 160 xas->xa_index += offset << shift; 161 } 162 163 static void xas_next_offset(struct xa_state *xas) 164 { 165 xas->xa_offset++; 166 xas_move_index(xas, xas->xa_offset); 167 } 168 169 static void *set_bounds(struct xa_state *xas) 170 { 171 xas->xa_node = XAS_BOUNDS; 172 return NULL; 173 } 174 175 /* 176 * Starts a walk. If the @xas is already valid, we assume that it's on 177 * the right path and just return where we've got to. If we're in an 178 * error state, return NULL. If the index is outside the current scope 179 * of the xarray, return NULL without changing @xas->xa_node. Otherwise 180 * set @xas->xa_node to NULL and return the current head of the array. 181 */ 182 static void *xas_start(struct xa_state *xas) 183 { 184 void *entry; 185 186 if (xas_valid(xas)) 187 return xas_reload(xas); 188 if (xas_error(xas)) 189 return NULL; 190 191 entry = xa_head(xas->xa); 192 if (!xa_is_node(entry)) { 193 if (xas->xa_index) 194 return set_bounds(xas); 195 } else { 196 if ((xas->xa_index >> xa_to_node(entry)->shift) > XA_CHUNK_MASK) 197 return set_bounds(xas); 198 } 199 200 xas->xa_node = NULL; 201 return entry; 202 } 203 204 static __always_inline void *xas_descend(struct xa_state *xas, 205 struct xa_node *node) 206 { 207 unsigned int offset = get_offset(xas->xa_index, node); 208 void *entry = xa_entry(xas->xa, node, offset); 209 210 xas->xa_node = node; 211 while (xa_is_sibling(entry)) { 212 offset = xa_to_sibling(entry); 213 entry = xa_entry(xas->xa, node, offset); 214 if (node->shift && xa_is_node(entry)) 215 entry = XA_RETRY_ENTRY; 216 } 217 218 xas->xa_offset = offset; 219 return entry; 220 } 221 222 /** 223 * xas_load() - Load an entry from the XArray (advanced). 224 * @xas: XArray operation state. 225 * 226 * Usually walks the @xas to the appropriate state to load the entry 227 * stored at xa_index. However, it will do nothing and return %NULL if 228 * @xas is in an error state. xas_load() will never expand the tree. 229 * 230 * If the xa_state is set up to operate on a multi-index entry, xas_load() 231 * may return %NULL or an internal entry, even if there are entries 232 * present within the range specified by @xas. 233 * 234 * Context: Any context. The caller should hold the xa_lock or the RCU lock. 235 * Return: Usually an entry in the XArray, but see description for exceptions. 236 */ 237 void *xas_load(struct xa_state *xas) 238 { 239 void *entry = xas_start(xas); 240 241 while (xa_is_node(entry)) { 242 struct xa_node *node = xa_to_node(entry); 243 244 if (xas->xa_shift > node->shift) 245 break; 246 entry = xas_descend(xas, node); 247 if (node->shift == 0) 248 break; 249 } 250 return entry; 251 } 252 EXPORT_SYMBOL_GPL(xas_load); 253 254 #define XA_RCU_FREE ((struct xarray *)1) 255 256 static void xa_node_free(struct xa_node *node) 257 { 258 XA_NODE_BUG_ON(node, !list_empty(&node->private_list)); 259 node->array = XA_RCU_FREE; 260 call_rcu(&node->rcu_head, radix_tree_node_rcu_free); 261 } 262 263 /* 264 * xas_destroy() - Free any resources allocated during the XArray operation. 265 * @xas: XArray operation state. 266 * 267 * Most users will not need to call this function; it is called for you 268 * by xas_nomem(). 269 */ 270 void xas_destroy(struct xa_state *xas) 271 { 272 struct xa_node *next, *node = xas->xa_alloc; 273 274 while (node) { 275 XA_NODE_BUG_ON(node, !list_empty(&node->private_list)); 276 next = rcu_dereference_raw(node->parent); 277 radix_tree_node_rcu_free(&node->rcu_head); 278 xas->xa_alloc = node = next; 279 } 280 } 281 EXPORT_SYMBOL_GPL(xas_destroy); 282 283 /** 284 * xas_nomem() - Allocate memory if needed. 285 * @xas: XArray operation state. 286 * @gfp: Memory allocation flags. 287 * 288 * If we need to add new nodes to the XArray, we try to allocate memory 289 * with GFP_NOWAIT while holding the lock, which will usually succeed. 290 * If it fails, @xas is flagged as needing memory to continue. The caller 291 * should drop the lock and call xas_nomem(). If xas_nomem() succeeds, 292 * the caller should retry the operation. 293 * 294 * Forward progress is guaranteed as one node is allocated here and 295 * stored in the xa_state where it will be found by xas_alloc(). More 296 * nodes will likely be found in the slab allocator, but we do not tie 297 * them up here. 298 * 299 * Return: true if memory was needed, and was successfully allocated. 300 */ 301 bool xas_nomem(struct xa_state *xas, gfp_t gfp) 302 { 303 if (xas->xa_node != XA_ERROR(-ENOMEM)) { 304 xas_destroy(xas); 305 return false; 306 } 307 if (xas->xa->xa_flags & XA_FLAGS_ACCOUNT) 308 gfp |= __GFP_ACCOUNT; 309 xas->xa_alloc = kmem_cache_alloc_lru(radix_tree_node_cachep, xas->xa_lru, gfp); 310 if (!xas->xa_alloc) 311 return false; 312 xas->xa_alloc->parent = NULL; 313 XA_NODE_BUG_ON(xas->xa_alloc, !list_empty(&xas->xa_alloc->private_list)); 314 xas->xa_node = XAS_RESTART; 315 return true; 316 } 317 EXPORT_SYMBOL_GPL(xas_nomem); 318 319 /* 320 * __xas_nomem() - Drop locks and allocate memory if needed. 321 * @xas: XArray operation state. 322 * @gfp: Memory allocation flags. 323 * 324 * Internal variant of xas_nomem(). 325 * 326 * Return: true if memory was needed, and was successfully allocated. 327 */ 328 static bool __xas_nomem(struct xa_state *xas, gfp_t gfp) 329 __must_hold(xas->xa->xa_lock) 330 { 331 unsigned int lock_type = xa_lock_type(xas->xa); 332 333 if (xas->xa_node != XA_ERROR(-ENOMEM)) { 334 xas_destroy(xas); 335 return false; 336 } 337 if (xas->xa->xa_flags & XA_FLAGS_ACCOUNT) 338 gfp |= __GFP_ACCOUNT; 339 if (gfpflags_allow_blocking(gfp)) { 340 xas_unlock_type(xas, lock_type); 341 xas->xa_alloc = kmem_cache_alloc_lru(radix_tree_node_cachep, xas->xa_lru, gfp); 342 xas_lock_type(xas, lock_type); 343 } else { 344 xas->xa_alloc = kmem_cache_alloc_lru(radix_tree_node_cachep, xas->xa_lru, gfp); 345 } 346 if (!xas->xa_alloc) 347 return false; 348 xas->xa_alloc->parent = NULL; 349 XA_NODE_BUG_ON(xas->xa_alloc, !list_empty(&xas->xa_alloc->private_list)); 350 xas->xa_node = XAS_RESTART; 351 return true; 352 } 353 354 static void xas_update(struct xa_state *xas, struct xa_node *node) 355 { 356 if (xas->xa_update) 357 xas->xa_update(node); 358 else 359 XA_NODE_BUG_ON(node, !list_empty(&node->private_list)); 360 } 361 362 static void *xas_alloc(struct xa_state *xas, unsigned int shift) 363 { 364 struct xa_node *parent = xas->xa_node; 365 struct xa_node *node = xas->xa_alloc; 366 367 if (xas_invalid(xas)) 368 return NULL; 369 370 if (node) { 371 xas->xa_alloc = NULL; 372 } else { 373 gfp_t gfp = GFP_NOWAIT; 374 375 if (xas->xa->xa_flags & XA_FLAGS_ACCOUNT) 376 gfp |= __GFP_ACCOUNT; 377 378 node = kmem_cache_alloc_lru(radix_tree_node_cachep, xas->xa_lru, gfp); 379 if (!node) { 380 xas_set_err(xas, -ENOMEM); 381 return NULL; 382 } 383 } 384 385 if (parent) { 386 node->offset = xas->xa_offset; 387 parent->count++; 388 XA_NODE_BUG_ON(node, parent->count > XA_CHUNK_SIZE); 389 xas_update(xas, parent); 390 } 391 XA_NODE_BUG_ON(node, shift > BITS_PER_LONG); 392 XA_NODE_BUG_ON(node, !list_empty(&node->private_list)); 393 node->shift = shift; 394 node->count = 0; 395 node->nr_values = 0; 396 RCU_INIT_POINTER(node->parent, xas->xa_node); 397 node->array = xas->xa; 398 399 return node; 400 } 401 402 #ifdef CONFIG_XARRAY_MULTI 403 /* Returns the number of indices covered by a given xa_state */ 404 static unsigned long xas_size(const struct xa_state *xas) 405 { 406 return (xas->xa_sibs + 1UL) << xas->xa_shift; 407 } 408 #endif 409 410 /* 411 * Use this to calculate the maximum index that will need to be created 412 * in order to add the entry described by @xas. Because we cannot store a 413 * multi-index entry at index 0, the calculation is a little more complex 414 * than you might expect. 415 */ 416 static unsigned long xas_max(struct xa_state *xas) 417 { 418 unsigned long max = xas->xa_index; 419 420 #ifdef CONFIG_XARRAY_MULTI 421 if (xas->xa_shift || xas->xa_sibs) { 422 unsigned long mask = xas_size(xas) - 1; 423 max |= mask; 424 if (mask == max) 425 max++; 426 } 427 #endif 428 429 return max; 430 } 431 432 /* The maximum index that can be contained in the array without expanding it */ 433 static unsigned long max_index(void *entry) 434 { 435 if (!xa_is_node(entry)) 436 return 0; 437 return (XA_CHUNK_SIZE << xa_to_node(entry)->shift) - 1; 438 } 439 440 static inline void *xa_zero_to_null(void *entry) 441 { 442 return xa_is_zero(entry) ? NULL : entry; 443 } 444 445 static void xas_shrink(struct xa_state *xas) 446 { 447 struct xarray *xa = xas->xa; 448 struct xa_node *node = xas->xa_node; 449 450 for (;;) { 451 void *entry; 452 453 XA_NODE_BUG_ON(node, node->count > XA_CHUNK_SIZE); 454 if (node->count != 1) 455 break; 456 entry = xa_entry_locked(xa, node, 0); 457 if (!entry) 458 break; 459 if (!xa_is_node(entry) && node->shift) 460 break; 461 if (xa_zero_busy(xa)) 462 entry = xa_zero_to_null(entry); 463 xas->xa_node = XAS_BOUNDS; 464 465 RCU_INIT_POINTER(xa->xa_head, entry); 466 if (xa_track_free(xa) && !node_get_mark(node, 0, XA_FREE_MARK)) 467 xa_mark_clear(xa, XA_FREE_MARK); 468 469 node->count = 0; 470 node->nr_values = 0; 471 if (!xa_is_node(entry)) 472 RCU_INIT_POINTER(node->slots[0], XA_RETRY_ENTRY); 473 xas_update(xas, node); 474 xa_node_free(node); 475 if (!xa_is_node(entry)) 476 break; 477 node = xa_to_node(entry); 478 node->parent = NULL; 479 } 480 } 481 482 /* 483 * xas_delete_node() - Attempt to delete an xa_node 484 * @xas: Array operation state. 485 * 486 * Attempts to delete the @xas->xa_node. This will fail if xa->node has 487 * a non-zero reference count. 488 */ 489 static void xas_delete_node(struct xa_state *xas) 490 { 491 struct xa_node *node = xas->xa_node; 492 493 for (;;) { 494 struct xa_node *parent; 495 496 XA_NODE_BUG_ON(node, node->count > XA_CHUNK_SIZE); 497 if (node->count) 498 break; 499 500 parent = xa_parent_locked(xas->xa, node); 501 xas->xa_node = parent; 502 xas->xa_offset = node->offset; 503 xa_node_free(node); 504 505 if (!parent) { 506 xas->xa->xa_head = NULL; 507 xas->xa_node = XAS_BOUNDS; 508 return; 509 } 510 511 parent->slots[xas->xa_offset] = NULL; 512 parent->count--; 513 XA_NODE_BUG_ON(parent, parent->count > XA_CHUNK_SIZE); 514 node = parent; 515 xas_update(xas, node); 516 } 517 518 if (!node->parent) 519 xas_shrink(xas); 520 } 521 522 /** 523 * xas_free_nodes() - Free this node and all nodes that it references 524 * @xas: Array operation state. 525 * @top: Node to free 526 * 527 * This node has been removed from the tree. We must now free it and all 528 * of its subnodes. There may be RCU walkers with references into the tree, 529 * so we must replace all entries with retry markers. 530 */ 531 static void xas_free_nodes(struct xa_state *xas, struct xa_node *top) 532 { 533 unsigned int offset = 0; 534 struct xa_node *node = top; 535 536 for (;;) { 537 void *entry = xa_entry_locked(xas->xa, node, offset); 538 539 if (node->shift && xa_is_node(entry)) { 540 node = xa_to_node(entry); 541 offset = 0; 542 continue; 543 } 544 if (entry) 545 RCU_INIT_POINTER(node->slots[offset], XA_RETRY_ENTRY); 546 offset++; 547 while (offset == XA_CHUNK_SIZE) { 548 struct xa_node *parent; 549 550 parent = xa_parent_locked(xas->xa, node); 551 offset = node->offset + 1; 552 node->count = 0; 553 node->nr_values = 0; 554 xas_update(xas, node); 555 xa_node_free(node); 556 if (node == top) 557 return; 558 node = parent; 559 } 560 } 561 } 562 563 /* 564 * xas_expand adds nodes to the head of the tree until it has reached 565 * sufficient height to be able to contain @xas->xa_index 566 */ 567 static int xas_expand(struct xa_state *xas, void *head) 568 { 569 struct xarray *xa = xas->xa; 570 struct xa_node *node = NULL; 571 unsigned int shift = 0; 572 unsigned long max = xas_max(xas); 573 574 if (!head) { 575 if (max == 0) 576 return 0; 577 while ((max >> shift) >= XA_CHUNK_SIZE) 578 shift += XA_CHUNK_SHIFT; 579 return shift + XA_CHUNK_SHIFT; 580 } else if (xa_is_node(head)) { 581 node = xa_to_node(head); 582 shift = node->shift + XA_CHUNK_SHIFT; 583 } 584 xas->xa_node = NULL; 585 586 while (max > max_index(head)) { 587 xa_mark_t mark = 0; 588 589 XA_NODE_BUG_ON(node, shift > BITS_PER_LONG); 590 node = xas_alloc(xas, shift); 591 if (!node) 592 return -ENOMEM; 593 594 node->count = 1; 595 if (xa_is_value(head)) 596 node->nr_values = 1; 597 RCU_INIT_POINTER(node->slots[0], head); 598 599 /* Propagate the aggregated mark info to the new child */ 600 for (;;) { 601 if (xa_track_free(xa) && mark == XA_FREE_MARK) { 602 node_mark_all(node, XA_FREE_MARK); 603 if (!xa_marked(xa, XA_FREE_MARK)) { 604 node_clear_mark(node, 0, XA_FREE_MARK); 605 xa_mark_set(xa, XA_FREE_MARK); 606 } 607 } else if (xa_marked(xa, mark)) { 608 node_set_mark(node, 0, mark); 609 } 610 if (mark == XA_MARK_MAX) 611 break; 612 mark_inc(mark); 613 } 614 615 /* 616 * Now that the new node is fully initialised, we can add 617 * it to the tree 618 */ 619 if (xa_is_node(head)) { 620 xa_to_node(head)->offset = 0; 621 rcu_assign_pointer(xa_to_node(head)->parent, node); 622 } 623 head = xa_mk_node(node); 624 rcu_assign_pointer(xa->xa_head, head); 625 xas_update(xas, node); 626 627 shift += XA_CHUNK_SHIFT; 628 } 629 630 xas->xa_node = node; 631 return shift; 632 } 633 634 /* 635 * xas_create() - Create a slot to store an entry in. 636 * @xas: XArray operation state. 637 * @allow_root: %true if we can store the entry in the root directly 638 * 639 * Most users will not need to call this function directly, as it is called 640 * by xas_store(). It is useful for doing conditional store operations 641 * (see the xa_cmpxchg() implementation for an example). 642 * 643 * Return: If the slot already existed, returns the contents of this slot. 644 * If the slot was newly created, returns %NULL. If it failed to create the 645 * slot, returns %NULL and indicates the error in @xas. 646 */ 647 static void *xas_create(struct xa_state *xas, bool allow_root) 648 { 649 struct xarray *xa = xas->xa; 650 void *entry; 651 void __rcu **slot; 652 struct xa_node *node = xas->xa_node; 653 int shift; 654 unsigned int order = xas->xa_shift; 655 656 if (xas_top(node)) { 657 entry = xa_head_locked(xa); 658 xas->xa_node = NULL; 659 if (!entry && xa_zero_busy(xa)) 660 entry = XA_ZERO_ENTRY; 661 shift = xas_expand(xas, entry); 662 if (shift < 0) 663 return NULL; 664 if (!shift && !allow_root) 665 shift = XA_CHUNK_SHIFT; 666 entry = xa_head_locked(xa); 667 slot = &xa->xa_head; 668 } else if (xas_error(xas)) { 669 return NULL; 670 } else if (node) { 671 unsigned int offset = xas->xa_offset; 672 673 shift = node->shift; 674 entry = xa_entry_locked(xa, node, offset); 675 slot = &node->slots[offset]; 676 } else { 677 shift = 0; 678 entry = xa_head_locked(xa); 679 slot = &xa->xa_head; 680 } 681 682 while (shift > order) { 683 shift -= XA_CHUNK_SHIFT; 684 if (!entry) { 685 node = xas_alloc(xas, shift); 686 if (!node) 687 break; 688 if (xa_track_free(xa)) 689 node_mark_all(node, XA_FREE_MARK); 690 rcu_assign_pointer(*slot, xa_mk_node(node)); 691 } else if (xa_is_node(entry)) { 692 node = xa_to_node(entry); 693 } else { 694 break; 695 } 696 entry = xas_descend(xas, node); 697 slot = &node->slots[xas->xa_offset]; 698 } 699 700 return entry; 701 } 702 703 /** 704 * xas_create_range() - Ensure that stores to this range will succeed 705 * @xas: XArray operation state. 706 * 707 * Creates all of the slots in the range covered by @xas. Sets @xas to 708 * create single-index entries and positions it at the beginning of the 709 * range. This is for the benefit of users which have not yet been 710 * converted to use multi-index entries. 711 */ 712 void xas_create_range(struct xa_state *xas) 713 { 714 unsigned long index = xas->xa_index; 715 unsigned char shift = xas->xa_shift; 716 unsigned char sibs = xas->xa_sibs; 717 718 xas->xa_index |= ((sibs + 1UL) << shift) - 1; 719 if (xas_is_node(xas) && xas->xa_node->shift == xas->xa_shift) 720 xas->xa_offset |= sibs; 721 xas->xa_shift = 0; 722 xas->xa_sibs = 0; 723 724 for (;;) { 725 xas_create(xas, true); 726 if (xas_error(xas)) 727 goto restore; 728 if (xas->xa_index <= (index | XA_CHUNK_MASK)) 729 goto success; 730 xas->xa_index -= XA_CHUNK_SIZE; 731 732 for (;;) { 733 struct xa_node *node = xas->xa_node; 734 if (node->shift >= shift) 735 break; 736 xas->xa_node = xa_parent_locked(xas->xa, node); 737 xas->xa_offset = node->offset - 1; 738 if (node->offset != 0) 739 break; 740 } 741 } 742 743 restore: 744 xas->xa_shift = shift; 745 xas->xa_sibs = sibs; 746 xas->xa_index = index; 747 return; 748 success: 749 xas->xa_index = index; 750 if (xas->xa_node) 751 xas_set_offset(xas); 752 } 753 EXPORT_SYMBOL_GPL(xas_create_range); 754 755 static void update_node(struct xa_state *xas, struct xa_node *node, 756 int count, int values) 757 { 758 if (!node || (!count && !values)) 759 return; 760 761 node->count += count; 762 node->nr_values += values; 763 XA_NODE_BUG_ON(node, node->count > XA_CHUNK_SIZE); 764 XA_NODE_BUG_ON(node, node->nr_values > XA_CHUNK_SIZE); 765 xas_update(xas, node); 766 if (count < 0) 767 xas_delete_node(xas); 768 } 769 770 /** 771 * xas_store() - Store this entry in the XArray. 772 * @xas: XArray operation state. 773 * @entry: New entry. 774 * 775 * If @xas is operating on a multi-index entry, the entry returned by this 776 * function is essentially meaningless (it may be an internal entry or it 777 * may be %NULL, even if there are non-NULL entries at some of the indices 778 * covered by the range). This is not a problem for any current users, 779 * and can be changed if needed. 780 * 781 * Return: The old entry at this index. 782 */ 783 void *xas_store(struct xa_state *xas, void *entry) 784 { 785 struct xa_node *node; 786 void __rcu **slot = &xas->xa->xa_head; 787 unsigned int offset, max; 788 int count = 0; 789 int values = 0; 790 void *first, *next; 791 bool value = xa_is_value(entry); 792 793 if (entry) { 794 bool allow_root = !xa_is_node(entry) && !xa_is_zero(entry); 795 first = xas_create(xas, allow_root); 796 } else { 797 first = xas_load(xas); 798 } 799 800 if (xas_invalid(xas)) 801 return first; 802 node = xas->xa_node; 803 if (node && (xas->xa_shift < node->shift)) 804 xas->xa_sibs = 0; 805 if ((first == entry) && !xas->xa_sibs) 806 return first; 807 808 next = first; 809 offset = xas->xa_offset; 810 max = xas->xa_offset + xas->xa_sibs; 811 if (node) { 812 slot = &node->slots[offset]; 813 if (xas->xa_sibs) 814 xas_squash_marks(xas); 815 } 816 if (!entry) 817 xas_init_marks(xas); 818 819 for (;;) { 820 /* 821 * Must clear the marks before setting the entry to NULL, 822 * otherwise xas_for_each_marked may find a NULL entry and 823 * stop early. rcu_assign_pointer contains a release barrier 824 * so the mark clearing will appear to happen before the 825 * entry is set to NULL. 826 */ 827 rcu_assign_pointer(*slot, entry); 828 if (xa_is_node(next) && (!node || node->shift)) 829 xas_free_nodes(xas, xa_to_node(next)); 830 if (!node) 831 break; 832 count += !next - !entry; 833 values += !xa_is_value(first) - !value; 834 if (entry) { 835 if (offset == max) 836 break; 837 if (!xa_is_sibling(entry)) 838 entry = xa_mk_sibling(xas->xa_offset); 839 } else { 840 if (offset == XA_CHUNK_MASK) 841 break; 842 } 843 next = xa_entry_locked(xas->xa, node, ++offset); 844 if (!xa_is_sibling(next)) { 845 if (!entry && (offset > max)) 846 break; 847 first = next; 848 } 849 slot++; 850 } 851 852 update_node(xas, node, count, values); 853 return first; 854 } 855 EXPORT_SYMBOL_GPL(xas_store); 856 857 /** 858 * xas_get_mark() - Returns the state of this mark. 859 * @xas: XArray operation state. 860 * @mark: Mark number. 861 * 862 * Return: true if the mark is set, false if the mark is clear or @xas 863 * is in an error state. 864 */ 865 bool xas_get_mark(const struct xa_state *xas, xa_mark_t mark) 866 { 867 if (xas_invalid(xas)) 868 return false; 869 if (!xas->xa_node) 870 return xa_marked(xas->xa, mark); 871 return node_get_mark(xas->xa_node, xas->xa_offset, mark); 872 } 873 EXPORT_SYMBOL_GPL(xas_get_mark); 874 875 /** 876 * xas_set_mark() - Sets the mark on this entry and its parents. 877 * @xas: XArray operation state. 878 * @mark: Mark number. 879 * 880 * Sets the specified mark on this entry, and walks up the tree setting it 881 * on all the ancestor entries. Does nothing if @xas has not been walked to 882 * an entry, or is in an error state. 883 */ 884 void xas_set_mark(const struct xa_state *xas, xa_mark_t mark) 885 { 886 struct xa_node *node = xas->xa_node; 887 unsigned int offset = xas->xa_offset; 888 889 if (xas_invalid(xas)) 890 return; 891 892 while (node) { 893 if (node_set_mark(node, offset, mark)) 894 return; 895 offset = node->offset; 896 node = xa_parent_locked(xas->xa, node); 897 } 898 899 if (!xa_marked(xas->xa, mark)) 900 xa_mark_set(xas->xa, mark); 901 } 902 EXPORT_SYMBOL_GPL(xas_set_mark); 903 904 /** 905 * xas_clear_mark() - Clears the mark on this entry and its parents. 906 * @xas: XArray operation state. 907 * @mark: Mark number. 908 * 909 * Clears the specified mark on this entry, and walks back to the head 910 * attempting to clear it on all the ancestor entries. Does nothing if 911 * @xas has not been walked to an entry, or is in an error state. 912 */ 913 void xas_clear_mark(const struct xa_state *xas, xa_mark_t mark) 914 { 915 struct xa_node *node = xas->xa_node; 916 unsigned int offset = xas->xa_offset; 917 918 if (xas_invalid(xas)) 919 return; 920 921 while (node) { 922 if (!node_clear_mark(node, offset, mark)) 923 return; 924 if (node_any_mark(node, mark)) 925 return; 926 927 offset = node->offset; 928 node = xa_parent_locked(xas->xa, node); 929 } 930 931 if (xa_marked(xas->xa, mark)) 932 xa_mark_clear(xas->xa, mark); 933 } 934 EXPORT_SYMBOL_GPL(xas_clear_mark); 935 936 /** 937 * xas_init_marks() - Initialise all marks for the entry 938 * @xas: Array operations state. 939 * 940 * Initialise all marks for the entry specified by @xas. If we're tracking 941 * free entries with a mark, we need to set it on all entries. All other 942 * marks are cleared. 943 * 944 * This implementation is not as efficient as it could be; we may walk 945 * up the tree multiple times. 946 */ 947 void xas_init_marks(const struct xa_state *xas) 948 { 949 xa_mark_t mark = 0; 950 951 for (;;) { 952 if (xa_track_free(xas->xa) && mark == XA_FREE_MARK) 953 xas_set_mark(xas, mark); 954 else 955 xas_clear_mark(xas, mark); 956 if (mark == XA_MARK_MAX) 957 break; 958 mark_inc(mark); 959 } 960 } 961 EXPORT_SYMBOL_GPL(xas_init_marks); 962 963 #ifdef CONFIG_XARRAY_MULTI 964 static unsigned int node_get_marks(struct xa_node *node, unsigned int offset) 965 { 966 unsigned int marks = 0; 967 xa_mark_t mark = XA_MARK_0; 968 969 for (;;) { 970 if (node_get_mark(node, offset, mark)) 971 marks |= 1 << (__force unsigned int)mark; 972 if (mark == XA_MARK_MAX) 973 break; 974 mark_inc(mark); 975 } 976 977 return marks; 978 } 979 980 static inline void node_mark_slots(struct xa_node *node, unsigned int sibs, 981 xa_mark_t mark) 982 { 983 int i; 984 985 if (sibs == 0) 986 node_mark_all(node, mark); 987 else { 988 for (i = 0; i < XA_CHUNK_SIZE; i += sibs + 1) 989 node_set_mark(node, i, mark); 990 } 991 } 992 993 static void node_set_marks(struct xa_node *node, unsigned int offset, 994 struct xa_node *child, unsigned int sibs, 995 unsigned int marks) 996 { 997 xa_mark_t mark = XA_MARK_0; 998 999 for (;;) { 1000 if (marks & (1 << (__force unsigned int)mark)) { 1001 node_set_mark(node, offset, mark); 1002 if (child) 1003 node_mark_slots(child, sibs, mark); 1004 } 1005 if (mark == XA_MARK_MAX) 1006 break; 1007 mark_inc(mark); 1008 } 1009 } 1010 1011 static void __xas_init_node_for_split(struct xa_state *xas, 1012 struct xa_node *node, void *entry) 1013 { 1014 unsigned int i; 1015 void *sibling = NULL; 1016 unsigned int mask = xas->xa_sibs; 1017 1018 if (!node) 1019 return; 1020 node->array = xas->xa; 1021 for (i = 0; i < XA_CHUNK_SIZE; i++) { 1022 if ((i & mask) == 0) { 1023 RCU_INIT_POINTER(node->slots[i], entry); 1024 sibling = xa_mk_sibling(i); 1025 } else { 1026 RCU_INIT_POINTER(node->slots[i], sibling); 1027 } 1028 } 1029 } 1030 1031 /** 1032 * xas_split_alloc() - Allocate memory for splitting an entry. 1033 * @xas: XArray operation state. 1034 * @entry: New entry which will be stored in the array. 1035 * @order: Current entry order. 1036 * @gfp: Memory allocation flags. 1037 * 1038 * This function should be called before calling xas_split(). 1039 * If necessary, it will allocate new nodes (and fill them with @entry) 1040 * to prepare for the upcoming split of an entry of @order size into 1041 * entries of the order stored in the @xas. 1042 * 1043 * Context: May sleep if @gfp flags permit. 1044 */ 1045 void xas_split_alloc(struct xa_state *xas, void *entry, unsigned int order, 1046 gfp_t gfp) 1047 { 1048 unsigned int sibs = (1 << (order % XA_CHUNK_SHIFT)) - 1; 1049 1050 /* XXX: no support for splitting really large entries yet */ 1051 if (WARN_ON(xas->xa_shift + 2 * XA_CHUNK_SHIFT <= order)) 1052 goto nomem; 1053 if (xas->xa_shift + XA_CHUNK_SHIFT > order) 1054 return; 1055 1056 if (xas->xa->xa_flags & XA_FLAGS_ACCOUNT) 1057 gfp |= __GFP_ACCOUNT; 1058 1059 do { 1060 struct xa_node *node; 1061 1062 node = kmem_cache_alloc_lru(radix_tree_node_cachep, xas->xa_lru, gfp); 1063 if (!node) 1064 goto nomem; 1065 1066 __xas_init_node_for_split(xas, node, entry); 1067 RCU_INIT_POINTER(node->parent, xas->xa_alloc); 1068 xas->xa_alloc = node; 1069 } while (sibs-- > 0); 1070 1071 return; 1072 nomem: 1073 xas_destroy(xas); 1074 xas_set_err(xas, -ENOMEM); 1075 } 1076 EXPORT_SYMBOL_GPL(xas_split_alloc); 1077 1078 /** 1079 * xas_split() - Split a multi-index entry into smaller entries. 1080 * @xas: XArray operation state. 1081 * @entry: New entry to store in the array. 1082 * @order: Current entry order. 1083 * 1084 * The size of the new entries is set in @xas. The value in @entry is 1085 * copied to all the replacement entries. 1086 * 1087 * Context: Any context. The caller should hold the xa_lock. 1088 */ 1089 void xas_split(struct xa_state *xas, void *entry, unsigned int order) 1090 { 1091 unsigned int sibs = (1 << (order % XA_CHUNK_SHIFT)) - 1; 1092 unsigned int offset, marks; 1093 struct xa_node *node; 1094 void *curr = xas_load(xas); 1095 int values = 0; 1096 1097 node = xas->xa_node; 1098 if (xas_top(node)) 1099 return; 1100 1101 marks = node_get_marks(node, xas->xa_offset); 1102 1103 offset = xas->xa_offset + sibs; 1104 do { 1105 if (xas->xa_shift < node->shift) { 1106 struct xa_node *child = xas->xa_alloc; 1107 1108 xas->xa_alloc = rcu_dereference_raw(child->parent); 1109 child->shift = node->shift - XA_CHUNK_SHIFT; 1110 child->offset = offset; 1111 child->count = XA_CHUNK_SIZE; 1112 child->nr_values = xa_is_value(entry) ? 1113 XA_CHUNK_SIZE : 0; 1114 RCU_INIT_POINTER(child->parent, node); 1115 node_set_marks(node, offset, child, xas->xa_sibs, 1116 marks); 1117 rcu_assign_pointer(node->slots[offset], 1118 xa_mk_node(child)); 1119 if (xa_is_value(curr)) 1120 values--; 1121 xas_update(xas, child); 1122 } else { 1123 unsigned int canon = offset - xas->xa_sibs; 1124 1125 node_set_marks(node, canon, NULL, 0, marks); 1126 rcu_assign_pointer(node->slots[canon], entry); 1127 while (offset > canon) 1128 rcu_assign_pointer(node->slots[offset--], 1129 xa_mk_sibling(canon)); 1130 values += (xa_is_value(entry) - xa_is_value(curr)) * 1131 (xas->xa_sibs + 1); 1132 } 1133 } while (offset-- > xas->xa_offset); 1134 1135 node->nr_values += values; 1136 xas_update(xas, node); 1137 } 1138 EXPORT_SYMBOL_GPL(xas_split); 1139 1140 /** 1141 * xas_try_split_min_order() - Minimal split order xas_try_split() can accept 1142 * @order: Current entry order. 1143 * 1144 * xas_try_split() can split a multi-index entry to smaller than @order - 1 if 1145 * no new xa_node is needed. This function provides the minimal order 1146 * xas_try_split() supports. 1147 * 1148 * Return: the minimal order xas_try_split() supports 1149 * 1150 * Context: Any context. 1151 * 1152 */ 1153 unsigned int xas_try_split_min_order(unsigned int order) 1154 { 1155 if (order % XA_CHUNK_SHIFT == 0) 1156 return order == 0 ? 0 : order - 1; 1157 1158 return order - (order % XA_CHUNK_SHIFT); 1159 } 1160 EXPORT_SYMBOL_GPL(xas_try_split_min_order); 1161 1162 /** 1163 * xas_try_split() - Try to split a multi-index entry. 1164 * @xas: XArray operation state. 1165 * @entry: New entry to store in the array. 1166 * @order: Current entry order. 1167 * 1168 * The size of the new entries is set in @xas. The value in @entry is 1169 * copied to all the replacement entries. If and only if one new xa_node is 1170 * needed, the function will use GFP_NOWAIT to get one if xas->xa_alloc is 1171 * NULL. If more new xa_node are needed, the function gives EINVAL error. 1172 * 1173 * NOTE: use xas_try_split_min_order() to get next split order instead of 1174 * @order - 1 if you want to minmize xas_try_split() calls. 1175 * 1176 * Context: Any context. The caller should hold the xa_lock. 1177 */ 1178 void xas_try_split(struct xa_state *xas, void *entry, unsigned int order) 1179 { 1180 unsigned int sibs = (1 << (order % XA_CHUNK_SHIFT)) - 1; 1181 unsigned int offset, marks; 1182 struct xa_node *node; 1183 void *curr = xas_load(xas); 1184 int values = 0; 1185 gfp_t gfp = GFP_NOWAIT; 1186 1187 node = xas->xa_node; 1188 if (xas_top(node)) 1189 return; 1190 1191 if (xas->xa->xa_flags & XA_FLAGS_ACCOUNT) 1192 gfp |= __GFP_ACCOUNT; 1193 1194 marks = node_get_marks(node, xas->xa_offset); 1195 1196 offset = xas->xa_offset + sibs; 1197 1198 if (xas->xa_shift < node->shift) { 1199 struct xa_node *child = xas->xa_alloc; 1200 unsigned int expected_sibs = 1201 (1 << ((order - 1) % XA_CHUNK_SHIFT)) - 1; 1202 1203 /* 1204 * No support for splitting sibling entries 1205 * (horizontally) or cascade split (vertically), which 1206 * requires two or more new xa_nodes. 1207 * Since if one xa_node allocation fails, 1208 * it is hard to free the prior allocations. 1209 */ 1210 if (sibs || xas->xa_sibs != expected_sibs) { 1211 xas_destroy(xas); 1212 xas_set_err(xas, -EINVAL); 1213 return; 1214 } 1215 1216 if (!child) { 1217 child = kmem_cache_alloc_lru(radix_tree_node_cachep, 1218 xas->xa_lru, gfp); 1219 if (!child) { 1220 xas_destroy(xas); 1221 xas_set_err(xas, -ENOMEM); 1222 return; 1223 } 1224 RCU_INIT_POINTER(child->parent, xas->xa_alloc); 1225 } 1226 __xas_init_node_for_split(xas, child, entry); 1227 1228 xas->xa_alloc = rcu_dereference_raw(child->parent); 1229 child->shift = node->shift - XA_CHUNK_SHIFT; 1230 child->offset = offset; 1231 child->count = XA_CHUNK_SIZE; 1232 child->nr_values = xa_is_value(entry) ? 1233 XA_CHUNK_SIZE : 0; 1234 RCU_INIT_POINTER(child->parent, node); 1235 node_set_marks(node, offset, child, xas->xa_sibs, 1236 marks); 1237 rcu_assign_pointer(node->slots[offset], 1238 xa_mk_node(child)); 1239 if (xa_is_value(curr)) 1240 values--; 1241 xas_update(xas, child); 1242 1243 } else { 1244 do { 1245 unsigned int canon = offset - xas->xa_sibs; 1246 1247 node_set_marks(node, canon, NULL, 0, marks); 1248 rcu_assign_pointer(node->slots[canon], entry); 1249 while (offset > canon) 1250 rcu_assign_pointer(node->slots[offset--], 1251 xa_mk_sibling(canon)); 1252 values += (xa_is_value(entry) - xa_is_value(curr)) * 1253 (xas->xa_sibs + 1); 1254 } while (offset-- > xas->xa_offset); 1255 } 1256 1257 node->nr_values += values; 1258 xas_update(xas, node); 1259 } 1260 EXPORT_SYMBOL_GPL(xas_try_split); 1261 #endif 1262 1263 /** 1264 * xas_pause() - Pause a walk to drop a lock. 1265 * @xas: XArray operation state. 1266 * 1267 * Some users need to pause a walk and drop the lock they're holding in 1268 * order to yield to a higher priority thread or carry out an operation 1269 * on an entry. Those users should call this function before they drop 1270 * the lock. It resets the @xas to be suitable for the next iteration 1271 * of the loop after the user has reacquired the lock. If most entries 1272 * found during a walk require you to call xas_pause(), the xa_for_each() 1273 * iterator may be more appropriate. 1274 * 1275 * Note that xas_pause() only works for forward iteration. If a user needs 1276 * to pause a reverse iteration, we will need a xas_pause_rev(). 1277 */ 1278 void xas_pause(struct xa_state *xas) 1279 { 1280 struct xa_node *node = xas->xa_node; 1281 1282 if (xas_invalid(xas)) 1283 return; 1284 1285 xas->xa_node = XAS_RESTART; 1286 if (node) { 1287 unsigned long offset = xas->xa_offset; 1288 while (++offset < XA_CHUNK_SIZE) { 1289 if (!xa_is_sibling(xa_entry(xas->xa, node, offset))) 1290 break; 1291 } 1292 xas->xa_index &= ~0UL << node->shift; 1293 xas->xa_index += (offset - xas->xa_offset) << node->shift; 1294 if (xas->xa_index == 0) 1295 xas->xa_node = XAS_BOUNDS; 1296 } else { 1297 xas->xa_index++; 1298 } 1299 } 1300 EXPORT_SYMBOL_GPL(xas_pause); 1301 1302 /* 1303 * __xas_prev() - Find the previous entry in the XArray. 1304 * @xas: XArray operation state. 1305 * 1306 * Helper function for xas_prev() which handles all the complex cases 1307 * out of line. 1308 */ 1309 void *__xas_prev(struct xa_state *xas) 1310 { 1311 void *entry; 1312 1313 if (!xas_frozen(xas->xa_node)) 1314 xas->xa_index--; 1315 if (!xas->xa_node) 1316 return set_bounds(xas); 1317 if (xas_not_node(xas->xa_node)) 1318 return xas_load(xas); 1319 1320 if (xas->xa_offset != get_offset(xas->xa_index, xas->xa_node)) 1321 xas->xa_offset--; 1322 1323 while (xas->xa_offset == 255) { 1324 xas->xa_offset = xas->xa_node->offset - 1; 1325 xas->xa_node = xa_parent(xas->xa, xas->xa_node); 1326 if (!xas->xa_node) 1327 return set_bounds(xas); 1328 } 1329 1330 for (;;) { 1331 entry = xa_entry(xas->xa, xas->xa_node, xas->xa_offset); 1332 if (!xa_is_node(entry)) 1333 return entry; 1334 1335 xas->xa_node = xa_to_node(entry); 1336 xas_set_offset(xas); 1337 } 1338 } 1339 EXPORT_SYMBOL_GPL(__xas_prev); 1340 1341 /* 1342 * __xas_next() - Find the next entry in the XArray. 1343 * @xas: XArray operation state. 1344 * 1345 * Helper function for xas_next() which handles all the complex cases 1346 * out of line. 1347 */ 1348 void *__xas_next(struct xa_state *xas) 1349 { 1350 void *entry; 1351 1352 if (!xas_frozen(xas->xa_node)) 1353 xas->xa_index++; 1354 if (!xas->xa_node) 1355 return set_bounds(xas); 1356 if (xas_not_node(xas->xa_node)) 1357 return xas_load(xas); 1358 1359 if (xas->xa_offset != get_offset(xas->xa_index, xas->xa_node)) 1360 xas->xa_offset++; 1361 1362 while (xas->xa_offset == XA_CHUNK_SIZE) { 1363 xas->xa_offset = xas->xa_node->offset + 1; 1364 xas->xa_node = xa_parent(xas->xa, xas->xa_node); 1365 if (!xas->xa_node) 1366 return set_bounds(xas); 1367 } 1368 1369 for (;;) { 1370 entry = xa_entry(xas->xa, xas->xa_node, xas->xa_offset); 1371 if (!xa_is_node(entry)) 1372 return entry; 1373 1374 xas->xa_node = xa_to_node(entry); 1375 xas_set_offset(xas); 1376 } 1377 } 1378 EXPORT_SYMBOL_GPL(__xas_next); 1379 1380 /** 1381 * xas_find() - Find the next present entry in the XArray. 1382 * @xas: XArray operation state. 1383 * @max: Highest index to return. 1384 * 1385 * If the @xas has not yet been walked to an entry, return the entry 1386 * which has an index >= xas.xa_index. If it has been walked, the entry 1387 * currently being pointed at has been processed, and so we move to the 1388 * next entry. 1389 * 1390 * If no entry is found and the array is smaller than @max, the iterator 1391 * is set to the smallest index not yet in the array. This allows @xas 1392 * to be immediately passed to xas_store(). 1393 * 1394 * Return: The entry, if found, otherwise %NULL. 1395 */ 1396 void *xas_find(struct xa_state *xas, unsigned long max) 1397 { 1398 void *entry; 1399 1400 if (xas_error(xas) || xas->xa_node == XAS_BOUNDS) 1401 return NULL; 1402 if (xas->xa_index > max) 1403 return set_bounds(xas); 1404 1405 if (!xas->xa_node) { 1406 xas->xa_index = 1; 1407 return set_bounds(xas); 1408 } else if (xas->xa_node == XAS_RESTART) { 1409 entry = xas_load(xas); 1410 if (entry || xas_not_node(xas->xa_node)) 1411 return entry; 1412 } else if (!xas->xa_node->shift && 1413 xas->xa_offset != (xas->xa_index & XA_CHUNK_MASK)) { 1414 xas->xa_offset = ((xas->xa_index - 1) & XA_CHUNK_MASK) + 1; 1415 } 1416 1417 xas_next_offset(xas); 1418 1419 while (xas->xa_node && (xas->xa_index <= max)) { 1420 if (unlikely(xas->xa_offset == XA_CHUNK_SIZE)) { 1421 xas->xa_offset = xas->xa_node->offset + 1; 1422 xas->xa_node = xa_parent(xas->xa, xas->xa_node); 1423 continue; 1424 } 1425 1426 entry = xa_entry(xas->xa, xas->xa_node, xas->xa_offset); 1427 if (xa_is_node(entry)) { 1428 xas->xa_node = xa_to_node(entry); 1429 xas->xa_offset = 0; 1430 continue; 1431 } 1432 if (entry && !xa_is_sibling(entry)) 1433 return entry; 1434 1435 xas_next_offset(xas); 1436 } 1437 1438 if (!xas->xa_node) 1439 xas->xa_node = XAS_BOUNDS; 1440 return NULL; 1441 } 1442 EXPORT_SYMBOL_GPL(xas_find); 1443 1444 /** 1445 * xas_find_marked() - Find the next marked entry in the XArray. 1446 * @xas: XArray operation state. 1447 * @max: Highest index to return. 1448 * @mark: Mark number to search for. 1449 * 1450 * If the @xas has not yet been walked to an entry, return the marked entry 1451 * which has an index >= xas.xa_index. If it has been walked, the entry 1452 * currently being pointed at has been processed, and so we return the 1453 * first marked entry with an index > xas.xa_index. 1454 * 1455 * If no marked entry is found and the array is smaller than @max, @xas is 1456 * set to the bounds state and xas->xa_index is set to the smallest index 1457 * not yet in the array. This allows @xas to be immediately passed to 1458 * xas_store(). 1459 * 1460 * If no entry is found before @max is reached, @xas is set to the restart 1461 * state. 1462 * 1463 * Return: The entry, if found, otherwise %NULL. 1464 */ 1465 void *xas_find_marked(struct xa_state *xas, unsigned long max, xa_mark_t mark) 1466 { 1467 bool advance = true; 1468 unsigned int offset; 1469 void *entry; 1470 1471 if (xas_error(xas)) 1472 return NULL; 1473 if (xas->xa_index > max) 1474 goto max; 1475 1476 if (!xas->xa_node) { 1477 xas->xa_index = 1; 1478 goto out; 1479 } else if (xas_top(xas->xa_node)) { 1480 advance = false; 1481 entry = xa_head(xas->xa); 1482 xas->xa_node = NULL; 1483 if (xas->xa_index > max_index(entry)) 1484 goto out; 1485 if (!xa_is_node(entry)) { 1486 if (xa_marked(xas->xa, mark)) 1487 return entry; 1488 xas->xa_index = 1; 1489 goto out; 1490 } 1491 xas->xa_node = xa_to_node(entry); 1492 xas->xa_offset = xas->xa_index >> xas->xa_node->shift; 1493 } 1494 1495 while (xas->xa_index <= max) { 1496 if (unlikely(xas->xa_offset == XA_CHUNK_SIZE)) { 1497 xas->xa_offset = xas->xa_node->offset + 1; 1498 xas->xa_node = xa_parent(xas->xa, xas->xa_node); 1499 if (!xas->xa_node) 1500 break; 1501 advance = false; 1502 continue; 1503 } 1504 1505 if (!advance) { 1506 entry = xa_entry(xas->xa, xas->xa_node, xas->xa_offset); 1507 if (xa_is_sibling(entry)) { 1508 xas->xa_offset = xa_to_sibling(entry); 1509 xas_move_index(xas, xas->xa_offset); 1510 } 1511 } 1512 1513 offset = xas_find_chunk(xas, advance, mark); 1514 if (offset > xas->xa_offset) { 1515 advance = false; 1516 xas_move_index(xas, offset); 1517 /* Mind the wrap */ 1518 if ((xas->xa_index - 1) >= max) 1519 goto max; 1520 xas->xa_offset = offset; 1521 if (offset == XA_CHUNK_SIZE) 1522 continue; 1523 } 1524 1525 entry = xa_entry(xas->xa, xas->xa_node, xas->xa_offset); 1526 if (!entry && !(xa_track_free(xas->xa) && mark == XA_FREE_MARK)) 1527 continue; 1528 if (xa_is_sibling(entry)) 1529 continue; 1530 if (!xa_is_node(entry)) 1531 return entry; 1532 xas->xa_node = xa_to_node(entry); 1533 xas_set_offset(xas); 1534 } 1535 1536 out: 1537 if (xas->xa_index > max) 1538 goto max; 1539 return set_bounds(xas); 1540 max: 1541 xas->xa_node = XAS_RESTART; 1542 return NULL; 1543 } 1544 EXPORT_SYMBOL_GPL(xas_find_marked); 1545 1546 /** 1547 * xas_find_conflict() - Find the next present entry in a range. 1548 * @xas: XArray operation state. 1549 * 1550 * The @xas describes both a range and a position within that range. 1551 * 1552 * Context: Any context. Expects xa_lock to be held. 1553 * Return: The next entry in the range covered by @xas or %NULL. 1554 */ 1555 void *xas_find_conflict(struct xa_state *xas) 1556 { 1557 void *curr; 1558 1559 if (xas_error(xas)) 1560 return NULL; 1561 1562 if (!xas->xa_node) 1563 return NULL; 1564 1565 if (xas_top(xas->xa_node)) { 1566 curr = xas_start(xas); 1567 if (!curr) 1568 return NULL; 1569 while (xa_is_node(curr)) { 1570 struct xa_node *node = xa_to_node(curr); 1571 curr = xas_descend(xas, node); 1572 } 1573 if (curr) 1574 return curr; 1575 } 1576 1577 if (xas->xa_node->shift > xas->xa_shift) 1578 return NULL; 1579 1580 for (;;) { 1581 if (xas->xa_node->shift == xas->xa_shift) { 1582 if ((xas->xa_offset & xas->xa_sibs) == xas->xa_sibs) 1583 break; 1584 } else if (xas->xa_offset == XA_CHUNK_MASK) { 1585 xas->xa_offset = xas->xa_node->offset; 1586 xas->xa_node = xa_parent_locked(xas->xa, xas->xa_node); 1587 if (!xas->xa_node) 1588 break; 1589 continue; 1590 } 1591 curr = xa_entry_locked(xas->xa, xas->xa_node, ++xas->xa_offset); 1592 if (xa_is_sibling(curr)) 1593 continue; 1594 while (xa_is_node(curr)) { 1595 xas->xa_node = xa_to_node(curr); 1596 xas->xa_offset = 0; 1597 curr = xa_entry_locked(xas->xa, xas->xa_node, 0); 1598 } 1599 if (curr) 1600 return curr; 1601 } 1602 xas->xa_offset -= xas->xa_sibs; 1603 return NULL; 1604 } 1605 EXPORT_SYMBOL_GPL(xas_find_conflict); 1606 1607 /** 1608 * xa_load() - Load an entry from an XArray. 1609 * @xa: XArray. 1610 * @index: index into array. 1611 * 1612 * Context: Any context. Takes and releases the RCU lock. 1613 * Return: The entry at @index in @xa. 1614 */ 1615 void *xa_load(struct xarray *xa, unsigned long index) 1616 { 1617 XA_STATE(xas, xa, index); 1618 void *entry; 1619 1620 rcu_read_lock(); 1621 do { 1622 entry = xa_zero_to_null(xas_load(&xas)); 1623 } while (xas_retry(&xas, entry)); 1624 rcu_read_unlock(); 1625 1626 return entry; 1627 } 1628 EXPORT_SYMBOL(xa_load); 1629 1630 static void *xas_result(struct xa_state *xas, void *curr) 1631 { 1632 if (xas_error(xas)) 1633 curr = xas->xa_node; 1634 return curr; 1635 } 1636 1637 /** 1638 * __xa_erase() - Erase this entry from the XArray while locked. 1639 * @xa: XArray. 1640 * @index: Index into array. 1641 * 1642 * After this function returns, loading from @index will return %NULL. 1643 * If the index is part of a multi-index entry, all indices will be erased 1644 * and none of the entries will be part of a multi-index entry. 1645 * 1646 * Context: Any context. Expects xa_lock to be held on entry. 1647 * Return: The entry which used to be at this index. 1648 */ 1649 void *__xa_erase(struct xarray *xa, unsigned long index) 1650 { 1651 XA_STATE(xas, xa, index); 1652 return xas_result(&xas, xa_zero_to_null(xas_store(&xas, NULL))); 1653 } 1654 EXPORT_SYMBOL(__xa_erase); 1655 1656 /** 1657 * xa_erase() - Erase this entry from the XArray. 1658 * @xa: XArray. 1659 * @index: Index of entry. 1660 * 1661 * After this function returns, loading from @index will return %NULL. 1662 * If the index is part of a multi-index entry, all indices will be erased 1663 * and none of the entries will be part of a multi-index entry. 1664 * 1665 * Context: Any context. Takes and releases the xa_lock. 1666 * Return: The entry which used to be at this index. 1667 */ 1668 void *xa_erase(struct xarray *xa, unsigned long index) 1669 { 1670 void *entry; 1671 1672 xa_lock(xa); 1673 entry = __xa_erase(xa, index); 1674 xa_unlock(xa); 1675 1676 return entry; 1677 } 1678 EXPORT_SYMBOL(xa_erase); 1679 1680 /** 1681 * __xa_store() - Store this entry in the XArray. 1682 * @xa: XArray. 1683 * @index: Index into array. 1684 * @entry: New entry. 1685 * @gfp: Memory allocation flags. 1686 * 1687 * You must already be holding the xa_lock when calling this function. 1688 * It will drop the lock if needed to allocate memory, and then reacquire 1689 * it afterwards. 1690 * 1691 * Context: Any context. Expects xa_lock to be held on entry. May 1692 * release and reacquire xa_lock if @gfp flags permit. 1693 * Return: The old entry at this index or xa_err() if an error happened. 1694 */ 1695 void *__xa_store(struct xarray *xa, unsigned long index, void *entry, gfp_t gfp) 1696 { 1697 XA_STATE(xas, xa, index); 1698 void *curr; 1699 1700 if (WARN_ON_ONCE(xa_is_advanced(entry))) 1701 return XA_ERROR(-EINVAL); 1702 if (xa_track_free(xa) && !entry) 1703 entry = XA_ZERO_ENTRY; 1704 1705 do { 1706 curr = xas_store(&xas, entry); 1707 if (xa_track_free(xa)) 1708 xas_clear_mark(&xas, XA_FREE_MARK); 1709 } while (__xas_nomem(&xas, gfp)); 1710 1711 return xas_result(&xas, xa_zero_to_null(curr)); 1712 } 1713 EXPORT_SYMBOL(__xa_store); 1714 1715 /** 1716 * xa_store() - Store this entry in the XArray. 1717 * @xa: XArray. 1718 * @index: Index into array. 1719 * @entry: New entry. 1720 * @gfp: Memory allocation flags. 1721 * 1722 * After this function returns, loads from this index will return @entry. 1723 * Storing into an existing multi-index entry updates the entry of every index. 1724 * The marks associated with @index are unaffected unless @entry is %NULL. 1725 * 1726 * Context: Any context. Takes and releases the xa_lock. 1727 * May sleep if the @gfp flags permit. 1728 * Return: The old entry at this index on success, xa_err(-EINVAL) if @entry 1729 * cannot be stored in an XArray, or xa_err(-ENOMEM) if memory allocation 1730 * failed. 1731 */ 1732 void *xa_store(struct xarray *xa, unsigned long index, void *entry, gfp_t gfp) 1733 { 1734 void *curr; 1735 1736 xa_lock(xa); 1737 curr = __xa_store(xa, index, entry, gfp); 1738 xa_unlock(xa); 1739 1740 return curr; 1741 } 1742 EXPORT_SYMBOL(xa_store); 1743 1744 static inline void *__xa_cmpxchg_raw(struct xarray *xa, unsigned long index, 1745 void *old, void *entry, gfp_t gfp); 1746 1747 /** 1748 * __xa_cmpxchg() - Conditionally replace an entry in the XArray. 1749 * @xa: XArray. 1750 * @index: Index into array. 1751 * @old: Old value to test against. 1752 * @entry: New value to place in array. 1753 * @gfp: Memory allocation flags. 1754 * 1755 * You must already be holding the xa_lock when calling this function. 1756 * It will drop the lock if needed to allocate memory, and then reacquire 1757 * it afterwards. 1758 * 1759 * If the entry at @index is the same as @old, replace it with @entry. 1760 * If the return value is equal to @old, then the exchange was successful. 1761 * 1762 * Context: Any context. Expects xa_lock to be held on entry. May 1763 * release and reacquire xa_lock if @gfp flags permit. 1764 * Return: The old value at this index or xa_err() if an error happened. 1765 */ 1766 void *__xa_cmpxchg(struct xarray *xa, unsigned long index, 1767 void *old, void *entry, gfp_t gfp) 1768 { 1769 return xa_zero_to_null(__xa_cmpxchg_raw(xa, index, old, entry, gfp)); 1770 } 1771 EXPORT_SYMBOL(__xa_cmpxchg); 1772 1773 static inline void *__xa_cmpxchg_raw(struct xarray *xa, unsigned long index, 1774 void *old, void *entry, gfp_t gfp) 1775 { 1776 XA_STATE(xas, xa, index); 1777 void *curr; 1778 1779 if (WARN_ON_ONCE(xa_is_advanced(entry))) 1780 return XA_ERROR(-EINVAL); 1781 1782 do { 1783 curr = xas_load(&xas); 1784 if (curr == old) { 1785 xas_store(&xas, entry); 1786 if (xa_track_free(xa) && entry && !curr) 1787 xas_clear_mark(&xas, XA_FREE_MARK); 1788 } 1789 } while (__xas_nomem(&xas, gfp)); 1790 1791 return xas_result(&xas, curr); 1792 } 1793 1794 /** 1795 * __xa_insert() - Store this entry in the XArray if no entry is present. 1796 * @xa: XArray. 1797 * @index: Index into array. 1798 * @entry: New entry. 1799 * @gfp: Memory allocation flags. 1800 * 1801 * Inserting a NULL entry will store a reserved entry (like xa_reserve()) 1802 * if no entry is present. Inserting will fail if a reserved entry is 1803 * present, even though loading from this index will return NULL. 1804 * 1805 * Context: Any context. Expects xa_lock to be held on entry. May 1806 * release and reacquire xa_lock if @gfp flags permit. 1807 * Return: 0 if the store succeeded. -EBUSY if another entry was present. 1808 * -ENOMEM if memory could not be allocated. 1809 */ 1810 int __xa_insert(struct xarray *xa, unsigned long index, void *entry, gfp_t gfp) 1811 { 1812 void *curr; 1813 int errno; 1814 1815 if (!entry) 1816 entry = XA_ZERO_ENTRY; 1817 curr = __xa_cmpxchg_raw(xa, index, NULL, entry, gfp); 1818 errno = xa_err(curr); 1819 if (errno) 1820 return errno; 1821 return (curr != NULL) ? -EBUSY : 0; 1822 } 1823 EXPORT_SYMBOL(__xa_insert); 1824 1825 #ifdef CONFIG_XARRAY_MULTI 1826 static void xas_set_range(struct xa_state *xas, unsigned long first, 1827 unsigned long last) 1828 { 1829 unsigned int shift = 0; 1830 unsigned long sibs = last - first; 1831 unsigned int offset = XA_CHUNK_MASK; 1832 1833 xas_set(xas, first); 1834 1835 while ((first & XA_CHUNK_MASK) == 0) { 1836 if (sibs < XA_CHUNK_MASK) 1837 break; 1838 if ((sibs == XA_CHUNK_MASK) && (offset < XA_CHUNK_MASK)) 1839 break; 1840 shift += XA_CHUNK_SHIFT; 1841 if (offset == XA_CHUNK_MASK) 1842 offset = sibs & XA_CHUNK_MASK; 1843 sibs >>= XA_CHUNK_SHIFT; 1844 first >>= XA_CHUNK_SHIFT; 1845 } 1846 1847 offset = first & XA_CHUNK_MASK; 1848 if (offset + sibs > XA_CHUNK_MASK) 1849 sibs = XA_CHUNK_MASK - offset; 1850 if ((((first + sibs + 1) << shift) - 1) > last) 1851 sibs -= 1; 1852 1853 xas->xa_shift = shift; 1854 xas->xa_sibs = sibs; 1855 } 1856 1857 /** 1858 * xa_store_range() - Store this entry at a range of indices in the XArray. 1859 * @xa: XArray. 1860 * @first: First index to affect. 1861 * @last: Last index to affect. 1862 * @entry: New entry. 1863 * @gfp: Memory allocation flags. 1864 * 1865 * After this function returns, loads from any index between @first and @last, 1866 * inclusive will return @entry. 1867 * Storing into an existing multi-index entry updates the entry of every index. 1868 * The marks associated with @index are unaffected unless @entry is %NULL. 1869 * 1870 * Context: Process context. Takes and releases the xa_lock. May sleep 1871 * if the @gfp flags permit. 1872 * Return: %NULL on success, xa_err(-EINVAL) if @entry cannot be stored in 1873 * an XArray, or xa_err(-ENOMEM) if memory allocation failed. 1874 */ 1875 void *xa_store_range(struct xarray *xa, unsigned long first, 1876 unsigned long last, void *entry, gfp_t gfp) 1877 { 1878 XA_STATE(xas, xa, 0); 1879 1880 if (WARN_ON_ONCE(xa_is_internal(entry))) 1881 return XA_ERROR(-EINVAL); 1882 if (last < first) 1883 return XA_ERROR(-EINVAL); 1884 1885 do { 1886 xas_lock(&xas); 1887 if (entry) { 1888 unsigned int order = BITS_PER_LONG; 1889 if (last + 1) 1890 order = __ffs(last + 1); 1891 xas_set_order(&xas, last, order); 1892 xas_create(&xas, true); 1893 if (xas_error(&xas)) 1894 goto unlock; 1895 } 1896 do { 1897 xas_set_range(&xas, first, last); 1898 xas_store(&xas, entry); 1899 if (xas_error(&xas)) 1900 goto unlock; 1901 first += xas_size(&xas); 1902 } while (first <= last); 1903 unlock: 1904 xas_unlock(&xas); 1905 } while (xas_nomem(&xas, gfp)); 1906 1907 return xas_result(&xas, NULL); 1908 } 1909 EXPORT_SYMBOL(xa_store_range); 1910 1911 /** 1912 * xas_get_order() - Get the order of an entry. 1913 * @xas: XArray operation state. 1914 * 1915 * Called after xas_load, the xas should not be in an error state. 1916 * The xas should not be pointing to a sibling entry. 1917 * 1918 * Return: A number between 0 and 63 indicating the order of the entry. 1919 */ 1920 int xas_get_order(struct xa_state *xas) 1921 { 1922 int order = 0; 1923 1924 if (!xas->xa_node) 1925 return 0; 1926 1927 XA_NODE_BUG_ON(xas->xa_node, xa_is_sibling(xa_entry(xas->xa, 1928 xas->xa_node, xas->xa_offset))); 1929 for (;;) { 1930 unsigned int slot = xas->xa_offset + (1 << order); 1931 1932 if (slot >= XA_CHUNK_SIZE) 1933 break; 1934 if (!xa_is_sibling(xa_entry(xas->xa, xas->xa_node, slot))) 1935 break; 1936 order++; 1937 } 1938 1939 order += xas->xa_node->shift; 1940 return order; 1941 } 1942 EXPORT_SYMBOL_GPL(xas_get_order); 1943 1944 /** 1945 * xa_get_order() - Get the order of an entry. 1946 * @xa: XArray. 1947 * @index: Index of the entry. 1948 * 1949 * Return: A number between 0 and 63 indicating the order of the entry. 1950 */ 1951 int xa_get_order(struct xarray *xa, unsigned long index) 1952 { 1953 XA_STATE(xas, xa, index); 1954 int order = 0; 1955 void *entry; 1956 1957 rcu_read_lock(); 1958 entry = xas_load(&xas); 1959 if (entry) 1960 order = xas_get_order(&xas); 1961 rcu_read_unlock(); 1962 1963 return order; 1964 } 1965 EXPORT_SYMBOL(xa_get_order); 1966 #endif /* CONFIG_XARRAY_MULTI */ 1967 1968 /** 1969 * __xa_alloc() - Find somewhere to store this entry in the XArray. 1970 * @xa: XArray. 1971 * @id: Pointer to ID. 1972 * @limit: Range for allocated ID. 1973 * @entry: New entry. 1974 * @gfp: Memory allocation flags. 1975 * 1976 * Finds an empty entry in @xa between @limit.min and @limit.max, 1977 * stores the index into the @id pointer, then stores the entry at 1978 * that index. A concurrent lookup will not see an uninitialised @id. 1979 * 1980 * Must only be operated on an xarray initialized with flag XA_FLAGS_ALLOC set 1981 * in xa_init_flags(). 1982 * 1983 * Context: Any context. Expects xa_lock to be held on entry. May 1984 * release and reacquire xa_lock if @gfp flags permit. 1985 * Return: 0 on success, -ENOMEM if memory could not be allocated or 1986 * -EBUSY if there are no free entries in @limit. 1987 */ 1988 int __xa_alloc(struct xarray *xa, u32 *id, void *entry, 1989 struct xa_limit limit, gfp_t gfp) 1990 { 1991 XA_STATE(xas, xa, 0); 1992 1993 if (WARN_ON_ONCE(xa_is_advanced(entry))) 1994 return -EINVAL; 1995 if (WARN_ON_ONCE(!xa_track_free(xa))) 1996 return -EINVAL; 1997 1998 if (!entry) 1999 entry = XA_ZERO_ENTRY; 2000 2001 do { 2002 xas.xa_index = limit.min; 2003 xas_find_marked(&xas, limit.max, XA_FREE_MARK); 2004 if (xas.xa_node == XAS_RESTART) 2005 xas_set_err(&xas, -EBUSY); 2006 else 2007 *id = xas.xa_index; 2008 xas_store(&xas, entry); 2009 xas_clear_mark(&xas, XA_FREE_MARK); 2010 } while (__xas_nomem(&xas, gfp)); 2011 2012 return xas_error(&xas); 2013 } 2014 EXPORT_SYMBOL(__xa_alloc); 2015 2016 /** 2017 * __xa_alloc_cyclic() - Find somewhere to store this entry in the XArray. 2018 * @xa: XArray. 2019 * @id: Pointer to ID. 2020 * @entry: New entry. 2021 * @limit: Range of allocated ID. 2022 * @next: Pointer to next ID to allocate. 2023 * @gfp: Memory allocation flags. 2024 * 2025 * Finds an empty entry in @xa between @limit.min and @limit.max, 2026 * stores the index into the @id pointer, then stores the entry at 2027 * that index. A concurrent lookup will not see an uninitialised @id. 2028 * The search for an empty entry will start at @next and will wrap 2029 * around if necessary. 2030 * 2031 * Must only be operated on an xarray initialized with flag XA_FLAGS_ALLOC set 2032 * in xa_init_flags(). 2033 * 2034 * Context: Any context. Expects xa_lock to be held on entry. May 2035 * release and reacquire xa_lock if @gfp flags permit. 2036 * Return: 0 if the allocation succeeded without wrapping. 1 if the 2037 * allocation succeeded after wrapping, -ENOMEM if memory could not be 2038 * allocated or -EBUSY if there are no free entries in @limit. 2039 */ 2040 int __xa_alloc_cyclic(struct xarray *xa, u32 *id, void *entry, 2041 struct xa_limit limit, u32 *next, gfp_t gfp) 2042 { 2043 u32 min = limit.min; 2044 int ret; 2045 2046 limit.min = max(min, *next); 2047 ret = __xa_alloc(xa, id, entry, limit, gfp); 2048 if ((xa->xa_flags & XA_FLAGS_ALLOC_WRAPPED) && ret == 0) { 2049 xa->xa_flags &= ~XA_FLAGS_ALLOC_WRAPPED; 2050 ret = 1; 2051 } 2052 2053 if (ret < 0 && limit.min > min) { 2054 limit.min = min; 2055 ret = __xa_alloc(xa, id, entry, limit, gfp); 2056 if (ret == 0) 2057 ret = 1; 2058 } 2059 2060 if (ret >= 0) { 2061 *next = *id + 1; 2062 if (*next == 0) 2063 xa->xa_flags |= XA_FLAGS_ALLOC_WRAPPED; 2064 } 2065 return ret; 2066 } 2067 EXPORT_SYMBOL(__xa_alloc_cyclic); 2068 2069 /** 2070 * __xa_set_mark() - Set this mark on this entry while locked. 2071 * @xa: XArray. 2072 * @index: Index of entry. 2073 * @mark: Mark number. 2074 * 2075 * Attempting to set a mark on a %NULL entry does not succeed. 2076 * 2077 * Context: Any context. Expects xa_lock to be held on entry. 2078 */ 2079 void __xa_set_mark(struct xarray *xa, unsigned long index, xa_mark_t mark) 2080 { 2081 XA_STATE(xas, xa, index); 2082 void *entry = xas_load(&xas); 2083 2084 if (entry) 2085 xas_set_mark(&xas, mark); 2086 } 2087 EXPORT_SYMBOL(__xa_set_mark); 2088 2089 /** 2090 * __xa_clear_mark() - Clear this mark on this entry while locked. 2091 * @xa: XArray. 2092 * @index: Index of entry. 2093 * @mark: Mark number. 2094 * 2095 * Context: Any context. Expects xa_lock to be held on entry. 2096 */ 2097 void __xa_clear_mark(struct xarray *xa, unsigned long index, xa_mark_t mark) 2098 { 2099 XA_STATE(xas, xa, index); 2100 void *entry = xas_load(&xas); 2101 2102 if (entry) 2103 xas_clear_mark(&xas, mark); 2104 } 2105 EXPORT_SYMBOL(__xa_clear_mark); 2106 2107 /** 2108 * xa_get_mark() - Inquire whether this mark is set on this entry. 2109 * @xa: XArray. 2110 * @index: Index of entry. 2111 * @mark: Mark number. 2112 * 2113 * This function uses the RCU read lock, so the result may be out of date 2114 * by the time it returns. If you need the result to be stable, use a lock. 2115 * 2116 * Context: Any context. Takes and releases the RCU lock. 2117 * Return: True if the entry at @index has this mark set, false if it doesn't. 2118 */ 2119 bool xa_get_mark(struct xarray *xa, unsigned long index, xa_mark_t mark) 2120 { 2121 XA_STATE(xas, xa, index); 2122 void *entry; 2123 2124 rcu_read_lock(); 2125 entry = xas_start(&xas); 2126 while (xas_get_mark(&xas, mark)) { 2127 if (!xa_is_node(entry)) 2128 goto found; 2129 entry = xas_descend(&xas, xa_to_node(entry)); 2130 } 2131 rcu_read_unlock(); 2132 return false; 2133 found: 2134 rcu_read_unlock(); 2135 return true; 2136 } 2137 EXPORT_SYMBOL(xa_get_mark); 2138 2139 /** 2140 * xa_set_mark() - Set this mark on this entry. 2141 * @xa: XArray. 2142 * @index: Index of entry. 2143 * @mark: Mark number. 2144 * 2145 * Attempting to set a mark on a %NULL entry does not succeed. 2146 * 2147 * Context: Process context. Takes and releases the xa_lock. 2148 */ 2149 void xa_set_mark(struct xarray *xa, unsigned long index, xa_mark_t mark) 2150 { 2151 xa_lock(xa); 2152 __xa_set_mark(xa, index, mark); 2153 xa_unlock(xa); 2154 } 2155 EXPORT_SYMBOL(xa_set_mark); 2156 2157 /** 2158 * xa_clear_mark() - Clear this mark on this entry. 2159 * @xa: XArray. 2160 * @index: Index of entry. 2161 * @mark: Mark number. 2162 * 2163 * Clearing a mark always succeeds. 2164 * 2165 * Context: Process context. Takes and releases the xa_lock. 2166 */ 2167 void xa_clear_mark(struct xarray *xa, unsigned long index, xa_mark_t mark) 2168 { 2169 xa_lock(xa); 2170 __xa_clear_mark(xa, index, mark); 2171 xa_unlock(xa); 2172 } 2173 EXPORT_SYMBOL(xa_clear_mark); 2174 2175 /** 2176 * xa_find() - Search the XArray for an entry. 2177 * @xa: XArray. 2178 * @indexp: Pointer to an index. 2179 * @max: Maximum index to search to. 2180 * @filter: Selection criterion. 2181 * 2182 * Finds the entry in @xa which matches the @filter, and has the lowest 2183 * index that is at least @indexp and no more than @max. 2184 * If an entry is found, @indexp is updated to be the index of the entry. 2185 * This function is protected by the RCU read lock, so it may not find 2186 * entries which are being simultaneously added. It will not return an 2187 * %XA_RETRY_ENTRY; if you need to see retry entries, use xas_find(). 2188 * 2189 * Context: Any context. Takes and releases the RCU lock. 2190 * Return: The entry, if found, otherwise %NULL. 2191 */ 2192 void *xa_find(struct xarray *xa, unsigned long *indexp, 2193 unsigned long max, xa_mark_t filter) 2194 { 2195 XA_STATE(xas, xa, *indexp); 2196 void *entry; 2197 2198 rcu_read_lock(); 2199 do { 2200 if ((__force unsigned int)filter < XA_MAX_MARKS) 2201 entry = xas_find_marked(&xas, max, filter); 2202 else 2203 entry = xas_find(&xas, max); 2204 } while (xas_retry(&xas, entry)); 2205 rcu_read_unlock(); 2206 2207 if (entry) 2208 *indexp = xas.xa_index; 2209 return entry; 2210 } 2211 EXPORT_SYMBOL(xa_find); 2212 2213 static bool xas_sibling(struct xa_state *xas) 2214 { 2215 struct xa_node *node = xas->xa_node; 2216 unsigned long mask; 2217 2218 if (!IS_ENABLED(CONFIG_XARRAY_MULTI) || !node) 2219 return false; 2220 mask = (XA_CHUNK_SIZE << node->shift) - 1; 2221 return (xas->xa_index & mask) > 2222 ((unsigned long)xas->xa_offset << node->shift); 2223 } 2224 2225 /** 2226 * xa_find_after() - Search the XArray for a present entry. 2227 * @xa: XArray. 2228 * @indexp: Pointer to an index. 2229 * @max: Maximum index to search to. 2230 * @filter: Selection criterion. 2231 * 2232 * Finds the entry in @xa which matches the @filter and has the lowest 2233 * index that is above @indexp and no more than @max. 2234 * If an entry is found, @indexp is updated to be the index of the entry. 2235 * This function is protected by the RCU read lock, so it may miss entries 2236 * which are being simultaneously added. It will not return an 2237 * %XA_RETRY_ENTRY; if you need to see retry entries, use xas_find(). 2238 * 2239 * Context: Any context. Takes and releases the RCU lock. 2240 * Return: The pointer, if found, otherwise %NULL. 2241 */ 2242 void *xa_find_after(struct xarray *xa, unsigned long *indexp, 2243 unsigned long max, xa_mark_t filter) 2244 { 2245 XA_STATE(xas, xa, *indexp + 1); 2246 void *entry; 2247 2248 if (xas.xa_index == 0) 2249 return NULL; 2250 2251 rcu_read_lock(); 2252 for (;;) { 2253 if ((__force unsigned int)filter < XA_MAX_MARKS) 2254 entry = xas_find_marked(&xas, max, filter); 2255 else 2256 entry = xas_find(&xas, max); 2257 2258 if (xas_invalid(&xas)) 2259 break; 2260 if (xas_sibling(&xas)) 2261 continue; 2262 if (!xas_retry(&xas, entry)) 2263 break; 2264 } 2265 rcu_read_unlock(); 2266 2267 if (entry) 2268 *indexp = xas.xa_index; 2269 return entry; 2270 } 2271 EXPORT_SYMBOL(xa_find_after); 2272 2273 static unsigned int xas_extract_present(struct xa_state *xas, void **dst, 2274 unsigned long max, unsigned int n) 2275 { 2276 void *entry; 2277 unsigned int i = 0; 2278 2279 rcu_read_lock(); 2280 xas_for_each(xas, entry, max) { 2281 if (xas_retry(xas, entry)) 2282 continue; 2283 dst[i++] = entry; 2284 if (i == n) 2285 break; 2286 } 2287 rcu_read_unlock(); 2288 2289 return i; 2290 } 2291 2292 static unsigned int xas_extract_marked(struct xa_state *xas, void **dst, 2293 unsigned long max, unsigned int n, xa_mark_t mark) 2294 { 2295 void *entry; 2296 unsigned int i = 0; 2297 2298 rcu_read_lock(); 2299 xas_for_each_marked(xas, entry, max, mark) { 2300 if (xas_retry(xas, entry)) 2301 continue; 2302 dst[i++] = entry; 2303 if (i == n) 2304 break; 2305 } 2306 rcu_read_unlock(); 2307 2308 return i; 2309 } 2310 2311 /** 2312 * xa_extract() - Copy selected entries from the XArray into a normal array. 2313 * @xa: The source XArray to copy from. 2314 * @dst: The buffer to copy entries into. 2315 * @start: The first index in the XArray eligible to be selected. 2316 * @max: The last index in the XArray eligible to be selected. 2317 * @n: The maximum number of entries to copy. 2318 * @filter: Selection criterion. 2319 * 2320 * Copies up to @n entries that match @filter from the XArray. The 2321 * copied entries will have indices between @start and @max, inclusive. 2322 * 2323 * The @filter may be an XArray mark value, in which case entries which are 2324 * marked with that mark will be copied. It may also be %XA_PRESENT, in 2325 * which case all entries which are not %NULL will be copied. 2326 * 2327 * The entries returned may not represent a snapshot of the XArray at a 2328 * moment in time. For example, if another thread stores to index 5, then 2329 * index 10, calling xa_extract() may return the old contents of index 5 2330 * and the new contents of index 10. Indices not modified while this 2331 * function is running will not be skipped. 2332 * 2333 * If you need stronger guarantees, holding the xa_lock across calls to this 2334 * function will prevent concurrent modification. 2335 * 2336 * Context: Any context. Takes and releases the RCU lock. 2337 * Return: The number of entries copied. 2338 */ 2339 unsigned int xa_extract(struct xarray *xa, void **dst, unsigned long start, 2340 unsigned long max, unsigned int n, xa_mark_t filter) 2341 { 2342 XA_STATE(xas, xa, start); 2343 2344 if (!n) 2345 return 0; 2346 2347 if ((__force unsigned int)filter < XA_MAX_MARKS) 2348 return xas_extract_marked(&xas, dst, max, n, filter); 2349 return xas_extract_present(&xas, dst, max, n); 2350 } 2351 EXPORT_SYMBOL(xa_extract); 2352 2353 /** 2354 * xa_delete_node() - Private interface for workingset code. 2355 * @node: Node to be removed from the tree. 2356 * @update: Function to call to update ancestor nodes. 2357 * 2358 * Context: xa_lock must be held on entry and will not be released. 2359 */ 2360 void xa_delete_node(struct xa_node *node, xa_update_node_t update) 2361 { 2362 struct xa_state xas = { 2363 .xa = node->array, 2364 .xa_index = (unsigned long)node->offset << 2365 (node->shift + XA_CHUNK_SHIFT), 2366 .xa_shift = node->shift + XA_CHUNK_SHIFT, 2367 .xa_offset = node->offset, 2368 .xa_node = xa_parent_locked(node->array, node), 2369 .xa_update = update, 2370 }; 2371 2372 xas_store(&xas, NULL); 2373 } 2374 EXPORT_SYMBOL_GPL(xa_delete_node); /* For the benefit of the test suite */ 2375 2376 /** 2377 * xa_destroy() - Free all internal data structures. 2378 * @xa: XArray. 2379 * 2380 * After calling this function, the XArray is empty and has freed all memory 2381 * allocated for its internal data structures. You are responsible for 2382 * freeing the objects referenced by the XArray. 2383 * 2384 * Context: Any context. Takes and releases the xa_lock, interrupt-safe. 2385 */ 2386 void xa_destroy(struct xarray *xa) 2387 { 2388 XA_STATE(xas, xa, 0); 2389 unsigned long flags; 2390 void *entry; 2391 2392 xas.xa_node = NULL; 2393 xas_lock_irqsave(&xas, flags); 2394 entry = xa_head_locked(xa); 2395 RCU_INIT_POINTER(xa->xa_head, NULL); 2396 xas_init_marks(&xas); 2397 if (xa_zero_busy(xa)) 2398 xa_mark_clear(xa, XA_FREE_MARK); 2399 /* lockdep checks we're still holding the lock in xas_free_nodes() */ 2400 if (xa_is_node(entry)) 2401 xas_free_nodes(&xas, xa_to_node(entry)); 2402 xas_unlock_irqrestore(&xas, flags); 2403 } 2404 EXPORT_SYMBOL(xa_destroy); 2405 2406 #ifdef XA_DEBUG 2407 void xa_dump_node(const struct xa_node *node) 2408 { 2409 unsigned i, j; 2410 2411 if (!node) 2412 return; 2413 if ((unsigned long)node & 3) { 2414 pr_cont("node %px\n", node); 2415 return; 2416 } 2417 2418 pr_cont("node %px %s %d parent %px shift %d count %d values %d " 2419 "array %px list %px %px marks", 2420 node, node->parent ? "offset" : "max", node->offset, 2421 node->parent, node->shift, node->count, node->nr_values, 2422 node->array, node->private_list.prev, node->private_list.next); 2423 for (i = 0; i < XA_MAX_MARKS; i++) 2424 for (j = 0; j < XA_MARK_LONGS; j++) 2425 pr_cont(" %lx", node->marks[i][j]); 2426 pr_cont("\n"); 2427 } 2428 2429 void xa_dump_index(unsigned long index, unsigned int shift) 2430 { 2431 if (!shift) 2432 pr_info("%lu: ", index); 2433 else if (shift >= BITS_PER_LONG) 2434 pr_info("0-%lu: ", ~0UL); 2435 else 2436 pr_info("%lu-%lu: ", index, index | ((1UL << shift) - 1)); 2437 } 2438 2439 void xa_dump_entry(const void *entry, unsigned long index, unsigned long shift) 2440 { 2441 if (!entry) 2442 return; 2443 2444 xa_dump_index(index, shift); 2445 2446 if (xa_is_node(entry)) { 2447 if (shift == 0) { 2448 pr_cont("%px\n", entry); 2449 } else { 2450 unsigned long i; 2451 struct xa_node *node = xa_to_node(entry); 2452 xa_dump_node(node); 2453 for (i = 0; i < XA_CHUNK_SIZE; i++) 2454 xa_dump_entry(node->slots[i], 2455 index + (i << node->shift), node->shift); 2456 } 2457 } else if (xa_is_value(entry)) 2458 pr_cont("value %ld (0x%lx) [%px]\n", xa_to_value(entry), 2459 xa_to_value(entry), entry); 2460 else if (!xa_is_internal(entry)) 2461 pr_cont("%px\n", entry); 2462 else if (xa_is_retry(entry)) 2463 pr_cont("retry (%ld)\n", xa_to_internal(entry)); 2464 else if (xa_is_sibling(entry)) 2465 pr_cont("sibling (slot %ld)\n", xa_to_sibling(entry)); 2466 else if (xa_is_zero(entry)) 2467 pr_cont("zero (%ld)\n", xa_to_internal(entry)); 2468 else 2469 pr_cont("UNKNOWN ENTRY (%px)\n", entry); 2470 } 2471 2472 void xa_dump(const struct xarray *xa) 2473 { 2474 void *entry = xa->xa_head; 2475 unsigned int shift = 0; 2476 2477 pr_info("xarray: %px head %px flags %x marks %d %d %d\n", xa, entry, 2478 xa->xa_flags, xa_marked(xa, XA_MARK_0), 2479 xa_marked(xa, XA_MARK_1), xa_marked(xa, XA_MARK_2)); 2480 if (xa_is_node(entry)) 2481 shift = xa_to_node(entry)->shift + XA_CHUNK_SHIFT; 2482 xa_dump_entry(entry, 0, shift); 2483 } 2484 #endif 2485