| // SPDX-License-Identifier: GPL-2.0-only | 
 | #include <linux/module.h> | 
 | #include <linux/moduleparam.h> | 
 | #include <linux/interval_tree.h> | 
 | #include <linux/prandom.h> | 
 | #include <linux/slab.h> | 
 | #include <asm/timex.h> | 
 | #include <linux/bitmap.h> | 
 | #include <linux/maple_tree.h> | 
 |  | 
 | #define __param(type, name, init, msg)		\ | 
 | 	static type name = init;		\ | 
 | 	module_param(name, type, 0444);		\ | 
 | 	MODULE_PARM_DESC(name, msg); | 
 |  | 
 | __param(int, nnodes, 100, "Number of nodes in the interval tree"); | 
 | __param(int, perf_loops, 1000, "Number of iterations modifying the tree"); | 
 |  | 
 | __param(int, nsearches, 100, "Number of searches to the interval tree"); | 
 | __param(int, search_loops, 1000, "Number of iterations searching the tree"); | 
 | __param(bool, search_all, false, "Searches will iterate all nodes in the tree"); | 
 |  | 
 | __param(uint, max_endpoint, ~0, "Largest value for the interval's endpoint"); | 
 | __param(ullong, seed, 3141592653589793238ULL, "Random seed"); | 
 |  | 
 | static struct rb_root_cached root = RB_ROOT_CACHED; | 
 | static struct interval_tree_node *nodes = NULL; | 
 | static u32 *queries = NULL; | 
 |  | 
 | static struct rnd_state rnd; | 
 |  | 
 | static inline unsigned long | 
 | search(struct rb_root_cached *root, unsigned long start, unsigned long last) | 
 | { | 
 | 	struct interval_tree_node *node; | 
 | 	unsigned long results = 0; | 
 |  | 
 | 	for (node = interval_tree_iter_first(root, start, last); node; | 
 | 	     node = interval_tree_iter_next(node, start, last)) | 
 | 		results++; | 
 | 	return results; | 
 | } | 
 |  | 
 | static void init(void) | 
 | { | 
 | 	int i; | 
 |  | 
 | 	for (i = 0; i < nnodes; i++) { | 
 | 		u32 b = (prandom_u32_state(&rnd) >> 4) % max_endpoint; | 
 | 		u32 a = (prandom_u32_state(&rnd) >> 4) % b; | 
 |  | 
 | 		nodes[i].start = a; | 
 | 		nodes[i].last = b; | 
 | 	} | 
 |  | 
 | 	/* | 
 | 	 * Limit the search scope to what the user defined. | 
 | 	 * Otherwise we are merely measuring empty walks, | 
 | 	 * which is pointless. | 
 | 	 */ | 
 | 	for (i = 0; i < nsearches; i++) | 
 | 		queries[i] = (prandom_u32_state(&rnd) >> 4) % max_endpoint; | 
 | } | 
 |  | 
 | static int basic_check(void) | 
 | { | 
 | 	int i, j; | 
 | 	cycles_t time1, time2, time; | 
 |  | 
 | 	printk(KERN_ALERT "interval tree insert/remove"); | 
 |  | 
 | 	init(); | 
 |  | 
 | 	time1 = get_cycles(); | 
 |  | 
 | 	for (i = 0; i < perf_loops; i++) { | 
 | 		for (j = 0; j < nnodes; j++) | 
 | 			interval_tree_insert(nodes + j, &root); | 
 | 		for (j = 0; j < nnodes; j++) | 
 | 			interval_tree_remove(nodes + j, &root); | 
 | 	} | 
 |  | 
 | 	time2 = get_cycles(); | 
 | 	time = time2 - time1; | 
 |  | 
 | 	time = div_u64(time, perf_loops); | 
 | 	printk(" -> %llu cycles\n", (unsigned long long)time); | 
 |  | 
 | 	return 0; | 
 | } | 
 |  | 
 | static int search_check(void) | 
 | { | 
 | 	int i, j; | 
 | 	unsigned long results; | 
 | 	cycles_t time1, time2, time; | 
 |  | 
 | 	printk(KERN_ALERT "interval tree search"); | 
 |  | 
 | 	init(); | 
 |  | 
 | 	for (j = 0; j < nnodes; j++) | 
 | 		interval_tree_insert(nodes + j, &root); | 
 |  | 
 | 	time1 = get_cycles(); | 
 |  | 
 | 	results = 0; | 
 | 	for (i = 0; i < search_loops; i++) | 
 | 		for (j = 0; j < nsearches; j++) { | 
 | 			unsigned long start = search_all ? 0 : queries[j]; | 
 | 			unsigned long last = search_all ? max_endpoint : queries[j]; | 
 |  | 
 | 			results += search(&root, start, last); | 
 | 		} | 
 |  | 
 | 	time2 = get_cycles(); | 
 | 	time = time2 - time1; | 
 |  | 
 | 	time = div_u64(time, search_loops); | 
 | 	results = div_u64(results, search_loops); | 
 | 	printk(" -> %llu cycles (%lu results)\n", | 
 | 	       (unsigned long long)time, results); | 
 |  | 
 | 	for (j = 0; j < nnodes; j++) | 
 | 		interval_tree_remove(nodes + j, &root); | 
 |  | 
 | 	return 0; | 
 | } | 
 |  | 
 | static int intersection_range_check(void) | 
 | { | 
 | 	int i, j, k; | 
 | 	unsigned long start, last; | 
 | 	struct interval_tree_node *node; | 
 | 	unsigned long *intxn1; | 
 | 	unsigned long *intxn2; | 
 |  | 
 | 	printk(KERN_ALERT "interval tree iteration\n"); | 
 |  | 
 | 	intxn1 = bitmap_alloc(nnodes, GFP_KERNEL); | 
 | 	if (!intxn1) { | 
 | 		WARN_ON_ONCE("Failed to allocate intxn1\n"); | 
 | 		return -ENOMEM; | 
 | 	} | 
 |  | 
 | 	intxn2 = bitmap_alloc(nnodes, GFP_KERNEL); | 
 | 	if (!intxn2) { | 
 | 		WARN_ON_ONCE("Failed to allocate intxn2\n"); | 
 | 		bitmap_free(intxn1); | 
 | 		return -ENOMEM; | 
 | 	} | 
 |  | 
 | 	for (i = 0; i < search_loops; i++) { | 
 | 		/* Initialize interval tree for each round */ | 
 | 		init(); | 
 | 		for (j = 0; j < nnodes; j++) | 
 | 			interval_tree_insert(nodes + j, &root); | 
 |  | 
 | 		/* Let's try nsearches different ranges */ | 
 | 		for (k = 0; k < nsearches; k++) { | 
 | 			/* Try whole range once */ | 
 | 			if (!k) { | 
 | 				start = 0UL; | 
 | 				last = ULONG_MAX; | 
 | 			} else { | 
 | 				last = (prandom_u32_state(&rnd) >> 4) % max_endpoint; | 
 | 				start = (prandom_u32_state(&rnd) >> 4) % last; | 
 | 			} | 
 |  | 
 | 			/* Walk nodes to mark intersection nodes */ | 
 | 			bitmap_zero(intxn1, nnodes); | 
 | 			for (j = 0; j < nnodes; j++) { | 
 | 				node = nodes + j; | 
 |  | 
 | 				if (start <= node->last && last >= node->start) | 
 | 					bitmap_set(intxn1, j, 1); | 
 | 			} | 
 |  | 
 | 			/* Iterate tree to clear intersection nodes */ | 
 | 			bitmap_zero(intxn2, nnodes); | 
 | 			for (node = interval_tree_iter_first(&root, start, last); node; | 
 | 			     node = interval_tree_iter_next(node, start, last)) | 
 | 				bitmap_set(intxn2, node - nodes, 1); | 
 |  | 
 | 			WARN_ON_ONCE(!bitmap_equal(intxn1, intxn2, nnodes)); | 
 | 		} | 
 |  | 
 | 		for (j = 0; j < nnodes; j++) | 
 | 			interval_tree_remove(nodes + j, &root); | 
 | 	} | 
 |  | 
 | 	bitmap_free(intxn1); | 
 | 	bitmap_free(intxn2); | 
 | 	return 0; | 
 | } | 
 |  | 
 | #ifdef CONFIG_INTERVAL_TREE_SPAN_ITER | 
 | /* | 
 |  * Helper function to get span of current position from maple tree point of | 
 |  * view. | 
 |  */ | 
 | static void mas_cur_span(struct ma_state *mas, struct interval_tree_span_iter *state) | 
 | { | 
 | 	unsigned long cur_start; | 
 | 	unsigned long cur_last; | 
 | 	int is_hole; | 
 |  | 
 | 	if (mas->status == ma_overflow) | 
 | 		return; | 
 |  | 
 | 	/* walk to current position */ | 
 | 	state->is_hole = mas_walk(mas) ? 0 : 1; | 
 |  | 
 | 	cur_start = mas->index < state->first_index ? | 
 | 			state->first_index : mas->index; | 
 |  | 
 | 	/* whether we have followers */ | 
 | 	do { | 
 |  | 
 | 		cur_last = mas->last > state->last_index ? | 
 | 				state->last_index : mas->last; | 
 |  | 
 | 		is_hole = mas_next_range(mas, state->last_index) ? 0 : 1; | 
 |  | 
 | 	} while (mas->status != ma_overflow && is_hole == state->is_hole); | 
 |  | 
 | 	if (state->is_hole) { | 
 | 		state->start_hole = cur_start; | 
 | 		state->last_hole = cur_last; | 
 | 	} else { | 
 | 		state->start_used = cur_start; | 
 | 		state->last_used = cur_last; | 
 | 	} | 
 |  | 
 | 	/* advance position for next round */ | 
 | 	if (mas->status != ma_overflow) | 
 | 		mas_set(mas, cur_last + 1); | 
 | } | 
 |  | 
 | static int span_iteration_check(void) | 
 | { | 
 | 	int i, j, k; | 
 | 	unsigned long start, last; | 
 | 	struct interval_tree_span_iter span, mas_span; | 
 |  | 
 | 	DEFINE_MTREE(tree); | 
 |  | 
 | 	MA_STATE(mas, &tree, 0, 0); | 
 |  | 
 | 	printk(KERN_ALERT "interval tree span iteration\n"); | 
 |  | 
 | 	for (i = 0; i < search_loops; i++) { | 
 | 		/* Initialize interval tree for each round */ | 
 | 		init(); | 
 | 		for (j = 0; j < nnodes; j++) | 
 | 			interval_tree_insert(nodes + j, &root); | 
 |  | 
 | 		/* Put all the range into maple tree */ | 
 | 		mt_init_flags(&tree, MT_FLAGS_ALLOC_RANGE); | 
 | 		mt_set_in_rcu(&tree); | 
 |  | 
 | 		for (j = 0; j < nnodes; j++) | 
 | 			WARN_ON_ONCE(mtree_store_range(&tree, nodes[j].start, | 
 | 					nodes[j].last, nodes + j, GFP_KERNEL)); | 
 |  | 
 | 		/* Let's try nsearches different ranges */ | 
 | 		for (k = 0; k < nsearches; k++) { | 
 | 			/* Try whole range once */ | 
 | 			if (!k) { | 
 | 				start = 0UL; | 
 | 				last = ULONG_MAX; | 
 | 			} else { | 
 | 				last = (prandom_u32_state(&rnd) >> 4) % max_endpoint; | 
 | 				start = (prandom_u32_state(&rnd) >> 4) % last; | 
 | 			} | 
 |  | 
 | 			mas_span.first_index = start; | 
 | 			mas_span.last_index = last; | 
 | 			mas_span.is_hole = -1; | 
 | 			mas_set(&mas, start); | 
 |  | 
 | 			interval_tree_for_each_span(&span, &root, start, last) { | 
 | 				mas_cur_span(&mas, &mas_span); | 
 |  | 
 | 				WARN_ON_ONCE(span.is_hole != mas_span.is_hole); | 
 |  | 
 | 				if (span.is_hole) { | 
 | 					WARN_ON_ONCE(span.start_hole != mas_span.start_hole); | 
 | 					WARN_ON_ONCE(span.last_hole != mas_span.last_hole); | 
 | 				} else { | 
 | 					WARN_ON_ONCE(span.start_used != mas_span.start_used); | 
 | 					WARN_ON_ONCE(span.last_used != mas_span.last_used); | 
 | 				} | 
 | 			} | 
 |  | 
 | 		} | 
 |  | 
 | 		WARN_ON_ONCE(mas.status != ma_overflow); | 
 |  | 
 | 		/* Cleanup maple tree for each round */ | 
 | 		mtree_destroy(&tree); | 
 | 		/* Cleanup interval tree for each round */ | 
 | 		for (j = 0; j < nnodes; j++) | 
 | 			interval_tree_remove(nodes + j, &root); | 
 | 	} | 
 | 	return 0; | 
 | } | 
 | #else | 
 | static inline int span_iteration_check(void) {return 0; } | 
 | #endif | 
 |  | 
 | static int interval_tree_test_init(void) | 
 | { | 
 | 	nodes = kmalloc_array(nnodes, sizeof(struct interval_tree_node), | 
 | 			      GFP_KERNEL); | 
 | 	if (!nodes) | 
 | 		return -ENOMEM; | 
 |  | 
 | 	queries = kmalloc_array(nsearches, sizeof(int), GFP_KERNEL); | 
 | 	if (!queries) { | 
 | 		kfree(nodes); | 
 | 		return -ENOMEM; | 
 | 	} | 
 |  | 
 | 	prandom_seed_state(&rnd, seed); | 
 |  | 
 | 	basic_check(); | 
 | 	search_check(); | 
 | 	intersection_range_check(); | 
 | 	span_iteration_check(); | 
 |  | 
 | 	kfree(queries); | 
 | 	kfree(nodes); | 
 |  | 
 | 	return -EAGAIN; /* Fail will directly unload the module */ | 
 | } | 
 |  | 
 | static void interval_tree_test_exit(void) | 
 | { | 
 | 	printk(KERN_ALERT "test exit\n"); | 
 | } | 
 |  | 
 | module_init(interval_tree_test_init) | 
 | module_exit(interval_tree_test_exit) | 
 |  | 
 | MODULE_LICENSE("GPL"); | 
 | MODULE_AUTHOR("Michel Lespinasse"); | 
 | MODULE_DESCRIPTION("Interval Tree test"); |