subr_vmem.c revision 1.2.2.4 1 1.2.2.4 yamt /* $NetBSD: subr_vmem.c,v 1.2.2.4 2006/09/03 15:25:22 yamt Exp $ */
2 1.2.2.2 yamt
3 1.2.2.2 yamt /*-
4 1.2.2.2 yamt * Copyright (c)2006 YAMAMOTO Takashi,
5 1.2.2.2 yamt * All rights reserved.
6 1.2.2.2 yamt *
7 1.2.2.2 yamt * Redistribution and use in source and binary forms, with or without
8 1.2.2.2 yamt * modification, are permitted provided that the following conditions
9 1.2.2.2 yamt * are met:
10 1.2.2.2 yamt * 1. Redistributions of source code must retain the above copyright
11 1.2.2.2 yamt * notice, this list of conditions and the following disclaimer.
12 1.2.2.2 yamt * 2. Redistributions in binary form must reproduce the above copyright
13 1.2.2.2 yamt * notice, this list of conditions and the following disclaimer in the
14 1.2.2.2 yamt * documentation and/or other materials provided with the distribution.
15 1.2.2.2 yamt *
16 1.2.2.2 yamt * THIS SOFTWARE IS PROVIDED BY THE AUTHOR AND CONTRIBUTORS ``AS IS'' AND
17 1.2.2.2 yamt * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
18 1.2.2.2 yamt * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
19 1.2.2.2 yamt * ARE DISCLAIMED. IN NO EVENT SHALL THE AUTHOR OR CONTRIBUTORS BE LIABLE
20 1.2.2.2 yamt * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
21 1.2.2.2 yamt * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS
22 1.2.2.2 yamt * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
23 1.2.2.2 yamt * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
24 1.2.2.2 yamt * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
25 1.2.2.2 yamt * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
26 1.2.2.2 yamt * SUCH DAMAGE.
27 1.2.2.2 yamt */
28 1.2.2.2 yamt
29 1.2.2.2 yamt /*
30 1.2.2.2 yamt * reference:
31 1.2.2.2 yamt * - Magazines and Vmem: Extending the Slab Allocator
32 1.2.2.2 yamt * to Many CPUs and Arbitrary Resources
33 1.2.2.2 yamt * http://www.usenix.org/event/usenix01/bonwick.html
34 1.2.2.2 yamt *
35 1.2.2.2 yamt * TODO:
36 1.2.2.2 yamt * - implement vmem_xalloc/vmem_xfree
37 1.2.2.2 yamt */
38 1.2.2.2 yamt
39 1.2.2.2 yamt #include <sys/cdefs.h>
40 1.2.2.4 yamt __KERNEL_RCSID(0, "$NetBSD: subr_vmem.c,v 1.2.2.4 2006/09/03 15:25:22 yamt Exp $");
41 1.2.2.2 yamt
42 1.2.2.2 yamt #define VMEM_DEBUG
43 1.2.2.4 yamt #if defined(_KERNEL)
44 1.2.2.4 yamt #define QCACHE
45 1.2.2.4 yamt #endif /* defined(_KERNEL) */
46 1.2.2.2 yamt
47 1.2.2.2 yamt #include <sys/param.h>
48 1.2.2.2 yamt #include <sys/hash.h>
49 1.2.2.2 yamt #include <sys/queue.h>
50 1.2.2.2 yamt
51 1.2.2.2 yamt #if defined(_KERNEL)
52 1.2.2.2 yamt #include <sys/systm.h>
53 1.2.2.2 yamt #include <sys/lock.h>
54 1.2.2.2 yamt #include <sys/malloc.h>
55 1.2.2.2 yamt #include <sys/once.h>
56 1.2.2.2 yamt #include <sys/pool.h>
57 1.2.2.3 yamt #include <sys/proc.h>
58 1.2.2.2 yamt #include <sys/vmem.h>
59 1.2.2.2 yamt #else /* defined(_KERNEL) */
60 1.2.2.2 yamt #include "../sys/vmem.h"
61 1.2.2.2 yamt #endif /* defined(_KERNEL) */
62 1.2.2.2 yamt
63 1.2.2.2 yamt #if defined(_KERNEL)
64 1.2.2.2 yamt #define SIMPLELOCK_DECL(name) struct simplelock name
65 1.2.2.2 yamt #else /* defined(_KERNEL) */
66 1.2.2.2 yamt #include <errno.h>
67 1.2.2.2 yamt #include <assert.h>
68 1.2.2.2 yamt #include <stdlib.h>
69 1.2.2.2 yamt
70 1.2.2.2 yamt #define KASSERT(a) assert(a)
71 1.2.2.2 yamt #define SIMPLELOCK_DECL(name) /* nothing */
72 1.2.2.2 yamt #define LOCK_ASSERT(a) /* nothing */
73 1.2.2.2 yamt #define simple_lock_init(a) /* nothing */
74 1.2.2.2 yamt #define simple_lock(a) /* nothing */
75 1.2.2.2 yamt #define simple_unlock(a) /* nothing */
76 1.2.2.3 yamt #define ASSERT_SLEEPABLE(lk, msg) /* nothing */
77 1.2.2.2 yamt #endif /* defined(_KERNEL) */
78 1.2.2.2 yamt
79 1.2.2.2 yamt struct vmem;
80 1.2.2.2 yamt struct vmem_btag;
81 1.2.2.2 yamt
82 1.2.2.2 yamt #if defined(VMEM_DEBUG)
83 1.2.2.2 yamt void vmem_dump(const vmem_t *);
84 1.2.2.2 yamt #endif /* defined(VMEM_DEBUG) */
85 1.2.2.2 yamt
86 1.2.2.4 yamt #define VMEM_MAXORDER (sizeof(vmem_size_t) * CHAR_BIT)
87 1.2.2.2 yamt #define VMEM_HASHSIZE_INIT 4096 /* XXX */
88 1.2.2.2 yamt
89 1.2.2.2 yamt #define VM_FITMASK (VM_BESTFIT | VM_INSTANTFIT)
90 1.2.2.2 yamt
91 1.2.2.2 yamt CIRCLEQ_HEAD(vmem_seglist, vmem_btag);
92 1.2.2.2 yamt LIST_HEAD(vmem_freelist, vmem_btag);
93 1.2.2.2 yamt LIST_HEAD(vmem_hashlist, vmem_btag);
94 1.2.2.2 yamt
95 1.2.2.4 yamt #if defined(QCACHE)
96 1.2.2.4 yamt #define VMEM_QCACHE_IDX_MAX 32
97 1.2.2.4 yamt
98 1.2.2.4 yamt #define QC_NAME_MAX 16
99 1.2.2.4 yamt
100 1.2.2.4 yamt struct qcache {
101 1.2.2.4 yamt struct pool qc_pool;
102 1.2.2.4 yamt struct pool_cache qc_cache;
103 1.2.2.4 yamt vmem_t *qc_vmem;
104 1.2.2.4 yamt char qc_name[QC_NAME_MAX];
105 1.2.2.4 yamt };
106 1.2.2.4 yamt typedef struct qcache qcache_t;
107 1.2.2.4 yamt #define QC_POOL_TO_QCACHE(pool) ((qcache_t *)(pool))
108 1.2.2.4 yamt #endif /* defined(QCACHE) */
109 1.2.2.4 yamt
110 1.2.2.2 yamt /* vmem arena */
111 1.2.2.2 yamt struct vmem {
112 1.2.2.2 yamt SIMPLELOCK_DECL(vm_lock);
113 1.2.2.2 yamt vmem_addr_t (*vm_allocfn)(vmem_t *, vmem_size_t, vmem_size_t *,
114 1.2.2.2 yamt vm_flag_t);
115 1.2.2.2 yamt void (*vm_freefn)(vmem_t *, vmem_addr_t, vmem_size_t);
116 1.2.2.2 yamt vmem_t *vm_source;
117 1.2.2.2 yamt struct vmem_seglist vm_seglist;
118 1.2.2.2 yamt struct vmem_freelist vm_freelist[VMEM_MAXORDER];
119 1.2.2.2 yamt size_t vm_hashsize;
120 1.2.2.2 yamt size_t vm_nbusytag;
121 1.2.2.2 yamt struct vmem_hashlist *vm_hashlist;
122 1.2.2.2 yamt size_t vm_quantum_mask;
123 1.2.2.2 yamt int vm_quantum_shift;
124 1.2.2.2 yamt const char *vm_name;
125 1.2.2.4 yamt
126 1.2.2.4 yamt #if defined(QCACHE)
127 1.2.2.4 yamt /* quantum cache */
128 1.2.2.4 yamt size_t vm_qcache_max;
129 1.2.2.4 yamt struct pool_allocator vm_qcache_allocator;
130 1.2.2.4 yamt qcache_t vm_qcache[VMEM_QCACHE_IDX_MAX];
131 1.2.2.4 yamt #endif /* defined(QCACHE) */
132 1.2.2.2 yamt };
133 1.2.2.2 yamt
134 1.2.2.2 yamt #define VMEM_LOCK(vm) simple_lock(&vm->vm_lock)
135 1.2.2.2 yamt #define VMEM_UNLOCK(vm) simple_unlock(&vm->vm_lock)
136 1.2.2.2 yamt #define VMEM_LOCK_INIT(vm) simple_lock_init(&vm->vm_lock);
137 1.2.2.2 yamt #define VMEM_ASSERT_LOCKED(vm) \
138 1.2.2.2 yamt LOCK_ASSERT(simple_lock_held(&vm->vm_lock))
139 1.2.2.2 yamt #define VMEM_ASSERT_UNLOCKED(vm) \
140 1.2.2.2 yamt LOCK_ASSERT(!simple_lock_held(&vm->vm_lock))
141 1.2.2.2 yamt
142 1.2.2.2 yamt /* boundary tag */
143 1.2.2.2 yamt struct vmem_btag {
144 1.2.2.2 yamt CIRCLEQ_ENTRY(vmem_btag) bt_seglist;
145 1.2.2.2 yamt union {
146 1.2.2.2 yamt LIST_ENTRY(vmem_btag) u_freelist; /* BT_TYPE_FREE */
147 1.2.2.2 yamt LIST_ENTRY(vmem_btag) u_hashlist; /* BT_TYPE_BUSY */
148 1.2.2.2 yamt } bt_u;
149 1.2.2.2 yamt #define bt_hashlist bt_u.u_hashlist
150 1.2.2.2 yamt #define bt_freelist bt_u.u_freelist
151 1.2.2.2 yamt vmem_addr_t bt_start;
152 1.2.2.2 yamt vmem_size_t bt_size;
153 1.2.2.2 yamt int bt_type;
154 1.2.2.2 yamt };
155 1.2.2.2 yamt
156 1.2.2.2 yamt #define BT_TYPE_SPAN 1
157 1.2.2.2 yamt #define BT_TYPE_SPAN_STATIC 2
158 1.2.2.2 yamt #define BT_TYPE_FREE 3
159 1.2.2.2 yamt #define BT_TYPE_BUSY 4
160 1.2.2.2 yamt #define BT_ISSPAN_P(bt) ((bt)->bt_type <= BT_TYPE_SPAN_STATIC)
161 1.2.2.2 yamt
162 1.2.2.2 yamt #define BT_END(bt) ((bt)->bt_start + (bt)->bt_size)
163 1.2.2.2 yamt
164 1.2.2.2 yamt typedef struct vmem_btag bt_t;
165 1.2.2.2 yamt
166 1.2.2.2 yamt /* ---- misc */
167 1.2.2.2 yamt
168 1.2.2.4 yamt #define ORDER2SIZE(order) ((vmem_size_t)1 << (order))
169 1.2.2.4 yamt
170 1.2.2.2 yamt static int
171 1.2.2.2 yamt calc_order(vmem_size_t size)
172 1.2.2.2 yamt {
173 1.2.2.4 yamt vmem_size_t target;
174 1.2.2.2 yamt int i;
175 1.2.2.2 yamt
176 1.2.2.2 yamt KASSERT(size != 0);
177 1.2.2.2 yamt
178 1.2.2.2 yamt i = 0;
179 1.2.2.4 yamt target = size >> 1;
180 1.2.2.4 yamt while (ORDER2SIZE(i) <= target) {
181 1.2.2.2 yamt i++;
182 1.2.2.2 yamt }
183 1.2.2.2 yamt
184 1.2.2.4 yamt KASSERT(ORDER2SIZE(i) <= size);
185 1.2.2.4 yamt KASSERT(size < ORDER2SIZE(i + 1) || ORDER2SIZE(i + 1) < ORDER2SIZE(i));
186 1.2.2.2 yamt
187 1.2.2.2 yamt return i;
188 1.2.2.2 yamt }
189 1.2.2.2 yamt
190 1.2.2.2 yamt #if defined(_KERNEL)
191 1.2.2.2 yamt static MALLOC_DEFINE(M_VMEM, "vmem", "vmem");
192 1.2.2.2 yamt #endif /* defined(_KERNEL) */
193 1.2.2.2 yamt
194 1.2.2.2 yamt static void *
195 1.2.2.2 yamt xmalloc(size_t sz, vm_flag_t flags)
196 1.2.2.2 yamt {
197 1.2.2.2 yamt
198 1.2.2.2 yamt #if defined(_KERNEL)
199 1.2.2.2 yamt return malloc(sz, M_VMEM,
200 1.2.2.2 yamt M_CANFAIL | ((flags & VM_SLEEP) ? M_WAITOK : M_NOWAIT));
201 1.2.2.2 yamt #else /* defined(_KERNEL) */
202 1.2.2.2 yamt return malloc(sz);
203 1.2.2.2 yamt #endif /* defined(_KERNEL) */
204 1.2.2.2 yamt }
205 1.2.2.2 yamt
206 1.2.2.2 yamt static void
207 1.2.2.2 yamt xfree(void *p)
208 1.2.2.2 yamt {
209 1.2.2.2 yamt
210 1.2.2.2 yamt #if defined(_KERNEL)
211 1.2.2.2 yamt return free(p, M_VMEM);
212 1.2.2.2 yamt #else /* defined(_KERNEL) */
213 1.2.2.2 yamt return free(p);
214 1.2.2.2 yamt #endif /* defined(_KERNEL) */
215 1.2.2.2 yamt }
216 1.2.2.2 yamt
217 1.2.2.2 yamt /* ---- boundary tag */
218 1.2.2.2 yamt
219 1.2.2.2 yamt #if defined(_KERNEL)
220 1.2.2.2 yamt static struct pool_cache bt_poolcache;
221 1.2.2.2 yamt static POOL_INIT(bt_pool, sizeof(bt_t), 0, 0, 0, "vmembtpl", NULL);
222 1.2.2.2 yamt #endif /* defined(_KERNEL) */
223 1.2.2.2 yamt
224 1.2.2.2 yamt static bt_t *
225 1.2.2.2 yamt bt_alloc(vmem_t *vm, vm_flag_t flags)
226 1.2.2.2 yamt {
227 1.2.2.2 yamt bt_t *bt;
228 1.2.2.2 yamt
229 1.2.2.2 yamt #if defined(_KERNEL)
230 1.2.2.2 yamt /* XXX bootstrap */
231 1.2.2.2 yamt bt = pool_cache_get(&bt_poolcache,
232 1.2.2.2 yamt (flags & VM_SLEEP) != 0 ? PR_WAITOK : PR_NOWAIT);
233 1.2.2.2 yamt #else /* defined(_KERNEL) */
234 1.2.2.2 yamt bt = malloc(sizeof *bt);
235 1.2.2.2 yamt #endif /* defined(_KERNEL) */
236 1.2.2.2 yamt
237 1.2.2.2 yamt return bt;
238 1.2.2.2 yamt }
239 1.2.2.2 yamt
240 1.2.2.2 yamt static void
241 1.2.2.2 yamt bt_free(vmem_t *vm, bt_t *bt)
242 1.2.2.2 yamt {
243 1.2.2.2 yamt
244 1.2.2.2 yamt #if defined(_KERNEL)
245 1.2.2.2 yamt /* XXX bootstrap */
246 1.2.2.2 yamt pool_cache_put(&bt_poolcache, bt);
247 1.2.2.2 yamt #else /* defined(_KERNEL) */
248 1.2.2.2 yamt free(bt);
249 1.2.2.2 yamt #endif /* defined(_KERNEL) */
250 1.2.2.2 yamt }
251 1.2.2.2 yamt
252 1.2.2.2 yamt /*
253 1.2.2.2 yamt * freelist[0] ... [1, 1]
254 1.2.2.2 yamt * freelist[1] ... [2, 3]
255 1.2.2.2 yamt * freelist[2] ... [4, 7]
256 1.2.2.2 yamt * freelist[3] ... [8, 15]
257 1.2.2.2 yamt * :
258 1.2.2.2 yamt * freelist[n] ... [(1 << n), (1 << (n + 1)) - 1]
259 1.2.2.2 yamt * :
260 1.2.2.2 yamt */
261 1.2.2.2 yamt
262 1.2.2.2 yamt static struct vmem_freelist *
263 1.2.2.2 yamt bt_freehead_tofree(vmem_t *vm, vmem_size_t size)
264 1.2.2.2 yamt {
265 1.2.2.2 yamt const vmem_size_t qsize = size >> vm->vm_quantum_shift;
266 1.2.2.2 yamt int idx;
267 1.2.2.2 yamt
268 1.2.2.2 yamt KASSERT((size & vm->vm_quantum_mask) == 0);
269 1.2.2.2 yamt KASSERT(size != 0);
270 1.2.2.2 yamt
271 1.2.2.2 yamt idx = calc_order(qsize);
272 1.2.2.2 yamt KASSERT(idx >= 0);
273 1.2.2.2 yamt KASSERT(idx < VMEM_MAXORDER);
274 1.2.2.2 yamt
275 1.2.2.2 yamt return &vm->vm_freelist[idx];
276 1.2.2.2 yamt }
277 1.2.2.2 yamt
278 1.2.2.2 yamt static struct vmem_freelist *
279 1.2.2.2 yamt bt_freehead_toalloc(vmem_t *vm, vmem_size_t size, vm_flag_t strat)
280 1.2.2.2 yamt {
281 1.2.2.2 yamt const vmem_size_t qsize = size >> vm->vm_quantum_shift;
282 1.2.2.2 yamt int idx;
283 1.2.2.2 yamt
284 1.2.2.2 yamt KASSERT((size & vm->vm_quantum_mask) == 0);
285 1.2.2.2 yamt KASSERT(size != 0);
286 1.2.2.2 yamt
287 1.2.2.2 yamt idx = calc_order(qsize);
288 1.2.2.4 yamt if (strat == VM_INSTANTFIT && ORDER2SIZE(idx) != qsize) {
289 1.2.2.2 yamt idx++;
290 1.2.2.2 yamt /* check too large request? */
291 1.2.2.2 yamt }
292 1.2.2.2 yamt KASSERT(idx >= 0);
293 1.2.2.2 yamt KASSERT(idx < VMEM_MAXORDER);
294 1.2.2.2 yamt
295 1.2.2.2 yamt return &vm->vm_freelist[idx];
296 1.2.2.2 yamt }
297 1.2.2.2 yamt
298 1.2.2.2 yamt /* ---- boundary tag hash */
299 1.2.2.2 yamt
300 1.2.2.2 yamt static struct vmem_hashlist *
301 1.2.2.2 yamt bt_hashhead(vmem_t *vm, vmem_addr_t addr)
302 1.2.2.2 yamt {
303 1.2.2.2 yamt struct vmem_hashlist *list;
304 1.2.2.2 yamt unsigned int hash;
305 1.2.2.2 yamt
306 1.2.2.2 yamt hash = hash32_buf(&addr, sizeof(addr), HASH32_BUF_INIT);
307 1.2.2.2 yamt list = &vm->vm_hashlist[hash % vm->vm_hashsize];
308 1.2.2.2 yamt
309 1.2.2.2 yamt return list;
310 1.2.2.2 yamt }
311 1.2.2.2 yamt
312 1.2.2.2 yamt static bt_t *
313 1.2.2.2 yamt bt_lookupbusy(vmem_t *vm, vmem_addr_t addr)
314 1.2.2.2 yamt {
315 1.2.2.2 yamt struct vmem_hashlist *list;
316 1.2.2.2 yamt bt_t *bt;
317 1.2.2.2 yamt
318 1.2.2.2 yamt list = bt_hashhead(vm, addr);
319 1.2.2.2 yamt LIST_FOREACH(bt, list, bt_hashlist) {
320 1.2.2.2 yamt if (bt->bt_start == addr) {
321 1.2.2.2 yamt break;
322 1.2.2.2 yamt }
323 1.2.2.2 yamt }
324 1.2.2.2 yamt
325 1.2.2.2 yamt return bt;
326 1.2.2.2 yamt }
327 1.2.2.2 yamt
328 1.2.2.2 yamt static void
329 1.2.2.2 yamt bt_rembusy(vmem_t *vm, bt_t *bt)
330 1.2.2.2 yamt {
331 1.2.2.2 yamt
332 1.2.2.2 yamt KASSERT(vm->vm_nbusytag > 0);
333 1.2.2.2 yamt vm->vm_nbusytag--;
334 1.2.2.2 yamt LIST_REMOVE(bt, bt_hashlist);
335 1.2.2.2 yamt }
336 1.2.2.2 yamt
337 1.2.2.2 yamt static void
338 1.2.2.2 yamt bt_insbusy(vmem_t *vm, bt_t *bt)
339 1.2.2.2 yamt {
340 1.2.2.2 yamt struct vmem_hashlist *list;
341 1.2.2.2 yamt
342 1.2.2.2 yamt KASSERT(bt->bt_type == BT_TYPE_BUSY);
343 1.2.2.2 yamt
344 1.2.2.2 yamt list = bt_hashhead(vm, bt->bt_start);
345 1.2.2.2 yamt LIST_INSERT_HEAD(list, bt, bt_hashlist);
346 1.2.2.2 yamt vm->vm_nbusytag++;
347 1.2.2.2 yamt }
348 1.2.2.2 yamt
349 1.2.2.2 yamt /* ---- boundary tag list */
350 1.2.2.2 yamt
351 1.2.2.2 yamt static void
352 1.2.2.2 yamt bt_remseg(vmem_t *vm, bt_t *bt)
353 1.2.2.2 yamt {
354 1.2.2.2 yamt
355 1.2.2.2 yamt CIRCLEQ_REMOVE(&vm->vm_seglist, bt, bt_seglist);
356 1.2.2.2 yamt }
357 1.2.2.2 yamt
358 1.2.2.2 yamt static void
359 1.2.2.2 yamt bt_insseg(vmem_t *vm, bt_t *bt, bt_t *prev)
360 1.2.2.2 yamt {
361 1.2.2.2 yamt
362 1.2.2.2 yamt CIRCLEQ_INSERT_AFTER(&vm->vm_seglist, prev, bt, bt_seglist);
363 1.2.2.2 yamt }
364 1.2.2.2 yamt
365 1.2.2.2 yamt static void
366 1.2.2.2 yamt bt_insseg_tail(vmem_t *vm, bt_t *bt)
367 1.2.2.2 yamt {
368 1.2.2.2 yamt
369 1.2.2.2 yamt CIRCLEQ_INSERT_TAIL(&vm->vm_seglist, bt, bt_seglist);
370 1.2.2.2 yamt }
371 1.2.2.2 yamt
372 1.2.2.2 yamt static void
373 1.2.2.2 yamt bt_remfree(vmem_t *vm, bt_t *bt)
374 1.2.2.2 yamt {
375 1.2.2.2 yamt
376 1.2.2.2 yamt KASSERT(bt->bt_type == BT_TYPE_FREE);
377 1.2.2.2 yamt
378 1.2.2.2 yamt LIST_REMOVE(bt, bt_freelist);
379 1.2.2.2 yamt }
380 1.2.2.2 yamt
381 1.2.2.2 yamt static void
382 1.2.2.2 yamt bt_insfree(vmem_t *vm, bt_t *bt)
383 1.2.2.2 yamt {
384 1.2.2.2 yamt struct vmem_freelist *list;
385 1.2.2.2 yamt
386 1.2.2.2 yamt list = bt_freehead_tofree(vm, bt->bt_size);
387 1.2.2.2 yamt LIST_INSERT_HEAD(list, bt, bt_freelist);
388 1.2.2.2 yamt }
389 1.2.2.2 yamt
390 1.2.2.2 yamt /* ---- vmem internal functions */
391 1.2.2.2 yamt
392 1.2.2.4 yamt #if defined(QCACHE)
393 1.2.2.4 yamt static inline vm_flag_t
394 1.2.2.4 yamt prf_to_vmf(int prflags)
395 1.2.2.4 yamt {
396 1.2.2.4 yamt vm_flag_t vmflags;
397 1.2.2.4 yamt
398 1.2.2.4 yamt KASSERT((prflags & ~(PR_LIMITFAIL | PR_WAITOK | PR_NOWAIT)) == 0);
399 1.2.2.4 yamt if ((prflags & PR_WAITOK) != 0) {
400 1.2.2.4 yamt vmflags = VM_SLEEP;
401 1.2.2.4 yamt } else {
402 1.2.2.4 yamt vmflags = VM_NOSLEEP;
403 1.2.2.4 yamt }
404 1.2.2.4 yamt return vmflags;
405 1.2.2.4 yamt }
406 1.2.2.4 yamt
407 1.2.2.4 yamt static inline int
408 1.2.2.4 yamt vmf_to_prf(vm_flag_t vmflags)
409 1.2.2.4 yamt {
410 1.2.2.4 yamt int prflags;
411 1.2.2.4 yamt
412 1.2.2.4 yamt if ((vmflags & VM_SLEEP) != 0) {
413 1.2.2.4 yamt prflags = PR_WAITOK;
414 1.2.2.4 yamt } else {
415 1.2.2.4 yamt prflags = PR_NOWAIT;
416 1.2.2.4 yamt }
417 1.2.2.4 yamt return prflags;
418 1.2.2.4 yamt }
419 1.2.2.4 yamt
420 1.2.2.4 yamt static size_t
421 1.2.2.4 yamt qc_poolpage_size(size_t qcache_max)
422 1.2.2.4 yamt {
423 1.2.2.4 yamt int i;
424 1.2.2.4 yamt
425 1.2.2.4 yamt for (i = 0; ORDER2SIZE(i) <= qcache_max * 3; i++) {
426 1.2.2.4 yamt /* nothing */
427 1.2.2.4 yamt }
428 1.2.2.4 yamt return ORDER2SIZE(i);
429 1.2.2.4 yamt }
430 1.2.2.4 yamt
431 1.2.2.4 yamt static void *
432 1.2.2.4 yamt qc_poolpage_alloc(struct pool *pool, int prflags)
433 1.2.2.4 yamt {
434 1.2.2.4 yamt qcache_t *qc = QC_POOL_TO_QCACHE(pool);
435 1.2.2.4 yamt vmem_t *vm = qc->qc_vmem;
436 1.2.2.4 yamt
437 1.2.2.4 yamt return (void *)vmem_alloc(vm, pool->pr_alloc->pa_pagesz,
438 1.2.2.4 yamt prf_to_vmf(prflags) | VM_INSTANTFIT);
439 1.2.2.4 yamt }
440 1.2.2.4 yamt
441 1.2.2.4 yamt static void
442 1.2.2.4 yamt qc_poolpage_free(struct pool *pool, void *addr)
443 1.2.2.4 yamt {
444 1.2.2.4 yamt qcache_t *qc = QC_POOL_TO_QCACHE(pool);
445 1.2.2.4 yamt vmem_t *vm = qc->qc_vmem;
446 1.2.2.4 yamt
447 1.2.2.4 yamt vmem_free(vm, (vmem_addr_t)addr, pool->pr_alloc->pa_pagesz);
448 1.2.2.4 yamt }
449 1.2.2.4 yamt
450 1.2.2.4 yamt static void
451 1.2.2.4 yamt qc_init(vmem_t *vm, size_t qcache_max)
452 1.2.2.4 yamt {
453 1.2.2.4 yamt struct pool_allocator *pa;
454 1.2.2.4 yamt int qcache_idx_max;
455 1.2.2.4 yamt int i;
456 1.2.2.4 yamt
457 1.2.2.4 yamt KASSERT((qcache_max & vm->vm_quantum_mask) == 0);
458 1.2.2.4 yamt if (qcache_max > (VMEM_QCACHE_IDX_MAX << vm->vm_quantum_shift)) {
459 1.2.2.4 yamt qcache_max = VMEM_QCACHE_IDX_MAX << vm->vm_quantum_shift;
460 1.2.2.4 yamt }
461 1.2.2.4 yamt vm->vm_qcache_max = qcache_max;
462 1.2.2.4 yamt pa = &vm->vm_qcache_allocator;
463 1.2.2.4 yamt memset(pa, 0, sizeof(*pa));
464 1.2.2.4 yamt pa->pa_alloc = qc_poolpage_alloc;
465 1.2.2.4 yamt pa->pa_free = qc_poolpage_free;
466 1.2.2.4 yamt pa->pa_pagesz = qc_poolpage_size(qcache_max);
467 1.2.2.4 yamt
468 1.2.2.4 yamt qcache_idx_max = qcache_max >> vm->vm_quantum_shift;
469 1.2.2.4 yamt for (i = 1; i <= qcache_idx_max; i++) {
470 1.2.2.4 yamt qcache_t *qc = &vm->vm_qcache[i - 1];
471 1.2.2.4 yamt size_t size = i << vm->vm_quantum_shift;
472 1.2.2.4 yamt
473 1.2.2.4 yamt qc->qc_vmem = vm;
474 1.2.2.4 yamt snprintf(qc->qc_name, sizeof(qc->qc_name), "%s-%zu",
475 1.2.2.4 yamt vm->vm_name, size);
476 1.2.2.4 yamt pool_init(&qc->qc_pool, size, 0, 0,
477 1.2.2.4 yamt PR_NOALIGN | PR_NOTOUCH /* XXX */, qc->qc_name, pa);
478 1.2.2.4 yamt pool_cache_init(&qc->qc_cache, &qc->qc_pool, NULL, NULL, NULL);
479 1.2.2.4 yamt }
480 1.2.2.4 yamt }
481 1.2.2.4 yamt
482 1.2.2.4 yamt static boolean_t
483 1.2.2.4 yamt qc_reap(vmem_t *vm)
484 1.2.2.4 yamt {
485 1.2.2.4 yamt int i;
486 1.2.2.4 yamt int qcache_idx_max;
487 1.2.2.4 yamt boolean_t didsomething = FALSE;
488 1.2.2.4 yamt
489 1.2.2.4 yamt qcache_idx_max = vm->vm_qcache_max >> vm->vm_quantum_shift;
490 1.2.2.4 yamt for (i = 1; i <= qcache_idx_max; i++) {
491 1.2.2.4 yamt qcache_t *qc = &vm->vm_qcache[i - 1];
492 1.2.2.4 yamt
493 1.2.2.4 yamt if (pool_reclaim(&qc->qc_pool) != 0) {
494 1.2.2.4 yamt didsomething = TRUE;
495 1.2.2.4 yamt }
496 1.2.2.4 yamt }
497 1.2.2.4 yamt
498 1.2.2.4 yamt return didsomething;
499 1.2.2.4 yamt }
500 1.2.2.4 yamt #endif /* defined(QCACHE) */
501 1.2.2.4 yamt
502 1.2.2.2 yamt #if defined(_KERNEL)
503 1.2.2.2 yamt static int
504 1.2.2.2 yamt vmem_init(void)
505 1.2.2.2 yamt {
506 1.2.2.2 yamt
507 1.2.2.2 yamt pool_cache_init(&bt_poolcache, &bt_pool, NULL, NULL, NULL);
508 1.2.2.2 yamt return 0;
509 1.2.2.2 yamt }
510 1.2.2.2 yamt #endif /* defined(_KERNEL) */
511 1.2.2.2 yamt
512 1.2.2.2 yamt static vmem_addr_t
513 1.2.2.2 yamt vmem_add1(vmem_t *vm, vmem_addr_t addr, vmem_size_t size, vm_flag_t flags,
514 1.2.2.2 yamt int spanbttype)
515 1.2.2.2 yamt {
516 1.2.2.2 yamt bt_t *btspan;
517 1.2.2.2 yamt bt_t *btfree;
518 1.2.2.2 yamt
519 1.2.2.2 yamt KASSERT((flags & (VM_SLEEP|VM_NOSLEEP)) != 0);
520 1.2.2.2 yamt KASSERT((~flags & (VM_SLEEP|VM_NOSLEEP)) != 0);
521 1.2.2.2 yamt VMEM_ASSERT_UNLOCKED(vm);
522 1.2.2.2 yamt
523 1.2.2.2 yamt btspan = bt_alloc(vm, flags);
524 1.2.2.2 yamt if (btspan == NULL) {
525 1.2.2.2 yamt return VMEM_ADDR_NULL;
526 1.2.2.2 yamt }
527 1.2.2.2 yamt btfree = bt_alloc(vm, flags);
528 1.2.2.2 yamt if (btfree == NULL) {
529 1.2.2.2 yamt bt_free(vm, btspan);
530 1.2.2.2 yamt return VMEM_ADDR_NULL;
531 1.2.2.2 yamt }
532 1.2.2.2 yamt
533 1.2.2.2 yamt btspan->bt_type = spanbttype;
534 1.2.2.2 yamt btspan->bt_start = addr;
535 1.2.2.2 yamt btspan->bt_size = size;
536 1.2.2.2 yamt
537 1.2.2.2 yamt btfree->bt_type = BT_TYPE_FREE;
538 1.2.2.2 yamt btfree->bt_start = addr;
539 1.2.2.2 yamt btfree->bt_size = size;
540 1.2.2.2 yamt
541 1.2.2.2 yamt VMEM_LOCK(vm);
542 1.2.2.2 yamt bt_insseg_tail(vm, btspan);
543 1.2.2.2 yamt bt_insseg(vm, btfree, btspan);
544 1.2.2.2 yamt bt_insfree(vm, btfree);
545 1.2.2.2 yamt VMEM_UNLOCK(vm);
546 1.2.2.2 yamt
547 1.2.2.2 yamt return addr;
548 1.2.2.2 yamt }
549 1.2.2.2 yamt
550 1.2.2.2 yamt static int
551 1.2.2.2 yamt vmem_import(vmem_t *vm, vmem_size_t size, vm_flag_t flags)
552 1.2.2.2 yamt {
553 1.2.2.2 yamt vmem_addr_t addr;
554 1.2.2.2 yamt
555 1.2.2.2 yamt VMEM_ASSERT_UNLOCKED(vm);
556 1.2.2.2 yamt
557 1.2.2.2 yamt if (vm->vm_allocfn == NULL) {
558 1.2.2.2 yamt return EINVAL;
559 1.2.2.2 yamt }
560 1.2.2.2 yamt
561 1.2.2.2 yamt addr = (*vm->vm_allocfn)(vm->vm_source, size, &size, flags);
562 1.2.2.2 yamt if (addr == VMEM_ADDR_NULL) {
563 1.2.2.2 yamt return ENOMEM;
564 1.2.2.2 yamt }
565 1.2.2.2 yamt
566 1.2.2.2 yamt if (vmem_add1(vm, addr, size, flags, BT_TYPE_SPAN) == VMEM_ADDR_NULL) {
567 1.2.2.2 yamt (*vm->vm_freefn)(vm->vm_source, addr, size);
568 1.2.2.2 yamt return ENOMEM;
569 1.2.2.2 yamt }
570 1.2.2.2 yamt
571 1.2.2.2 yamt return 0;
572 1.2.2.2 yamt }
573 1.2.2.2 yamt
574 1.2.2.2 yamt static int
575 1.2.2.2 yamt vmem_rehash(vmem_t *vm, size_t newhashsize, vm_flag_t flags)
576 1.2.2.2 yamt {
577 1.2.2.2 yamt bt_t *bt;
578 1.2.2.2 yamt int i;
579 1.2.2.2 yamt struct vmem_hashlist *newhashlist;
580 1.2.2.2 yamt struct vmem_hashlist *oldhashlist;
581 1.2.2.2 yamt size_t oldhashsize;
582 1.2.2.2 yamt
583 1.2.2.2 yamt KASSERT(newhashsize > 0);
584 1.2.2.2 yamt VMEM_ASSERT_UNLOCKED(vm);
585 1.2.2.2 yamt
586 1.2.2.2 yamt newhashlist =
587 1.2.2.2 yamt xmalloc(sizeof(struct vmem_hashlist *) * newhashsize, flags);
588 1.2.2.2 yamt if (newhashlist == NULL) {
589 1.2.2.2 yamt return ENOMEM;
590 1.2.2.2 yamt }
591 1.2.2.2 yamt for (i = 0; i < newhashsize; i++) {
592 1.2.2.2 yamt LIST_INIT(&newhashlist[i]);
593 1.2.2.2 yamt }
594 1.2.2.2 yamt
595 1.2.2.2 yamt VMEM_LOCK(vm);
596 1.2.2.2 yamt oldhashlist = vm->vm_hashlist;
597 1.2.2.2 yamt oldhashsize = vm->vm_hashsize;
598 1.2.2.2 yamt vm->vm_hashlist = newhashlist;
599 1.2.2.2 yamt vm->vm_hashsize = newhashsize;
600 1.2.2.2 yamt if (oldhashlist == NULL) {
601 1.2.2.2 yamt VMEM_UNLOCK(vm);
602 1.2.2.2 yamt return 0;
603 1.2.2.2 yamt }
604 1.2.2.2 yamt for (i = 0; i < oldhashsize; i++) {
605 1.2.2.2 yamt while ((bt = LIST_FIRST(&oldhashlist[i])) != NULL) {
606 1.2.2.2 yamt bt_rembusy(vm, bt); /* XXX */
607 1.2.2.2 yamt bt_insbusy(vm, bt);
608 1.2.2.2 yamt }
609 1.2.2.2 yamt }
610 1.2.2.2 yamt VMEM_UNLOCK(vm);
611 1.2.2.2 yamt
612 1.2.2.2 yamt xfree(oldhashlist);
613 1.2.2.2 yamt
614 1.2.2.2 yamt return 0;
615 1.2.2.2 yamt }
616 1.2.2.2 yamt
617 1.2.2.2 yamt /* ---- vmem API */
618 1.2.2.2 yamt
619 1.2.2.2 yamt /*
620 1.2.2.2 yamt * vmem_create: create an arena.
621 1.2.2.2 yamt *
622 1.2.2.2 yamt * => must not be called from interrupt context.
623 1.2.2.2 yamt */
624 1.2.2.2 yamt
625 1.2.2.2 yamt vmem_t *
626 1.2.2.2 yamt vmem_create(const char *name, vmem_addr_t base, vmem_size_t size,
627 1.2.2.2 yamt vmem_size_t quantum,
628 1.2.2.2 yamt vmem_addr_t (*allocfn)(vmem_t *, vmem_size_t, vmem_size_t *, vm_flag_t),
629 1.2.2.2 yamt void (*freefn)(vmem_t *, vmem_addr_t, vmem_size_t),
630 1.2.2.2 yamt vmem_t *source, vmem_size_t qcache_max, vm_flag_t flags)
631 1.2.2.2 yamt {
632 1.2.2.2 yamt vmem_t *vm;
633 1.2.2.2 yamt int i;
634 1.2.2.2 yamt #if defined(_KERNEL)
635 1.2.2.2 yamt static ONCE_DECL(control);
636 1.2.2.2 yamt #endif /* defined(_KERNEL) */
637 1.2.2.2 yamt
638 1.2.2.2 yamt KASSERT((flags & (VM_SLEEP|VM_NOSLEEP)) != 0);
639 1.2.2.2 yamt KASSERT((~flags & (VM_SLEEP|VM_NOSLEEP)) != 0);
640 1.2.2.2 yamt
641 1.2.2.2 yamt #if defined(_KERNEL)
642 1.2.2.2 yamt if (RUN_ONCE(&control, vmem_init)) {
643 1.2.2.2 yamt return NULL;
644 1.2.2.2 yamt }
645 1.2.2.2 yamt #endif /* defined(_KERNEL) */
646 1.2.2.2 yamt vm = xmalloc(sizeof(*vm), flags);
647 1.2.2.2 yamt if (vm == NULL) {
648 1.2.2.2 yamt return NULL;
649 1.2.2.2 yamt }
650 1.2.2.2 yamt
651 1.2.2.2 yamt VMEM_LOCK_INIT(vm);
652 1.2.2.2 yamt vm->vm_name = name;
653 1.2.2.2 yamt vm->vm_quantum_mask = quantum - 1;
654 1.2.2.2 yamt vm->vm_quantum_shift = calc_order(quantum);
655 1.2.2.4 yamt KASSERT(ORDER2SIZE(vm->vm_quantum_shift) == quantum);
656 1.2.2.2 yamt vm->vm_allocfn = allocfn;
657 1.2.2.2 yamt vm->vm_freefn = freefn;
658 1.2.2.2 yamt vm->vm_source = source;
659 1.2.2.2 yamt vm->vm_nbusytag = 0;
660 1.2.2.4 yamt #if defined(QCACHE)
661 1.2.2.4 yamt qc_init(vm, qcache_max);
662 1.2.2.4 yamt #endif /* defined(QCACHE) */
663 1.2.2.2 yamt
664 1.2.2.2 yamt CIRCLEQ_INIT(&vm->vm_seglist);
665 1.2.2.2 yamt for (i = 0; i < VMEM_MAXORDER; i++) {
666 1.2.2.2 yamt LIST_INIT(&vm->vm_freelist[i]);
667 1.2.2.2 yamt }
668 1.2.2.2 yamt vm->vm_hashlist = NULL;
669 1.2.2.2 yamt if (vmem_rehash(vm, VMEM_HASHSIZE_INIT, flags)) {
670 1.2.2.2 yamt vmem_destroy(vm);
671 1.2.2.2 yamt return NULL;
672 1.2.2.2 yamt }
673 1.2.2.2 yamt
674 1.2.2.2 yamt if (size != 0) {
675 1.2.2.2 yamt if (vmem_add(vm, base, size, flags) == 0) {
676 1.2.2.2 yamt vmem_destroy(vm);
677 1.2.2.2 yamt return NULL;
678 1.2.2.2 yamt }
679 1.2.2.2 yamt }
680 1.2.2.2 yamt
681 1.2.2.2 yamt return vm;
682 1.2.2.2 yamt }
683 1.2.2.2 yamt
684 1.2.2.2 yamt void
685 1.2.2.2 yamt vmem_destroy(vmem_t *vm)
686 1.2.2.2 yamt {
687 1.2.2.2 yamt
688 1.2.2.2 yamt VMEM_ASSERT_UNLOCKED(vm);
689 1.2.2.2 yamt
690 1.2.2.2 yamt if (vm->vm_hashlist != NULL) {
691 1.2.2.2 yamt int i;
692 1.2.2.2 yamt
693 1.2.2.2 yamt for (i = 0; i < vm->vm_hashsize; i++) {
694 1.2.2.2 yamt bt_t *bt;
695 1.2.2.2 yamt
696 1.2.2.2 yamt while ((bt = LIST_FIRST(&vm->vm_hashlist[i])) != NULL) {
697 1.2.2.2 yamt KASSERT(bt->bt_type == BT_TYPE_SPAN_STATIC);
698 1.2.2.2 yamt bt_free(vm, bt);
699 1.2.2.2 yamt }
700 1.2.2.2 yamt }
701 1.2.2.2 yamt xfree(vm->vm_hashlist);
702 1.2.2.2 yamt }
703 1.2.2.2 yamt xfree(vm);
704 1.2.2.2 yamt }
705 1.2.2.2 yamt
706 1.2.2.2 yamt vmem_size_t
707 1.2.2.2 yamt vmem_roundup_size(vmem_t *vm, vmem_size_t size)
708 1.2.2.2 yamt {
709 1.2.2.2 yamt
710 1.2.2.2 yamt return (size + vm->vm_quantum_mask) & ~vm->vm_quantum_mask;
711 1.2.2.2 yamt }
712 1.2.2.2 yamt
713 1.2.2.2 yamt /*
714 1.2.2.2 yamt * vmem_alloc:
715 1.2.2.2 yamt *
716 1.2.2.2 yamt * => caller must ensure appropriate spl,
717 1.2.2.2 yamt * if the arena can be accessed from interrupt context.
718 1.2.2.2 yamt */
719 1.2.2.2 yamt
720 1.2.2.2 yamt vmem_addr_t
721 1.2.2.2 yamt vmem_alloc(vmem_t *vm, vmem_size_t size0, vm_flag_t flags)
722 1.2.2.2 yamt {
723 1.2.2.2 yamt struct vmem_freelist *list;
724 1.2.2.2 yamt struct vmem_freelist *first;
725 1.2.2.2 yamt struct vmem_freelist *end;
726 1.2.2.2 yamt bt_t *bt;
727 1.2.2.2 yamt bt_t *btnew;
728 1.2.2.2 yamt const vmem_size_t size = vmem_roundup_size(vm, size0);
729 1.2.2.2 yamt vm_flag_t strat = flags & VM_FITMASK;
730 1.2.2.2 yamt
731 1.2.2.2 yamt KASSERT((flags & (VM_SLEEP|VM_NOSLEEP)) != 0);
732 1.2.2.2 yamt KASSERT((~flags & (VM_SLEEP|VM_NOSLEEP)) != 0);
733 1.2.2.2 yamt VMEM_ASSERT_UNLOCKED(vm);
734 1.2.2.2 yamt
735 1.2.2.2 yamt KASSERT(size0 > 0);
736 1.2.2.2 yamt KASSERT(size > 0);
737 1.2.2.2 yamt KASSERT(strat == VM_BESTFIT || strat == VM_INSTANTFIT);
738 1.2.2.3 yamt if ((flags & VM_SLEEP) != 0) {
739 1.2.2.3 yamt ASSERT_SLEEPABLE(NULL, "vmem_alloc");
740 1.2.2.3 yamt }
741 1.2.2.2 yamt
742 1.2.2.4 yamt #if defined(QCACHE)
743 1.2.2.4 yamt if (size <= vm->vm_qcache_max) {
744 1.2.2.4 yamt int qidx = size >> vm->vm_quantum_shift;
745 1.2.2.4 yamt qcache_t *qc = &vm->vm_qcache[qidx - 1];
746 1.2.2.4 yamt
747 1.2.2.4 yamt return (vmem_addr_t)pool_cache_get(&qc->qc_cache,
748 1.2.2.4 yamt vmf_to_prf(flags));
749 1.2.2.4 yamt }
750 1.2.2.4 yamt #endif /* defined(QCACHE) */
751 1.2.2.4 yamt
752 1.2.2.2 yamt btnew = bt_alloc(vm, flags);
753 1.2.2.2 yamt if (btnew == NULL) {
754 1.2.2.2 yamt return VMEM_ADDR_NULL;
755 1.2.2.2 yamt }
756 1.2.2.2 yamt
757 1.2.2.2 yamt retry_strat:
758 1.2.2.2 yamt first = bt_freehead_toalloc(vm, size, strat);
759 1.2.2.2 yamt end = &vm->vm_freelist[VMEM_MAXORDER];
760 1.2.2.2 yamt retry:
761 1.2.2.2 yamt bt = NULL;
762 1.2.2.2 yamt VMEM_LOCK(vm);
763 1.2.2.2 yamt if (strat == VM_INSTANTFIT) {
764 1.2.2.2 yamt for (list = first; list < end; list++) {
765 1.2.2.2 yamt bt = LIST_FIRST(list);
766 1.2.2.2 yamt if (bt != NULL) {
767 1.2.2.2 yamt goto gotit;
768 1.2.2.2 yamt }
769 1.2.2.2 yamt }
770 1.2.2.2 yamt } else { /* VM_BESTFIT */
771 1.2.2.2 yamt for (list = first; list < end; list++) {
772 1.2.2.2 yamt LIST_FOREACH(bt, list, bt_freelist) {
773 1.2.2.2 yamt if (bt->bt_size >= size) {
774 1.2.2.2 yamt goto gotit;
775 1.2.2.2 yamt }
776 1.2.2.2 yamt }
777 1.2.2.2 yamt }
778 1.2.2.2 yamt }
779 1.2.2.2 yamt VMEM_UNLOCK(vm);
780 1.2.2.2 yamt #if 1
781 1.2.2.2 yamt if (strat == VM_INSTANTFIT) {
782 1.2.2.2 yamt strat = VM_BESTFIT;
783 1.2.2.2 yamt goto retry_strat;
784 1.2.2.2 yamt }
785 1.2.2.2 yamt #endif
786 1.2.2.2 yamt if (vmem_import(vm, size, flags) == 0) {
787 1.2.2.2 yamt goto retry;
788 1.2.2.2 yamt }
789 1.2.2.2 yamt /* XXX */
790 1.2.2.2 yamt return VMEM_ADDR_NULL;
791 1.2.2.2 yamt
792 1.2.2.2 yamt gotit:
793 1.2.2.2 yamt KASSERT(bt->bt_type == BT_TYPE_FREE);
794 1.2.2.2 yamt KASSERT(bt->bt_size >= size);
795 1.2.2.2 yamt bt_remfree(vm, bt);
796 1.2.2.2 yamt if (bt->bt_size != size && bt->bt_size - size > vm->vm_quantum_mask) {
797 1.2.2.2 yamt /* split */
798 1.2.2.2 yamt btnew->bt_type = BT_TYPE_BUSY;
799 1.2.2.2 yamt btnew->bt_start = bt->bt_start;
800 1.2.2.2 yamt btnew->bt_size = size;
801 1.2.2.2 yamt bt->bt_start = bt->bt_start + size;
802 1.2.2.2 yamt bt->bt_size -= size;
803 1.2.2.2 yamt bt_insfree(vm, bt);
804 1.2.2.2 yamt bt_insseg(vm, btnew, CIRCLEQ_PREV(bt, bt_seglist));
805 1.2.2.2 yamt bt_insbusy(vm, btnew);
806 1.2.2.2 yamt VMEM_UNLOCK(vm);
807 1.2.2.2 yamt } else {
808 1.2.2.2 yamt bt->bt_type = BT_TYPE_BUSY;
809 1.2.2.2 yamt bt_insbusy(vm, bt);
810 1.2.2.2 yamt VMEM_UNLOCK(vm);
811 1.2.2.2 yamt bt_free(vm, btnew);
812 1.2.2.2 yamt btnew = bt;
813 1.2.2.2 yamt }
814 1.2.2.2 yamt KASSERT(btnew->bt_size >= size);
815 1.2.2.2 yamt btnew->bt_type = BT_TYPE_BUSY;
816 1.2.2.2 yamt
817 1.2.2.2 yamt return btnew->bt_start;
818 1.2.2.2 yamt }
819 1.2.2.2 yamt
820 1.2.2.2 yamt /*
821 1.2.2.2 yamt * vmem_free:
822 1.2.2.2 yamt *
823 1.2.2.2 yamt * => caller must ensure appropriate spl,
824 1.2.2.2 yamt * if the arena can be accessed from interrupt context.
825 1.2.2.2 yamt */
826 1.2.2.2 yamt
827 1.2.2.2 yamt void
828 1.2.2.2 yamt vmem_free(vmem_t *vm, vmem_addr_t addr, vmem_size_t size)
829 1.2.2.2 yamt {
830 1.2.2.2 yamt bt_t *bt;
831 1.2.2.2 yamt bt_t *t;
832 1.2.2.2 yamt
833 1.2.2.2 yamt VMEM_ASSERT_UNLOCKED(vm);
834 1.2.2.2 yamt
835 1.2.2.2 yamt KASSERT(addr != VMEM_ADDR_NULL);
836 1.2.2.2 yamt KASSERT(size > 0);
837 1.2.2.2 yamt
838 1.2.2.4 yamt #if defined(QCACHE)
839 1.2.2.4 yamt if (size <= vm->vm_qcache_max) {
840 1.2.2.4 yamt int qidx = (size + vm->vm_quantum_mask) >> vm->vm_quantum_shift;
841 1.2.2.4 yamt qcache_t *qc = &vm->vm_qcache[qidx - 1];
842 1.2.2.4 yamt
843 1.2.2.4 yamt return pool_cache_put(&qc->qc_cache, (void *)addr);
844 1.2.2.4 yamt }
845 1.2.2.4 yamt #endif /* defined(QCACHE) */
846 1.2.2.4 yamt
847 1.2.2.2 yamt VMEM_LOCK(vm);
848 1.2.2.2 yamt
849 1.2.2.2 yamt bt = bt_lookupbusy(vm, addr);
850 1.2.2.2 yamt KASSERT(bt != NULL);
851 1.2.2.2 yamt KASSERT(bt->bt_start == addr);
852 1.2.2.2 yamt KASSERT(bt->bt_size == vmem_roundup_size(vm, size) ||
853 1.2.2.2 yamt bt->bt_size - vmem_roundup_size(vm, size) <= vm->vm_quantum_mask);
854 1.2.2.2 yamt KASSERT(bt->bt_type == BT_TYPE_BUSY);
855 1.2.2.2 yamt bt_rembusy(vm, bt);
856 1.2.2.2 yamt bt->bt_type = BT_TYPE_FREE;
857 1.2.2.2 yamt
858 1.2.2.2 yamt /* coalesce */
859 1.2.2.2 yamt t = CIRCLEQ_NEXT(bt, bt_seglist);
860 1.2.2.2 yamt if (t != NULL && t->bt_type == BT_TYPE_FREE) {
861 1.2.2.2 yamt KASSERT(BT_END(bt) == t->bt_start);
862 1.2.2.2 yamt bt_remfree(vm, t);
863 1.2.2.2 yamt bt_remseg(vm, t);
864 1.2.2.2 yamt bt->bt_size += t->bt_size;
865 1.2.2.2 yamt bt_free(vm, t);
866 1.2.2.2 yamt }
867 1.2.2.2 yamt t = CIRCLEQ_PREV(bt, bt_seglist);
868 1.2.2.2 yamt if (t != NULL && t->bt_type == BT_TYPE_FREE) {
869 1.2.2.2 yamt KASSERT(BT_END(t) == bt->bt_start);
870 1.2.2.2 yamt bt_remfree(vm, t);
871 1.2.2.2 yamt bt_remseg(vm, t);
872 1.2.2.2 yamt bt->bt_size += t->bt_size;
873 1.2.2.2 yamt bt->bt_start = t->bt_start;
874 1.2.2.2 yamt bt_free(vm, t);
875 1.2.2.2 yamt }
876 1.2.2.2 yamt
877 1.2.2.2 yamt t = CIRCLEQ_PREV(bt, bt_seglist);
878 1.2.2.2 yamt KASSERT(t != NULL);
879 1.2.2.2 yamt KASSERT(BT_ISSPAN_P(t) || t->bt_type == BT_TYPE_BUSY);
880 1.2.2.2 yamt if (vm->vm_freefn != NULL && t->bt_type == BT_TYPE_SPAN &&
881 1.2.2.2 yamt t->bt_size == bt->bt_size) {
882 1.2.2.2 yamt vmem_addr_t spanaddr;
883 1.2.2.2 yamt vmem_size_t spansize;
884 1.2.2.2 yamt
885 1.2.2.2 yamt KASSERT(t->bt_start == bt->bt_start);
886 1.2.2.2 yamt spanaddr = bt->bt_start;
887 1.2.2.2 yamt spansize = bt->bt_size;
888 1.2.2.2 yamt bt_remseg(vm, bt);
889 1.2.2.2 yamt bt_free(vm, bt);
890 1.2.2.2 yamt bt_remseg(vm, t);
891 1.2.2.2 yamt bt_free(vm, t);
892 1.2.2.2 yamt VMEM_UNLOCK(vm);
893 1.2.2.2 yamt (*vm->vm_freefn)(vm->vm_source, spanaddr, spansize);
894 1.2.2.2 yamt } else {
895 1.2.2.2 yamt bt_insfree(vm, bt);
896 1.2.2.2 yamt VMEM_UNLOCK(vm);
897 1.2.2.2 yamt }
898 1.2.2.2 yamt }
899 1.2.2.2 yamt
900 1.2.2.2 yamt /*
901 1.2.2.2 yamt * vmem_add:
902 1.2.2.2 yamt *
903 1.2.2.2 yamt * => caller must ensure appropriate spl,
904 1.2.2.2 yamt * if the arena can be accessed from interrupt context.
905 1.2.2.2 yamt */
906 1.2.2.2 yamt
907 1.2.2.2 yamt vmem_addr_t
908 1.2.2.2 yamt vmem_add(vmem_t *vm, vmem_addr_t addr, vmem_size_t size, vm_flag_t flags)
909 1.2.2.2 yamt {
910 1.2.2.2 yamt
911 1.2.2.2 yamt return vmem_add1(vm, addr, size, flags, BT_TYPE_SPAN_STATIC);
912 1.2.2.2 yamt }
913 1.2.2.2 yamt
914 1.2.2.4 yamt /*
915 1.2.2.4 yamt * vmem_reap: reap unused resources.
916 1.2.2.4 yamt *
917 1.2.2.4 yamt * => return TRUE if we successfully reaped something.
918 1.2.2.4 yamt */
919 1.2.2.4 yamt
920 1.2.2.4 yamt boolean_t
921 1.2.2.4 yamt vmem_reap(vmem_t *vm)
922 1.2.2.4 yamt {
923 1.2.2.4 yamt boolean_t didsomething = FALSE;
924 1.2.2.4 yamt
925 1.2.2.4 yamt VMEM_ASSERT_UNLOCKED(vm);
926 1.2.2.4 yamt
927 1.2.2.4 yamt #if defined(QCACHE)
928 1.2.2.4 yamt didsomething = qc_reap(vm);
929 1.2.2.4 yamt #endif /* defined(QCACHE) */
930 1.2.2.4 yamt return didsomething;
931 1.2.2.4 yamt }
932 1.2.2.4 yamt
933 1.2.2.2 yamt /* ---- debug */
934 1.2.2.2 yamt
935 1.2.2.2 yamt #if defined(VMEM_DEBUG)
936 1.2.2.2 yamt
937 1.2.2.2 yamt #if !defined(_KERNEL)
938 1.2.2.2 yamt #include <stdio.h>
939 1.2.2.2 yamt #endif /* !defined(_KERNEL) */
940 1.2.2.2 yamt
941 1.2.2.2 yamt void bt_dump(const bt_t *);
942 1.2.2.2 yamt
943 1.2.2.2 yamt void
944 1.2.2.2 yamt bt_dump(const bt_t *bt)
945 1.2.2.2 yamt {
946 1.2.2.2 yamt
947 1.2.2.2 yamt printf("\t%p: %" PRIu64 ", %" PRIu64 ", %d\n",
948 1.2.2.2 yamt bt, (uint64_t)bt->bt_start, (uint64_t)bt->bt_size,
949 1.2.2.2 yamt bt->bt_type);
950 1.2.2.2 yamt }
951 1.2.2.2 yamt
952 1.2.2.2 yamt void
953 1.2.2.2 yamt vmem_dump(const vmem_t *vm)
954 1.2.2.2 yamt {
955 1.2.2.2 yamt const bt_t *bt;
956 1.2.2.2 yamt int i;
957 1.2.2.2 yamt
958 1.2.2.2 yamt printf("vmem %p '%s'\n", vm, vm->vm_name);
959 1.2.2.2 yamt CIRCLEQ_FOREACH(bt, &vm->vm_seglist, bt_seglist) {
960 1.2.2.2 yamt bt_dump(bt);
961 1.2.2.2 yamt }
962 1.2.2.2 yamt
963 1.2.2.2 yamt for (i = 0; i < VMEM_MAXORDER; i++) {
964 1.2.2.2 yamt const struct vmem_freelist *fl = &vm->vm_freelist[i];
965 1.2.2.2 yamt
966 1.2.2.2 yamt if (LIST_EMPTY(fl)) {
967 1.2.2.2 yamt continue;
968 1.2.2.2 yamt }
969 1.2.2.2 yamt
970 1.2.2.2 yamt printf("freelist[%d]\n", i);
971 1.2.2.2 yamt LIST_FOREACH(bt, fl, bt_freelist) {
972 1.2.2.2 yamt bt_dump(bt);
973 1.2.2.2 yamt if (bt->bt_size) {
974 1.2.2.2 yamt }
975 1.2.2.2 yamt }
976 1.2.2.2 yamt }
977 1.2.2.2 yamt }
978 1.2.2.2 yamt
979 1.2.2.2 yamt #if !defined(_KERNEL)
980 1.2.2.2 yamt
981 1.2.2.2 yamt #include <stdlib.h>
982 1.2.2.2 yamt
983 1.2.2.2 yamt int
984 1.2.2.2 yamt main()
985 1.2.2.2 yamt {
986 1.2.2.2 yamt vmem_t *vm;
987 1.2.2.2 yamt vmem_addr_t p;
988 1.2.2.2 yamt struct reg {
989 1.2.2.2 yamt vmem_addr_t p;
990 1.2.2.2 yamt vmem_size_t sz;
991 1.2.2.2 yamt } *reg = NULL;
992 1.2.2.2 yamt int nreg = 0;
993 1.2.2.2 yamt int nalloc = 0;
994 1.2.2.2 yamt int nfree = 0;
995 1.2.2.2 yamt vmem_size_t total = 0;
996 1.2.2.2 yamt #if 1
997 1.2.2.2 yamt vm_flag_t strat = VM_INSTANTFIT;
998 1.2.2.2 yamt #else
999 1.2.2.2 yamt vm_flag_t strat = VM_BESTFIT;
1000 1.2.2.2 yamt #endif
1001 1.2.2.2 yamt
1002 1.2.2.2 yamt vm = vmem_create("test", VMEM_ADDR_NULL, 0, 1,
1003 1.2.2.2 yamt NULL, NULL, NULL, 0, VM_NOSLEEP);
1004 1.2.2.2 yamt if (vm == NULL) {
1005 1.2.2.2 yamt printf("vmem_create\n");
1006 1.2.2.2 yamt exit(EXIT_FAILURE);
1007 1.2.2.2 yamt }
1008 1.2.2.2 yamt vmem_dump(vm);
1009 1.2.2.2 yamt
1010 1.2.2.2 yamt p = vmem_add(vm, 100, 200, VM_SLEEP);
1011 1.2.2.2 yamt p = vmem_add(vm, 2000, 1, VM_SLEEP);
1012 1.2.2.2 yamt p = vmem_add(vm, 40000, 0x10000000>>12, VM_SLEEP);
1013 1.2.2.2 yamt p = vmem_add(vm, 10000, 10000, VM_SLEEP);
1014 1.2.2.2 yamt p = vmem_add(vm, 500, 1000, VM_SLEEP);
1015 1.2.2.2 yamt vmem_dump(vm);
1016 1.2.2.2 yamt for (;;) {
1017 1.2.2.2 yamt struct reg *r;
1018 1.2.2.2 yamt
1019 1.2.2.2 yamt if (rand() % 100 > 40) {
1020 1.2.2.2 yamt vmem_size_t sz = rand() % 500 + 1;
1021 1.2.2.2 yamt
1022 1.2.2.2 yamt printf("=== alloc %" PRIu64 "\n", (uint64_t)sz);
1023 1.2.2.2 yamt p = vmem_alloc(vm, sz, strat|VM_SLEEP);
1024 1.2.2.2 yamt printf("-> %" PRIu64 "\n", (uint64_t)p);
1025 1.2.2.2 yamt vmem_dump(vm);
1026 1.2.2.2 yamt if (p == VMEM_ADDR_NULL) {
1027 1.2.2.2 yamt break;
1028 1.2.2.2 yamt }
1029 1.2.2.2 yamt nreg++;
1030 1.2.2.2 yamt reg = realloc(reg, sizeof(*reg) * nreg);
1031 1.2.2.2 yamt r = ®[nreg - 1];
1032 1.2.2.2 yamt r->p = p;
1033 1.2.2.2 yamt r->sz = sz;
1034 1.2.2.2 yamt total += sz;
1035 1.2.2.2 yamt nalloc++;
1036 1.2.2.2 yamt } else if (nreg != 0) {
1037 1.2.2.2 yamt r = ®[rand() % nreg];
1038 1.2.2.2 yamt printf("=== free %" PRIu64 ", %" PRIu64 "\n",
1039 1.2.2.2 yamt (uint64_t)r->p, (uint64_t)r->sz);
1040 1.2.2.2 yamt vmem_free(vm, r->p, r->sz);
1041 1.2.2.2 yamt total -= r->sz;
1042 1.2.2.2 yamt vmem_dump(vm);
1043 1.2.2.2 yamt *r = reg[nreg - 1];
1044 1.2.2.2 yamt nreg--;
1045 1.2.2.2 yamt nfree++;
1046 1.2.2.2 yamt }
1047 1.2.2.2 yamt printf("total=%" PRIu64 "\n", (uint64_t)total);
1048 1.2.2.2 yamt }
1049 1.2.2.2 yamt fprintf(stderr, "total=%" PRIu64 ", nalloc=%d, nfree=%d\n",
1050 1.2.2.2 yamt (uint64_t)total, nalloc, nfree);
1051 1.2.2.2 yamt exit(EXIT_SUCCESS);
1052 1.2.2.2 yamt }
1053 1.2.2.2 yamt #endif /* !defined(_KERNEL) */
1054 1.2.2.2 yamt #endif /* defined(VMEM_DEBUG) */
1055