tree.c 6.94 KB
Newer Older
Michael Niedermayer's avatar
Michael Niedermayer committed
1 2 3 4 5 6 7 8 9 10 11 12 13 14 15 16 17 18 19 20 21 22 23
/*
 * copyright (c) 2006 Michael Niedermayer <michaelni@gmx.at>
 *
 * This file is part of FFmpeg.
 *
 * FFmpeg is free software; you can redistribute it and/or
 * modify it under the terms of the GNU Lesser General Public
 * License as published by the Free Software Foundation; either
 * version 2.1 of the License, or (at your option) any later version.
 *
 * FFmpeg is distributed in the hope that it will be useful,
 * but WITHOUT ANY WARRANTY; without even the implied warranty of
 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the GNU
 * Lesser General Public License for more details.
 *
 * You should have received a copy of the GNU Lesser General Public
 * License along with FFmpeg; if not, write to the Free Software
 * Foundation, Inc., 51 Franklin Street, Fifth Floor, Boston, MA 02110-1301 USA
 */

#include "log.h"
#include "tree.h"

24
typedef struct AVTreeNode {
Michael Niedermayer's avatar
Michael Niedermayer committed
25 26 27
    struct AVTreeNode *child[2];
    void *elem;
    int state;
28
} AVTreeNode;
Michael Niedermayer's avatar
Michael Niedermayer committed
29

30 31
const int av_tree_node_size = sizeof(AVTreeNode);

32 33 34 35 36 37 38 39 40 41
void *av_tree_find(const AVTreeNode *t, void *key,
                   int (*cmp)(void *key, const void *b), void *next[2])
{
    if (t) {
        unsigned int v = cmp(key, t->elem);
        if (v) {
            if (next) next[v >> 31] = t->elem;
            return av_tree_find(t->child[(v >> 31) ^ 1], key, cmp, next);
        } else {
            if (next) {
42 43 44
                av_tree_find(t->child[0], key, cmp, next);
                av_tree_find(t->child[1], key, cmp, next);
            }
Michael Niedermayer's avatar
Michael Niedermayer committed
45 46 47 48 49 50
            return t->elem;
        }
    }
    return NULL;
}

51 52 53 54 55 56
void *av_tree_insert(AVTreeNode **tp, void *key,
                     int (*cmp)(void *key, const void *b), AVTreeNode **next)
{
    AVTreeNode *t = *tp;
    if (t) {
        unsigned int v = cmp(t->elem, key);
57
        void *ret;
58 59
        if (!v) {
            if (*next)
60
                return t->elem;
61 62
            else if (t->child[0] || t->child[1]) {
                int i = !t->child[0];
63
                void *next_elem[2];
Michael Niedermayer's avatar
Michael Niedermayer committed
64
                av_tree_find(t->child[i], key, cmp, next_elem);
65 66 67 68 69
                key = t->elem = next_elem[i];
                v = -i;
            } else {
                *next = t;
                *tp = NULL;
70 71 72
                return NULL;
            }
        }
73 74 75 76 77 78 79 80
        ret = av_tree_insert(&t->child[v >> 31], key, cmp, next);
        if (!ret) {
            int i = (v >> 31) ^ !!*next;
            AVTreeNode **child = &t->child[i];
            t->state += 2 * i - 1;

            if (!(t->state & 1)) {
                if (t->state) {
81 82 83 84 85 86
                    /* The following code is equivalent to
                    if((*child)->state*2 == -t->state)
                        rotate(child, i^1);
                    rotate(tp, i);

                    with rotate():
87
                    static void rotate(AVTreeNode **tp, int i) {
88 89 90 91 92 93 94 95 96 97 98
                        AVTreeNode *t= *tp;

                        *tp= t->child[i];
                        t->child[i]= t->child[i]->child[i^1];
                        (*tp)->child[i^1]= t;
                        i= 4*t->state + 2*(*tp)->state + 12;
                          t  ->state=                     ((0x614586 >> i) & 3)-1;
                        (*tp)->state= ((*tp)->state>>1) + ((0x400EEA >> i) & 3)-1;
                    }
                    but such a rotate function is both bigger and slower
                    */
99 100 101 102 103 104 105 106 107 108 109 110 111 112 113 114 115
                    if (( *child )->state * 2 == -t->state) {
                        *tp                    = (*child)->child[i ^ 1];
                        (*child)->child[i ^ 1] = (*tp)->child[i];
                        (*tp)->child[i]        = *child;
                        *child                 = ( *tp )->child[i ^ 1];
                        (*tp)->child[i ^ 1]    = t;

                        (*tp)->child[0]->state = -((*tp)->state > 0);
                        (*tp)->child[1]->state =   (*tp)->state < 0;
                        (*tp)->state           = 0;
                    } else {
                        *tp                    = *child;
                        *child                 = (*child)->child[i ^ 1];
                        (*tp)->child[i ^ 1]    = t;
                        if ((*tp)->state) t->state = 0;
                        else              t->state >>= 1;
                        (*tp)->state           = -t->state;
Michael Niedermayer's avatar
Michael Niedermayer committed
116 117 118
                    }
                }
            }
119
            if (!(*tp)->state ^ !!*next)
Michael Niedermayer's avatar
Michael Niedermayer committed
120 121 122
                return key;
        }
        return ret;
123 124 125 126 127
    } else {
        *tp   = *next;
        *next = NULL;
        if (*tp) {
            (*tp)->elem = key;
128
            return NULL;
129
        } else
130
            return key;
Michael Niedermayer's avatar
Michael Niedermayer committed
131 132 133
    }
}

134 135 136
void av_tree_destroy(AVTreeNode *t)
{
    if (t) {
Aurelien Jacobs's avatar
Aurelien Jacobs committed
137 138 139
        av_tree_destroy(t->child[0]);
        av_tree_destroy(t->child[1]);
        av_free(t);
140
    }
Michael Niedermayer's avatar
Michael Niedermayer committed
141 142
}

143 144 145 146 147 148 149 150 151 152 153 154
void av_tree_enumerate(AVTreeNode *t, void *opaque,
                       int (*cmp)(void *opaque, void *elem),
                       int (*enu)(void *opaque, void *elem))
{
    if (t) {
        int v = cmp ? cmp(opaque, t->elem) : 0;
        if (v >= 0)
            av_tree_enumerate(t->child[0], opaque, cmp, enu);
        if (v == 0)
            enu(opaque, t->elem);
        if (v <= 0)
            av_tree_enumerate(t->child[1], opaque, cmp, enu);
155
    }
Michael Niedermayer's avatar
Michael Niedermayer committed
156 157 158
}

#ifdef TEST
159 160 161

#include "lfg.h"

162 163 164 165 166
static int check(AVTreeNode *t)
{
    if (t) {
        int left  = check(t->child[0]);
        int right = check(t->child[1]);
Michael Niedermayer's avatar
Michael Niedermayer committed
167

168
        if (left>999 || right>999)
Michael Niedermayer's avatar
Michael Niedermayer committed
169
            return 1000;
170
        if (right - left != t->state)
Michael Niedermayer's avatar
Michael Niedermayer committed
171
            return 1000;
172
        if (t->state>1 || t->state<-1)
Michael Niedermayer's avatar
Michael Niedermayer committed
173
            return 1000;
174
        return FFMAX(left, right) + 1;
Michael Niedermayer's avatar
Michael Niedermayer committed
175 176 177 178
    }
    return 0;
}

179 180
static void print(AVTreeNode *t, int depth)
{
Michael Niedermayer's avatar
Michael Niedermayer committed
181
    int i;
182 183
    for (i = 0; i < depth * 4; i++) av_log(NULL, AV_LOG_ERROR, " ");
    if (t) {
184
        av_log(NULL, AV_LOG_ERROR, "Node %p %2d %p\n", t, t->state, t->elem);
185 186 187
        print(t->child[0], depth + 1);
        print(t->child[1], depth + 1);
    } else
Michael Niedermayer's avatar
Michael Niedermayer committed
188 189 190
        av_log(NULL, AV_LOG_ERROR, "NULL\n");
}

191 192 193
static int cmp(void *a, const void *b)
{
    return (uint8_t *) a - (const uint8_t *) b;
Michael Niedermayer's avatar
Michael Niedermayer committed
194 195
}

196 197
int main (void)
{
198 199
    int i;
    void *k;
200
    AVTreeNode *root = NULL, *node = NULL;
201
    AVLFG prng;
202

203
    av_lfg_init(&prng, 1);
Michael Niedermayer's avatar
Michael Niedermayer committed
204

205
    for (i = 0; i < 10000; i++) {
206
        int j = av_lfg_get(&prng) % 86294;
207
        if (check(root) > 999) {
Michael Niedermayer's avatar
Michael Niedermayer committed
208 209 210 211 212
            av_log(NULL, AV_LOG_ERROR, "FATAL error %d\n", i);
        print(root, 0);
            return -1;
        }
        av_log(NULL, AV_LOG_ERROR, "inserting %4d\n", j);
213 214 215
        if (!node)
            node = av_mallocz(av_tree_node_size);
        av_tree_insert(&root, (void *) (j + 1), cmp, &node);
216

217
        j = av_lfg_get(&prng) % 86294;
218
        {
219
            AVTreeNode *node2 = NULL;
220
            av_log(NULL, AV_LOG_ERROR, "removing %4d\n", j);
221 222 223
            av_tree_insert(&root, (void *) (j + 1), cmp, &node2);
            k = av_tree_find(root, (void *) (j + 1), cmp, NULL);
            if (k)
224
                av_log(NULL, AV_LOG_ERROR, "removal failure %d\n", i);
225
        }
Michael Niedermayer's avatar
Michael Niedermayer committed
226 227 228 229
    }
    return 0;
}
#endif