[GitHub/mt8127/android_kernel_alcatel_ttab.git] / lib / rbtree_test.c

#include <linux/module.h>
#include <linux/rbtree_augmented.h>
#include <linux/random.h>
#include <asm/timex.h>

#define NODES       100
#define PERF_LOOPS  100000
#define CHECK_LOOPS 100

struct test_node {
	struct rb_node rb;
	u32 key;

	/* following fields used for testing augmented rbtree functionality */
	u32 val;
	u32 augmented;
};

static struct rb_root root = RB_ROOT;
static struct test_node nodes[NODES];

static struct rnd_state rnd;

static void insert(struct test_node *node, struct rb_root *root)
{
	struct rb_node **new = &root->rb_node, *parent = NULL;
	u32 key = node->key;

	while (*new) {
		parent = *new;
		if (key < rb_entry(parent, struct test_node, rb)->key)
			new = &parent->rb_left;
		else
			new = &parent->rb_right;
	}

	rb_link_node(&node->rb, parent, new);
	rb_insert_color(&node->rb, root);
}

static inline void erase(struct test_node *node, struct rb_root *root)
{
	rb_erase(&node->rb, root);
}

static inline u32 augment_recompute(struct test_node *node)
{
	u32 max = node->val, child_augmented;
	if (node->rb.rb_left) {
		child_augmented = rb_entry(node->rb.rb_left, struct test_node,
					   rb)->augmented;
		if (max < child_augmented)
			max = child_augmented;
	}
	if (node->rb.rb_right) {
		child_augmented = rb_entry(node->rb.rb_right, struct test_node,
					   rb)->augmented;
		if (max < child_augmented)
			max = child_augmented;
	}
	return max;
}

RB_DECLARE_CALLBACKS(static, augment_callbacks, struct test_node, rb,
		     u32, augmented, augment_recompute)

static void insert_augmented(struct test_node *node, struct rb_root *root)
{
	struct rb_node **new = &root->rb_node, *rb_parent = NULL;
	u32 key = node->key;
	u32 val = node->val;
	struct test_node *parent;

	while (*new) {
		rb_parent = *new;
		parent = rb_entry(rb_parent, struct test_node, rb);
		if (parent->augmented < val)
			parent->augmented = val;
		if (key < parent->key)
			new = &parent->rb.rb_left;
		else
			new = &parent->rb.rb_right;
	}

	node->augmented = val;
	rb_link_node(&node->rb, rb_parent, new);
	rb_insert_augmented(&node->rb, root, &augment_callbacks);
}

static void erase_augmented(struct test_node *node, struct rb_root *root)
{
	rb_erase_augmented(&node->rb, root, &augment_callbacks);
}

static void init(void)
{
	int i;
	for (i = 0; i < NODES; i++) {
		nodes[i].key = prandom_u32_state(&rnd);
		nodes[i].val = prandom_u32_state(&rnd);
	}
}

static bool is_red(struct rb_node *rb)
{
	return !(rb->__rb_parent_color & 1);
}

static int black_path_count(struct rb_node *rb)
{
	int count;
	for (count = 0; rb; rb = rb_parent(rb))
		count += !is_red(rb);
	return count;
}

static void check(int nr_nodes)
{
	struct rb_node *rb;
	int count = 0, blacks = 0;
	u32 prev_key = 0;

	for (rb = rb_first(&root); rb; rb = rb_next(rb)) {
		struct test_node *node = rb_entry(rb, struct test_node, rb);
		WARN_ON_ONCE(node->key < prev_key);
		WARN_ON_ONCE(is_red(rb) &&
			     (!rb_parent(rb) || is_red(rb_parent(rb))));
		if (!count)
			blacks = black_path_count(rb);
		else
			WARN_ON_ONCE((!rb->rb_left || !rb->rb_right) &&
				     blacks != black_path_count(rb));
		prev_key = node->key;
		count++;
	}

	WARN_ON_ONCE(count != nr_nodes);
	WARN_ON_ONCE(count < (1 << black_path_count(rb_last(&root))) - 1);
}

static void check_augmented(int nr_nodes)
{
	struct rb_node *rb;

	check(nr_nodes);
	for (rb = rb_first(&root); rb; rb = rb_next(rb)) {
		struct test_node *node = rb_entry(rb, struct test_node, rb);
		WARN_ON_ONCE(node->augmented != augment_recompute(node));
	}
}

static int __init rbtree_test_init(void)
{
	int i, j;
	cycles_t time1, time2, time;

	printk(KERN_ALERT "rbtree testing");

	prandom_seed_state(&rnd, 3141592653589793238ULL);
	init();

	time1 = get_cycles();

	for (i = 0; i < PERF_LOOPS; i++) {
		for (j = 0; j < NODES; j++)
			insert(nodes + j, &root);
		for (j = 0; j < NODES; j++)
			erase(nodes + j, &root);
	}

	time2 = get_cycles();
	time = time2 - time1;

	time = div_u64(time, PERF_LOOPS);
	printk(" -> %llu cycles\n", (unsigned long long)time);

	for (i = 0; i < CHECK_LOOPS; i++) {
		init();
		for (j = 0; j < NODES; j++) {
			check(j);
			insert(nodes + j, &root);
		}
		for (j = 0; j < NODES; j++) {
			check(NODES - j);
			erase(nodes + j, &root);
		}
		check(0);
	}

	printk(KERN_ALERT "augmented rbtree testing");

	init();

	time1 = get_cycles();

	for (i = 0; i < PERF_LOOPS; i++) {
		for (j = 0; j < NODES; j++)
			insert_augmented(nodes + j, &root);
		for (j = 0; j < NODES; j++)
			erase_augmented(nodes + j, &root);
	}

	time2 = get_cycles();
	time = time2 - time1;

	time = div_u64(time, PERF_LOOPS);
	printk(" -> %llu cycles\n", (unsigned long long)time);

	for (i = 0; i < CHECK_LOOPS; i++) {
		init();
		for (j = 0; j < NODES; j++) {
			check_augmented(j);
			insert_augmented(nodes + j, &root);
		}
		for (j = 0; j < NODES; j++) {
			check_augmented(NODES - j);
			erase_augmented(nodes + j, &root);
		}
		check_augmented(0);
	}

	return -EAGAIN; /* Fail will directly unload the module */
}

static void __exit rbtree_test_exit(void)
{
	printk(KERN_ALERT "test exit\n");
}

module_init(rbtree_test_init)
module_exit(rbtree_test_exit)

MODULE_LICENSE("GPL");
MODULE_AUTHOR("Michel Lespinasse");
MODULE_DESCRIPTION("Red Black Tree test");
Commit	Line	Data
910a742d	1	#include <linux/module.h>
9c079add	2	#include <linux/rbtree_augmented.h>
910a742d ML	3	#include <linux/random.h>
	4	#include <asm/timex.h>
	5
	6	#define NODES 100
	7	#define PERF_LOOPS 100000
	8	#define CHECK_LOOPS 100
	9
	10	struct test_node {
	11	struct rb_node rb;
	12	u32 key;
dadf9353 ML	13
	14	/* following fields used for testing augmented rbtree functionality */
	15	u32 val;
	16	u32 augmented;
910a742d ML	17	};
	18
	19	static struct rb_root root = RB_ROOT;
	20	static struct test_node nodes[NODES];
	21
	22	static struct rnd_state rnd;
	23
	24	static void insert(struct test_node node, struct rb_root root)
	25	{
	26	struct rb_node *new = &root->rb_node, parent = NULL;
dadf9353	27	u32 key = node->key;
910a742d ML	28
	29	while (*new) {
	30	parent = *new;
dadf9353	31	if (key < rb_entry(parent, struct test_node, rb)->key)
910a742d ML	32	new = &parent->rb_left;
	33	else
	34	new = &parent->rb_right;
	35	}
	36
	37	rb_link_node(&node->rb, parent, new);
	38	rb_insert_color(&node->rb, root);
	39	}
	40
	41	static inline void erase(struct test_node node, struct rb_root root)
	42	{
	43	rb_erase(&node->rb, root);
	44	}
	45
dadf9353 ML	46	static inline u32 augment_recompute(struct test_node *node)
	47	{
	48	u32 max = node->val, child_augmented;
	49	if (node->rb.rb_left) {
	50	child_augmented = rb_entry(node->rb.rb_left, struct test_node,
	51	rb)->augmented;
	52	if (max < child_augmented)
	53	max = child_augmented;
	54	}
	55	if (node->rb.rb_right) {
	56	child_augmented = rb_entry(node->rb.rb_right, struct test_node,
	57	rb)->augmented;
	58	if (max < child_augmented)
	59	max = child_augmented;
	60	}
	61	return max;
	62	}
	63
3908836a ML	64	RB_DECLARE_CALLBACKS(static, augment_callbacks, struct test_node, rb,
3908836a ML	65	u32, augmented, augment_recompute)
14b94af0	66
dadf9353 ML	67	static void insert_augmented(struct test_node node, struct rb_root root)
dadf9353 ML	68	{
14b94af0	69	struct rb_node *new = &root->rb_node, rb_parent = NULL;
dadf9353	70	u32 key = node->key;
14b94af0 ML	71	u32 val = node->val;
14b94af0 ML	72	struct test_node *parent;
dadf9353 ML	73
dadf9353 ML	74	while (*new) {
14b94af0 ML	75	rb_parent = *new;
	76	parent = rb_entry(rb_parent, struct test_node, rb);
	77	if (parent->augmented < val)
	78	parent->augmented = val;
	79	if (key < parent->key)
	80	new = &parent->rb.rb_left;
dadf9353	81	else
14b94af0	82	new = &parent->rb.rb_right;
dadf9353 ML	83	}
dadf9353 ML	84
14b94af0 ML	85	node->augmented = val;
	86	rb_link_node(&node->rb, rb_parent, new);
	87	rb_insert_augmented(&node->rb, root, &augment_callbacks);
dadf9353 ML	88	}
	89
	90	static void erase_augmented(struct test_node node, struct rb_root root)
	91	{
14b94af0	92	rb_erase_augmented(&node->rb, root, &augment_callbacks);
dadf9353 ML	93	}
dadf9353 ML	94
910a742d ML	95	static void init(void)
	96	{
	97	int i;
dadf9353	98	for (i = 0; i < NODES; i++) {
496f2f93 AM	99	nodes[i].key = prandom_u32_state(&rnd);
496f2f93 AM	100	nodes[i].val = prandom_u32_state(&rnd);
dadf9353	101	}
910a742d ML	102	}
	103
	104	static bool is_red(struct rb_node *rb)
	105	{
	106	return !(rb->__rb_parent_color & 1);
	107	}
	108
	109	static int black_path_count(struct rb_node *rb)
	110	{
	111	int count;
	112	for (count = 0; rb; rb = rb_parent(rb))
	113	count += !is_red(rb);
	114	return count;
	115	}
	116
	117	static void check(int nr_nodes)
	118	{
	119	struct rb_node *rb;
4130f0ef	120	int count = 0, blacks = 0;
910a742d ML	121	u32 prev_key = 0;
	122
	123	for (rb = rb_first(&root); rb; rb = rb_next(rb)) {
	124	struct test_node *node = rb_entry(rb, struct test_node, rb);
	125	WARN_ON_ONCE(node->key < prev_key);
	126	WARN_ON_ONCE(is_red(rb) &&
	127	(!rb_parent(rb) \|\| is_red(rb_parent(rb))));
	128	if (!count)
	129	blacks = black_path_count(rb);
	130	else
	131	WARN_ON_ONCE((!rb->rb_left \|\| !rb->rb_right) &&
	132	blacks != black_path_count(rb));
	133	prev_key = node->key;
	134	count++;
	135	}
4130f0ef	136
910a742d	137	WARN_ON_ONCE(count != nr_nodes);
4130f0ef	138	WARN_ON_ONCE(count < (1 << black_path_count(rb_last(&root))) - 1);
910a742d ML	139	}
910a742d ML	140
dadf9353 ML	141	static void check_augmented(int nr_nodes)
	142	{
	143	struct rb_node *rb;
	144
	145	check(nr_nodes);
	146	for (rb = rb_first(&root); rb; rb = rb_next(rb)) {
	147	struct test_node *node = rb_entry(rb, struct test_node, rb);
	148	WARN_ON_ONCE(node->augmented != augment_recompute(node));
	149	}
	150	}
	151
c75aaa8e	152	static int __init rbtree_test_init(void)
910a742d ML	153	{
	154	int i, j;
	155	cycles_t time1, time2, time;
	156
	157	printk(KERN_ALERT "rbtree testing");
	158
496f2f93	159	prandom_seed_state(&rnd, 3141592653589793238ULL);
910a742d ML	160	init();
	161
	162	time1 = get_cycles();
	163
	164	for (i = 0; i < PERF_LOOPS; i++) {
	165	for (j = 0; j < NODES; j++)
	166	insert(nodes + j, &root);
	167	for (j = 0; j < NODES; j++)
	168	erase(nodes + j, &root);
	169	}
	170
	171	time2 = get_cycles();
	172	time = time2 - time1;
	173
	174	time = div_u64(time, PERF_LOOPS);
	175	printk(" -> %llu cycles\n", (unsigned long long)time);
	176
	177	for (i = 0; i < CHECK_LOOPS; i++) {
	178	init();
	179	for (j = 0; j < NODES; j++) {
	180	check(j);
	181	insert(nodes + j, &root);
	182	}
	183	for (j = 0; j < NODES; j++) {
	184	check(NODES - j);
	185	erase(nodes + j, &root);
	186	}
	187	check(0);
	188	}
	189
dadf9353 ML	190	printk(KERN_ALERT "augmented rbtree testing");
	191
	192	init();
	193
	194	time1 = get_cycles();
	195
	196	for (i = 0; i < PERF_LOOPS; i++) {
	197	for (j = 0; j < NODES; j++)
	198	insert_augmented(nodes + j, &root);
	199	for (j = 0; j < NODES; j++)
	200	erase_augmented(nodes + j, &root);
	201	}
	202
	203	time2 = get_cycles();
	204	time = time2 - time1;
	205
	206	time = div_u64(time, PERF_LOOPS);
	207	printk(" -> %llu cycles\n", (unsigned long long)time);
	208
	209	for (i = 0; i < CHECK_LOOPS; i++) {
	210	init();
	211	for (j = 0; j < NODES; j++) {
	212	check_augmented(j);
	213	insert_augmented(nodes + j, &root);
	214	}
	215	for (j = 0; j < NODES; j++) {
	216	check_augmented(NODES - j);
	217	erase_augmented(nodes + j, &root);
	218	}
	219	check_augmented(0);
	220	}
	221
910a742d ML	222	return -EAGAIN; /* Fail will directly unload the module */
	223	}
	224
c75aaa8e	225	static void __exit rbtree_test_exit(void)
910a742d ML	226	{
	227	printk(KERN_ALERT "test exit\n");
	228	}
	229
	230	module_init(rbtree_test_init)
	231	module_exit(rbtree_test_exit)
	232
	233	MODULE_LICENSE("GPL");
	234	MODULE_AUTHOR("Michel Lespinasse");
	235	MODULE_DESCRIPTION("Red Black Tree test");