dc84236da7e962d96cc81cd6525d2ca1b9fb6fae
[apps/pfixtools.git] / common / trie.c
1 /******************************************************************************/
2 /*          pfixtools: a collection of postfix related tools                  */
3 /*          ~~~~~~~~~                                                         */
4 /*  ________________________________________________________________________  */
5 /*                                                                            */
6 /*  Redistribution and use in source and binary forms, with or without        */
7 /*  modification, are permitted provided that the following conditions        */
8 /*  are met:                                                                  */
9 /*                                                                            */
10 /*  1. Redistributions of source code must retain the above copyright         */
11 /*     notice, this list of conditions and the following disclaimer.          */
12 /*  2. Redistributions in binary form must reproduce the above copyright      */
13 /*     notice, this list of conditions and the following disclaimer in the    */
14 /*     documentation and/or other materials provided with the distribution.   */
15 /*  3. The names of its contributors may not be used to endorse or promote    */
16 /*     products derived from this software without specific prior written     */
17 /*     permission.                                                            */
18 /*                                                                            */
19 /*  THIS SOFTWARE IS PROVIDED BY THE REGENTS AND CONTRIBUTORS ``AS IS'' AND   */
20 /*  ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE     */
21 /*  IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR        */
22 /*  PURPOSE ARE DISCLAIMED.  IN NO EVENT SHALL THE REGENTS OR CONTRIBUTORS    */
23 /*  BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR    */
24 /*  CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF      */
25 /*  SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS  */
26 /*  INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN   */
27 /*  CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE)   */
28 /*  ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF    */
29 /*  THE POSSIBILITY OF SUCH DAMAGE.                                           */
30 /******************************************************************************/
31
32 /*
33  * Copyright © 2008 Florent Bruneau
34  */
35
36 #include <sys/mman.h>
37
38 #include "str.h"
39 #include "trie.h"
40
41 typedef struct trie_entry_t trie_entry_t;
42
43 struct trie_entry_t {
44     int32_t  c_offset;
45     int32_t  c_len;
46
47     int32_t children_offset;
48     int32_t children_len;
49 };
50
51 struct trie_t {
52     trie_entry_t *entries;
53     int32_t entries_len;
54     int32_t entries_size;
55
56     char *c;
57     int32_t  c_len;
58     int32_t  c_size;
59
60     char **keys;
61     int32_t  keys_len;
62     int32_t  keys_size;
63
64     bool locked;
65 };
66
67 trie_t *trie_new(void)
68 {
69     return p_new(trie_t, 1);
70 }
71
72 static inline void trie_cleanup_build_data(trie_t *trie)
73 {
74     for (int i = 0 ; i < trie->keys_len ; ++i) {
75         p_delete(&trie->keys[i]);
76     }
77     p_delete(&trie->keys);
78     trie->keys_len = trie->keys_size = 0;
79 }
80
81 void trie_delete(trie_t **trie)
82 {
83     if (*trie) {
84         trie_cleanup_build_data(*trie);
85         p_delete(&(*trie)->entries);
86         p_delete(&(*trie)->c);
87         p_delete(trie);
88     }
89 }
90
91 /** Check that the given entry is a prefix for the given key.
92  */
93 static inline bool trie_entry_c_match(const trie_t *trie,
94                                       const trie_entry_t *entry,
95                                       const char *key, int *pos)
96 {
97     const char *c = trie->c + entry->c_offset;
98     int i = 0;
99     for (i = 0 ; i < entry->c_len ; ++i) {
100         if (key[i] != c[i]) {
101             if (pos) {
102                 *pos = i;
103             }
104             return false;
105         }
106     }
107     if (pos) {
108         *pos = i;
109     }
110     return true;
111 }
112
113 static inline bool trie_entry_match(const trie_t *trie,
114                                     const trie_entry_t *entry, const char *key)
115 {
116     return !!(strcmp(trie->c + entry->c_offset, key) == 0);
117 }
118
119 static inline bool trie_entry_is_leaf(const trie_entry_t *entry)
120 {
121     return entry->children_len == 0;
122 }
123
124 /** Lookup for a child of entry matching the given entry at the given pos.
125  * Only the first character of the children is taken into account in the
126  * lookup. The current entry is assumed to match the key.
127  */
128 static inline trie_entry_t* trie_entry_child(const trie_t *trie,
129                                              const trie_entry_t* entry,
130                                              const char *key)
131 {
132     int start = entry->children_offset;
133     int end   = start + entry->children_len;
134     const char c = *key;
135
136     while (start < end) {
137         int mid = (start + end) / 2;
138         trie_entry_t* child = &trie->entries[mid];
139         const char c2 = trie->c[child->c_offset];
140
141         if (child->c_len) {
142             if (c2 == c) {
143                 return child;
144             }
145             if (c < c2) {
146                 end = mid;
147             } else {
148                 start = mid + 1;
149             }
150         } else {
151             abort();
152         }
153     }
154     return NULL;
155 }
156
157 #define GROW(Buffer, Added, Len, Size)                  \
158   do {                                                  \
159       const int required_size = (Len) + (Added);        \
160       int next_size = (Size);                           \
161       if (next_size >= required_size) {                 \
162           break;                                        \
163       }                                                 \
164       do {                                              \
165           next_size = p_alloc_nr(next_size);            \
166       } while (next_size < required_size);              \
167       p_allocgrow(&(Buffer), next_size, &(Size));       \
168   } while(0)
169
170 static inline void trie_grow(trie_t *trie, int delta)
171 {
172     GROW(trie->entries, delta, trie->entries_len, trie->entries_size);
173 }
174
175 static inline int trie_entry_new(trie_t *trie)
176 {
177     memset(trie->entries + trie->entries_len, 0, sizeof(trie_entry_t));
178     return trie->entries_len++;
179 }
180
181 static inline int trie_add_leaf(trie_t *trie, const char *key)
182 {
183     trie_entry_t *entry;
184     int len = m_strlen(key) + 1;
185     entry = &trie->entries[trie_entry_new(trie)];
186     GROW(trie->c, len, trie->c_len, trie->c_size);
187     memcpy(trie->c + trie->c_len, key, len);
188     entry->c_offset = trie->c_len;
189     entry->c_len    = len;
190     trie->c_len    += len;
191     return trie->entries_len - 1;
192 }
193
194 static inline void trie_entry_insert_child(trie_t *trie, trie_entry_t *entry,
195                                            int pchild)
196 {
197     if (entry->children_len == 0) {
198         entry->children_offset = pchild;
199         entry->children_len    = 1;
200     } else {
201         if (entry->children_offset + entry->children_len != pchild) {
202             printf("Inserting child %d while offset is %d[%d]\n",
203                    pchild, entry->children_offset, entry->children_len);
204             abort();
205         }
206         ++entry->children_len;
207     }
208 }
209
210 static inline void trie_entry_split(trie_t *trie, trie_entry_t *entry, int pos)
211 {
212     trie_entry_t *child;
213     child    = &trie->entries[trie_entry_new(trie)];
214     if (pos == 0) {
215         child->c_offset = entry->c_offset;
216         child->c_len    = entry->c_len;
217         entry->c_offset = 0;
218         entry->c_len    = 0;
219     } else {
220         child->c_offset = entry->c_offset + pos;
221         child->c_len    = entry->c_len - pos;
222         entry->c_len    = pos;
223     }
224     child->children_offset = entry->children_offset;
225     child->children_len    = entry->children_len;
226     entry->children_offset = trie->entries_len - 1;
227     entry->children_len    = 1;
228 }
229
230 void trie_insert(trie_t *trie, const char* key)
231 {
232     GROW(trie->keys, 1, trie->keys_len, trie->keys_size);
233     trie->keys[trie->keys_len++] = strdup(key);
234 }
235
236
237 static inline void trie_compile_aux(trie_t *trie, int id,
238                                     int first_key, int last_key, int offset,
239                                     int initial_diff)
240 {
241     int forks[256];
242     int fork_pos = 0;
243     char current = '\0';
244
245     for (int off_diff = initial_diff ; fork_pos == 0 ; ++off_diff, ++offset) {
246         current = trie->keys[first_key][offset];
247         for (int i = first_key + 1 ; i < last_key ; ++i) {
248             if (trie->keys[i][offset] != current) {
249                 trie_grow(trie, 2);
250                 if (fork_pos == 0) {
251                     trie_entry_split(trie, &trie->entries[id], off_diff);
252                 }
253                 trie_entry_insert_child(trie, &trie->entries[id],
254                                         trie_add_leaf(trie, trie->keys[i] +
255                                                       offset));
256                 forks[fork_pos++] = i;
257                 current = trie->keys[i][offset];
258             }
259         }
260         if (fork_pos == 0 && current == '\0') {
261             return;
262         }
263     }
264     forks[fork_pos] = last_key;
265
266     const int children_len = trie->entries[id].children_len;
267     for (int i = 0 ; i < children_len ; ++i) {
268         int child = trie->entries[id].children_offset + i;
269         if (forks[i] - 1 > first_key) {
270             trie_compile_aux(trie, child, first_key, forks[i], offset, 1);
271         }
272         first_key = forks[i];
273     }
274 }
275
276
277 static inline void trie_shrink(trie_t *trie)
278 {
279     p_shrink(&trie->entries, trie->entries_len, &trie->entries_size);
280     p_shrink(&trie->c, trie->c_len, &trie->c_size);
281 }
282
283 static inline void trie_lock(trie_t *trie)
284 {
285     if (mlock(trie->entries, sizeof(trie_entry_t) * trie->entries_len) != 0) {
286         UNIXERR("mlock");
287         return;
288     }
289     if (mlock(trie->c, trie->c_len) != 0) {
290         UNIXERR("mlock");
291         munlock(trie->entries, sizeof(trie_entry_t) * trie->entries_len);
292         return;
293     }
294     trie->locked = true;
295 }
296
297 typedef char *str_t;
298
299 void trie_compile(trie_t *trie, bool memlock)
300 {
301     {
302 #       define QSORT_TYPE str_t
303 #       define QSORT_BASE trie->keys
304 #       define QSORT_NELT trie->keys_len
305 #       define QSORT_LT(a,b) strcmp(*a, *b) < 0
306 #       include "qsort.c"
307     }
308
309     trie_grow(trie, trie->keys_len);
310     trie_compile_aux(trie, trie_add_leaf(trie, trie->keys[0]),
311                      0, trie->keys_len, 0, 0);
312     trie_cleanup_build_data(trie);
313     trie_shrink(trie);
314     if (memlock) {
315         trie_lock(trie);
316     }
317 }
318
319 bool trie_lookup(const trie_t *trie, const char *key)
320 {
321     if (trie->entries_len == 0) {
322         return false;
323     } else {
324         trie_entry_t *current = trie->entries;
325         while (true) {
326             int pos = 0;
327             if (trie_entry_is_leaf(current)) {
328                 return trie_entry_match(trie, current, key);
329             } else if (trie_entry_c_match(trie, current, key, &pos)) {
330                 key += pos;
331                 current = trie_entry_child(trie, current, key);
332                 if (current == NULL) {
333                     return false;
334                 }
335             } else {
336                 return false;
337             }
338         }
339     }
340 }
341
342
343 /* Debug {{{1
344  */
345
346 static inline void trie_entry_inspect(const trie_t *trie, bool show_content,
347                                       const trie_entry_t *entry, int level)
348 {
349     static int max_depth = 0;
350     static int leaves    = 0;
351     static int depth_sum = 0;
352
353     if (trie_entry_is_leaf(entry)) {
354         if (level > max_depth) {
355             max_depth = level;
356         }
357         ++leaves;
358         depth_sum += level;
359     }
360     if (show_content) {
361         for (int i = 0 ; i < level ; ++i) {
362             fputs("  ", stdout);
363         }
364         if (entry->c_len == 0) {
365             fputs("(nil)", stdout);
366         } else {
367             const char *c = trie->c + entry->c_offset;
368             printf("(%d) ", entry->c_len);
369             for (int i = 0 ; i < entry->c_len ; ++i) {
370                 if (c[i]) {
371                     printf("%c ", c[i]);
372                 } else {
373                     fputs("\\0 ", stdout);
374                 }
375             }
376         }
377         fputs("\n", stdout);
378     }
379     for (int i = entry->children_offset ;
380           i < entry->children_offset + entry->children_len ; ++i) {
381         trie_entry_inspect(trie, show_content, &trie->entries[i], level + 1);
382     }
383     if (level == 0) {
384         printf("Average char per node: %d\n", trie->c_len / trie->entries_len);
385         printf("Number of nodes: %d\n", trie->entries_len);
386         printf("Number of leaves: %d\n", leaves);
387         printf("Max depth: %d\n", max_depth);
388         printf("Average leaf depth: %d\n", depth_sum / leaves);
389         printf("Memory used: %d\n", (trie->entries_size * sizeof(trie_entry_t))
390                                   + (trie->c_size) + sizeof(trie_t));
391     }
392 }
393
394 void trie_inspect(const trie_t *trie, bool show_content)
395 {
396     trie_entry_inspect(trie, show_content, trie->entries, 0);
397 }