#ifdef _KERNEL
#include <sys/param.h>
#include <sys/systm.h>
#include <sys/lock.h>
#include <sys/kernel.h>
#include <sys/alist.h>
#include <sys/malloc.h>
#include <vm/vm.h>
#include <vm/vm_object.h>
#include <vm/vm_kern.h>
#include <vm/vm_extern.h>
#include <vm/vm_page.h>
#else
#ifndef ALIST_NO_DEBUG
#define ALIST_DEBUG
#endif
#include <sys/types.h>
#include <stdio.h>
#include <assert.h>
#include <string.h>
#include <stdlib.h>
#include <stdarg.h>
#define kmalloc(a,b,c) malloc(a)
#define kfree(a,b) free(a)
#define kprintf printf
#define KKASSERT(exp) assert(exp)
struct malloc_type;
#include <sys/alist.h>
void panic(const char *ctl, ...);
#endif
static alist_blk_t alst_leaf_alloc(almeta_t *scan, alist_blk_t blk,
alist_blk_t start, alist_blk_t count);
static alist_blk_t alst_meta_alloc(alist_t bl, almeta_t *scan, alist_blk_t blk,
alist_blk_t start, alist_blk_t count,
alist_blk_t radix, alist_blk_t skip);
static void alst_leaf_free(almeta_t *scan, alist_blk_t relblk,
alist_blk_t count);
static void alst_meta_free(alist_t bl, almeta_t *scan, alist_blk_t freeBlk,
alist_blk_t count, alist_blk_t radix,
alist_blk_t skip, alist_blk_t blk);
static alist_blk_t alst_radix_init(almeta_t *scan, alist_blk_t blk,
alist_blk_t radix, alist_blk_t skip,
alist_blk_t count);
#ifndef _KERNEL
static void alst_radix_print(alist_t bl, almeta_t *scan, alist_blk_t blk,
alist_blk_t radix, alist_blk_t skip,
int tab);
#endif
alist_t
alist_create(alist_blk_t blocks, struct malloc_type *mtype)
{
alist_t bl;
alist_blk_t radix;
alist_blk_t skip = 0;
radix = ALIST_BMAP_RADIX;
while (radix < blocks) {
radix *= ALIST_META_RADIX;
skip = (skip + 1) * ALIST_META_RADIX;
}
bl = kmalloc(sizeof(struct alist), mtype, M_WAITOK | M_ZERO);
bl->bl_blocks = blocks;
bl->bl_radix = radix;
bl->bl_skip = skip;
bl->bl_rootblks = 1 + alst_radix_init(NULL, 0, bl->bl_radix,
bl->bl_skip, blocks);
bl->bl_root = kmalloc(sizeof(almeta_t) * bl->bl_rootblks,
mtype, M_WAITOK);
#if defined(ALIST_DEBUG)
kprintf(
"ALIST representing %d blocks (%d MB of swap)"
", requiring %d entries and %dK (%d bytes) of ram\n",
bl->bl_blocks,
bl->bl_blocks * 4 / 1024,
bl->bl_rootblks,
(bl->bl_rootblks * sizeof(almeta_t) + 1023) / 1024,
(bl->bl_rootblks * sizeof(almeta_t))
);
kprintf("ALIST raw radix tree contains %d records\n", bl->bl_rootblks);
#endif
alst_radix_init(bl->bl_root, 0, bl->bl_radix, bl->bl_skip, blocks);
return(bl);
}
void
alist_init(alist_t bl, alist_blk_t blocks,
almeta_t *records, alist_blk_t nrecords)
{
alist_blk_t radix;
alist_blk_t skip = 0;
radix = ALIST_BMAP_RADIX;
while (radix < blocks) {
radix *= ALIST_META_RADIX;
skip = (skip + 1) * ALIST_META_RADIX;
}
bzero(bl, sizeof(*bl));
bl->bl_blocks = blocks;
bl->bl_radix = radix;
bl->bl_skip = skip;
bl->bl_rootblks = 1 + alst_radix_init(NULL, 0, bl->bl_radix,
bl->bl_skip, blocks);
KKASSERT(bl->bl_rootblks <= nrecords);
bl->bl_root = records;
#if defined(ALIST_DEBUG)
kprintf(
"ALIST representing %d blocks (%d MB of swap)"
", requiring %d entries and %dK (%d bytes) of ram\n",
bl->bl_blocks,
bl->bl_blocks * 4 / 1024,
bl->bl_rootblks,
(bl->bl_rootblks * sizeof(almeta_t) + 1023) / 1024,
(bl->bl_rootblks * sizeof(almeta_t))
);
kprintf("ALIST raw radix tree contains %d records\n", bl->bl_rootblks);
#endif
alst_radix_init(bl->bl_root, 0, bl->bl_radix, bl->bl_skip, blocks);
}
void
alist_destroy(alist_t bl, struct malloc_type *mtype)
{
kfree(bl->bl_root, mtype);
kfree(bl, mtype);
}
alist_blk_t
alist_alloc(alist_t bl, alist_blk_t start, alist_blk_t count)
{
alist_blk_t blk = ALIST_BLOCK_NONE;
KKASSERT(count);
if ((count | (count - 1)) != (count << 1) - 1) {
alist_blk_t ncount = (count < 256) ? 1 : 256;
while (ncount < count)
ncount <<= 1;
blk = alist_alloc(bl, start, ncount);
if (blk != ALIST_BLOCK_NONE)
alist_free(bl, blk + count, ncount - count);
return (blk);
}
if (bl && count < bl->bl_radix) {
if (bl->bl_radix == ALIST_BMAP_RADIX) {
blk = alst_leaf_alloc(bl->bl_root, 0, start, count);
} else {
blk = alst_meta_alloc(bl, bl->bl_root, 0, start, count,
bl->bl_radix, bl->bl_skip);
}
if (blk != ALIST_BLOCK_NONE)
bl->bl_free -= count;
}
return(blk);
}
void
alist_free(alist_t bl, alist_blk_t blkno, alist_blk_t count)
{
if (bl) {
KKASSERT(blkno + count <= bl->bl_blocks);
if (bl->bl_radix == ALIST_BMAP_RADIX) {
alst_leaf_free(bl->bl_root, blkno, count);
} else {
alst_meta_free(bl, bl->bl_root, blkno, count,
bl->bl_radix, bl->bl_skip, 0);
}
bl->bl_free += count;
}
}
alist_blk_t
alist_free_info(alist_t bl, alist_blk_t *startp, alist_blk_t *countp)
{
alist_blk_t radix = bl->bl_radix;
alist_blk_t skip = bl->bl_skip;
alist_blk_t next_skip;
alist_blk_t i;
alist_bmap_t mask;
almeta_t *scan = bl->bl_root;
*startp = 0;
*countp = 0;
while (radix != ALIST_BMAP_RADIX) {
radix /= ALIST_META_RADIX;
next_skip = skip / ALIST_META_RADIX;
for (i = ALIST_META_RADIX - 1; i != ALIST_BLOCK_NONE; --i) {
mask = (scan->bm_bitmap >> (i * 2)) & 3;
if (mask == 0) {
continue;
}
if (mask == 1) {
break;
}
if (mask == 2) {
return(bl->bl_free);
}
*startp += i * radix;
*countp = radix;
return(bl->bl_free);
}
if (i == ALIST_BLOCK_NONE)
return(bl->bl_free);
*startp += i * radix;
scan += 1 + next_skip * i;
skip = next_skip - 1;
}
if (radix == ALIST_BMAP_RADIX) {
mask = scan->bm_bitmap;
for (i = ALIST_BMAP_RADIX - 1; i != ALIST_BLOCK_NONE; --i) {
if ((mask & ((alist_bmap_t)1U << i)))
break;
}
if (i == ALIST_BLOCK_NONE)
return(bl->bl_free);
*startp += i;
*countp = 1;
return(bl->bl_free);
}
return(bl->bl_free);
}
#ifdef ALIST_DEBUG
void
alist_print(alist_t bl)
{
kprintf("ALIST {\n");
alst_radix_print(bl, bl->bl_root, 0, bl->bl_radix, bl->bl_skip, 4);
kprintf("}\n");
}
#endif
static alist_blk_t
alst_leaf_alloc(almeta_t *scan, alist_blk_t blk, alist_blk_t start,
alist_blk_t count)
{
alist_bmap_t orig = scan->bm_bitmap;
if (start >= blk + ALIST_BMAP_RADIX)
return(ALIST_BLOCK_NONE);
if (start > blk && start < blk + ALIST_BMAP_RADIX)
orig &= ~(((alist_bmap_t)1U << (start - blk)) - 1);
start &= ALIST_BMAP_RADIX - 1;
if (orig == 0) {
if (start <= blk)
scan->bm_bighint = 0;
return(ALIST_BLOCK_NONE);
}
if (count == 1) {
alist_bmap_t mask;
alist_blk_t j = ALIST_BMAP_RADIX/2;
alist_blk_t r = 0;
mask = (alist_bmap_t)-1 >> (ALIST_BMAP_RADIX/2);
while (j) {
if ((orig & mask) == 0) {
r += j;
orig >>= j;
}
j >>= 1;
mask >>= j;
}
scan->bm_bitmap &= ~(1 << r);
return(blk + r);
}
{
alist_blk_t j;
alist_blk_t n = ALIST_BMAP_RADIX - count;
alist_bmap_t mask;
mask = (alist_bmap_t)-1 >> n;
for (j = 0; j <= n; j += count) {
if ((orig & mask) == mask) {
scan->bm_bitmap &= ~mask;
return(blk + j);
}
mask = mask << count;
}
}
if (start <= blk)
scan->bm_bighint = count - 1;
return(ALIST_BLOCK_NONE);
}
static alist_blk_t
alst_meta_alloc(alist_t bl, almeta_t *scan, alist_blk_t blk, alist_blk_t start,
alist_blk_t count, alist_blk_t radix, alist_blk_t skip)
{
alist_blk_t i;
alist_bmap_t mask;
alist_bmap_t pmask;
alist_blk_t next_skip = ((u_int)skip / ALIST_META_RADIX);
alist_blk_t orig_blk;
if (scan->bm_bitmap == 0) {
scan->bm_bighint = 0;
return(ALIST_BLOCK_NONE);
}
radix /= ALIST_META_RADIX;
if (count >= radix) {
alist_blk_t n = count / radix * 2;
alist_blk_t j;
mask = (alist_bmap_t)-1 >> (ALIST_BMAP_RADIX - n);
for (j = 0; j < ALIST_META_RADIX; j += n / 2) {
if ((scan->bm_bitmap & mask) == mask &&
blk + j * radix >= start) {
scan->bm_bitmap &= ~mask;
return(blk + j * radix);
}
mask <<= n;
}
if (scan->bm_bighint >= count && start <= blk)
scan->bm_bighint = count >> 1;
return(ALIST_BLOCK_NONE);
}
mask = 0x00000003;
pmask = 0x00000001;
orig_blk = blk;
for (i = 1; i <= skip; i += next_skip) {
if (blk >= bl->bl_blocks)
break;
#if 0
if (scan[i].bm_bighint == (alist_blk_t)-1)
break;
#endif
if ((scan->bm_bitmap & mask) == mask) {
scan[i].bm_bitmap = (alist_bmap_t)-1;
scan[i].bm_bighint = radix;
}
if ((scan->bm_bitmap & mask) == 0) {
} else if (blk + radix <= start) {
} else if (count <= scan[i].bm_bighint) {
alist_blk_t r;
if (next_skip == 1) {
r = alst_leaf_alloc(&scan[i], blk, start,
count);
} else {
r = alst_meta_alloc(bl, &scan[i], blk, start,
count,
radix, next_skip - 1);
}
if (r != ALIST_BLOCK_NONE) {
if (scan[i].bm_bitmap == 0) {
scan->bm_bitmap &= ~mask;
} else {
scan->bm_bitmap &= ~mask;
scan->bm_bitmap |= pmask;
}
return(r);
}
}
blk += radix;
mask <<= 2;
pmask <<= 2;
}
if (scan->bm_bighint >= count && start <= orig_blk)
scan->bm_bighint = count >> 1;
return(ALIST_BLOCK_NONE);
}
static void
alst_leaf_free(almeta_t *scan, alist_blk_t blk, alist_blk_t count)
{
alist_blk_t n = blk & (ALIST_BMAP_RADIX - 1);
alist_bmap_t mask;
mask = ((alist_bmap_t)-1 << n) &
((alist_bmap_t)-1 >> (ALIST_BMAP_RADIX - count - n));
if (scan->bm_bitmap & mask)
panic("%s: freeing free block", __func__);
scan->bm_bitmap |= mask;
scan->bm_bighint = ALIST_BMAP_RADIX;
}
static void
alst_meta_free(alist_t bl, almeta_t *scan, alist_blk_t freeBlk,
alist_blk_t count,
alist_blk_t radix, alist_blk_t skip, alist_blk_t blk)
{
alist_blk_t next_skip = ((u_int)skip / ALIST_META_RADIX);
alist_bmap_t mask;
alist_bmap_t pmask;
alist_blk_t i;
radix /= ALIST_META_RADIX;
i = (freeBlk - blk) / radix;
blk += i * radix;
mask = 0x00000003 << (i * 2);
pmask = 0x00000001 << (i * 2);
i = i * next_skip + 1;
while (i <= skip && blk < freeBlk + count) {
alist_blk_t v;
v = blk + radix - freeBlk;
if (v > count)
v = count;
#if 0
if (scan->bm_bighint == (alist_blk_t)-1)
panic("%s: freeing unexpected range", __func__);
#endif
if (freeBlk == blk && count >= radix) {
KKASSERT((scan->bm_bitmap & mask) == 0);
scan->bm_bitmap |= mask;
scan->bm_bighint = radix * ALIST_META_RADIX;
} else if (freeBlk < bl->bl_blocks) {
if ((scan->bm_bitmap & mask) == 0) {
scan[i].bm_bitmap = (alist_bmap_t)0;
scan[i].bm_bighint = 0;
}
if (next_skip == 1) {
alst_leaf_free(&scan[i], freeBlk, v);
} else {
alst_meta_free(bl, &scan[i], freeBlk, v,
radix, next_skip - 1, blk);
}
if (scan[i].bm_bitmap == (alist_bmap_t)-1) {
scan->bm_bitmap |= mask;
scan->bm_bighint = radix * ALIST_META_RADIX;
} else {
scan->bm_bitmap &= ~mask;
scan->bm_bitmap |= pmask;
if (scan->bm_bighint < scan[i].bm_bighint)
scan->bm_bighint = scan[i].bm_bighint;
}
} else {
panic("alst_meta_free: attempt to free block %d "
"beyond limit of %d\n", freeBlk, bl->bl_blocks);
}
mask <<= 2;
pmask <<= 2;
count -= v;
freeBlk += v;
blk += radix;
i += next_skip;
}
}
static alist_blk_t
alst_radix_init(almeta_t *scan, alist_blk_t blk, alist_blk_t radix,
alist_blk_t skip, alist_blk_t count)
{
alist_blk_t i;
alist_blk_t next_skip;
alist_bmap_t mask;
alist_bmap_t pmask;
alist_blk_t memindex;
if (radix == ALIST_BMAP_RADIX) {
if (scan) {
scan->bm_bighint = 0;
scan->bm_bitmap = 0;
}
return(0);
}
if (scan) {
scan->bm_bighint = 0;
scan->bm_bitmap = 0;
}
memindex = 0;
radix /= ALIST_META_RADIX;
next_skip = skip / ALIST_META_RADIX;
mask = 0x00000003;
pmask = 0x00000001;
for (i = 1; i <= skip; i += next_skip) {
if (count >= blk + radix) {
memindex += alst_radix_init(((scan) ? &scan[i] : NULL),
blk, radix,
next_skip - 1, count);
} else if (count > blk) {
memindex += alst_radix_init(((scan) ? &scan[i] : NULL),
blk, radix,
next_skip - 1, count);
} else {
break;
#if 0
if (scan) {
scan[i].bm_bighint = (alist_blk_t)-1;
scan[i].bm_bitmap = 0;
}
#endif
}
mask <<= 2;
pmask <<= 2;
blk += radix;
}
memindex += ALIST_META_RADIX;
return(memindex);
}
#ifdef ALIST_DEBUG
static void
alst_radix_print(alist_t bl, almeta_t *scan, alist_blk_t blk, alist_blk_t radix,
alist_blk_t skip, int tab)
{
alist_blk_t i;
alist_blk_t next_skip;
alist_bmap_t mask;
if (radix == ALIST_BMAP_RADIX) {
kprintf(
"%*.*s(%04x,%d): bitmap %08x big=%d\n",
tab, tab, "",
blk, radix,
scan->bm_bitmap,
scan->bm_bighint
);
return;
}
if (scan->bm_bitmap == 0) {
kprintf(
"%*.*s(%04x,%d) ALL ALLOCATED\n",
tab, tab, "",
blk,
radix
);
return;
}
if (scan->bm_bitmap == (alist_bmap_t)-1) {
kprintf(
"%*.*s(%04x,%d) ALL FREE\n",
tab, tab, "",
blk,
radix
);
return;
}
kprintf(
"%*.*s(%04x,%d): subtree (%d) bitmap=%08x big=%d {\n",
tab, tab, "",
blk, radix,
radix,
scan->bm_bitmap,
scan->bm_bighint
);
radix /= ALIST_META_RADIX;
next_skip = skip / ALIST_META_RADIX;
tab += 4;
mask = 0x00000003;
for (i = 1; i <= skip; i += next_skip) {
if (blk >= bl->bl_blocks)
break;
if (scan[i].bm_bighint == (alist_blk_t)-1) {
kprintf(
"%*.*s(%04x,%d): Terminator (shouldn't exist)\n",
tab, tab, "",
blk, radix
);
break;
}
if ((scan->bm_bitmap & mask) == mask) {
kprintf(
"%*.*s(%04x,%d): ALL FREE\n",
tab, tab, "",
blk, radix
);
} else if ((scan->bm_bitmap & mask) == 0) {
kprintf(
"%*.*s(%04x,%d): ALL ALLOCATED\n",
tab, tab, "",
blk, radix
);
} else {
alst_radix_print(
bl,
&scan[i],
blk,
radix,
next_skip - 1,
tab
);
}
blk += radix;
mask <<= 2;
}
tab -= 4;
kprintf("%*.*s}\n", tab, tab, "");
}
#endif
#ifdef ALIST_DEBUG
int
main(int ac, char **av)
{
alist_blk_t size = 1024;
alist_blk_t da = 0;
alist_blk_t count = 0;
alist_t bl;
int i;
for (i = 1; i < ac; ++i) {
const char *ptr = av[i];
if (*ptr != '-') {
size = strtol(ptr, NULL, 0);
continue;
}
ptr += 2;
fprintf(stderr, "Bad option: %s\n", ptr - 2);
exit(1);
}
bl = alist_create(size, NULL);
alist_free(bl, 0, size);
for (;;) {
char buf[1024];
alist_blk_t bfree;
kprintf("%d/%d/%d> ", bl->bl_free, size, bl->bl_radix);
fflush(stdout);
if (fgets(buf, sizeof(buf), stdin) == NULL)
break;
switch(buf[0]) {
case 'p':
alist_print(bl);
break;
case 'a':
if (sscanf(buf + 1, "%x %d", &da, &count) == 2) {
da = alist_alloc(bl, da, count);
kprintf(" R=%04x\n", da);
} else if (sscanf(buf + 1, "%d", &count) == 1) {
da = alist_alloc(bl, 0, count);
kprintf(" R=%04x\n", da);
} else if (count) {
kprintf("alloc 0x%04x/%d\n", da, count);
alist_blk_t blk = alist_alloc(bl, da, count);
kprintf(" R=%04x\n", blk);
} else {
kprintf("?\n");
}
break;
case 'f':
if (sscanf(buf + 1, "%x %d", &da, &count) == 2) {
alist_free(bl, da, count);
} else if (count) {
kprintf("free 0x%04x/%d\n", da, count);
alist_free(bl, da, count);
} else {
kprintf("?\n");
}
break;
case '?':
case 'h':
puts("p -print\n"
"a %d -allocate\n"
"f %x %d -free\n"
"h/? -help");
break;
case 'i':
bfree = alist_free_info(bl, &da, &count);
kprintf("info: %d free trailing: 0x%04x/%d\n",
bfree, da, count);
break;
default:
kprintf("?\n");
break;
}
}
return(0);
}
void
panic(const char *ctl, ...)
{
__va_list va;
__va_start(va, ctl);
vfprintf(stderr, ctl, va);
fprintf(stderr, "\n");
__va_end(va);
exit(1);
}
#endif