nuclear@68: #include <stdio.h>
nuclear@68: #include <stdlib.h>
nuclear@68: #include <string.h>
nuclear@68: #include "rbtree.h"
nuclear@69: #include "panic.h"
nuclear@68: 
nuclear@68: #define INT2PTR(x)	((void*)(x))
nuclear@68: #define PTR2INT(x)	((int)(x))
nuclear@68: 
nuclear@68: static int cmpaddr(void *ap, void *bp);
nuclear@68: static int cmpint(void *ap, void *bp);
nuclear@68: 
nuclear@68: static int count_nodes(struct rbnode *node);
nuclear@68: static void del_tree(struct rbnode *node, void (*delfunc)(struct rbnode*, void*), void *cls);
nuclear@68: static struct rbnode *insert(struct rbtree *rb, struct rbnode *tree, void *key, void *data);
nuclear@68: static struct rbnode *delete(struct rbtree *rb, struct rbnode *tree, void *key);
nuclear@68: static void traverse(struct rbnode *node, void (*func)(struct rbnode*, void*), void *cls);
nuclear@68: 
nuclear@68: struct rbtree *rb_create(rb_cmp_func_t cmp_func)
nuclear@68: {
nuclear@68: 	struct rbtree *rb;
nuclear@68: 
nuclear@68: 	if(!(rb = malloc(sizeof *rb))) {
nuclear@68: 		return 0;
nuclear@68: 	}
nuclear@68: 	if(rb_init(rb, cmp_func) == -1) {
nuclear@68: 		free(rb);
nuclear@68: 		return 0;
nuclear@68: 	}
nuclear@68: 	return rb;
nuclear@68: }
nuclear@68: 
nuclear@68: void rb_free(struct rbtree *rb)
nuclear@68: {
nuclear@68: 	rb_destroy(rb);
nuclear@68: 	free(rb);
nuclear@68: }
nuclear@68: 
nuclear@68: 
nuclear@68: int rb_init(struct rbtree *rb, rb_cmp_func_t cmp_func)
nuclear@68: {
nuclear@68: 	memset(rb, 0, sizeof *rb);
nuclear@68: 
nuclear@68: 	if(cmp_func == RB_KEY_INT) {
nuclear@68: 		rb->cmp = cmpint;
nuclear@68: 	} else if(cmp_func == RB_KEY_STRING) {
nuclear@68: 		rb->cmp = (rb_cmp_func_t)strcmp;
nuclear@68: 	} else {
nuclear@68: 		rb->cmp = cmpaddr;
nuclear@68: 	}
nuclear@68: 
nuclear@68: 	rb->alloc = malloc;
nuclear@68: 	rb->free = free;
nuclear@68: 	return 0;
nuclear@68: }
nuclear@68: 
nuclear@68: void rb_destroy(struct rbtree *rb)
nuclear@68: {
nuclear@68: 	del_tree(rb->root, rb->del, rb->del_cls);
nuclear@68: }
nuclear@68: 
nuclear@69: void rb_clear(struct rbtree *rb)
nuclear@69: {
nuclear@69: 	del_tree(rb->root, rb->del, rb->del_cls);
nuclear@69: 	rb->root = 0;
nuclear@69: }
nuclear@69: 
nuclear@69: int rb_copy(struct rbtree *dest, struct rbtree *src)
nuclear@69: {
nuclear@69: 	struct rbnode *node;
nuclear@69: 
nuclear@69: 	rb_clear(dest);
nuclear@69: 
nuclear@69: 	rb_begin(src);
nuclear@69: 	while((node = rb_next(src))) {
nuclear@69: 		if(rb_insert(dest, node->key, node->data) == -1) {
nuclear@69: 			return -1;
nuclear@69: 		}
nuclear@69: 	}
nuclear@69: 	return 0;
nuclear@69: }
nuclear@69: 
nuclear@68: void rb_set_allocator(struct rbtree *rb, rb_alloc_func_t alloc, rb_free_func_t free)
nuclear@68: {
nuclear@68: 	rb->alloc = alloc;
nuclear@68: 	rb->free = free;
nuclear@68: }
nuclear@68: 
nuclear@68: 
nuclear@68: void rb_set_compare_func(struct rbtree *rb, rb_cmp_func_t func)
nuclear@68: {
nuclear@68: 	rb->cmp = func;
nuclear@68: }
nuclear@68: 
nuclear@68: void rb_set_delete_func(struct rbtree *rb, rb_del_func_t func, void *cls)
nuclear@68: {
nuclear@68: 	rb->del = func;
nuclear@68: 	rb->del_cls = cls;
nuclear@68: }
nuclear@68: 
nuclear@68: int rb_size(struct rbtree *rb)
nuclear@68: {
nuclear@68: 	return count_nodes(rb->root);
nuclear@68: }
nuclear@68: 
nuclear@68: int rb_insert(struct rbtree *rb, void *key, void *data)
nuclear@68: {
nuclear@68: 	rb->root = insert(rb, rb->root, key, data);
nuclear@68: 	rb->root->red = 0;
nuclear@68: 	return 0;
nuclear@68: }
nuclear@68: 
nuclear@68: int rb_inserti(struct rbtree *rb, int key, void *data)
nuclear@68: {
nuclear@68: 	rb->root = insert(rb, rb->root, INT2PTR(key), data);
nuclear@68: 	rb->root->red = 0;
nuclear@68: 	return 0;
nuclear@68: }
nuclear@68: 
nuclear@68: 
nuclear@68: int rb_delete(struct rbtree *rb, void *key)
nuclear@68: {
nuclear@68: 	rb->root = delete(rb, rb->root, key);
nuclear@68: 	rb->root->red = 0;
nuclear@68: 	return 0;
nuclear@68: }
nuclear@68: 
nuclear@68: int rb_deletei(struct rbtree *rb, int key)
nuclear@68: {
nuclear@68: 	rb->root = delete(rb, rb->root, INT2PTR(key));
nuclear@68: 	rb->root->red = 0;
nuclear@68: 	return 0;
nuclear@68: }
nuclear@68: 
nuclear@68: 
nuclear@68: void *rb_find(struct rbtree *rb, void *key)
nuclear@68: {
nuclear@68: 	struct rbnode *node = rb->root;
nuclear@68: 
nuclear@68: 	while(node) {
nuclear@68: 		int cmp = rb->cmp(key, node->key);
nuclear@68: 		if(cmp == 0) {
nuclear@68: 			return node;
nuclear@68: 		}
nuclear@68: 		node = cmp < 0 ? node->left : node->right;
nuclear@68: 	}
nuclear@68: 	return 0;
nuclear@68: }
nuclear@68: 
nuclear@68: void *rb_findi(struct rbtree *rb, int key)
nuclear@68: {
nuclear@68: 	return rb_find(rb, INT2PTR(key));
nuclear@68: }
nuclear@68: 
nuclear@68: 
nuclear@68: void rb_foreach(struct rbtree *rb, void (*func)(struct rbnode*, void*), void *cls)
nuclear@68: {
nuclear@68: 	traverse(rb->root, func, cls);
nuclear@68: }
nuclear@68: 
nuclear@68: 
nuclear@68: struct rbnode *rb_root(struct rbtree *rb)
nuclear@68: {
nuclear@68: 	return rb->root;
nuclear@68: }
nuclear@68: 
nuclear@68: void rb_begin(struct rbtree *rb)
nuclear@68: {
nuclear@68: 	rb->rstack = 0;
nuclear@68: 	rb->iter = rb->root;
nuclear@68: }
nuclear@68: 
nuclear@68: #define push(sp, x)		((x)->next = (sp), (sp) = (x))
nuclear@68: #define pop(sp)			((sp) = (sp)->next)
nuclear@68: #define top(sp)			(sp)
nuclear@68: 
nuclear@68: struct rbnode *rb_next(struct rbtree *rb)
nuclear@68: {
nuclear@68: 	struct rbnode *res = 0;
nuclear@68: 
nuclear@68: 	while(rb->rstack || rb->iter) {
nuclear@68: 		if(rb->iter) {
nuclear@68: 			push(rb->rstack, rb->iter);
nuclear@68: 			rb->iter = rb->iter->left;
nuclear@68: 		} else {
nuclear@68: 			rb->iter = top(rb->rstack);
nuclear@68: 			pop(rb->rstack);
nuclear@68: 			res = rb->iter;
nuclear@68: 			rb->iter = rb->iter->right;
nuclear@68: 			break;
nuclear@68: 		}
nuclear@68: 	}
nuclear@68: 	return res;
nuclear@68: }
nuclear@68: 
nuclear@68: void *rb_node_key(struct rbnode *node)
nuclear@68: {
nuclear@68: 	return node ? node->key : 0;
nuclear@68: }
nuclear@68: 
nuclear@68: int rb_node_keyi(struct rbnode *node)
nuclear@68: {
nuclear@68: 	return node ? PTR2INT(node->key) : 0;
nuclear@68: }
nuclear@68: 
nuclear@68: void *rb_node_data(struct rbnode *node)
nuclear@68: {
nuclear@68: 	return node ? node->data : 0;
nuclear@68: }
nuclear@68: 
nuclear@68: static int cmpaddr(void *ap, void *bp)
nuclear@68: {
nuclear@68: 	return ap < bp ? -1 : (ap > bp ? 1 : 0);
nuclear@68: }
nuclear@68: 
nuclear@68: static int cmpint(void *ap, void *bp)
nuclear@68: {
nuclear@68: 	return PTR2INT(ap) - PTR2INT(bp);
nuclear@68: }
nuclear@68: 
nuclear@68: 
nuclear@68: /* ---- left-leaning 2-3 red-black implementation ---- */
nuclear@68: 
nuclear@68: /* helper prototypes */
nuclear@68: static int is_red(struct rbnode *tree);
nuclear@68: static void color_flip(struct rbnode *tree);
nuclear@68: static struct rbnode *rot_left(struct rbnode *a);
nuclear@68: static struct rbnode *rot_right(struct rbnode *a);
nuclear@68: static struct rbnode *find_min(struct rbnode *tree);
nuclear@68: static struct rbnode *del_min(struct rbtree *rb, struct rbnode *tree);
nuclear@68: /*static struct rbnode *move_red_right(struct rbnode *tree);*/
nuclear@68: static struct rbnode *move_red_left(struct rbnode *tree);
nuclear@68: static struct rbnode *fix_up(struct rbnode *tree);
nuclear@68: 
nuclear@68: static int count_nodes(struct rbnode *node)
nuclear@68: {
nuclear@68: 	if(!node)
nuclear@68: 		return 0;
nuclear@68: 
nuclear@68: 	return 1 + count_nodes(node->left) + count_nodes(node->right);
nuclear@68: }
nuclear@68: 
nuclear@68: static void del_tree(struct rbnode *node, rb_del_func_t delfunc, void *cls)
nuclear@68: {
nuclear@68: 	if(!node)
nuclear@68: 		return;
nuclear@68: 
nuclear@68: 	del_tree(node->left, delfunc, cls);
nuclear@68: 	del_tree(node->right, delfunc, cls);
nuclear@68: 
nuclear@73: 	if(delfunc) {
nuclear@73: 		delfunc(node, cls);
nuclear@73: 	}
nuclear@68: 	free(node);
nuclear@68: }
nuclear@68: 
nuclear@68: static struct rbnode *insert(struct rbtree *rb, struct rbnode *tree, void *key, void *data)
nuclear@68: {
nuclear@68: 	int cmp;
nuclear@68: 
nuclear@68: 	if(!tree) {
nuclear@68: 		struct rbnode *node = rb->alloc(sizeof *node);
nuclear@69: 		if(!node) {
nuclear@69: 			panic("failed to allocate tree node\n");
nuclear@69: 		}
nuclear@68: 		node->red = 1;
nuclear@68: 		node->key = key;
nuclear@68: 		node->data = data;
nuclear@68: 		node->left = node->right = 0;
nuclear@68: 		return node;
nuclear@68: 	}
nuclear@68: 
nuclear@68: 	cmp = rb->cmp(key, tree->key);
nuclear@68: 
nuclear@68: 	if(cmp < 0) {
nuclear@68: 		tree->left = insert(rb, tree->left, key, data);
nuclear@68: 	} else if(cmp > 0) {
nuclear@68: 		tree->right = insert(rb, tree->right, key, data);
nuclear@68: 	} else {
nuclear@68: 		tree->data = data;
nuclear@68: 	}
nuclear@68: 
nuclear@68: 	/* fix right-leaning reds */
nuclear@68: 	if(is_red(tree->right)) {
nuclear@68: 		tree = rot_left(tree);
nuclear@68: 	}
nuclear@68: 	/* fix two reds in a row */
nuclear@68: 	if(is_red(tree->left) && is_red(tree->left->left)) {
nuclear@68: 		tree = rot_right(tree);
nuclear@68: 	}
nuclear@68: 
nuclear@68: 	/* if 4-node, split it by color inversion */
nuclear@68: 	if(is_red(tree->left) && is_red(tree->right)) {
nuclear@68: 		color_flip(tree);
nuclear@68: 	}
nuclear@68: 
nuclear@68: 	return tree;
nuclear@68: }
nuclear@68: 
nuclear@68: static struct rbnode *delete(struct rbtree *rb, struct rbnode *tree, void *key)
nuclear@68: {
nuclear@68: 	int cmp;
nuclear@68: 
nuclear@68: 	if(!tree) {
nuclear@68: 		return 0;
nuclear@68: 	}
nuclear@68: 
nuclear@68: 	cmp = rb->cmp(key, tree->key);
nuclear@68: 
nuclear@68: 	if(cmp < 0) {
nuclear@68: 		if(!is_red(tree->left) && !is_red(tree->left->left)) {
nuclear@68: 			tree = move_red_left(tree);
nuclear@68: 		}
nuclear@68: 		tree->left = delete(rb, tree->left, key);
nuclear@68: 	} else {
nuclear@68: 		/* need reds on the right */
nuclear@68: 		if(is_red(tree->left)) {
nuclear@68: 			tree = rot_right(tree);
nuclear@68: 		}
nuclear@68: 
nuclear@68: 		/* found it at the bottom (XXX what certifies left is null?) */
nuclear@68: 		if(cmp == 0 && !tree->right) {
nuclear@68: 			if(rb->del) {
nuclear@68: 				rb->del(tree, rb->del_cls);
nuclear@68: 			}
nuclear@68: 			rb->free(tree);
nuclear@68: 			return 0;
nuclear@68: 		}
nuclear@68: 
nuclear@68: 		if(!is_red(tree->right) && !is_red(tree->right->left)) {
nuclear@68: 			tree = move_red_left(tree);
nuclear@68: 		}
nuclear@68: 
nuclear@68: 		if(key == tree->key) {
nuclear@68: 			struct rbnode *rmin = find_min(tree->right);
nuclear@68: 			tree->key = rmin->key;
nuclear@68: 			tree->data = rmin->data;
nuclear@68: 			tree->right = del_min(rb, tree->right);
nuclear@68: 		} else {
nuclear@68: 			tree->right = delete(rb, tree->right, key);
nuclear@68: 		}
nuclear@68: 	}
nuclear@68: 
nuclear@68: 	return fix_up(tree);
nuclear@68: }
nuclear@68: 
nuclear@68: /*static struct rbnode *find(struct rbtree *rb, struct rbnode *node, void *key)
nuclear@68: {
nuclear@68: 	int cmp;
nuclear@68: 
nuclear@68: 	if(!node)
nuclear@68: 		return 0;
nuclear@68: 
nuclear@68: 	if((cmp = rb->cmp(key, node->key)) == 0) {
nuclear@68: 		return node;
nuclear@68: 	}
nuclear@68: 	return find(rb, cmp < 0 ? node->left : node->right, key);
nuclear@68: }*/
nuclear@68: 
nuclear@68: static void traverse(struct rbnode *node, void (*func)(struct rbnode*, void*), void *cls)
nuclear@68: {
nuclear@68: 	if(!node)
nuclear@68: 		return;
nuclear@68: 
nuclear@68: 	traverse(node->left, func, cls);
nuclear@68: 	func(node, cls);
nuclear@68: 	traverse(node->right, func, cls);
nuclear@68: }
nuclear@68: 
nuclear@68: /* helpers */
nuclear@68: 
nuclear@68: static int is_red(struct rbnode *tree)
nuclear@68: {
nuclear@68: 	return tree && tree->red;
nuclear@68: }
nuclear@68: 
nuclear@68: static void color_flip(struct rbnode *tree)
nuclear@68: {
nuclear@68: 	tree->red = !tree->red;
nuclear@68: 	tree->left->red = !tree->left->red;
nuclear@68: 	tree->right->red = !tree->right->red;
nuclear@68: }
nuclear@68: 
nuclear@68: static struct rbnode *rot_left(struct rbnode *a)
nuclear@68: {
nuclear@68: 	struct rbnode *b = a->right;
nuclear@68: 	a->right = b->left;
nuclear@68: 	b->left = a;
nuclear@68: 	b->red = a->red;
nuclear@68: 	a->red = 1;
nuclear@68: 	return b;
nuclear@68: }
nuclear@68: 
nuclear@68: static struct rbnode *rot_right(struct rbnode *a)
nuclear@68: {
nuclear@68: 	struct rbnode *b = a->left;
nuclear@68: 	a->left = b->right;
nuclear@68: 	b->right = a;
nuclear@68: 	b->red = a->red;
nuclear@68: 	a->red = 1;
nuclear@68: 	return b;
nuclear@68: }
nuclear@68: 
nuclear@68: static struct rbnode *find_min(struct rbnode *tree)
nuclear@68: {
nuclear@68: 	struct rbnode *node;
nuclear@68: 
nuclear@68: 	if(!tree)
nuclear@68: 		return 0;
nuclear@68: 
nuclear@68: 	while(node->left) {
nuclear@68: 		node = node->left;
nuclear@68: 	}
nuclear@68: 	return node;
nuclear@68: }
nuclear@68: 
nuclear@68: static struct rbnode *del_min(struct rbtree *rb, struct rbnode *tree)
nuclear@68: {
nuclear@68: 	if(!tree->left) {
nuclear@68: 		if(rb->del) {
nuclear@68: 			rb->del(tree->left, rb->del_cls);
nuclear@68: 		}
nuclear@68: 		rb->free(tree->left);
nuclear@68: 		return 0;
nuclear@68: 	}
nuclear@68: 
nuclear@68: 	/* make sure we've got red (3/4-nodes) at the left side so we can delete at the bottom */
nuclear@68: 	if(!is_red(tree->left) && !is_red(tree->left->left)) {
nuclear@68: 		tree = move_red_left(tree);
nuclear@68: 	}
nuclear@68: 	tree->left = del_min(rb, tree->left);
nuclear@68: 
nuclear@68: 	/* fix right-reds, red-reds, and split 4-nodes on the way up */
nuclear@68: 	return fix_up(tree);
nuclear@68: }
nuclear@68: 
nuclear@68: #if 0
nuclear@68: /* push a red link on this node to the right */
nuclear@68: static struct rbnode *move_red_right(struct rbnode *tree)
nuclear@68: {
nuclear@68: 	/* flipping it makes both children go red, so we have a red to the right */
nuclear@68: 	color_flip(tree);
nuclear@68: 
nuclear@68: 	/* if after the flip we've got a red-red situation to the left, fix it */
nuclear@68: 	if(is_red(tree->left->left)) {
nuclear@68: 		tree = rot_right(tree);
nuclear@68: 		color_flip(tree);
nuclear@68: 	}
nuclear@68: 	return tree;
nuclear@68: }
nuclear@68: #endif
nuclear@68: 
nuclear@68: /* push a red link on this node to the left */
nuclear@68: static struct rbnode *move_red_left(struct rbnode *tree)
nuclear@68: {
nuclear@68: 	/* flipping it makes both children go red, so we have a red to the left */
nuclear@68: 	color_flip(tree);
nuclear@68: 
nuclear@68: 	/* if after the flip we've got a red-red on the right-left, fix it */
nuclear@68: 	if(is_red(tree->right->left)) {
nuclear@68: 		tree->right = rot_right(tree->right);
nuclear@68: 		tree = rot_left(tree);
nuclear@68: 		color_flip(tree);
nuclear@68: 	}
nuclear@68: 	return tree;
nuclear@68: }
nuclear@68: 
nuclear@68: static struct rbnode *fix_up(struct rbnode *tree)
nuclear@68: {
nuclear@68: 	/* fix right-leaning */
nuclear@68: 	if(is_red(tree->right)) {
nuclear@68: 		tree = rot_left(tree);
nuclear@68: 	}
nuclear@68: 	/* change invalid red-red pairs into a proper 4-node */
nuclear@68: 	if(is_red(tree->left) && is_red(tree->left->left)) {
nuclear@68: 		tree = rot_right(tree);
nuclear@68: 	}
nuclear@68: 	/* split 4-nodes */
nuclear@68: 	if(is_red(tree->left) && is_red(tree->right)) {
nuclear@68: 		color_flip(tree);
nuclear@68: 	}
nuclear@68: 	return tree;
nuclear@68: }
nuclear@69: 
nuclear@69: void rb_dbg_print_tree(struct rbtree *tree)
nuclear@69: {
nuclear@69: 	struct rbnode *node;
nuclear@69: 
nuclear@69: 	rb_begin(tree);
nuclear@69: 	while((node = rb_next(tree))) {
nuclear@69: 		printf("%d ", rb_node_keyi(node));
nuclear@69: 	}
nuclear@69: 	printf("\n");
nuclear@69: }