xref: /kvmtool/util/rbtree-interval.c (revision 495fbd4e1f262a9d04cdb79e11818fa5d55b91a9)
1e358b4fbSSasha Levin #include <kvm/rbtree-interval.h>
2e358b4fbSSasha Levin #include <stddef.h>
3*495fbd4eSSasha Levin #include <errno.h>
4e358b4fbSSasha Levin 
5e358b4fbSSasha Levin struct rb_int_node *rb_int_search_single(struct rb_root *root, u64 point)
6e358b4fbSSasha Levin {
7e358b4fbSSasha Levin 	struct rb_node *node = root->rb_node;
8e358b4fbSSasha Levin 	struct rb_node *lowest = NULL;
9e358b4fbSSasha Levin 
10e358b4fbSSasha Levin 	while (node) {
11e358b4fbSSasha Levin 		struct rb_int_node *cur = rb_int(node);
12e358b4fbSSasha Levin 
13e358b4fbSSasha Levin 		if (node->rb_left && (rb_int(node->rb_left)->max_high > point)) {
14e358b4fbSSasha Levin 			node = node->rb_left;
15e358b4fbSSasha Levin 		} else if (cur->low <= point && cur->high > point) {
16e358b4fbSSasha Levin 			lowest = node;
17e358b4fbSSasha Levin 			break;
18e358b4fbSSasha Levin 		} else if (point > cur->low) {
19e358b4fbSSasha Levin 			node = node->rb_right;
20e358b4fbSSasha Levin 		} else {
21e358b4fbSSasha Levin 			break;
22e358b4fbSSasha Levin 		}
23e358b4fbSSasha Levin 	}
24e358b4fbSSasha Levin 
25e358b4fbSSasha Levin 	if (lowest == NULL)
26e358b4fbSSasha Levin 		return NULL;
27e358b4fbSSasha Levin 
28e358b4fbSSasha Levin 	return rb_int(lowest);
29e358b4fbSSasha Levin }
30e358b4fbSSasha Levin 
31e358b4fbSSasha Levin struct rb_int_node *rb_int_search_range(struct rb_root *root, u64 low, u64 high)
32e358b4fbSSasha Levin {
33e358b4fbSSasha Levin 	struct rb_int_node *range;
34e358b4fbSSasha Levin 
35e358b4fbSSasha Levin 	range = rb_int_search_single(root, low);
36e358b4fbSSasha Levin 	if (range == NULL)
37e358b4fbSSasha Levin 		return NULL;
38e358b4fbSSasha Levin 
39e358b4fbSSasha Levin 	/* We simply verify that 'high' is smaller than the end of the range where 'low' is located */
40e358b4fbSSasha Levin 	if (range->high < high)
41e358b4fbSSasha Levin 		return NULL;
42e358b4fbSSasha Levin 
43e358b4fbSSasha Levin 	return range;
44e358b4fbSSasha Levin }
45e358b4fbSSasha Levin 
46e358b4fbSSasha Levin static void update_node_max_high(struct rb_node *node, void *arg)
47e358b4fbSSasha Levin {
48e358b4fbSSasha Levin 	struct rb_int_node *i_node = rb_int(node);
49e358b4fbSSasha Levin 
50e358b4fbSSasha Levin 	i_node->max_high = i_node->high;
51e358b4fbSSasha Levin 
52e358b4fbSSasha Levin 	if (node->rb_left)
539f112becSSasha Levin 		i_node->max_high = max(i_node->max_high, rb_int(node->rb_left)->max_high);
54e358b4fbSSasha Levin 	if (node->rb_right)
559f112becSSasha Levin 		i_node->max_high = max(i_node->max_high, rb_int(node->rb_right)->max_high);
56e358b4fbSSasha Levin }
57e358b4fbSSasha Levin 
58e358b4fbSSasha Levin int rb_int_insert(struct rb_root *root, struct rb_int_node *i_node)
59e358b4fbSSasha Levin {
60e358b4fbSSasha Levin 	struct rb_node **node = &(root->rb_node), *parent = NULL;
61e358b4fbSSasha Levin 
62e358b4fbSSasha Levin 	while (*node) {
63e358b4fbSSasha Levin 		int result = i_node->low - rb_int(*node)->low;
64e358b4fbSSasha Levin 
65e358b4fbSSasha Levin 		parent = *node;
66e358b4fbSSasha Levin 		if (result < 0)
67e358b4fbSSasha Levin 			node	= &((*node)->rb_left);
68e358b4fbSSasha Levin 		else if (result > 0)
69e358b4fbSSasha Levin 			node	= &((*node)->rb_right);
70e358b4fbSSasha Levin 		else
71*495fbd4eSSasha Levin 			return -EEXIST;
72e358b4fbSSasha Levin 	}
73e358b4fbSSasha Levin 
74e358b4fbSSasha Levin 	rb_link_node(&i_node->node, parent, node);
75e358b4fbSSasha Levin 	rb_insert_color(&i_node->node, root);
76e358b4fbSSasha Levin 
779f112becSSasha Levin 	rb_augment_insert(&i_node->node, update_node_max_high, NULL);
78*495fbd4eSSasha Levin 	return 0;
79e358b4fbSSasha Levin }
80e358b4fbSSasha Levin 
81e358b4fbSSasha Levin void rb_int_erase(struct rb_root *root, struct rb_int_node *node)
82e358b4fbSSasha Levin {
83e358b4fbSSasha Levin 	struct rb_node *deepest;
84e358b4fbSSasha Levin 
85e358b4fbSSasha Levin 	deepest = rb_augment_erase_begin(&node->node);
86e358b4fbSSasha Levin 	rb_erase(&node->node, root);
87e358b4fbSSasha Levin 	rb_augment_erase_end(deepest, update_node_max_high, NULL);
88e358b4fbSSasha Levin 
89e358b4fbSSasha Levin }
90