1 | /*
|
---|
2 | Unix SMB/CIFS implementation.
|
---|
3 |
|
---|
4 | very efficient functions to manage mapping a id (such as a fnum) to
|
---|
5 | a pointer. This is used for fnum and search id allocation.
|
---|
6 |
|
---|
7 | Copyright (C) Andrew Tridgell 2004
|
---|
8 |
|
---|
9 | This code is derived from lib/idr.c in the 2.6 Linux kernel, which was
|
---|
10 | written by Jim Houston jim.houston@ccur.com, and is
|
---|
11 | Copyright (C) 2002 by Concurrent Computer Corporation
|
---|
12 |
|
---|
13 | This program is free software; you can redistribute it and/or modify
|
---|
14 | it under the terms of the GNU General Public License as published by
|
---|
15 | the Free Software Foundation; either version 2 of the License, or
|
---|
16 | (at your option) any later version.
|
---|
17 |
|
---|
18 | This program is distributed in the hope that it will be useful,
|
---|
19 | but WITHOUT ANY WARRANTY; without even the implied warranty of
|
---|
20 | MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
|
---|
21 | GNU General Public License for more details.
|
---|
22 |
|
---|
23 | You should have received a copy of the GNU General Public License
|
---|
24 | along with this program. If not, see <http://www.gnu.org/licenses/>.
|
---|
25 | */
|
---|
26 |
|
---|
27 | /*
|
---|
28 | see the section marked "public interface" below for documentation
|
---|
29 | */
|
---|
30 |
|
---|
31 | /**
|
---|
32 | * @file
|
---|
33 | */
|
---|
34 |
|
---|
35 | #include "includes.h"
|
---|
36 |
|
---|
37 | #define IDR_BITS 5
|
---|
38 | #define IDR_FULL 0xfffffffful
|
---|
39 | #if 0 /* unused */
|
---|
40 | #define TOP_LEVEL_FULL (IDR_FULL >> 30)
|
---|
41 | #endif
|
---|
42 | #define IDR_SIZE (1 << IDR_BITS)
|
---|
43 | #define IDR_MASK ((1 << IDR_BITS)-1)
|
---|
44 | #define MAX_ID_SHIFT (sizeof(int)*8 - 1)
|
---|
45 | #define MAX_ID_BIT (1U << MAX_ID_SHIFT)
|
---|
46 | #define MAX_ID_MASK (MAX_ID_BIT - 1)
|
---|
47 | #define MAX_LEVEL (MAX_ID_SHIFT + IDR_BITS - 1) / IDR_BITS
|
---|
48 | #define IDR_FREE_MAX MAX_LEVEL + MAX_LEVEL
|
---|
49 |
|
---|
50 | #define set_bit(bit, v) (v) |= (1<<(bit))
|
---|
51 | #define clear_bit(bit, v) (v) &= ~(1<<(bit))
|
---|
52 | #define test_bit(bit, v) ((v) & (1<<(bit)))
|
---|
53 |
|
---|
54 | struct idr_layer {
|
---|
55 | uint32_t bitmap;
|
---|
56 | struct idr_layer *ary[IDR_SIZE];
|
---|
57 | int count;
|
---|
58 | };
|
---|
59 |
|
---|
60 | struct idr_context {
|
---|
61 | struct idr_layer *top;
|
---|
62 | struct idr_layer *id_free;
|
---|
63 | int layers;
|
---|
64 | int id_free_cnt;
|
---|
65 | };
|
---|
66 |
|
---|
67 | static struct idr_layer *alloc_layer(struct idr_context *idp)
|
---|
68 | {
|
---|
69 | struct idr_layer *p;
|
---|
70 |
|
---|
71 | if (!(p = idp->id_free))
|
---|
72 | return NULL;
|
---|
73 | idp->id_free = p->ary[0];
|
---|
74 | idp->id_free_cnt--;
|
---|
75 | p->ary[0] = NULL;
|
---|
76 | return p;
|
---|
77 | }
|
---|
78 |
|
---|
79 | static int find_next_bit(uint32_t bm, int maxid, int n)
|
---|
80 | {
|
---|
81 | while (n<maxid && !test_bit(n, bm)) n++;
|
---|
82 | return n;
|
---|
83 | }
|
---|
84 |
|
---|
85 | static void free_layer(struct idr_context *idp, struct idr_layer *p)
|
---|
86 | {
|
---|
87 | p->ary[0] = idp->id_free;
|
---|
88 | idp->id_free = p;
|
---|
89 | idp->id_free_cnt++;
|
---|
90 | }
|
---|
91 |
|
---|
92 | static int idr_pre_get(struct idr_context *idp)
|
---|
93 | {
|
---|
94 | while (idp->id_free_cnt < IDR_FREE_MAX) {
|
---|
95 | struct idr_layer *pn = talloc_zero(idp, struct idr_layer);
|
---|
96 | if(pn == NULL)
|
---|
97 | return (0);
|
---|
98 | free_layer(idp, pn);
|
---|
99 | }
|
---|
100 | return 1;
|
---|
101 | }
|
---|
102 |
|
---|
103 | static int sub_alloc(struct idr_context *idp, void *ptr, int *starting_id)
|
---|
104 | {
|
---|
105 | int n, m, sh;
|
---|
106 | struct idr_layer *p, *pn;
|
---|
107 | struct idr_layer *pa[MAX_LEVEL];
|
---|
108 | int l, id, oid;
|
---|
109 | uint32_t bm;
|
---|
110 |
|
---|
111 | memset(pa, 0, sizeof(pa));
|
---|
112 |
|
---|
113 | id = *starting_id;
|
---|
114 | restart:
|
---|
115 | p = idp->top;
|
---|
116 | l = idp->layers;
|
---|
117 | pa[l--] = NULL;
|
---|
118 | while (1) {
|
---|
119 | /*
|
---|
120 | * We run around this while until we reach the leaf node...
|
---|
121 | */
|
---|
122 | n = (id >> (IDR_BITS*l)) & IDR_MASK;
|
---|
123 | bm = ~p->bitmap;
|
---|
124 | m = find_next_bit(bm, IDR_SIZE, n);
|
---|
125 | if (m == IDR_SIZE) {
|
---|
126 | /* no space available go back to previous layer. */
|
---|
127 | l++;
|
---|
128 | oid = id;
|
---|
129 | id = (id | ((1 << (IDR_BITS*l))-1)) + 1;
|
---|
130 |
|
---|
131 | /* if already at the top layer, we need to grow */
|
---|
132 | if (!(p = pa[l])) {
|
---|
133 | *starting_id = id;
|
---|
134 | return -2;
|
---|
135 | }
|
---|
136 |
|
---|
137 | /* If we need to go up one layer, continue the
|
---|
138 | * loop; otherwise, restart from the top.
|
---|
139 | */
|
---|
140 | sh = IDR_BITS * (l + 1);
|
---|
141 | if (oid >> sh == id >> sh)
|
---|
142 | continue;
|
---|
143 | else
|
---|
144 | goto restart;
|
---|
145 | }
|
---|
146 | if (m != n) {
|
---|
147 | sh = IDR_BITS*l;
|
---|
148 | id = ((id >> sh) ^ n ^ m) << sh;
|
---|
149 | }
|
---|
150 | if ((id >= MAX_ID_BIT) || (id < 0))
|
---|
151 | return -1;
|
---|
152 | if (l == 0)
|
---|
153 | break;
|
---|
154 | /*
|
---|
155 | * Create the layer below if it is missing.
|
---|
156 | */
|
---|
157 | if (!p->ary[m]) {
|
---|
158 | if (!(pn = alloc_layer(idp)))
|
---|
159 | return -1;
|
---|
160 | p->ary[m] = pn;
|
---|
161 | p->count++;
|
---|
162 | }
|
---|
163 | pa[l--] = p;
|
---|
164 | p = p->ary[m];
|
---|
165 | }
|
---|
166 | /*
|
---|
167 | * We have reached the leaf node, plant the
|
---|
168 | * users pointer and return the raw id.
|
---|
169 | */
|
---|
170 | p->ary[m] = (struct idr_layer *)ptr;
|
---|
171 | set_bit(m, p->bitmap);
|
---|
172 | p->count++;
|
---|
173 | /*
|
---|
174 | * If this layer is full mark the bit in the layer above
|
---|
175 | * to show that this part of the radix tree is full.
|
---|
176 | * This may complete the layer above and require walking
|
---|
177 | * up the radix tree.
|
---|
178 | */
|
---|
179 | n = id;
|
---|
180 | while (p->bitmap == IDR_FULL) {
|
---|
181 | if (!(p = pa[++l]))
|
---|
182 | break;
|
---|
183 | n = n >> IDR_BITS;
|
---|
184 | set_bit((n & IDR_MASK), p->bitmap);
|
---|
185 | }
|
---|
186 | return(id);
|
---|
187 | }
|
---|
188 |
|
---|
189 | static int idr_get_new_above_int(struct idr_context *idp, void *ptr, int starting_id)
|
---|
190 | {
|
---|
191 | struct idr_layer *p, *pn;
|
---|
192 | int layers, v, id;
|
---|
193 |
|
---|
194 | idr_pre_get(idp);
|
---|
195 |
|
---|
196 | id = starting_id;
|
---|
197 | build_up:
|
---|
198 | p = idp->top;
|
---|
199 | layers = idp->layers;
|
---|
200 | if (!p) {
|
---|
201 | if (!(p = alloc_layer(idp)))
|
---|
202 | return -1;
|
---|
203 | layers = 1;
|
---|
204 | }
|
---|
205 | /*
|
---|
206 | * Add a new layer to the top of the tree if the requested
|
---|
207 | * id is larger than the currently allocated space.
|
---|
208 | */
|
---|
209 | while ((layers < MAX_LEVEL) && (id >= (1 << (layers*IDR_BITS)))) {
|
---|
210 | layers++;
|
---|
211 | if (!p->count)
|
---|
212 | continue;
|
---|
213 | if (!(pn = alloc_layer(idp))) {
|
---|
214 | /*
|
---|
215 | * The allocation failed. If we built part of
|
---|
216 | * the structure tear it down.
|
---|
217 | */
|
---|
218 | for (pn = p; p && p != idp->top; pn = p) {
|
---|
219 | p = p->ary[0];
|
---|
220 | pn->ary[0] = NULL;
|
---|
221 | pn->bitmap = pn->count = 0;
|
---|
222 | free_layer(idp, pn);
|
---|
223 | }
|
---|
224 | return -1;
|
---|
225 | }
|
---|
226 | pn->ary[0] = p;
|
---|
227 | pn->count = 1;
|
---|
228 | if (p->bitmap == IDR_FULL)
|
---|
229 | set_bit(0, pn->bitmap);
|
---|
230 | p = pn;
|
---|
231 | }
|
---|
232 | idp->top = p;
|
---|
233 | idp->layers = layers;
|
---|
234 | v = sub_alloc(idp, ptr, &id);
|
---|
235 | if (v == -2)
|
---|
236 | goto build_up;
|
---|
237 | return(v);
|
---|
238 | }
|
---|
239 |
|
---|
240 | static int sub_remove(struct idr_context *idp, int shift, int id)
|
---|
241 | {
|
---|
242 | struct idr_layer *p = idp->top;
|
---|
243 | struct idr_layer **pa[MAX_LEVEL];
|
---|
244 | struct idr_layer ***paa = &pa[0];
|
---|
245 | int n;
|
---|
246 |
|
---|
247 | *paa = NULL;
|
---|
248 | *++paa = &idp->top;
|
---|
249 |
|
---|
250 | while ((shift > 0) && p) {
|
---|
251 | n = (id >> shift) & IDR_MASK;
|
---|
252 | clear_bit(n, p->bitmap);
|
---|
253 | *++paa = &p->ary[n];
|
---|
254 | p = p->ary[n];
|
---|
255 | shift -= IDR_BITS;
|
---|
256 | }
|
---|
257 | n = id & IDR_MASK;
|
---|
258 | if (p != NULL && test_bit(n, p->bitmap)) {
|
---|
259 | clear_bit(n, p->bitmap);
|
---|
260 | p->ary[n] = NULL;
|
---|
261 | while(*paa && ! --((**paa)->count)){
|
---|
262 | free_layer(idp, **paa);
|
---|
263 | **paa-- = NULL;
|
---|
264 | }
|
---|
265 | if ( ! *paa )
|
---|
266 | idp->layers = 0;
|
---|
267 | return 0;
|
---|
268 | }
|
---|
269 | return -1;
|
---|
270 | }
|
---|
271 |
|
---|
272 | static void *_idr_find(struct idr_context *idp, int id)
|
---|
273 | {
|
---|
274 | int n;
|
---|
275 | struct idr_layer *p;
|
---|
276 |
|
---|
277 | n = idp->layers * IDR_BITS;
|
---|
278 | p = idp->top;
|
---|
279 | /*
|
---|
280 | * This tests to see if bits outside the current tree are
|
---|
281 | * present. If so, tain't one of ours!
|
---|
282 | */
|
---|
283 | if ((id & ~(~0 << MAX_ID_SHIFT)) >> (n + IDR_BITS))
|
---|
284 | return NULL;
|
---|
285 |
|
---|
286 | /* Mask off upper bits we don't use for the search. */
|
---|
287 | id &= MAX_ID_MASK;
|
---|
288 |
|
---|
289 | while (n >= IDR_BITS && p) {
|
---|
290 | n -= IDR_BITS;
|
---|
291 | p = p->ary[(id >> n) & IDR_MASK];
|
---|
292 | }
|
---|
293 | return((void *)p);
|
---|
294 | }
|
---|
295 |
|
---|
296 | static int _idr_remove(struct idr_context *idp, int id)
|
---|
297 | {
|
---|
298 | struct idr_layer *p;
|
---|
299 |
|
---|
300 | /* Mask off upper bits we don't use for the search. */
|
---|
301 | id &= MAX_ID_MASK;
|
---|
302 |
|
---|
303 | if (sub_remove(idp, (idp->layers - 1) * IDR_BITS, id) == -1) {
|
---|
304 | return -1;
|
---|
305 | }
|
---|
306 |
|
---|
307 | if ( idp->top && idp->top->count == 1 &&
|
---|
308 | (idp->layers > 1) &&
|
---|
309 | idp->top->ary[0]) {
|
---|
310 | /* We can drop a layer */
|
---|
311 | p = idp->top->ary[0];
|
---|
312 | idp->top->bitmap = idp->top->count = 0;
|
---|
313 | free_layer(idp, idp->top);
|
---|
314 | idp->top = p;
|
---|
315 | --idp->layers;
|
---|
316 | }
|
---|
317 | while (idp->id_free_cnt >= IDR_FREE_MAX) {
|
---|
318 | p = alloc_layer(idp);
|
---|
319 | talloc_free(p);
|
---|
320 | }
|
---|
321 | return 0;
|
---|
322 | }
|
---|
323 |
|
---|
324 | /************************************************************************
|
---|
325 | this is the public interface
|
---|
326 | **************************************************************************/
|
---|
327 |
|
---|
328 | /**
|
---|
329 | initialise a idr tree. The context return value must be passed to
|
---|
330 | all subsequent idr calls. To destroy the idr tree use talloc_free()
|
---|
331 | on this context
|
---|
332 | */
|
---|
333 | _PUBLIC_ struct idr_context *idr_init(TALLOC_CTX *mem_ctx)
|
---|
334 | {
|
---|
335 | return talloc_zero(mem_ctx, struct idr_context);
|
---|
336 | }
|
---|
337 |
|
---|
338 | /**
|
---|
339 | allocate the next available id, and assign 'ptr' into its slot.
|
---|
340 | you can retrieve later this pointer using idr_find()
|
---|
341 | */
|
---|
342 | _PUBLIC_ int idr_get_new(struct idr_context *idp, void *ptr, int limit)
|
---|
343 | {
|
---|
344 | int ret = idr_get_new_above_int(idp, ptr, 0);
|
---|
345 | if (ret > limit) {
|
---|
346 | idr_remove(idp, ret);
|
---|
347 | return -1;
|
---|
348 | }
|
---|
349 | return ret;
|
---|
350 | }
|
---|
351 |
|
---|
352 | /**
|
---|
353 | allocate a new id, giving the first available value greater than or
|
---|
354 | equal to the given starting id
|
---|
355 | */
|
---|
356 | _PUBLIC_ int idr_get_new_above(struct idr_context *idp, void *ptr, int starting_id, int limit)
|
---|
357 | {
|
---|
358 | int ret = idr_get_new_above_int(idp, ptr, starting_id);
|
---|
359 | if (ret > limit) {
|
---|
360 | idr_remove(idp, ret);
|
---|
361 | return -1;
|
---|
362 | }
|
---|
363 | return ret;
|
---|
364 | }
|
---|
365 |
|
---|
366 | /**
|
---|
367 | allocate a new id randomly in the given range
|
---|
368 | */
|
---|
369 | _PUBLIC_ int idr_get_new_random(struct idr_context *idp, void *ptr, int limit)
|
---|
370 | {
|
---|
371 | int id;
|
---|
372 |
|
---|
373 | /* first try a random starting point in the whole range, and if that fails,
|
---|
374 | then start randomly in the bottom half of the range. This can only
|
---|
375 | fail if the range is over half full, and finally fallback to any
|
---|
376 | free id */
|
---|
377 | id = idr_get_new_above(idp, ptr, 1+(generate_random() % limit), limit);
|
---|
378 | if (id == -1) {
|
---|
379 | id = idr_get_new_above(idp, ptr, 1+(generate_random()%(limit/2)), limit);
|
---|
380 | }
|
---|
381 | if (id == -1) {
|
---|
382 | id = idr_get_new_above(idp, ptr, 1, limit);
|
---|
383 | }
|
---|
384 |
|
---|
385 | return id;
|
---|
386 | }
|
---|
387 |
|
---|
388 | /**
|
---|
389 | find a pointer value previously set with idr_get_new given an id
|
---|
390 | */
|
---|
391 | _PUBLIC_ void *idr_find(struct idr_context *idp, int id)
|
---|
392 | {
|
---|
393 | return _idr_find(idp, id);
|
---|
394 | }
|
---|
395 |
|
---|
396 | /**
|
---|
397 | remove an id from the idr tree
|
---|
398 | */
|
---|
399 | _PUBLIC_ int idr_remove(struct idr_context *idp, int id)
|
---|
400 | {
|
---|
401 | int ret;
|
---|
402 | ret = _idr_remove((struct idr_context *)idp, id);
|
---|
403 | if (ret != 0) {
|
---|
404 | DEBUG(0,("WARNING: attempt to remove unset id %d in idtree\n", id));
|
---|
405 | }
|
---|
406 | return ret;
|
---|
407 | }
|
---|