Merge branch 'for-linus' of git://git.kernel.org/pub/scm/linux/kernel/git/x86/linux...
[GitHub/mt8127/android_kernel_alcatel_ttab.git] / lib / radix-tree.c
1 /*
2 * Copyright (C) 2001 Momchil Velikov
3 * Portions Copyright (C) 2001 Christoph Hellwig
4 * Copyright (C) 2005 SGI, Christoph Lameter <clameter@sgi.com>
5 * Copyright (C) 2006 Nick Piggin
6 *
7 * This program is free software; you can redistribute it and/or
8 * modify it under the terms of the GNU General Public License as
9 * published by the Free Software Foundation; either version 2, or (at
10 * your option) any later version.
11 *
12 * This program is distributed in the hope that it will be useful, but
13 * WITHOUT ANY WARRANTY; without even the implied warranty of
14 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU
15 * General Public License for more details.
16 *
17 * You should have received a copy of the GNU General Public License
18 * along with this program; if not, write to the Free Software
19 * Foundation, Inc., 675 Mass Ave, Cambridge, MA 02139, USA.
20 */
21
22 #include <linux/errno.h>
23 #include <linux/init.h>
24 #include <linux/kernel.h>
25 #include <linux/module.h>
26 #include <linux/radix-tree.h>
27 #include <linux/percpu.h>
28 #include <linux/slab.h>
29 #include <linux/notifier.h>
30 #include <linux/cpu.h>
31 #include <linux/gfp.h>
32 #include <linux/string.h>
33 #include <linux/bitops.h>
34 #include <linux/rcupdate.h>
35
36
37 #ifdef __KERNEL__
38 #define RADIX_TREE_MAP_SHIFT (CONFIG_BASE_SMALL ? 4 : 6)
39 #else
40 #define RADIX_TREE_MAP_SHIFT 3 /* For more stressful testing */
41 #endif
42
43 #define RADIX_TREE_MAP_SIZE (1UL << RADIX_TREE_MAP_SHIFT)
44 #define RADIX_TREE_MAP_MASK (RADIX_TREE_MAP_SIZE-1)
45
46 #define RADIX_TREE_TAG_LONGS \
47 ((RADIX_TREE_MAP_SIZE + BITS_PER_LONG - 1) / BITS_PER_LONG)
48
49 struct radix_tree_node {
50 unsigned int height; /* Height from the bottom */
51 unsigned int count;
52 struct rcu_head rcu_head;
53 void *slots[RADIX_TREE_MAP_SIZE];
54 unsigned long tags[RADIX_TREE_MAX_TAGS][RADIX_TREE_TAG_LONGS];
55 };
56
57 struct radix_tree_path {
58 struct radix_tree_node *node;
59 int offset;
60 };
61
62 #define RADIX_TREE_INDEX_BITS (8 /* CHAR_BIT */ * sizeof(unsigned long))
63 #define RADIX_TREE_MAX_PATH (DIV_ROUND_UP(RADIX_TREE_INDEX_BITS, \
64 RADIX_TREE_MAP_SHIFT))
65
66 /*
67 * The height_to_maxindex array needs to be one deeper than the maximum
68 * path as height 0 holds only 1 entry.
69 */
70 static unsigned long height_to_maxindex[RADIX_TREE_MAX_PATH + 1] __read_mostly;
71
72 /*
73 * Radix tree node cache.
74 */
75 static struct kmem_cache *radix_tree_node_cachep;
76
77 /*
78 * Per-cpu pool of preloaded nodes
79 */
80 struct radix_tree_preload {
81 int nr;
82 struct radix_tree_node *nodes[RADIX_TREE_MAX_PATH];
83 };
84 DEFINE_PER_CPU(struct radix_tree_preload, radix_tree_preloads) = { 0, };
85
86 static inline gfp_t root_gfp_mask(struct radix_tree_root *root)
87 {
88 return root->gfp_mask & __GFP_BITS_MASK;
89 }
90
91 /*
92 * This assumes that the caller has performed appropriate preallocation, and
93 * that the caller has pinned this thread of control to the current CPU.
94 */
95 static struct radix_tree_node *
96 radix_tree_node_alloc(struct radix_tree_root *root)
97 {
98 struct radix_tree_node *ret = NULL;
99 gfp_t gfp_mask = root_gfp_mask(root);
100
101 if (!(gfp_mask & __GFP_WAIT)) {
102 struct radix_tree_preload *rtp;
103
104 /*
105 * Provided the caller has preloaded here, we will always
106 * succeed in getting a node here (and never reach
107 * kmem_cache_alloc)
108 */
109 rtp = &__get_cpu_var(radix_tree_preloads);
110 if (rtp->nr) {
111 ret = rtp->nodes[rtp->nr - 1];
112 rtp->nodes[rtp->nr - 1] = NULL;
113 rtp->nr--;
114 }
115 }
116 if (ret == NULL)
117 ret = kmem_cache_alloc(radix_tree_node_cachep, gfp_mask);
118
119 BUG_ON(radix_tree_is_indirect_ptr(ret));
120 return ret;
121 }
122
123 static void radix_tree_node_rcu_free(struct rcu_head *head)
124 {
125 struct radix_tree_node *node =
126 container_of(head, struct radix_tree_node, rcu_head);
127 kmem_cache_free(radix_tree_node_cachep, node);
128 }
129
130 static inline void
131 radix_tree_node_free(struct radix_tree_node *node)
132 {
133 call_rcu(&node->rcu_head, radix_tree_node_rcu_free);
134 }
135
136 /*
137 * Load up this CPU's radix_tree_node buffer with sufficient objects to
138 * ensure that the addition of a single element in the tree cannot fail. On
139 * success, return zero, with preemption disabled. On error, return -ENOMEM
140 * with preemption not disabled.
141 */
142 int radix_tree_preload(gfp_t gfp_mask)
143 {
144 struct radix_tree_preload *rtp;
145 struct radix_tree_node *node;
146 int ret = -ENOMEM;
147
148 preempt_disable();
149 rtp = &__get_cpu_var(radix_tree_preloads);
150 while (rtp->nr < ARRAY_SIZE(rtp->nodes)) {
151 preempt_enable();
152 node = kmem_cache_alloc(radix_tree_node_cachep, gfp_mask);
153 if (node == NULL)
154 goto out;
155 preempt_disable();
156 rtp = &__get_cpu_var(radix_tree_preloads);
157 if (rtp->nr < ARRAY_SIZE(rtp->nodes))
158 rtp->nodes[rtp->nr++] = node;
159 else
160 kmem_cache_free(radix_tree_node_cachep, node);
161 }
162 ret = 0;
163 out:
164 return ret;
165 }
166 EXPORT_SYMBOL(radix_tree_preload);
167
168 static inline void tag_set(struct radix_tree_node *node, unsigned int tag,
169 int offset)
170 {
171 __set_bit(offset, node->tags[tag]);
172 }
173
174 static inline void tag_clear(struct radix_tree_node *node, unsigned int tag,
175 int offset)
176 {
177 __clear_bit(offset, node->tags[tag]);
178 }
179
180 static inline int tag_get(struct radix_tree_node *node, unsigned int tag,
181 int offset)
182 {
183 return test_bit(offset, node->tags[tag]);
184 }
185
186 static inline void root_tag_set(struct radix_tree_root *root, unsigned int tag)
187 {
188 root->gfp_mask |= (__force gfp_t)(1 << (tag + __GFP_BITS_SHIFT));
189 }
190
191
192 static inline void root_tag_clear(struct radix_tree_root *root, unsigned int tag)
193 {
194 root->gfp_mask &= (__force gfp_t)~(1 << (tag + __GFP_BITS_SHIFT));
195 }
196
197 static inline void root_tag_clear_all(struct radix_tree_root *root)
198 {
199 root->gfp_mask &= __GFP_BITS_MASK;
200 }
201
202 static inline int root_tag_get(struct radix_tree_root *root, unsigned int tag)
203 {
204 return (__force unsigned)root->gfp_mask & (1 << (tag + __GFP_BITS_SHIFT));
205 }
206
207 /*
208 * Returns 1 if any slot in the node has this tag set.
209 * Otherwise returns 0.
210 */
211 static inline int any_tag_set(struct radix_tree_node *node, unsigned int tag)
212 {
213 int idx;
214 for (idx = 0; idx < RADIX_TREE_TAG_LONGS; idx++) {
215 if (node->tags[tag][idx])
216 return 1;
217 }
218 return 0;
219 }
220
221 /*
222 * Return the maximum key which can be store into a
223 * radix tree with height HEIGHT.
224 */
225 static inline unsigned long radix_tree_maxindex(unsigned int height)
226 {
227 return height_to_maxindex[height];
228 }
229
230 /*
231 * Extend a radix tree so it can store key @index.
232 */
233 static int radix_tree_extend(struct radix_tree_root *root, unsigned long index)
234 {
235 struct radix_tree_node *node;
236 unsigned int height;
237 int tag;
238
239 /* Figure out what the height should be. */
240 height = root->height + 1;
241 while (index > radix_tree_maxindex(height))
242 height++;
243
244 if (root->rnode == NULL) {
245 root->height = height;
246 goto out;
247 }
248
249 do {
250 unsigned int newheight;
251 if (!(node = radix_tree_node_alloc(root)))
252 return -ENOMEM;
253
254 /* Increase the height. */
255 node->slots[0] = radix_tree_indirect_to_ptr(root->rnode);
256
257 /* Propagate the aggregated tag info into the new root */
258 for (tag = 0; tag < RADIX_TREE_MAX_TAGS; tag++) {
259 if (root_tag_get(root, tag))
260 tag_set(node, tag, 0);
261 }
262
263 newheight = root->height+1;
264 node->height = newheight;
265 node->count = 1;
266 node = radix_tree_ptr_to_indirect(node);
267 rcu_assign_pointer(root->rnode, node);
268 root->height = newheight;
269 } while (height > root->height);
270 out:
271 return 0;
272 }
273
274 /**
275 * radix_tree_insert - insert into a radix tree
276 * @root: radix tree root
277 * @index: index key
278 * @item: item to insert
279 *
280 * Insert an item into the radix tree at position @index.
281 */
282 int radix_tree_insert(struct radix_tree_root *root,
283 unsigned long index, void *item)
284 {
285 struct radix_tree_node *node = NULL, *slot;
286 unsigned int height, shift;
287 int offset;
288 int error;
289
290 BUG_ON(radix_tree_is_indirect_ptr(item));
291
292 /* Make sure the tree is high enough. */
293 if (index > radix_tree_maxindex(root->height)) {
294 error = radix_tree_extend(root, index);
295 if (error)
296 return error;
297 }
298
299 slot = radix_tree_indirect_to_ptr(root->rnode);
300
301 height = root->height;
302 shift = (height-1) * RADIX_TREE_MAP_SHIFT;
303
304 offset = 0; /* uninitialised var warning */
305 while (height > 0) {
306 if (slot == NULL) {
307 /* Have to add a child node. */
308 if (!(slot = radix_tree_node_alloc(root)))
309 return -ENOMEM;
310 slot->height = height;
311 if (node) {
312 rcu_assign_pointer(node->slots[offset], slot);
313 node->count++;
314 } else
315 rcu_assign_pointer(root->rnode,
316 radix_tree_ptr_to_indirect(slot));
317 }
318
319 /* Go a level down */
320 offset = (index >> shift) & RADIX_TREE_MAP_MASK;
321 node = slot;
322 slot = node->slots[offset];
323 shift -= RADIX_TREE_MAP_SHIFT;
324 height--;
325 }
326
327 if (slot != NULL)
328 return -EEXIST;
329
330 if (node) {
331 node->count++;
332 rcu_assign_pointer(node->slots[offset], item);
333 BUG_ON(tag_get(node, 0, offset));
334 BUG_ON(tag_get(node, 1, offset));
335 } else {
336 rcu_assign_pointer(root->rnode, item);
337 BUG_ON(root_tag_get(root, 0));
338 BUG_ON(root_tag_get(root, 1));
339 }
340
341 return 0;
342 }
343 EXPORT_SYMBOL(radix_tree_insert);
344
345 /**
346 * radix_tree_lookup_slot - lookup a slot in a radix tree
347 * @root: radix tree root
348 * @index: index key
349 *
350 * Returns: the slot corresponding to the position @index in the
351 * radix tree @root. This is useful for update-if-exists operations.
352 *
353 * This function cannot be called under rcu_read_lock, it must be
354 * excluded from writers, as must the returned slot for subsequent
355 * use by radix_tree_deref_slot() and radix_tree_replace slot.
356 * Caller must hold tree write locked across slot lookup and
357 * replace.
358 */
359 void **radix_tree_lookup_slot(struct radix_tree_root *root, unsigned long index)
360 {
361 unsigned int height, shift;
362 struct radix_tree_node *node, **slot;
363
364 node = root->rnode;
365 if (node == NULL)
366 return NULL;
367
368 if (!radix_tree_is_indirect_ptr(node)) {
369 if (index > 0)
370 return NULL;
371 return (void **)&root->rnode;
372 }
373 node = radix_tree_indirect_to_ptr(node);
374
375 height = node->height;
376 if (index > radix_tree_maxindex(height))
377 return NULL;
378
379 shift = (height-1) * RADIX_TREE_MAP_SHIFT;
380
381 do {
382 slot = (struct radix_tree_node **)
383 (node->slots + ((index>>shift) & RADIX_TREE_MAP_MASK));
384 node = *slot;
385 if (node == NULL)
386 return NULL;
387
388 shift -= RADIX_TREE_MAP_SHIFT;
389 height--;
390 } while (height > 0);
391
392 return (void **)slot;
393 }
394 EXPORT_SYMBOL(radix_tree_lookup_slot);
395
396 /**
397 * radix_tree_lookup - perform lookup operation on a radix tree
398 * @root: radix tree root
399 * @index: index key
400 *
401 * Lookup the item at the position @index in the radix tree @root.
402 *
403 * This function can be called under rcu_read_lock, however the caller
404 * must manage lifetimes of leaf nodes (eg. RCU may also be used to free
405 * them safely). No RCU barriers are required to access or modify the
406 * returned item, however.
407 */
408 void *radix_tree_lookup(struct radix_tree_root *root, unsigned long index)
409 {
410 unsigned int height, shift;
411 struct radix_tree_node *node, **slot;
412
413 node = rcu_dereference(root->rnode);
414 if (node == NULL)
415 return NULL;
416
417 if (!radix_tree_is_indirect_ptr(node)) {
418 if (index > 0)
419 return NULL;
420 return node;
421 }
422 node = radix_tree_indirect_to_ptr(node);
423
424 height = node->height;
425 if (index > radix_tree_maxindex(height))
426 return NULL;
427
428 shift = (height-1) * RADIX_TREE_MAP_SHIFT;
429
430 do {
431 slot = (struct radix_tree_node **)
432 (node->slots + ((index>>shift) & RADIX_TREE_MAP_MASK));
433 node = rcu_dereference(*slot);
434 if (node == NULL)
435 return NULL;
436
437 shift -= RADIX_TREE_MAP_SHIFT;
438 height--;
439 } while (height > 0);
440
441 return node;
442 }
443 EXPORT_SYMBOL(radix_tree_lookup);
444
445 /**
446 * radix_tree_tag_set - set a tag on a radix tree node
447 * @root: radix tree root
448 * @index: index key
449 * @tag: tag index
450 *
451 * Set the search tag (which must be < RADIX_TREE_MAX_TAGS)
452 * corresponding to @index in the radix tree. From
453 * the root all the way down to the leaf node.
454 *
455 * Returns the address of the tagged item. Setting a tag on a not-present
456 * item is a bug.
457 */
458 void *radix_tree_tag_set(struct radix_tree_root *root,
459 unsigned long index, unsigned int tag)
460 {
461 unsigned int height, shift;
462 struct radix_tree_node *slot;
463
464 height = root->height;
465 BUG_ON(index > radix_tree_maxindex(height));
466
467 slot = radix_tree_indirect_to_ptr(root->rnode);
468 shift = (height - 1) * RADIX_TREE_MAP_SHIFT;
469
470 while (height > 0) {
471 int offset;
472
473 offset = (index >> shift) & RADIX_TREE_MAP_MASK;
474 if (!tag_get(slot, tag, offset))
475 tag_set(slot, tag, offset);
476 slot = slot->slots[offset];
477 BUG_ON(slot == NULL);
478 shift -= RADIX_TREE_MAP_SHIFT;
479 height--;
480 }
481
482 /* set the root's tag bit */
483 if (slot && !root_tag_get(root, tag))
484 root_tag_set(root, tag);
485
486 return slot;
487 }
488 EXPORT_SYMBOL(radix_tree_tag_set);
489
490 /**
491 * radix_tree_tag_clear - clear a tag on a radix tree node
492 * @root: radix tree root
493 * @index: index key
494 * @tag: tag index
495 *
496 * Clear the search tag (which must be < RADIX_TREE_MAX_TAGS)
497 * corresponding to @index in the radix tree. If
498 * this causes the leaf node to have no tags set then clear the tag in the
499 * next-to-leaf node, etc.
500 *
501 * Returns the address of the tagged item on success, else NULL. ie:
502 * has the same return value and semantics as radix_tree_lookup().
503 */
504 void *radix_tree_tag_clear(struct radix_tree_root *root,
505 unsigned long index, unsigned int tag)
506 {
507 /*
508 * The radix tree path needs to be one longer than the maximum path
509 * since the "list" is null terminated.
510 */
511 struct radix_tree_path path[RADIX_TREE_MAX_PATH + 1], *pathp = path;
512 struct radix_tree_node *slot = NULL;
513 unsigned int height, shift;
514
515 height = root->height;
516 if (index > radix_tree_maxindex(height))
517 goto out;
518
519 shift = (height - 1) * RADIX_TREE_MAP_SHIFT;
520 pathp->node = NULL;
521 slot = radix_tree_indirect_to_ptr(root->rnode);
522
523 while (height > 0) {
524 int offset;
525
526 if (slot == NULL)
527 goto out;
528
529 offset = (index >> shift) & RADIX_TREE_MAP_MASK;
530 pathp[1].offset = offset;
531 pathp[1].node = slot;
532 slot = slot->slots[offset];
533 pathp++;
534 shift -= RADIX_TREE_MAP_SHIFT;
535 height--;
536 }
537
538 if (slot == NULL)
539 goto out;
540
541 while (pathp->node) {
542 if (!tag_get(pathp->node, tag, pathp->offset))
543 goto out;
544 tag_clear(pathp->node, tag, pathp->offset);
545 if (any_tag_set(pathp->node, tag))
546 goto out;
547 pathp--;
548 }
549
550 /* clear the root's tag bit */
551 if (root_tag_get(root, tag))
552 root_tag_clear(root, tag);
553
554 out:
555 return slot;
556 }
557 EXPORT_SYMBOL(radix_tree_tag_clear);
558
559 #ifndef __KERNEL__ /* Only the test harness uses this at present */
560 /**
561 * radix_tree_tag_get - get a tag on a radix tree node
562 * @root: radix tree root
563 * @index: index key
564 * @tag: tag index (< RADIX_TREE_MAX_TAGS)
565 *
566 * Return values:
567 *
568 * 0: tag not present or not set
569 * 1: tag set
570 */
571 int radix_tree_tag_get(struct radix_tree_root *root,
572 unsigned long index, unsigned int tag)
573 {
574 unsigned int height, shift;
575 struct radix_tree_node *node;
576 int saw_unset_tag = 0;
577
578 /* check the root's tag bit */
579 if (!root_tag_get(root, tag))
580 return 0;
581
582 node = rcu_dereference(root->rnode);
583 if (node == NULL)
584 return 0;
585
586 if (!radix_tree_is_indirect_ptr(node))
587 return (index == 0);
588 node = radix_tree_indirect_to_ptr(node);
589
590 height = node->height;
591 if (index > radix_tree_maxindex(height))
592 return 0;
593
594 shift = (height - 1) * RADIX_TREE_MAP_SHIFT;
595
596 for ( ; ; ) {
597 int offset;
598
599 if (node == NULL)
600 return 0;
601
602 offset = (index >> shift) & RADIX_TREE_MAP_MASK;
603
604 /*
605 * This is just a debug check. Later, we can bale as soon as
606 * we see an unset tag.
607 */
608 if (!tag_get(node, tag, offset))
609 saw_unset_tag = 1;
610 if (height == 1) {
611 int ret = tag_get(node, tag, offset);
612
613 BUG_ON(ret && saw_unset_tag);
614 return !!ret;
615 }
616 node = rcu_dereference(node->slots[offset]);
617 shift -= RADIX_TREE_MAP_SHIFT;
618 height--;
619 }
620 }
621 EXPORT_SYMBOL(radix_tree_tag_get);
622 #endif
623
624 /**
625 * radix_tree_next_hole - find the next hole (not-present entry)
626 * @root: tree root
627 * @index: index key
628 * @max_scan: maximum range to search
629 *
630 * Search the set [index, min(index+max_scan-1, MAX_INDEX)] for the lowest
631 * indexed hole.
632 *
633 * Returns: the index of the hole if found, otherwise returns an index
634 * outside of the set specified (in which case 'return - index >= max_scan'
635 * will be true).
636 *
637 * radix_tree_next_hole may be called under rcu_read_lock. However, like
638 * radix_tree_gang_lookup, this will not atomically search a snapshot of the
639 * tree at a single point in time. For example, if a hole is created at index
640 * 5, then subsequently a hole is created at index 10, radix_tree_next_hole
641 * covering both indexes may return 10 if called under rcu_read_lock.
642 */
643 unsigned long radix_tree_next_hole(struct radix_tree_root *root,
644 unsigned long index, unsigned long max_scan)
645 {
646 unsigned long i;
647
648 for (i = 0; i < max_scan; i++) {
649 if (!radix_tree_lookup(root, index))
650 break;
651 index++;
652 if (index == 0)
653 break;
654 }
655
656 return index;
657 }
658 EXPORT_SYMBOL(radix_tree_next_hole);
659
660 static unsigned int
661 __lookup(struct radix_tree_node *slot, void **results, unsigned long index,
662 unsigned int max_items, unsigned long *next_index)
663 {
664 unsigned int nr_found = 0;
665 unsigned int shift, height;
666 unsigned long i;
667
668 height = slot->height;
669 if (height == 0)
670 goto out;
671 shift = (height-1) * RADIX_TREE_MAP_SHIFT;
672
673 for ( ; height > 1; height--) {
674 i = (index >> shift) & RADIX_TREE_MAP_MASK;
675 for (;;) {
676 if (slot->slots[i] != NULL)
677 break;
678 index &= ~((1UL << shift) - 1);
679 index += 1UL << shift;
680 if (index == 0)
681 goto out; /* 32-bit wraparound */
682 i++;
683 if (i == RADIX_TREE_MAP_SIZE)
684 goto out;
685 }
686
687 shift -= RADIX_TREE_MAP_SHIFT;
688 slot = rcu_dereference(slot->slots[i]);
689 if (slot == NULL)
690 goto out;
691 }
692
693 /* Bottom level: grab some items */
694 for (i = index & RADIX_TREE_MAP_MASK; i < RADIX_TREE_MAP_SIZE; i++) {
695 struct radix_tree_node *node;
696 index++;
697 node = slot->slots[i];
698 if (node) {
699 results[nr_found++] = rcu_dereference(node);
700 if (nr_found == max_items)
701 goto out;
702 }
703 }
704 out:
705 *next_index = index;
706 return nr_found;
707 }
708
709 /**
710 * radix_tree_gang_lookup - perform multiple lookup on a radix tree
711 * @root: radix tree root
712 * @results: where the results of the lookup are placed
713 * @first_index: start the lookup from this key
714 * @max_items: place up to this many items at *results
715 *
716 * Performs an index-ascending scan of the tree for present items. Places
717 * them at *@results and returns the number of items which were placed at
718 * *@results.
719 *
720 * The implementation is naive.
721 *
722 * Like radix_tree_lookup, radix_tree_gang_lookup may be called under
723 * rcu_read_lock. In this case, rather than the returned results being
724 * an atomic snapshot of the tree at a single point in time, the semantics
725 * of an RCU protected gang lookup are as though multiple radix_tree_lookups
726 * have been issued in individual locks, and results stored in 'results'.
727 */
728 unsigned int
729 radix_tree_gang_lookup(struct radix_tree_root *root, void **results,
730 unsigned long first_index, unsigned int max_items)
731 {
732 unsigned long max_index;
733 struct radix_tree_node *node;
734 unsigned long cur_index = first_index;
735 unsigned int ret;
736
737 node = rcu_dereference(root->rnode);
738 if (!node)
739 return 0;
740
741 if (!radix_tree_is_indirect_ptr(node)) {
742 if (first_index > 0)
743 return 0;
744 results[0] = node;
745 return 1;
746 }
747 node = radix_tree_indirect_to_ptr(node);
748
749 max_index = radix_tree_maxindex(node->height);
750
751 ret = 0;
752 while (ret < max_items) {
753 unsigned int nr_found;
754 unsigned long next_index; /* Index of next search */
755
756 if (cur_index > max_index)
757 break;
758 nr_found = __lookup(node, results + ret, cur_index,
759 max_items - ret, &next_index);
760 ret += nr_found;
761 if (next_index == 0)
762 break;
763 cur_index = next_index;
764 }
765
766 return ret;
767 }
768 EXPORT_SYMBOL(radix_tree_gang_lookup);
769
770 /*
771 * FIXME: the two tag_get()s here should use find_next_bit() instead of
772 * open-coding the search.
773 */
774 static unsigned int
775 __lookup_tag(struct radix_tree_node *slot, void **results, unsigned long index,
776 unsigned int max_items, unsigned long *next_index, unsigned int tag)
777 {
778 unsigned int nr_found = 0;
779 unsigned int shift, height;
780
781 height = slot->height;
782 if (height == 0)
783 goto out;
784 shift = (height-1) * RADIX_TREE_MAP_SHIFT;
785
786 while (height > 0) {
787 unsigned long i = (index >> shift) & RADIX_TREE_MAP_MASK ;
788
789 for (;;) {
790 if (tag_get(slot, tag, i))
791 break;
792 index &= ~((1UL << shift) - 1);
793 index += 1UL << shift;
794 if (index == 0)
795 goto out; /* 32-bit wraparound */
796 i++;
797 if (i == RADIX_TREE_MAP_SIZE)
798 goto out;
799 }
800 height--;
801 if (height == 0) { /* Bottom level: grab some items */
802 unsigned long j = index & RADIX_TREE_MAP_MASK;
803
804 for ( ; j < RADIX_TREE_MAP_SIZE; j++) {
805 struct radix_tree_node *node;
806 index++;
807 if (!tag_get(slot, tag, j))
808 continue;
809 node = slot->slots[j];
810 /*
811 * Even though the tag was found set, we need to
812 * recheck that we have a non-NULL node, because
813 * if this lookup is lockless, it may have been
814 * subsequently deleted.
815 *
816 * Similar care must be taken in any place that
817 * lookup ->slots[x] without a lock (ie. can't
818 * rely on its value remaining the same).
819 */
820 if (node) {
821 node = rcu_dereference(node);
822 results[nr_found++] = node;
823 if (nr_found == max_items)
824 goto out;
825 }
826 }
827 }
828 shift -= RADIX_TREE_MAP_SHIFT;
829 slot = rcu_dereference(slot->slots[i]);
830 if (slot == NULL)
831 break;
832 }
833 out:
834 *next_index = index;
835 return nr_found;
836 }
837
838 /**
839 * radix_tree_gang_lookup_tag - perform multiple lookup on a radix tree
840 * based on a tag
841 * @root: radix tree root
842 * @results: where the results of the lookup are placed
843 * @first_index: start the lookup from this key
844 * @max_items: place up to this many items at *results
845 * @tag: the tag index (< RADIX_TREE_MAX_TAGS)
846 *
847 * Performs an index-ascending scan of the tree for present items which
848 * have the tag indexed by @tag set. Places the items at *@results and
849 * returns the number of items which were placed at *@results.
850 */
851 unsigned int
852 radix_tree_gang_lookup_tag(struct radix_tree_root *root, void **results,
853 unsigned long first_index, unsigned int max_items,
854 unsigned int tag)
855 {
856 struct radix_tree_node *node;
857 unsigned long max_index;
858 unsigned long cur_index = first_index;
859 unsigned int ret;
860
861 /* check the root's tag bit */
862 if (!root_tag_get(root, tag))
863 return 0;
864
865 node = rcu_dereference(root->rnode);
866 if (!node)
867 return 0;
868
869 if (!radix_tree_is_indirect_ptr(node)) {
870 if (first_index > 0)
871 return 0;
872 results[0] = node;
873 return 1;
874 }
875 node = radix_tree_indirect_to_ptr(node);
876
877 max_index = radix_tree_maxindex(node->height);
878
879 ret = 0;
880 while (ret < max_items) {
881 unsigned int nr_found;
882 unsigned long next_index; /* Index of next search */
883
884 if (cur_index > max_index)
885 break;
886 nr_found = __lookup_tag(node, results + ret, cur_index,
887 max_items - ret, &next_index, tag);
888 ret += nr_found;
889 if (next_index == 0)
890 break;
891 cur_index = next_index;
892 }
893
894 return ret;
895 }
896 EXPORT_SYMBOL(radix_tree_gang_lookup_tag);
897
898 /**
899 * radix_tree_shrink - shrink height of a radix tree to minimal
900 * @root radix tree root
901 */
902 static inline void radix_tree_shrink(struct radix_tree_root *root)
903 {
904 /* try to shrink tree height */
905 while (root->height > 0) {
906 struct radix_tree_node *to_free = root->rnode;
907 void *newptr;
908
909 BUG_ON(!radix_tree_is_indirect_ptr(to_free));
910 to_free = radix_tree_indirect_to_ptr(to_free);
911
912 /*
913 * The candidate node has more than one child, or its child
914 * is not at the leftmost slot, we cannot shrink.
915 */
916 if (to_free->count != 1)
917 break;
918 if (!to_free->slots[0])
919 break;
920
921 /*
922 * We don't need rcu_assign_pointer(), since we are simply
923 * moving the node from one part of the tree to another. If
924 * it was safe to dereference the old pointer to it
925 * (to_free->slots[0]), it will be safe to dereference the new
926 * one (root->rnode).
927 */
928 newptr = to_free->slots[0];
929 if (root->height > 1)
930 newptr = radix_tree_ptr_to_indirect(newptr);
931 root->rnode = newptr;
932 root->height--;
933 /* must only free zeroed nodes into the slab */
934 tag_clear(to_free, 0, 0);
935 tag_clear(to_free, 1, 0);
936 to_free->slots[0] = NULL;
937 to_free->count = 0;
938 radix_tree_node_free(to_free);
939 }
940 }
941
942 /**
943 * radix_tree_delete - delete an item from a radix tree
944 * @root: radix tree root
945 * @index: index key
946 *
947 * Remove the item at @index from the radix tree rooted at @root.
948 *
949 * Returns the address of the deleted item, or NULL if it was not present.
950 */
951 void *radix_tree_delete(struct radix_tree_root *root, unsigned long index)
952 {
953 /*
954 * The radix tree path needs to be one longer than the maximum path
955 * since the "list" is null terminated.
956 */
957 struct radix_tree_path path[RADIX_TREE_MAX_PATH + 1], *pathp = path;
958 struct radix_tree_node *slot = NULL;
959 struct radix_tree_node *to_free;
960 unsigned int height, shift;
961 int tag;
962 int offset;
963
964 height = root->height;
965 if (index > radix_tree_maxindex(height))
966 goto out;
967
968 slot = root->rnode;
969 if (height == 0) {
970 root_tag_clear_all(root);
971 root->rnode = NULL;
972 goto out;
973 }
974 slot = radix_tree_indirect_to_ptr(slot);
975
976 shift = (height - 1) * RADIX_TREE_MAP_SHIFT;
977 pathp->node = NULL;
978
979 do {
980 if (slot == NULL)
981 goto out;
982
983 pathp++;
984 offset = (index >> shift) & RADIX_TREE_MAP_MASK;
985 pathp->offset = offset;
986 pathp->node = slot;
987 slot = slot->slots[offset];
988 shift -= RADIX_TREE_MAP_SHIFT;
989 height--;
990 } while (height > 0);
991
992 if (slot == NULL)
993 goto out;
994
995 /*
996 * Clear all tags associated with the just-deleted item
997 */
998 for (tag = 0; tag < RADIX_TREE_MAX_TAGS; tag++) {
999 if (tag_get(pathp->node, tag, pathp->offset))
1000 radix_tree_tag_clear(root, index, tag);
1001 }
1002
1003 to_free = NULL;
1004 /* Now free the nodes we do not need anymore */
1005 while (pathp->node) {
1006 pathp->node->slots[pathp->offset] = NULL;
1007 pathp->node->count--;
1008 /*
1009 * Queue the node for deferred freeing after the
1010 * last reference to it disappears (set NULL, above).
1011 */
1012 if (to_free)
1013 radix_tree_node_free(to_free);
1014
1015 if (pathp->node->count) {
1016 if (pathp->node ==
1017 radix_tree_indirect_to_ptr(root->rnode))
1018 radix_tree_shrink(root);
1019 goto out;
1020 }
1021
1022 /* Node with zero slots in use so free it */
1023 to_free = pathp->node;
1024 pathp--;
1025
1026 }
1027 root_tag_clear_all(root);
1028 root->height = 0;
1029 root->rnode = NULL;
1030 if (to_free)
1031 radix_tree_node_free(to_free);
1032
1033 out:
1034 return slot;
1035 }
1036 EXPORT_SYMBOL(radix_tree_delete);
1037
1038 /**
1039 * radix_tree_tagged - test whether any items in the tree are tagged
1040 * @root: radix tree root
1041 * @tag: tag to test
1042 */
1043 int radix_tree_tagged(struct radix_tree_root *root, unsigned int tag)
1044 {
1045 return root_tag_get(root, tag);
1046 }
1047 EXPORT_SYMBOL(radix_tree_tagged);
1048
1049 static void
1050 radix_tree_node_ctor(struct kmem_cache *cachep, void *node)
1051 {
1052 memset(node, 0, sizeof(struct radix_tree_node));
1053 }
1054
1055 static __init unsigned long __maxindex(unsigned int height)
1056 {
1057 unsigned int width = height * RADIX_TREE_MAP_SHIFT;
1058 int shift = RADIX_TREE_INDEX_BITS - width;
1059
1060 if (shift < 0)
1061 return ~0UL;
1062 if (shift >= BITS_PER_LONG)
1063 return 0UL;
1064 return ~0UL >> shift;
1065 }
1066
1067 static __init void radix_tree_init_maxindex(void)
1068 {
1069 unsigned int i;
1070
1071 for (i = 0; i < ARRAY_SIZE(height_to_maxindex); i++)
1072 height_to_maxindex[i] = __maxindex(i);
1073 }
1074
1075 static int radix_tree_callback(struct notifier_block *nfb,
1076 unsigned long action,
1077 void *hcpu)
1078 {
1079 int cpu = (long)hcpu;
1080 struct radix_tree_preload *rtp;
1081
1082 /* Free per-cpu pool of perloaded nodes */
1083 if (action == CPU_DEAD || action == CPU_DEAD_FROZEN) {
1084 rtp = &per_cpu(radix_tree_preloads, cpu);
1085 while (rtp->nr) {
1086 kmem_cache_free(radix_tree_node_cachep,
1087 rtp->nodes[rtp->nr-1]);
1088 rtp->nodes[rtp->nr-1] = NULL;
1089 rtp->nr--;
1090 }
1091 }
1092 return NOTIFY_OK;
1093 }
1094
1095 void __init radix_tree_init(void)
1096 {
1097 radix_tree_node_cachep = kmem_cache_create("radix_tree_node",
1098 sizeof(struct radix_tree_node), 0,
1099 SLAB_PANIC | SLAB_RECLAIM_ACCOUNT,
1100 radix_tree_node_ctor);
1101 radix_tree_init_maxindex();
1102 hotcpu_notifier(radix_tree_callback, 0);
1103 }