freeswitch/libs/ldns/rbtree.c

670 lines
17 KiB
C

/*
* rbtree.c -- generic red black tree
*
* Taken from Unbound, modified for ldns
*
* Copyright (c) 2001-2008, NLnet Labs. All rights reserved.
*
* This software is open source.
*
* Redistribution and use in source and binary forms, with or without
* modification, are permitted provided that the following conditions
* are met:
*
* Redistributions of source code must retain the above copyright notice,
* this list of conditions and the following disclaimer.
*
* Redistributions in binary form must reproduce the above copyright notice,
* this list of conditions and the following disclaimer in the documentation
* and/or other materials provided with the distribution.
*
* Neither the name of the NLNET LABS nor the names of its contributors may
* be used to endorse or promote products derived from this software without
* specific prior written permission.
*
* THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS
* "AS IS" AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED
* TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR
* PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL THE REGENTS OR CONTRIBUTORS BE
* LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR
* CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF
* SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS
* INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN
* CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE)
* ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE
* POSSIBILITY OF SUCH DAMAGE.
*
*/
/**
* \file
* Implementation of a redblack tree.
*/
#include <ldns/config.h>
#include <ldns/rbtree.h>
#include <stdlib.h>
/** Node colour black */
#define BLACK 0
/** Node colour red */
#define RED 1
/** the NULL node, global alloc */
ldns_rbnode_t ldns_rbtree_null_node = {
LDNS_RBTREE_NULL, /* Parent. */
LDNS_RBTREE_NULL, /* Left. */
LDNS_RBTREE_NULL, /* Right. */
NULL, /* Key. */
NULL, /* Data. */
BLACK /* Color. */
};
/** rotate subtree left (to preserve redblack property) */
static void ldns_rbtree_rotate_left(ldns_rbtree_t *rbtree, ldns_rbnode_t *node);
/** rotate subtree right (to preserve redblack property) */
static void ldns_rbtree_rotate_right(ldns_rbtree_t *rbtree, ldns_rbnode_t *node);
/** Fixup node colours when insert happened */
static void ldns_rbtree_insert_fixup(ldns_rbtree_t *rbtree, ldns_rbnode_t *node);
/** Fixup node colours when delete happened */
static void ldns_rbtree_delete_fixup(ldns_rbtree_t* rbtree, ldns_rbnode_t* child, ldns_rbnode_t* child_parent);
/*
* Creates a new red black tree, intializes and returns a pointer to it.
*
* Return NULL on failure.
*
*/
ldns_rbtree_t *
ldns_rbtree_create (int (*cmpf)(const void *, const void *))
{
ldns_rbtree_t *rbtree;
/* Allocate memory for it */
rbtree = (ldns_rbtree_t *) malloc(sizeof(ldns_rbtree_t));
if (!rbtree) {
return NULL;
}
/* Initialize it */
ldns_rbtree_init(rbtree, cmpf);
return rbtree;
}
void
ldns_rbtree_init(ldns_rbtree_t *rbtree, int (*cmpf)(const void *, const void *))
{
/* Initialize it */
rbtree->root = LDNS_RBTREE_NULL;
rbtree->count = 0;
rbtree->cmp = cmpf;
}
void
ldns_rbtree_free(ldns_rbtree_t *rbtree)
{
free(rbtree);
}
/*
* Rotates the node to the left.
*
*/
static void
ldns_rbtree_rotate_left(ldns_rbtree_t *rbtree, ldns_rbnode_t *node)
{
ldns_rbnode_t *right = node->right;
node->right = right->left;
if (right->left != LDNS_RBTREE_NULL)
right->left->parent = node;
right->parent = node->parent;
if (node->parent != LDNS_RBTREE_NULL) {
if (node == node->parent->left) {
node->parent->left = right;
} else {
node->parent->right = right;
}
} else {
rbtree->root = right;
}
right->left = node;
node->parent = right;
}
/*
* Rotates the node to the right.
*
*/
static void
ldns_rbtree_rotate_right(ldns_rbtree_t *rbtree, ldns_rbnode_t *node)
{
ldns_rbnode_t *left = node->left;
node->left = left->right;
if (left->right != LDNS_RBTREE_NULL)
left->right->parent = node;
left->parent = node->parent;
if (node->parent != LDNS_RBTREE_NULL) {
if (node == node->parent->right) {
node->parent->right = left;
} else {
node->parent->left = left;
}
} else {
rbtree->root = left;
}
left->right = node;
node->parent = left;
}
static void
ldns_rbtree_insert_fixup(ldns_rbtree_t *rbtree, ldns_rbnode_t *node)
{
ldns_rbnode_t *uncle;
/* While not at the root and need fixing... */
while (node != rbtree->root && node->parent->color == RED) {
/* If our parent is left child of our grandparent... */
if (node->parent == node->parent->parent->left) {
uncle = node->parent->parent->right;
/* If our uncle is red... */
if (uncle->color == RED) {
/* Paint the parent and the uncle black... */
node->parent->color = BLACK;
uncle->color = BLACK;
/* And the grandparent red... */
node->parent->parent->color = RED;
/* And continue fixing the grandparent */
node = node->parent->parent;
} else { /* Our uncle is black... */
/* Are we the right child? */
if (node == node->parent->right) {
node = node->parent;
ldns_rbtree_rotate_left(rbtree, node);
}
/* Now we're the left child, repaint and rotate... */
node->parent->color = BLACK;
node->parent->parent->color = RED;
ldns_rbtree_rotate_right(rbtree, node->parent->parent);
}
} else {
uncle = node->parent->parent->left;
/* If our uncle is red... */
if (uncle->color == RED) {
/* Paint the parent and the uncle black... */
node->parent->color = BLACK;
uncle->color = BLACK;
/* And the grandparent red... */
node->parent->parent->color = RED;
/* And continue fixing the grandparent */
node = node->parent->parent;
} else { /* Our uncle is black... */
/* Are we the right child? */
if (node == node->parent->left) {
node = node->parent;
ldns_rbtree_rotate_right(rbtree, node);
}
/* Now we're the right child, repaint and rotate... */
node->parent->color = BLACK;
node->parent->parent->color = RED;
ldns_rbtree_rotate_left(rbtree, node->parent->parent);
}
}
}
rbtree->root->color = BLACK;
}
void
ldns_rbtree_insert_vref(ldns_rbnode_t *data, void *rbtree)
{
(void) ldns_rbtree_insert((ldns_rbtree_t *) rbtree,
data);
}
/*
* Inserts a node into a red black tree.
*
* Returns NULL on failure or the pointer to the newly added node
* otherwise.
*/
ldns_rbnode_t *
ldns_rbtree_insert (ldns_rbtree_t *rbtree, ldns_rbnode_t *data)
{
/* XXX Not necessary, but keeps compiler quiet... */
int r = 0;
/* We start at the root of the tree */
ldns_rbnode_t *node = rbtree->root;
ldns_rbnode_t *parent = LDNS_RBTREE_NULL;
/* Lets find the new parent... */
while (node != LDNS_RBTREE_NULL) {
/* Compare two keys, do we have a duplicate? */
if ((r = rbtree->cmp(data->key, node->key)) == 0) {
return NULL;
}
parent = node;
if (r < 0) {
node = node->left;
} else {
node = node->right;
}
}
/* Initialize the new node */
data->parent = parent;
data->left = data->right = LDNS_RBTREE_NULL;
data->color = RED;
rbtree->count++;
/* Insert it into the tree... */
if (parent != LDNS_RBTREE_NULL) {
if (r < 0) {
parent->left = data;
} else {
parent->right = data;
}
} else {
rbtree->root = data;
}
/* Fix up the red-black properties... */
ldns_rbtree_insert_fixup(rbtree, data);
return data;
}
/*
* Searches the red black tree, returns the data if key is found or NULL otherwise.
*
*/
ldns_rbnode_t *
ldns_rbtree_search (ldns_rbtree_t *rbtree, const void *key)
{
ldns_rbnode_t *node;
if (ldns_rbtree_find_less_equal(rbtree, key, &node)) {
return node;
} else {
return NULL;
}
}
/** helpers for delete: swap node colours */
static void swap_int8(uint8_t* x, uint8_t* y)
{
uint8_t t = *x; *x = *y; *y = t;
}
/** helpers for delete: swap node pointers */
static void swap_np(ldns_rbnode_t** x, ldns_rbnode_t** y)
{
ldns_rbnode_t* t = *x; *x = *y; *y = t;
}
/** Update parent pointers of child trees of 'parent' */
static void change_parent_ptr(ldns_rbtree_t* rbtree, ldns_rbnode_t* parent, ldns_rbnode_t* old, ldns_rbnode_t* new)
{
if(parent == LDNS_RBTREE_NULL)
{
if(rbtree->root == old) rbtree->root = new;
return;
}
if(parent->left == old) parent->left = new;
if(parent->right == old) parent->right = new;
}
/** Update parent pointer of a node 'child' */
static void change_child_ptr(ldns_rbnode_t* child, ldns_rbnode_t* old, ldns_rbnode_t* new)
{
if(child == LDNS_RBTREE_NULL) return;
if(child->parent == old) child->parent = new;
}
ldns_rbnode_t*
ldns_rbtree_delete(ldns_rbtree_t *rbtree, const void *key)
{
ldns_rbnode_t *to_delete;
ldns_rbnode_t *child;
if((to_delete = ldns_rbtree_search(rbtree, key)) == 0) return 0;
rbtree->count--;
/* make sure we have at most one non-leaf child */
if(to_delete->left != LDNS_RBTREE_NULL &&
to_delete->right != LDNS_RBTREE_NULL)
{
/* swap with smallest from right subtree (or largest from left) */
ldns_rbnode_t *smright = to_delete->right;
while(smright->left != LDNS_RBTREE_NULL)
smright = smright->left;
/* swap the smright and to_delete elements in the tree,
* but the ldns_rbnode_t is first part of user data struct
* so cannot just swap the keys and data pointers. Instead
* readjust the pointers left,right,parent */
/* swap colors - colors are tied to the position in the tree */
swap_int8(&to_delete->color, &smright->color);
/* swap child pointers in parents of smright/to_delete */
change_parent_ptr(rbtree, to_delete->parent, to_delete, smright);
if(to_delete->right != smright)
change_parent_ptr(rbtree, smright->parent, smright, to_delete);
/* swap parent pointers in children of smright/to_delete */
change_child_ptr(smright->left, smright, to_delete);
change_child_ptr(smright->left, smright, to_delete);
change_child_ptr(smright->right, smright, to_delete);
change_child_ptr(smright->right, smright, to_delete);
change_child_ptr(to_delete->left, to_delete, smright);
if(to_delete->right != smright)
change_child_ptr(to_delete->right, to_delete, smright);
if(to_delete->right == smright)
{
/* set up so after swap they work */
to_delete->right = to_delete;
smright->parent = smright;
}
/* swap pointers in to_delete/smright nodes */
swap_np(&to_delete->parent, &smright->parent);
swap_np(&to_delete->left, &smright->left);
swap_np(&to_delete->right, &smright->right);
/* now delete to_delete (which is at the location where the smright previously was) */
}
if(to_delete->left != LDNS_RBTREE_NULL) child = to_delete->left;
else child = to_delete->right;
/* unlink to_delete from the tree, replace to_delete with child */
change_parent_ptr(rbtree, to_delete->parent, to_delete, child);
change_child_ptr(child, to_delete, to_delete->parent);
if(to_delete->color == RED)
{
/* if node is red then the child (black) can be swapped in */
}
else if(child->color == RED)
{
/* change child to BLACK, removing a RED node is no problem */
if(child!=LDNS_RBTREE_NULL) child->color = BLACK;
}
else ldns_rbtree_delete_fixup(rbtree, child, to_delete->parent);
/* unlink completely */
to_delete->parent = LDNS_RBTREE_NULL;
to_delete->left = LDNS_RBTREE_NULL;
to_delete->right = LDNS_RBTREE_NULL;
to_delete->color = BLACK;
return to_delete;
}
static void ldns_rbtree_delete_fixup(ldns_rbtree_t* rbtree, ldns_rbnode_t* child, ldns_rbnode_t* child_parent)
{
ldns_rbnode_t* sibling;
int go_up = 1;
/* determine sibling to the node that is one-black short */
if(child_parent->right == child) sibling = child_parent->left;
else sibling = child_parent->right;
while(go_up)
{
if(child_parent == LDNS_RBTREE_NULL)
{
/* removed parent==black from root, every path, so ok */
return;
}
if(sibling->color == RED)
{ /* rotate to get a black sibling */
child_parent->color = RED;
sibling->color = BLACK;
if(child_parent->right == child)
ldns_rbtree_rotate_right(rbtree, child_parent);
else ldns_rbtree_rotate_left(rbtree, child_parent);
/* new sibling after rotation */
if(child_parent->right == child) sibling = child_parent->left;
else sibling = child_parent->right;
}
if(child_parent->color == BLACK
&& sibling->color == BLACK
&& sibling->left->color == BLACK
&& sibling->right->color == BLACK)
{ /* fixup local with recolor of sibling */
if(sibling != LDNS_RBTREE_NULL)
sibling->color = RED;
child = child_parent;
child_parent = child_parent->parent;
/* prepare to go up, new sibling */
if(child_parent->right == child) sibling = child_parent->left;
else sibling = child_parent->right;
}
else go_up = 0;
}
if(child_parent->color == RED
&& sibling->color == BLACK
&& sibling->left->color == BLACK
&& sibling->right->color == BLACK)
{
/* move red to sibling to rebalance */
if(sibling != LDNS_RBTREE_NULL)
sibling->color = RED;
child_parent->color = BLACK;
return;
}
/* get a new sibling, by rotating at sibling. See which child
of sibling is red */
if(child_parent->right == child
&& sibling->color == BLACK
&& sibling->right->color == RED
&& sibling->left->color == BLACK)
{
sibling->color = RED;
sibling->right->color = BLACK;
ldns_rbtree_rotate_left(rbtree, sibling);
/* new sibling after rotation */
if(child_parent->right == child) sibling = child_parent->left;
else sibling = child_parent->right;
}
else if(child_parent->left == child
&& sibling->color == BLACK
&& sibling->left->color == RED
&& sibling->right->color == BLACK)
{
sibling->color = RED;
sibling->left->color = BLACK;
ldns_rbtree_rotate_right(rbtree, sibling);
/* new sibling after rotation */
if(child_parent->right == child) sibling = child_parent->left;
else sibling = child_parent->right;
}
/* now we have a black sibling with a red child. rotate and exchange colors. */
sibling->color = child_parent->color;
child_parent->color = BLACK;
if(child_parent->right == child)
{
sibling->left->color = BLACK;
ldns_rbtree_rotate_right(rbtree, child_parent);
}
else
{
sibling->right->color = BLACK;
ldns_rbtree_rotate_left(rbtree, child_parent);
}
}
int
ldns_rbtree_find_less_equal(ldns_rbtree_t *rbtree, const void *key, ldns_rbnode_t **result)
{
int r;
ldns_rbnode_t *node;
/* We start at root... */
node = rbtree->root;
*result = NULL;
/* While there are children... */
while (node != LDNS_RBTREE_NULL) {
r = rbtree->cmp(key, node->key);
if (r == 0) {
/* Exact match */
*result = node;
return 1;
}
if (r < 0) {
node = node->left;
} else {
/* Temporary match */
*result = node;
node = node->right;
}
}
return 0;
}
/*
* Finds the first element in the red black tree
*
*/
ldns_rbnode_t *
ldns_rbtree_first (ldns_rbtree_t *rbtree)
{
ldns_rbnode_t *node = rbtree->root;
if (rbtree->root != LDNS_RBTREE_NULL) {
for (node = rbtree->root; node->left != LDNS_RBTREE_NULL; node = node->left);
}
return node;
}
ldns_rbnode_t *
ldns_rbtree_last (ldns_rbtree_t *rbtree)
{
ldns_rbnode_t *node = rbtree->root;
if (rbtree->root != LDNS_RBTREE_NULL) {
for (node = rbtree->root; node->right != LDNS_RBTREE_NULL; node = node->right);
}
return node;
}
/*
* Returns the next node...
*
*/
ldns_rbnode_t *
ldns_rbtree_next (ldns_rbnode_t *node)
{
ldns_rbnode_t *parent;
if (node->right != LDNS_RBTREE_NULL) {
/* One right, then keep on going left... */
for (node = node->right;
node->left != LDNS_RBTREE_NULL;
node = node->left);
} else {
parent = node->parent;
while (parent != LDNS_RBTREE_NULL && node == parent->right) {
node = parent;
parent = parent->parent;
}
node = parent;
}
return node;
}
ldns_rbnode_t *
ldns_rbtree_previous(ldns_rbnode_t *node)
{
ldns_rbnode_t *parent;
if (node->left != LDNS_RBTREE_NULL) {
/* One left, then keep on going right... */
for (node = node->left;
node->right != LDNS_RBTREE_NULL;
node = node->right);
} else {
parent = node->parent;
while (parent != LDNS_RBTREE_NULL && node == parent->left) {
node = parent;
parent = parent->parent;
}
node = parent;
}
return node;
}
/**
* split off elements number of elements from the start
* of the name tree and return a new tree
*/
ldns_rbtree_t *
ldns_rbtree_split(ldns_rbtree_t *tree,
size_t elements)
{
ldns_rbtree_t *new_tree;
ldns_rbnode_t *cur_node;
ldns_rbnode_t *move_node;
size_t count = 0;
new_tree = ldns_rbtree_create(tree->cmp);
cur_node = ldns_rbtree_first(tree);
while (count < elements && cur_node != LDNS_RBTREE_NULL) {
move_node = ldns_rbtree_delete(tree, cur_node->key);
(void)ldns_rbtree_insert(new_tree, move_node);
cur_node = ldns_rbtree_first(tree);
count++;
}
return new_tree;
}
/*
* add all node from the second tree to the first (removing them from the
* second), and fix up nsec(3)s if present
*/
void
ldns_rbtree_join(ldns_rbtree_t *tree1, ldns_rbtree_t *tree2)
{
ldns_traverse_postorder(tree2, ldns_rbtree_insert_vref, tree1);
}
/** recursive descent traverse */
static void
traverse_post(void (*func)(ldns_rbnode_t*, void*), void* arg,
ldns_rbnode_t* node)
{
if(!node || node == LDNS_RBTREE_NULL)
return;
/* recurse */
traverse_post(func, arg, node->left);
traverse_post(func, arg, node->right);
/* call user func */
(*func)(node, arg);
}
void
ldns_traverse_postorder(ldns_rbtree_t* tree,
void (*func)(ldns_rbnode_t*, void*), void* arg)
{
traverse_post(func, arg, tree->root);
}