41ccd6eec6513104f1a774dace046f887d6cef43
[dragonfly.git] / sys / kern / kern_slaballoc.c
1 /*
2  * (MPSAFE)
3  *
4  * KERN_SLABALLOC.C     - Kernel SLAB memory allocator
5  * 
6  * Copyright (c) 2003,2004,2010 The DragonFly Project.  All rights reserved.
7  * 
8  * This code is derived from software contributed to The DragonFly Project
9  * by Matthew Dillon <dillon@backplane.com>
10  * 
11  * Redistribution and use in source and binary forms, with or without
12  * modification, are permitted provided that the following conditions
13  * are met:
14  * 
15  * 1. Redistributions of source code must retain the above copyright
16  *    notice, this list of conditions and the following disclaimer.
17  * 2. Redistributions in binary form must reproduce the above copyright
18  *    notice, this list of conditions and the following disclaimer in
19  *    the documentation and/or other materials provided with the
20  *    distribution.
21  * 3. Neither the name of The DragonFly Project nor the names of its
22  *    contributors may be used to endorse or promote products derived
23  *    from this software without specific, prior written permission.
24  * 
25  * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS
26  * ``AS IS'' AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT
27  * LIMITED TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS
28  * FOR A PARTICULAR PURPOSE ARE DISCLAIMED.  IN NO EVENT SHALL THE
29  * COPYRIGHT HOLDERS OR CONTRIBUTORS BE LIABLE FOR ANY DIRECT, INDIRECT,
30  * INCIDENTAL, SPECIAL, EXEMPLARY OR CONSEQUENTIAL DAMAGES (INCLUDING,
31  * BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES;
32  * LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED
33  * AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY,
34  * OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT
35  * OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
36  * SUCH DAMAGE.
37  * 
38  * $DragonFly: src/sys/kern/kern_slaballoc.c,v 1.55 2008/10/22 01:42:17 dillon Exp $
39  *
40  * This module implements a slab allocator drop-in replacement for the
41  * kernel malloc().
42  *
43  * A slab allocator reserves a ZONE for each chunk size, then lays the
44  * chunks out in an array within the zone.  Allocation and deallocation
45  * is nearly instantanious, and fragmentation/overhead losses are limited
46  * to a fixed worst-case amount.
47  *
48  * The downside of this slab implementation is in the chunk size
49  * multiplied by the number of zones.  ~80 zones * 128K = 10MB of VM per cpu.
50  * In a kernel implementation all this memory will be physical so
51  * the zone size is adjusted downward on machines with less physical
52  * memory.  The upside is that overhead is bounded... this is the *worst*
53  * case overhead.
54  *
55  * Slab management is done on a per-cpu basis and no locking or mutexes
56  * are required, only a critical section.  When one cpu frees memory
57  * belonging to another cpu's slab manager an asynchronous IPI message
58  * will be queued to execute the operation.   In addition, both the
59  * high level slab allocator and the low level zone allocator optimize
60  * M_ZERO requests, and the slab allocator does not have to pre initialize
61  * the linked list of chunks.
62  *
63  * XXX Balancing is needed between cpus.  Balance will be handled through
64  * asynchronous IPIs primarily by reassigning the z_Cpu ownership of chunks.
65  *
66  * XXX If we have to allocate a new zone and M_USE_RESERVE is set, use of
67  * the new zone should be restricted to M_USE_RESERVE requests only.
68  *
69  *      Alloc Size      Chunking        Number of zones
70  *      0-127           8               16
71  *      128-255         16              8
72  *      256-511         32              8
73  *      512-1023        64              8
74  *      1024-2047       128             8
75  *      2048-4095       256             8
76  *      4096-8191       512             8
77  *      8192-16383      1024            8
78  *      16384-32767     2048            8
79  *      (if PAGE_SIZE is 4K the maximum zone allocation is 16383)
80  *
81  *      Allocations >= ZoneLimit go directly to kmem.
82  *
83  *                      API REQUIREMENTS AND SIDE EFFECTS
84  *
85  *    To operate as a drop-in replacement to the FreeBSD-4.x malloc() we
86  *    have remained compatible with the following API requirements:
87  *
88  *    + small power-of-2 sized allocations are power-of-2 aligned (kern_tty)
89  *    + all power-of-2 sized allocations are power-of-2 aligned (twe)
90  *    + malloc(0) is allowed and returns non-NULL (ahc driver)
91  *    + ability to allocate arbitrarily large chunks of memory
92  */
93
94 #include "opt_vm.h"
95
96 #include <sys/param.h>
97 #include <sys/systm.h>
98 #include <sys/kernel.h>
99 #include <sys/slaballoc.h>
100 #include <sys/mbuf.h>
101 #include <sys/vmmeter.h>
102 #include <sys/lock.h>
103 #include <sys/thread.h>
104 #include <sys/globaldata.h>
105 #include <sys/sysctl.h>
106 #include <sys/ktr.h>
107
108 #include <vm/vm.h>
109 #include <vm/vm_param.h>
110 #include <vm/vm_kern.h>
111 #include <vm/vm_extern.h>
112 #include <vm/vm_object.h>
113 #include <vm/pmap.h>
114 #include <vm/vm_map.h>
115 #include <vm/vm_page.h>
116 #include <vm/vm_pageout.h>
117
118 #include <machine/cpu.h>
119
120 #include <sys/thread2.h>
121
122 #define arysize(ary)    (sizeof(ary)/sizeof((ary)[0]))
123
124 #define MEMORY_STRING   "ptr=%p type=%p size=%d flags=%04x"
125 #define MEMORY_ARG_SIZE (sizeof(void *) * 2 + sizeof(unsigned long) +   \
126                         sizeof(int))
127
128 #if !defined(KTR_MEMORY)
129 #define KTR_MEMORY      KTR_ALL
130 #endif
131 KTR_INFO_MASTER(memory);
132 KTR_INFO(KTR_MEMORY, memory, malloc_beg, 0, "malloc begin", 0);
133 KTR_INFO(KTR_MEMORY, memory, malloc_end, 1, MEMORY_STRING, MEMORY_ARG_SIZE);
134 KTR_INFO(KTR_MEMORY, memory, free_zero, 2, MEMORY_STRING, MEMORY_ARG_SIZE);
135 KTR_INFO(KTR_MEMORY, memory, free_ovsz, 3, MEMORY_STRING, MEMORY_ARG_SIZE);
136 KTR_INFO(KTR_MEMORY, memory, free_ovsz_delayed, 4, MEMORY_STRING, MEMORY_ARG_SIZE);
137 KTR_INFO(KTR_MEMORY, memory, free_chunk, 5, MEMORY_STRING, MEMORY_ARG_SIZE);
138 #ifdef SMP
139 KTR_INFO(KTR_MEMORY, memory, free_request, 6, MEMORY_STRING, MEMORY_ARG_SIZE);
140 KTR_INFO(KTR_MEMORY, memory, free_rem_beg, 7, MEMORY_STRING, MEMORY_ARG_SIZE);
141 KTR_INFO(KTR_MEMORY, memory, free_rem_end, 8, MEMORY_STRING, MEMORY_ARG_SIZE);
142 #endif
143 KTR_INFO(KTR_MEMORY, memory, free_beg, 9, "free begin", 0);
144 KTR_INFO(KTR_MEMORY, memory, free_end, 10, "free end", 0);
145
146 #define logmemory(name, ptr, type, size, flags)                         \
147         KTR_LOG(memory_ ## name, ptr, type, size, flags)
148 #define logmemory_quick(name)                                           \
149         KTR_LOG(memory_ ## name)
150
151 /*
152  * Fixed globals (not per-cpu)
153  */
154 static int ZoneSize;
155 static int ZoneLimit;
156 static int ZonePageCount;
157 static uintptr_t ZoneMask;
158 static int ZoneBigAlloc;                /* in KB */
159 static int ZoneGenAlloc;                /* in KB */
160 struct malloc_type *kmemstatistics;     /* exported to vmstat */
161 static struct kmemusage *kmemusage;
162 static int32_t weirdary[16];
163
164 static void *kmem_slab_alloc(vm_size_t bytes, vm_offset_t align, int flags);
165 static void kmem_slab_free(void *ptr, vm_size_t bytes);
166
167 #if defined(INVARIANTS)
168 static void chunk_mark_allocated(SLZone *z, void *chunk);
169 static void chunk_mark_free(SLZone *z, void *chunk);
170 #else
171 #define chunk_mark_allocated(z, chunk)
172 #define chunk_mark_free(z, chunk)
173 #endif
174
175 /*
176  * Misc constants.  Note that allocations that are exact multiples of 
177  * PAGE_SIZE, or exceed the zone limit, fall through to the kmem module.
178  * IN_SAME_PAGE_MASK is used to sanity-check the per-page free lists.
179  */
180 #define MIN_CHUNK_SIZE          8               /* in bytes */
181 #define MIN_CHUNK_MASK          (MIN_CHUNK_SIZE - 1)
182 #define ZONE_RELS_THRESH        2               /* threshold number of zones */
183 #define IN_SAME_PAGE_MASK       (~(intptr_t)PAGE_MASK | MIN_CHUNK_MASK)
184
185 /*
186  * The WEIRD_ADDR is used as known text to copy into free objects to
187  * try to create deterministic failure cases if the data is accessed after
188  * free.
189  */    
190 #define WEIRD_ADDR      0xdeadc0de
191 #define MAX_COPY        sizeof(weirdary)
192 #define ZERO_LENGTH_PTR ((void *)-8)
193
194 /*
195  * Misc global malloc buckets
196  */
197
198 MALLOC_DEFINE(M_CACHE, "cache", "Various Dynamically allocated caches");
199 MALLOC_DEFINE(M_DEVBUF, "devbuf", "device driver memory");
200 MALLOC_DEFINE(M_TEMP, "temp", "misc temporary data buffers");
201  
202 MALLOC_DEFINE(M_IP6OPT, "ip6opt", "IPv6 options");
203 MALLOC_DEFINE(M_IP6NDP, "ip6ndp", "IPv6 Neighbor Discovery");
204
205 /*
206  * Initialize the slab memory allocator.  We have to choose a zone size based
207  * on available physical memory.  We choose a zone side which is approximately
208  * 1/1024th of our memory, so if we have 128MB of ram we have a zone size of
209  * 128K.  The zone size is limited to the bounds set in slaballoc.h
210  * (typically 32K min, 128K max). 
211  */
212 static void kmeminit(void *dummy);
213
214 char *ZeroPage;
215
216 SYSINIT(kmem, SI_BOOT1_ALLOCATOR, SI_ORDER_FIRST, kmeminit, NULL)
217
218 #ifdef INVARIANTS
219 /*
220  * If enabled any memory allocated without M_ZERO is initialized to -1.
221  */
222 static int  use_malloc_pattern;
223 SYSCTL_INT(_debug, OID_AUTO, use_malloc_pattern, CTLFLAG_RW,
224                 &use_malloc_pattern, 0, "");
225 #endif
226
227 SYSCTL_INT(_kern, OID_AUTO, zone_big_alloc, CTLFLAG_RD, &ZoneBigAlloc, 0, "");
228 SYSCTL_INT(_kern, OID_AUTO, zone_gen_alloc, CTLFLAG_RD, &ZoneGenAlloc, 0, "");
229
230 static void
231 kmeminit(void *dummy)
232 {
233     size_t limsize;
234     int usesize;
235     int i;
236     vm_offset_t npg;
237
238     limsize = (size_t)vmstats.v_page_count * PAGE_SIZE;
239     if (limsize > KvaSize)
240         limsize = KvaSize;
241
242     usesize = (int)(limsize / 1024);    /* convert to KB */
243
244     ZoneSize = ZALLOC_MIN_ZONE_SIZE;
245     while (ZoneSize < ZALLOC_MAX_ZONE_SIZE && (ZoneSize << 1) < usesize)
246         ZoneSize <<= 1;
247     ZoneLimit = ZoneSize / 4;
248     if (ZoneLimit > ZALLOC_ZONE_LIMIT)
249         ZoneLimit = ZALLOC_ZONE_LIMIT;
250     ZoneMask = ~(uintptr_t)(ZoneSize - 1);
251     ZonePageCount = ZoneSize / PAGE_SIZE;
252
253     npg = KvaSize / PAGE_SIZE;
254     kmemusage = kmem_slab_alloc(npg * sizeof(struct kmemusage), 
255                                 PAGE_SIZE, M_WAITOK|M_ZERO);
256
257     for (i = 0; i < arysize(weirdary); ++i)
258         weirdary[i] = WEIRD_ADDR;
259
260     ZeroPage = kmem_slab_alloc(PAGE_SIZE, PAGE_SIZE, M_WAITOK|M_ZERO);
261
262     if (bootverbose)
263         kprintf("Slab ZoneSize set to %dKB\n", ZoneSize / 1024);
264 }
265
266 /*
267  * Initialize a malloc type tracking structure.
268  */
269 void
270 malloc_init(void *data)
271 {
272     struct malloc_type *type = data;
273     size_t limsize;
274
275     if (type->ks_magic != M_MAGIC)
276         panic("malloc type lacks magic");
277                                            
278     if (type->ks_limit != 0)
279         return;
280
281     if (vmstats.v_page_count == 0)
282         panic("malloc_init not allowed before vm init");
283
284     limsize = (size_t)vmstats.v_page_count * PAGE_SIZE;
285     if (limsize > KvaSize)
286         limsize = KvaSize;
287     type->ks_limit = limsize / 10;
288
289     type->ks_next = kmemstatistics;
290     kmemstatistics = type;
291 }
292
293 void
294 malloc_uninit(void *data)
295 {
296     struct malloc_type *type = data;
297     struct malloc_type *t;
298 #ifdef INVARIANTS
299     int i;
300     long ttl;
301 #endif
302
303     if (type->ks_magic != M_MAGIC)
304         panic("malloc type lacks magic");
305
306     if (vmstats.v_page_count == 0)
307         panic("malloc_uninit not allowed before vm init");
308
309     if (type->ks_limit == 0)
310         panic("malloc_uninit on uninitialized type");
311
312 #ifdef SMP
313     /* Make sure that all pending kfree()s are finished. */
314     lwkt_synchronize_ipiqs("muninit");
315 #endif
316
317 #ifdef INVARIANTS
318     /*
319      * memuse is only correct in aggregation.  Due to memory being allocated
320      * on one cpu and freed on another individual array entries may be 
321      * negative or positive (canceling each other out).
322      */
323     for (i = ttl = 0; i < ncpus; ++i)
324         ttl += type->ks_memuse[i];
325     if (ttl) {
326         kprintf("malloc_uninit: %ld bytes of '%s' still allocated on cpu %d\n",
327             ttl, type->ks_shortdesc, i);
328     }
329 #endif
330     if (type == kmemstatistics) {
331         kmemstatistics = type->ks_next;
332     } else {
333         for (t = kmemstatistics; t->ks_next != NULL; t = t->ks_next) {
334             if (t->ks_next == type) {
335                 t->ks_next = type->ks_next;
336                 break;
337             }
338         }
339     }
340     type->ks_next = NULL;
341     type->ks_limit = 0;
342 }
343
344 /*
345  * Increase the kmalloc pool limit for the specified pool.  No changes
346  * are the made if the pool would shrink.
347  */
348 void
349 kmalloc_raise_limit(struct malloc_type *type, size_t bytes)
350 {
351     if (type->ks_limit == 0)
352         malloc_init(type);
353     if (bytes == 0)
354         bytes = KvaSize;
355     if (type->ks_limit < bytes)
356         type->ks_limit = bytes;
357 }
358
359 /*
360  * Dynamically create a malloc pool.  This function is a NOP if *typep is
361  * already non-NULL.
362  */
363 void
364 kmalloc_create(struct malloc_type **typep, const char *descr)
365 {
366         struct malloc_type *type;
367
368         if (*typep == NULL) {
369                 type = kmalloc(sizeof(*type), M_TEMP, M_WAITOK | M_ZERO);
370                 type->ks_magic = M_MAGIC;
371                 type->ks_shortdesc = descr;
372                 malloc_init(type);
373                 *typep = type;
374         }
375 }
376
377 /*
378  * Destroy a dynamically created malloc pool.  This function is a NOP if
379  * the pool has already been destroyed.
380  */
381 void
382 kmalloc_destroy(struct malloc_type **typep)
383 {
384         if (*typep != NULL) {
385                 malloc_uninit(*typep);
386                 kfree(*typep, M_TEMP);
387                 *typep = NULL;
388         }
389 }
390
391 /*
392  * Calculate the zone index for the allocation request size and set the
393  * allocation request size to that particular zone's chunk size.
394  */
395 static __inline int
396 zoneindex(unsigned long *bytes)
397 {
398     unsigned int n = (unsigned int)*bytes;      /* unsigned for shift opt */
399     if (n < 128) {
400         *bytes = n = (n + 7) & ~7;
401         return(n / 8 - 1);              /* 8 byte chunks, 16 zones */
402     }
403     if (n < 256) {
404         *bytes = n = (n + 15) & ~15;
405         return(n / 16 + 7);
406     }
407     if (n < 8192) {
408         if (n < 512) {
409             *bytes = n = (n + 31) & ~31;
410             return(n / 32 + 15);
411         }
412         if (n < 1024) {
413             *bytes = n = (n + 63) & ~63;
414             return(n / 64 + 23);
415         } 
416         if (n < 2048) {
417             *bytes = n = (n + 127) & ~127;
418             return(n / 128 + 31);
419         }
420         if (n < 4096) {
421             *bytes = n = (n + 255) & ~255;
422             return(n / 256 + 39);
423         }
424         *bytes = n = (n + 511) & ~511;
425         return(n / 512 + 47);
426     }
427 #if ZALLOC_ZONE_LIMIT > 8192
428     if (n < 16384) {
429         *bytes = n = (n + 1023) & ~1023;
430         return(n / 1024 + 55);
431     }
432 #endif
433 #if ZALLOC_ZONE_LIMIT > 16384
434     if (n < 32768) {
435         *bytes = n = (n + 2047) & ~2047;
436         return(n / 2048 + 63);
437     }
438 #endif
439     panic("Unexpected byte count %d", n);
440     return(0);
441 }
442
443 /*
444  * kmalloc()    (SLAB ALLOCATOR)
445  *
446  *      Allocate memory via the slab allocator.  If the request is too large,
447  *      or if it page-aligned beyond a certain size, we fall back to the
448  *      KMEM subsystem.  A SLAB tracking descriptor must be specified, use
449  *      &SlabMisc if you don't care.
450  *
451  *      M_RNOWAIT       - don't block.
452  *      M_NULLOK        - return NULL instead of blocking.
453  *      M_ZERO          - zero the returned memory.
454  *      M_USE_RESERVE   - allow greater drawdown of the free list
455  *      M_USE_INTERRUPT_RESERVE - allow the freelist to be exhausted
456  *
457  * MPSAFE
458  */
459 void *
460 kmalloc(unsigned long size, struct malloc_type *type, int flags)
461 {
462     SLZone *z;
463     SLChunk *chunk;
464 #ifdef SMP
465     SLChunk *bchunk;
466 #endif
467     SLGlobalData *slgd;
468     struct globaldata *gd;
469     int zi;
470 #ifdef INVARIANTS
471     int i;
472 #endif
473
474     logmemory_quick(malloc_beg);
475     gd = mycpu;
476     slgd = &gd->gd_slab;
477
478     /*
479      * XXX silly to have this in the critical path.
480      */
481     if (type->ks_limit == 0) {
482         crit_enter();
483         if (type->ks_limit == 0)
484             malloc_init(type);
485         crit_exit();
486     }
487     ++type->ks_calls;
488
489     /*
490      * Handle the case where the limit is reached.  Panic if we can't return
491      * NULL.  The original malloc code looped, but this tended to
492      * simply deadlock the computer.
493      *
494      * ks_loosememuse is an up-only limit that is NOT MP-synchronized, used
495      * to determine if a more complete limit check should be done.  The
496      * actual memory use is tracked via ks_memuse[cpu].
497      */
498     while (type->ks_loosememuse >= type->ks_limit) {
499         int i;
500         long ttl;
501
502         for (i = ttl = 0; i < ncpus; ++i)
503             ttl += type->ks_memuse[i];
504         type->ks_loosememuse = ttl;     /* not MP synchronized */
505         if (ttl >= type->ks_limit) {
506             if (flags & M_NULLOK) {
507                 logmemory(malloc_end, NULL, type, size, flags);
508                 return(NULL);
509             }
510             panic("%s: malloc limit exceeded", type->ks_shortdesc);
511         }
512     }
513
514     /*
515      * Handle the degenerate size == 0 case.  Yes, this does happen.
516      * Return a special pointer.  This is to maintain compatibility with
517      * the original malloc implementation.  Certain devices, such as the
518      * adaptec driver, not only allocate 0 bytes, they check for NULL and
519      * also realloc() later on.  Joy.
520      */
521     if (size == 0) {
522         logmemory(malloc_end, ZERO_LENGTH_PTR, type, size, flags);
523         return(ZERO_LENGTH_PTR);
524     }
525
526     /*
527      * Handle hysteresis from prior frees here in malloc().  We cannot
528      * safely manipulate the kernel_map in free() due to free() possibly
529      * being called via an IPI message or from sensitive interrupt code.
530      *
531      * NOTE: ku_pagecnt must be cleared before we free the slab or we
532      *       might race another cpu allocating the kva and setting
533      *       ku_pagecnt.
534      */
535     while (slgd->NFreeZones > ZONE_RELS_THRESH && (flags & M_RNOWAIT) == 0) {
536         crit_enter();
537         if (slgd->NFreeZones > ZONE_RELS_THRESH) {      /* crit sect race */
538             struct kmemusage *kup;
539
540             z = slgd->FreeZones;
541             slgd->FreeZones = z->z_Next;
542             --slgd->NFreeZones;
543             kup = btokup(z);
544             kup->ku_pagecnt = 0;
545             kmem_slab_free(z, ZoneSize);        /* may block */
546             atomic_add_int(&ZoneGenAlloc, -(int)ZoneSize / 1024);
547         }
548         crit_exit();
549     }
550
551     /*
552      * XXX handle oversized frees that were queued from kfree().
553      */
554     while (slgd->FreeOvZones && (flags & M_RNOWAIT) == 0) {
555         crit_enter();
556         if ((z = slgd->FreeOvZones) != NULL) {
557             vm_size_t tsize;
558
559             KKASSERT(z->z_Magic == ZALLOC_OVSZ_MAGIC);
560             slgd->FreeOvZones = z->z_Next;
561             tsize = z->z_ChunkSize;
562             kmem_slab_free(z, tsize);   /* may block */
563             atomic_add_int(&ZoneBigAlloc, -(int)tsize / 1024);
564         }
565         crit_exit();
566     }
567
568     /*
569      * Handle large allocations directly.  There should not be very many of
570      * these so performance is not a big issue.
571      *
572      * The backend allocator is pretty nasty on a SMP system.   Use the
573      * slab allocator for one and two page-sized chunks even though we lose
574      * some efficiency.  XXX maybe fix mmio and the elf loader instead.
575      */
576     if (size >= ZoneLimit || ((size & PAGE_MASK) == 0 && size > PAGE_SIZE*2)) {
577         struct kmemusage *kup;
578
579         size = round_page(size);
580         chunk = kmem_slab_alloc(size, PAGE_SIZE, flags);
581         if (chunk == NULL) {
582             logmemory(malloc_end, NULL, type, size, flags);
583             return(NULL);
584         }
585         atomic_add_int(&ZoneBigAlloc, (int)size / 1024);
586         flags &= ~M_ZERO;       /* result already zero'd if M_ZERO was set */
587         flags |= M_PASSIVE_ZERO;
588         kup = btokup(chunk);
589         kup->ku_pagecnt = size / PAGE_SIZE;
590         crit_enter();
591         goto done;
592     }
593
594     /*
595      * Attempt to allocate out of an existing zone.  First try the free list,
596      * then allocate out of unallocated space.  If we find a good zone move
597      * it to the head of the list so later allocations find it quickly
598      * (we might have thousands of zones in the list).
599      *
600      * Note: zoneindex() will panic of size is too large.
601      */
602     zi = zoneindex(&size);
603     KKASSERT(zi < NZONES);
604     crit_enter();
605
606     if ((z = slgd->ZoneAry[zi]) != NULL) {
607         /*
608          * Locate a chunk - we have to have at least one.  If this is the
609          * last chunk go ahead and do the work to retrieve chunks freed
610          * from remote cpus, and if the zone is still empty move it off
611          * the ZoneAry.
612          */
613         if (--z->z_NFree <= 0) {
614             KKASSERT(z->z_NFree == 0);
615
616 #ifdef SMP
617             /*
618              * WARNING! This code competes with other cpus.  It is ok
619              * for us to not drain RChunks here but we might as well, and
620              * it is ok if more accumulate after we're done.
621              *
622              * Set RSignal before pulling rchunks off, indicating that we
623              * will be moving ourselves off of the ZoneAry.  Remote ends will
624              * read RSignal before putting rchunks on thus interlocking
625              * their IPI signaling.
626              */
627             if (z->z_RChunks == NULL)
628                 atomic_swap_int(&z->z_RSignal, 1);
629
630             while ((bchunk = z->z_RChunks) != NULL) {
631                 cpu_ccfence();
632                 if (atomic_cmpset_ptr(&z->z_RChunks, bchunk, NULL)) {
633                     *z->z_LChunksp = bchunk;
634                     while (bchunk) {
635                         chunk_mark_free(z, bchunk);
636                         z->z_LChunksp = &bchunk->c_Next;
637                         bchunk = bchunk->c_Next;
638                         ++z->z_NFree;
639                     }
640                     break;
641                 }
642             }
643 #endif
644             /*
645              * Remove from the zone list if no free chunks remain.
646              * Clear RSignal
647              */
648             if (z->z_NFree == 0) {
649                 slgd->ZoneAry[zi] = z->z_Next;
650                 z->z_Next = NULL;
651             } else {
652                 z->z_RSignal = 0;
653             }
654         }
655
656         /*
657          * Fast path, we have chunks available in z_LChunks.
658          */
659         chunk = z->z_LChunks;
660         if (chunk) {
661                 chunk_mark_allocated(z, chunk);
662                 z->z_LChunks = chunk->c_Next;
663                 if (z->z_LChunks == NULL)
664                         z->z_LChunksp = &z->z_LChunks;
665                 goto done;
666         }
667
668         /*
669          * No chunks are available in LChunks, the free chunk MUST be
670          * in the never-before-used memory area, controlled by UIndex.
671          *
672          * The consequences are very serious if our zone got corrupted so
673          * we use an explicit panic rather than a KASSERT.
674          */
675         if (z->z_UIndex + 1 != z->z_NMax)
676             ++z->z_UIndex;
677         else
678             z->z_UIndex = 0;
679
680         if (z->z_UIndex == z->z_UEndIndex)
681             panic("slaballoc: corrupted zone");
682
683         chunk = (SLChunk *)(z->z_BasePtr + z->z_UIndex * size);
684         if ((z->z_Flags & SLZF_UNOTZEROD) == 0) {
685             flags &= ~M_ZERO;
686             flags |= M_PASSIVE_ZERO;
687         }
688         chunk_mark_allocated(z, chunk);
689         goto done;
690     }
691
692     /*
693      * If all zones are exhausted we need to allocate a new zone for this
694      * index.  Use M_ZERO to take advantage of pre-zerod pages.  Also see
695      * UAlloc use above in regards to M_ZERO.  Note that when we are reusing
696      * a zone from the FreeZones list UAlloc'd data will not be zero'd, and
697      * we do not pre-zero it because we do not want to mess up the L1 cache.
698      *
699      * At least one subsystem, the tty code (see CROUND) expects power-of-2
700      * allocations to be power-of-2 aligned.  We maintain compatibility by
701      * adjusting the base offset below.
702      */
703     {
704         int off;
705         struct kmemusage *kup;
706
707         if ((z = slgd->FreeZones) != NULL) {
708             slgd->FreeZones = z->z_Next;
709             --slgd->NFreeZones;
710             bzero(z, sizeof(SLZone));
711             z->z_Flags |= SLZF_UNOTZEROD;
712         } else {
713             z = kmem_slab_alloc(ZoneSize, ZoneSize, flags|M_ZERO);
714             if (z == NULL)
715                 goto fail;
716             atomic_add_int(&ZoneGenAlloc, (int)ZoneSize / 1024);
717         }
718
719         /*
720          * How big is the base structure?
721          */
722 #if defined(INVARIANTS)
723         /*
724          * Make room for z_Bitmap.  An exact calculation is somewhat more
725          * complicated so don't make an exact calculation.
726          */
727         off = offsetof(SLZone, z_Bitmap[(ZoneSize / size + 31) / 32]);
728         bzero(z->z_Bitmap, (ZoneSize / size + 31) / 8);
729 #else
730         off = sizeof(SLZone);
731 #endif
732
733         /*
734          * Guarentee power-of-2 alignment for power-of-2-sized chunks.
735          * Otherwise just 8-byte align the data.
736          */
737         if ((size | (size - 1)) + 1 == (size << 1))
738             off = (off + size - 1) & ~(size - 1);
739         else
740             off = (off + MIN_CHUNK_MASK) & ~MIN_CHUNK_MASK;
741         z->z_Magic = ZALLOC_SLAB_MAGIC;
742         z->z_ZoneIndex = zi;
743         z->z_NMax = (ZoneSize - off) / size;
744         z->z_NFree = z->z_NMax - 1;
745         z->z_BasePtr = (char *)z + off;
746         z->z_UIndex = z->z_UEndIndex = slgd->JunkIndex % z->z_NMax;
747         z->z_ChunkSize = size;
748         z->z_CpuGd = gd;
749         z->z_Cpu = gd->gd_cpuid;
750         z->z_LChunksp = &z->z_LChunks;
751         chunk = (SLChunk *)(z->z_BasePtr + z->z_UIndex * size);
752         z->z_Next = slgd->ZoneAry[zi];
753         slgd->ZoneAry[zi] = z;
754         if ((z->z_Flags & SLZF_UNOTZEROD) == 0) {
755             flags &= ~M_ZERO;   /* already zero'd */
756             flags |= M_PASSIVE_ZERO;
757         }
758         kup = btokup(z);
759         kup->ku_pagecnt = -(z->z_Cpu + 1);      /* -1 to -(N+1) */
760         chunk_mark_allocated(z, chunk);
761
762         /*
763          * Slide the base index for initial allocations out of the next
764          * zone we create so we do not over-weight the lower part of the
765          * cpu memory caches.
766          */
767         slgd->JunkIndex = (slgd->JunkIndex + ZALLOC_SLAB_SLIDE)
768                                 & (ZALLOC_MAX_ZONE_SIZE - 1);
769     }
770
771 done:
772     ++type->ks_inuse[gd->gd_cpuid];
773     type->ks_memuse[gd->gd_cpuid] += size;
774     type->ks_loosememuse += size;       /* not MP synchronized */
775     crit_exit();
776
777     if (flags & M_ZERO)
778         bzero(chunk, size);
779 #ifdef INVARIANTS
780     else if ((flags & (M_ZERO|M_PASSIVE_ZERO)) == 0) {
781         if (use_malloc_pattern) {
782             for (i = 0; i < size; i += sizeof(int)) {
783                 *(int *)((char *)chunk + i) = -1;
784             }
785         }
786         chunk->c_Next = (void *)-1; /* avoid accidental double-free check */
787     }
788 #endif
789     logmemory(malloc_end, chunk, type, size, flags);
790     return(chunk);
791 fail:
792     crit_exit();
793     logmemory(malloc_end, NULL, type, size, flags);
794     return(NULL);
795 }
796
797 /*
798  * kernel realloc.  (SLAB ALLOCATOR) (MP SAFE)
799  *
800  * Generally speaking this routine is not called very often and we do
801  * not attempt to optimize it beyond reusing the same pointer if the
802  * new size fits within the chunking of the old pointer's zone.
803  */
804 void *
805 krealloc(void *ptr, unsigned long size, struct malloc_type *type, int flags)
806 {
807     struct kmemusage *kup;
808     SLZone *z;
809     void *nptr;
810     unsigned long osize;
811
812     KKASSERT((flags & M_ZERO) == 0);    /* not supported */
813
814     if (ptr == NULL || ptr == ZERO_LENGTH_PTR)
815         return(kmalloc(size, type, flags));
816     if (size == 0) {
817         kfree(ptr, type);
818         return(NULL);
819     }
820
821     /*
822      * Handle oversized allocations.  XXX we really should require that a
823      * size be passed to free() instead of this nonsense.
824      */
825     kup = btokup(ptr);
826     if (kup->ku_pagecnt > 0) {
827         osize = kup->ku_pagecnt << PAGE_SHIFT;
828         if (osize == round_page(size))
829             return(ptr);
830         if ((nptr = kmalloc(size, type, flags)) == NULL)
831             return(NULL);
832         bcopy(ptr, nptr, min(size, osize));
833         kfree(ptr, type);
834         return(nptr);
835     }
836
837     /*
838      * Get the original allocation's zone.  If the new request winds up
839      * using the same chunk size we do not have to do anything.
840      */
841     z = (SLZone *)((uintptr_t)ptr & ZoneMask);
842     kup = btokup(z);
843     KKASSERT(kup->ku_pagecnt < 0);
844     KKASSERT(z->z_Magic == ZALLOC_SLAB_MAGIC);
845
846     /*
847      * Allocate memory for the new request size.  Note that zoneindex has
848      * already adjusted the request size to the appropriate chunk size, which
849      * should optimize our bcopy().  Then copy and return the new pointer.
850      *
851      * Resizing a non-power-of-2 allocation to a power-of-2 size does not
852      * necessary align the result.
853      *
854      * We can only zoneindex (to align size to the chunk size) if the new
855      * size is not too large.
856      */
857     if (size < ZoneLimit) {
858         zoneindex(&size);
859         if (z->z_ChunkSize == size)
860             return(ptr);
861     }
862     if ((nptr = kmalloc(size, type, flags)) == NULL)
863         return(NULL);
864     bcopy(ptr, nptr, min(size, z->z_ChunkSize));
865     kfree(ptr, type);
866     return(nptr);
867 }
868
869 /*
870  * Return the kmalloc limit for this type, in bytes.
871  */
872 long
873 kmalloc_limit(struct malloc_type *type)
874 {
875     if (type->ks_limit == 0) {
876         crit_enter();
877         if (type->ks_limit == 0)
878             malloc_init(type);
879         crit_exit();
880     }
881     return(type->ks_limit);
882 }
883
884 /*
885  * Allocate a copy of the specified string.
886  *
887  * (MP SAFE) (MAY BLOCK)
888  */
889 char *
890 kstrdup(const char *str, struct malloc_type *type)
891 {
892     int zlen;   /* length inclusive of terminating NUL */
893     char *nstr;
894
895     if (str == NULL)
896         return(NULL);
897     zlen = strlen(str) + 1;
898     nstr = kmalloc(zlen, type, M_WAITOK);
899     bcopy(str, nstr, zlen);
900     return(nstr);
901 }
902
903 #ifdef SMP
904 /*
905  * Notify our cpu that a remote cpu has freed some chunks in a zone that
906  * we own.  Due to MP races we might no longer own the zone, use the
907  * kmemusage array to check.
908  */
909 static
910 void
911 kfree_remote(void *ptr)
912 {
913     struct kmemusage *kup;
914     SLGlobalData *slgd;
915     SLChunk *bchunk;
916     SLZone *z;
917     int nfree;
918
919     /*
920      * Do not dereference (z) until we validate that its storage is
921      * still around.
922      */
923     slgd = &mycpu->gd_slab;
924     z = ptr;
925     kup = btokup(z);
926
927     if (kup->ku_pagecnt == -((int)mycpuid + 1)) {       /* -1 to -(N+1) */
928         logmemory(free_rem_beg, z, NULL, 0, 0);
929         KKASSERT(z->z_Magic == ZALLOC_SLAB_MAGIC);
930         KKASSERT(z->z_Cpu  == mycpu->gd_cpuid);
931         nfree = z->z_NFree;
932
933         /*
934          * Indicate that we will no longer be off of the ZoneAry by
935          * clearing RSignal.
936          */
937         if (z->z_RChunks)
938             z->z_RSignal = 0;
939
940         /*
941          * Atomically extract the bchunks list and then process it back
942          * into the lchunks list.  We want to append our bchunks to the
943          * lchunks list and not prepend since we likely do not have
944          * cache mastership of the related data (not that it helps since
945          * we are using c_Next).
946          */
947         while ((bchunk = z->z_RChunks) != NULL) {
948             cpu_ccfence();
949             if (atomic_cmpset_ptr(&z->z_RChunks, bchunk, NULL)) {
950                 *z->z_LChunksp = bchunk;
951                 while (bchunk) {
952                         chunk_mark_free(z, bchunk);
953                         z->z_LChunksp = &bchunk->c_Next;
954                         bchunk = bchunk->c_Next;
955                         ++z->z_NFree;
956                 }
957                 break;
958             }
959         }
960         if (z->z_NFree && nfree == 0) {
961             z->z_Next = slgd->ZoneAry[z->z_ZoneIndex];
962             slgd->ZoneAry[z->z_ZoneIndex] = z;
963         }
964
965         /*
966          * If the zone becomes totally free, and there are other zones we
967          * can allocate from, move this zone to the FreeZones list.  Since
968          * this code can be called from an IPI callback, do *NOT* try to mess
969          * with kernel_map here.  Hysteresis will be performed at malloc() time.
970          */
971         if (z->z_NFree == z->z_NMax &&
972             (z->z_Next || slgd->ZoneAry[z->z_ZoneIndex] != z)
973         ) {
974             struct kmemusage *kup;
975             SLZone **pz;
976
977             for (pz = &slgd->ZoneAry[z->z_ZoneIndex];
978                  z != *pz;
979                  pz = &(*pz)->z_Next) {
980                 ;
981             }
982             *pz = z->z_Next;
983             z->z_Magic = -1;
984             z->z_Next = slgd->FreeZones;
985             slgd->FreeZones = z;
986             ++slgd->NFreeZones;
987             kup = btokup(z);
988             kup->ku_pagecnt = 0;
989         }
990         logmemory(free_rem_end, z, bchunk, 0, 0);
991     }
992 }
993
994 #endif
995
996 /*
997  * free (SLAB ALLOCATOR)
998  *
999  * Free a memory block previously allocated by malloc.  Note that we do not
1000  * attempt to update ks_loosememuse as MP races could prevent us from
1001  * checking memory limits in malloc.
1002  *
1003  * MPSAFE
1004  */
1005 void
1006 kfree(void *ptr, struct malloc_type *type)
1007 {
1008     SLZone *z;
1009     SLChunk *chunk;
1010     SLGlobalData *slgd;
1011     struct globaldata *gd;
1012     struct kmemusage *kup;
1013     unsigned long size;
1014 #ifdef SMP
1015     SLChunk *bchunk;
1016     int rsignal;
1017 #endif
1018
1019     logmemory_quick(free_beg);
1020     gd = mycpu;
1021     slgd = &gd->gd_slab;
1022
1023     if (ptr == NULL)
1024         panic("trying to free NULL pointer");
1025
1026     /*
1027      * Handle special 0-byte allocations
1028      */
1029     if (ptr == ZERO_LENGTH_PTR) {
1030         logmemory(free_zero, ptr, type, -1, 0);
1031         logmemory_quick(free_end);
1032         return;
1033     }
1034
1035     /*
1036      * Panic on bad malloc type
1037      */
1038     if (type->ks_magic != M_MAGIC)
1039         panic("free: malloc type lacks magic");
1040
1041     /*
1042      * Handle oversized allocations.  XXX we really should require that a
1043      * size be passed to free() instead of this nonsense.
1044      *
1045      * This code is never called via an ipi.
1046      */
1047     kup = btokup(ptr);
1048     if (kup->ku_pagecnt > 0) {
1049         size = kup->ku_pagecnt << PAGE_SHIFT;
1050         kup->ku_pagecnt = 0;
1051 #ifdef INVARIANTS
1052         KKASSERT(sizeof(weirdary) <= size);
1053         bcopy(weirdary, ptr, sizeof(weirdary));
1054 #endif
1055         /*
1056          * NOTE: For oversized allocations we do not record the
1057          *           originating cpu.  It gets freed on the cpu calling
1058          *           kfree().  The statistics are in aggregate.
1059          *
1060          * note: XXX we have still inherited the interrupts-can't-block
1061          * assumption.  An interrupt thread does not bump
1062          * gd_intr_nesting_level so check TDF_INTTHREAD.  This is
1063          * primarily until we can fix softupdate's assumptions about free().
1064          */
1065         crit_enter();
1066         --type->ks_inuse[gd->gd_cpuid];
1067         type->ks_memuse[gd->gd_cpuid] -= size;
1068         if (mycpu->gd_intr_nesting_level ||
1069             (gd->gd_curthread->td_flags & TDF_INTTHREAD))
1070         {
1071             logmemory(free_ovsz_delayed, ptr, type, size, 0);
1072             z = (SLZone *)ptr;
1073             z->z_Magic = ZALLOC_OVSZ_MAGIC;
1074             z->z_Next = slgd->FreeOvZones;
1075             z->z_ChunkSize = size;
1076             slgd->FreeOvZones = z;
1077             crit_exit();
1078         } else {
1079             crit_exit();
1080             logmemory(free_ovsz, ptr, type, size, 0);
1081             kmem_slab_free(ptr, size);  /* may block */
1082             atomic_add_int(&ZoneBigAlloc, -(int)size / 1024);
1083         }
1084         logmemory_quick(free_end);
1085         return;
1086     }
1087
1088     /*
1089      * Zone case.  Figure out the zone based on the fact that it is
1090      * ZoneSize aligned. 
1091      */
1092     z = (SLZone *)((uintptr_t)ptr & ZoneMask);
1093     kup = btokup(z);
1094     KKASSERT(kup->ku_pagecnt < 0);
1095     KKASSERT(z->z_Magic == ZALLOC_SLAB_MAGIC);
1096
1097     /*
1098      * If we do not own the zone then use atomic ops to free to the
1099      * remote cpu linked list and notify the target zone using a
1100      * passive message.
1101      *
1102      * The target zone cannot be deallocated while we own a chunk of it,
1103      * so the zone header's storage is stable until the very moment
1104      * we adjust z_RChunks.  After that we cannot safely dereference (z).
1105      *
1106      * (no critical section needed)
1107      */
1108     if (z->z_CpuGd != gd) {
1109 #ifdef SMP
1110         /*
1111          * Making these adjustments now allow us to avoid passing (type)
1112          * to the remote cpu.  Note that ks_inuse/ks_memuse is being
1113          * adjusted on a different cpu, but it should all still sum up
1114          * properly and cancel out.
1115          */
1116         --type->ks_inuse[z->z_Cpu];
1117         type->ks_memuse[z->z_Cpu] -= z->z_ChunkSize;
1118
1119         /*
1120          * WARNING! This code competes with other cpus.  Once we
1121          *          successfully link the chunk to RChunks the remote
1122          *          cpu can rip z's storage out from under us.
1123          */
1124         rsignal = z->z_RSignal;
1125         cpu_lfence();
1126
1127         chunk = ptr;
1128         for (;;) {
1129             bchunk = z->z_RChunks;
1130             cpu_ccfence();
1131             chunk->c_Next = bchunk;
1132             cpu_sfence();
1133
1134             if (atomic_cmpset_ptr(&z->z_RChunks, bchunk, chunk))
1135                 break;
1136         }
1137         /* z cannot be dereferenced now */
1138
1139         /*
1140          * We have to signal the remote cpu if our actions will cause
1141          * the remote zone to be placed back on ZoneAry so it can
1142          * move the zone back on.
1143          *
1144          * We only need to deal with NULL->non-NULL RChunk transitions
1145          * and only if z_RSignal is set.  We interlock by reading rsignal
1146          * before adding our chunk to RChunks.  This should result in
1147          * virtually no IPI traffic.
1148          *
1149          * We can use a passive IPI to reduce overhead even further.
1150          */
1151         if (bchunk == NULL && rsignal) {
1152             logmemory(free_request, ptr, type, z->z_ChunkSize, 0);
1153             lwkt_send_ipiq_passive(z->z_CpuGd, kfree_remote, z);
1154         }
1155 #else
1156         panic("Corrupt SLZone");
1157 #endif
1158         logmemory_quick(free_end);
1159         return;
1160     }
1161
1162     /*
1163      * kfree locally
1164      */
1165     logmemory(free_chunk, ptr, type, z->z_ChunkSize, 0);
1166
1167     crit_enter();
1168     chunk = ptr;
1169     chunk_mark_free(z, chunk);
1170
1171     /*
1172      * Put weird data into the memory to detect modifications after freeing,
1173      * illegal pointer use after freeing (we should fault on the odd address),
1174      * and so forth.  XXX needs more work, see the old malloc code.
1175      */
1176 #ifdef INVARIANTS
1177     if (z->z_ChunkSize < sizeof(weirdary))
1178         bcopy(weirdary, chunk, z->z_ChunkSize);
1179     else
1180         bcopy(weirdary, chunk, sizeof(weirdary));
1181 #endif
1182
1183     /*
1184      * Add this free non-zero'd chunk to a linked list for reuse.  Add
1185      * to the front of the linked list so it is more likely to be
1186      * reallocated, since it is already in our L1 cache.
1187      */
1188 #ifdef INVARIANTS
1189     if ((vm_offset_t)chunk < KvaStart || (vm_offset_t)chunk >= KvaEnd)
1190         panic("BADFREE %p", chunk);
1191 #endif
1192     chunk->c_Next = z->z_LChunks;
1193     z->z_LChunks = chunk;
1194     if (chunk->c_Next == NULL)
1195             z->z_LChunksp = &chunk->c_Next;
1196
1197 #ifdef INVARIANTS
1198     if (chunk->c_Next && (vm_offset_t)chunk->c_Next < KvaStart)
1199         panic("BADFREE2");
1200 #endif
1201
1202     /*
1203      * Bump the number of free chunks.  If it becomes non-zero the zone
1204      * must be added back onto the appropriate list.
1205      */
1206     if (z->z_NFree++ == 0) {
1207         z->z_Next = slgd->ZoneAry[z->z_ZoneIndex];
1208         slgd->ZoneAry[z->z_ZoneIndex] = z;
1209     }
1210
1211     --type->ks_inuse[z->z_Cpu];
1212     type->ks_memuse[z->z_Cpu] -= z->z_ChunkSize;
1213
1214     /*
1215      * If the zone becomes totally free, and there are other zones we
1216      * can allocate from, move this zone to the FreeZones list.  Since
1217      * this code can be called from an IPI callback, do *NOT* try to mess
1218      * with kernel_map here.  Hysteresis will be performed at malloc() time.
1219      */
1220     if (z->z_NFree == z->z_NMax && 
1221         (z->z_Next || slgd->ZoneAry[z->z_ZoneIndex] != z)
1222     ) {
1223         SLZone **pz;
1224         struct kmemusage *kup;
1225
1226         for (pz = &slgd->ZoneAry[z->z_ZoneIndex]; z != *pz; pz = &(*pz)->z_Next)
1227             ;
1228         *pz = z->z_Next;
1229         z->z_Magic = -1;
1230         z->z_Next = slgd->FreeZones;
1231         slgd->FreeZones = z;
1232         ++slgd->NFreeZones;
1233         kup = btokup(z);
1234         kup->ku_pagecnt = 0;
1235     }
1236     logmemory_quick(free_end);
1237     crit_exit();
1238 }
1239
1240 #if defined(INVARIANTS)
1241
1242 /*
1243  * Helper routines for sanity checks
1244  */
1245 static
1246 void
1247 chunk_mark_allocated(SLZone *z, void *chunk)
1248 {
1249     int bitdex = ((char *)chunk - (char *)z->z_BasePtr) / z->z_ChunkSize;
1250     __uint32_t *bitptr;
1251
1252     KKASSERT((((intptr_t)chunk ^ (intptr_t)z) & ZoneMask) == 0);
1253     KASSERT(bitdex >= 0 && bitdex < z->z_NMax,
1254             ("memory chunk %p bit index %d is illegal", chunk, bitdex));
1255     bitptr = &z->z_Bitmap[bitdex >> 5];
1256     bitdex &= 31;
1257     KASSERT((*bitptr & (1 << bitdex)) == 0,
1258             ("memory chunk %p is already allocated!", chunk));
1259     *bitptr |= 1 << bitdex;
1260 }
1261
1262 static
1263 void
1264 chunk_mark_free(SLZone *z, void *chunk)
1265 {
1266     int bitdex = ((char *)chunk - (char *)z->z_BasePtr) / z->z_ChunkSize;
1267     __uint32_t *bitptr;
1268
1269     KKASSERT((((intptr_t)chunk ^ (intptr_t)z) & ZoneMask) == 0);
1270     KASSERT(bitdex >= 0 && bitdex < z->z_NMax,
1271             ("memory chunk %p bit index %d is illegal!", chunk, bitdex));
1272     bitptr = &z->z_Bitmap[bitdex >> 5];
1273     bitdex &= 31;
1274     KASSERT((*bitptr & (1 << bitdex)) != 0,
1275             ("memory chunk %p is already free!", chunk));
1276     *bitptr &= ~(1 << bitdex);
1277 }
1278
1279 #endif
1280
1281 /*
1282  * kmem_slab_alloc()
1283  *
1284  *      Directly allocate and wire kernel memory in PAGE_SIZE chunks with the
1285  *      specified alignment.  M_* flags are expected in the flags field.
1286  *
1287  *      Alignment must be a multiple of PAGE_SIZE.
1288  *
1289  *      NOTE! XXX For the moment we use vm_map_entry_reserve/release(),
1290  *      but when we move zalloc() over to use this function as its backend
1291  *      we will have to switch to kreserve/krelease and call reserve(0)
1292  *      after the new space is made available.
1293  *
1294  *      Interrupt code which has preempted other code is not allowed to
1295  *      use PQ_CACHE pages.  However, if an interrupt thread is run
1296  *      non-preemptively or blocks and then runs non-preemptively, then
1297  *      it is free to use PQ_CACHE pages.
1298  */
1299 static void *
1300 kmem_slab_alloc(vm_size_t size, vm_offset_t align, int flags)
1301 {
1302     vm_size_t i;
1303     vm_offset_t addr;
1304     int count, vmflags, base_vmflags;
1305     thread_t td;
1306
1307     size = round_page(size);
1308     addr = vm_map_min(&kernel_map);
1309
1310     /*
1311      * Reserve properly aligned space from kernel_map.  RNOWAIT allocations
1312      * cannot block.
1313      */
1314     if (flags & M_RNOWAIT) {
1315         if (lwkt_trytoken(&vm_token) == 0)
1316             return(NULL);
1317     } else {
1318         lwkt_gettoken(&vm_token);
1319     }
1320     count = vm_map_entry_reserve(MAP_RESERVE_COUNT);
1321     crit_enter();
1322     vm_map_lock(&kernel_map);
1323     if (vm_map_findspace(&kernel_map, addr, size, align, 0, &addr)) {
1324         vm_map_unlock(&kernel_map);
1325         if ((flags & M_NULLOK) == 0)
1326             panic("kmem_slab_alloc(): kernel_map ran out of space!");
1327         vm_map_entry_release(count);
1328         crit_exit();
1329         lwkt_reltoken(&vm_token);
1330         return(NULL);
1331     }
1332
1333     /*
1334      * kernel_object maps 1:1 to kernel_map.
1335      */
1336     vm_object_reference(&kernel_object);
1337     vm_map_insert(&kernel_map, &count, 
1338                     &kernel_object, addr, addr, addr + size,
1339                     VM_MAPTYPE_NORMAL,
1340                     VM_PROT_ALL, VM_PROT_ALL,
1341                     0);
1342
1343     td = curthread;
1344
1345     base_vmflags = 0;
1346     if (flags & M_ZERO)
1347         base_vmflags |= VM_ALLOC_ZERO;
1348     if (flags & M_USE_RESERVE)
1349         base_vmflags |= VM_ALLOC_SYSTEM;
1350     if (flags & M_USE_INTERRUPT_RESERVE)
1351         base_vmflags |= VM_ALLOC_INTERRUPT;
1352     if ((flags & (M_RNOWAIT|M_WAITOK)) == 0) {
1353         panic("kmem_slab_alloc: bad flags %08x (%p)",
1354               flags, ((int **)&size)[-1]);
1355     }
1356
1357
1358     /*
1359      * Allocate the pages.  Do not mess with the PG_ZERO flag yet.
1360      */
1361     for (i = 0; i < size; i += PAGE_SIZE) {
1362         vm_page_t m;
1363
1364         /*
1365          * VM_ALLOC_NORMAL can only be set if we are not preempting.
1366          *
1367          * VM_ALLOC_SYSTEM is automatically set if we are preempting and
1368          * M_WAITOK was specified as an alternative (i.e. M_USE_RESERVE is
1369          * implied in this case), though I'm not sure if we really need to
1370          * do that.
1371          */
1372         vmflags = base_vmflags;
1373         if (flags & M_WAITOK) {
1374             if (td->td_preempted)
1375                 vmflags |= VM_ALLOC_SYSTEM;
1376             else
1377                 vmflags |= VM_ALLOC_NORMAL;
1378         }
1379
1380         m = vm_page_alloc(&kernel_object, OFF_TO_IDX(addr + i), vmflags);
1381
1382         /*
1383          * If the allocation failed we either return NULL or we retry.
1384          *
1385          * If M_WAITOK is specified we wait for more memory and retry.
1386          * If M_WAITOK is specified from a preemption we yield instead of
1387          * wait.  Livelock will not occur because the interrupt thread
1388          * will not be preempting anyone the second time around after the
1389          * yield.
1390          */
1391         if (m == NULL) {
1392             if (flags & M_WAITOK) {
1393                 if (td->td_preempted) {
1394                     vm_map_unlock(&kernel_map);
1395                     lwkt_switch();
1396                     vm_map_lock(&kernel_map);
1397                 } else {
1398                     vm_map_unlock(&kernel_map);
1399                     vm_wait(0);
1400                     vm_map_lock(&kernel_map);
1401                 }
1402                 i -= PAGE_SIZE; /* retry */
1403                 continue;
1404             }
1405
1406             /*
1407              * We were unable to recover, cleanup and return NULL
1408              *
1409              * (vm_token already held)
1410              */
1411             while (i != 0) {
1412                 i -= PAGE_SIZE;
1413                 m = vm_page_lookup(&kernel_object, OFF_TO_IDX(addr + i));
1414                 /* page should already be busy */
1415                 vm_page_free(m);
1416             }
1417             vm_map_delete(&kernel_map, addr, addr + size, &count);
1418             vm_map_unlock(&kernel_map);
1419             vm_map_entry_release(count);
1420             crit_exit();
1421             lwkt_reltoken(&vm_token);
1422             return(NULL);
1423         }
1424     }
1425
1426     /*
1427      * Success!
1428      *
1429      * Mark the map entry as non-pageable using a routine that allows us to
1430      * populate the underlying pages.
1431      *
1432      * The pages were busied by the allocations above.
1433      */
1434     vm_map_set_wired_quick(&kernel_map, addr, size, &count);
1435     crit_exit();
1436
1437     /*
1438      * Enter the pages into the pmap and deal with PG_ZERO and M_ZERO.
1439      */
1440     lwkt_gettoken(&vm_token);
1441     for (i = 0; i < size; i += PAGE_SIZE) {
1442         vm_page_t m;
1443
1444         m = vm_page_lookup(&kernel_object, OFF_TO_IDX(addr + i));
1445         m->valid = VM_PAGE_BITS_ALL;
1446         /* page should already be busy */
1447         vm_page_wire(m);
1448         vm_page_wakeup(m);
1449         pmap_enter(&kernel_pmap, addr + i, m, VM_PROT_ALL, 1);
1450         if ((m->flags & PG_ZERO) == 0 && (flags & M_ZERO))
1451             bzero((char *)addr + i, PAGE_SIZE);
1452         vm_page_flag_clear(m, PG_ZERO);
1453         KKASSERT(m->flags & (PG_WRITEABLE | PG_MAPPED));
1454         vm_page_flag_set(m, PG_REFERENCED);
1455     }
1456     lwkt_reltoken(&vm_token);
1457     vm_map_unlock(&kernel_map);
1458     vm_map_entry_release(count);
1459     lwkt_reltoken(&vm_token);
1460     return((void *)addr);
1461 }
1462
1463 /*
1464  * kmem_slab_free()
1465  */
1466 static void
1467 kmem_slab_free(void *ptr, vm_size_t size)
1468 {
1469     crit_enter();
1470     lwkt_gettoken(&vm_token);
1471     vm_map_remove(&kernel_map, (vm_offset_t)ptr, (vm_offset_t)ptr + size);
1472     lwkt_reltoken(&vm_token);
1473     crit_exit();
1474 }
1475