xref: /plan9/sys/src/libc/port/pool.c (revision f7c114af05ae4d498891de07f5a043835bd540ab)
17dd7cddfSDavid du Colombier /*
27dd7cddfSDavid du Colombier  * This allocator takes blocks from a coarser allocator (p->alloc) and
37dd7cddfSDavid du Colombier  * uses them as arenas.
47dd7cddfSDavid du Colombier  *
57dd7cddfSDavid du Colombier  * An arena is split into a sequence of blocks of variable size.  The
67dd7cddfSDavid du Colombier  * blocks begin with a Bhdr that denotes the length (including the Bhdr)
77dd7cddfSDavid du Colombier  * of the block.  An arena begins with an Arena header block (Arena,
87dd7cddfSDavid du Colombier  * ARENA_MAGIC) and ends with a Bhdr block with magic ARENATAIL_MAGIC and
97dd7cddfSDavid du Colombier  * size 0.  Intermediate blocks are either allocated or free.  At the end
107dd7cddfSDavid du Colombier  * of each intermediate block is a Btail, which contains information
117dd7cddfSDavid du Colombier  * about where the block starts.  This is useful for walking backwards.
127dd7cddfSDavid du Colombier  *
137dd7cddfSDavid du Colombier  * Free blocks (Free*) have a magic value of FREE_MAGIC in their Bhdr
147dd7cddfSDavid du Colombier  * headers.  They are kept in a binary tree (p->freeroot) traversible by
157dd7cddfSDavid du Colombier  * walking ->left and ->right.  Each node of the binary tree is a pointer
167dd7cddfSDavid du Colombier  * to a circular doubly-linked list (next, prev) of blocks of identical
177dd7cddfSDavid du Colombier  * size.  Blocks are added to this ``tree of lists'' by pooladd(), and
187dd7cddfSDavid du Colombier  * removed by pooldel().
197dd7cddfSDavid du Colombier  *
207dd7cddfSDavid du Colombier  * When freed, adjacent blocks are coalesced to create larger blocks when
217dd7cddfSDavid du Colombier  * possible.
227dd7cddfSDavid du Colombier  *
235243b8d1SDavid du Colombier  * Allocated blocks (Alloc*) have one of two magic values: ALLOC_MAGIC or
245243b8d1SDavid du Colombier  * UNALLOC_MAGIC.  When blocks are released from the pool, they have
255243b8d1SDavid du Colombier  * magic value UNALLOC_MAGIC.  Once the block has been trimmed by trim()
267dd7cddfSDavid du Colombier  * and the amount of user-requested data has been recorded in the
275243b8d1SDavid du Colombier  * datasize field of the tail, the magic value is changed to ALLOC_MAGIC.
285243b8d1SDavid du Colombier  * All blocks returned to callers should be of type ALLOC_MAGIC, as
297dd7cddfSDavid du Colombier  * should all blocks passed to us by callers.  The amount of data the user
307dd7cddfSDavid du Colombier  * asked us for can be found by subtracting the short in tail->datasize
317dd7cddfSDavid du Colombier  * from header->size.  Further, the up to at most four bytes between the
327dd7cddfSDavid du Colombier  * end of the user-requested data block and the actual Btail structure are
337dd7cddfSDavid du Colombier  * marked with a magic value, which is checked to detect user overflow.
347dd7cddfSDavid du Colombier  *
357dd7cddfSDavid du Colombier  * The arenas returned by p->alloc are kept in a doubly-linked list
367dd7cddfSDavid du Colombier  * (p->arenalist) running through the arena headers, sorted by descending
377dd7cddfSDavid du Colombier  * base address (prev, next).  When a new arena is allocated, we attempt
387dd7cddfSDavid du Colombier  * to merge it with its two neighbors via p->merge.
397dd7cddfSDavid du Colombier  */
407dd7cddfSDavid du Colombier 
417dd7cddfSDavid du Colombier #include <u.h>
427dd7cddfSDavid du Colombier #include <libc.h>
437dd7cddfSDavid du Colombier #include <pool.h>
447dd7cddfSDavid du Colombier 
457dd7cddfSDavid du Colombier typedef struct Alloc	Alloc;
467dd7cddfSDavid du Colombier typedef struct Arena	Arena;
477dd7cddfSDavid du Colombier typedef struct Bhdr	Bhdr;
487dd7cddfSDavid du Colombier typedef struct Btail	Btail;
497dd7cddfSDavid du Colombier typedef struct Free	Free;
507dd7cddfSDavid du Colombier 
517dd7cddfSDavid du Colombier struct Bhdr {
527dd7cddfSDavid du Colombier 	ulong	magic;
537dd7cddfSDavid du Colombier 	ulong	size;
547dd7cddfSDavid du Colombier };
557dd7cddfSDavid du Colombier enum {
567dd7cddfSDavid du Colombier 	NOT_MAGIC = 0xdeadfa11,
579a747e4fSDavid du Colombier 	DEAD_MAGIC = 0xdeaddead,
587dd7cddfSDavid du Colombier };
597dd7cddfSDavid du Colombier #define B2NB(b) ((Bhdr*)((uchar*)(b)+(b)->size))
607dd7cddfSDavid du Colombier 
617dd7cddfSDavid du Colombier #define SHORT(x) (((x)[0] << 8) | (x)[1])
627dd7cddfSDavid du Colombier #define PSHORT(p, x) \
637dd7cddfSDavid du Colombier 	(((uchar*)(p))[0] = ((x)>>8)&0xFF, \
647dd7cddfSDavid du Colombier 	((uchar*)(p))[1] = (x)&0xFF)
657dd7cddfSDavid du Colombier 
667dd7cddfSDavid du Colombier enum {
677dd7cddfSDavid du Colombier 	TAIL_MAGIC0 = 0xBE,
687dd7cddfSDavid du Colombier 	TAIL_MAGIC1 = 0xEF
697dd7cddfSDavid du Colombier };
707dd7cddfSDavid du Colombier struct Btail {
717dd7cddfSDavid du Colombier 	uchar	magic0;
727dd7cddfSDavid du Colombier 	uchar	datasize[2];
737dd7cddfSDavid du Colombier 	uchar	magic1;
747dd7cddfSDavid du Colombier 	ulong	size;	/* same as Bhdr->size */
757dd7cddfSDavid du Colombier };
767dd7cddfSDavid du Colombier #define B2T(b)	((Btail*)((uchar*)(b)+(b)->size-sizeof(Btail)))
777dd7cddfSDavid du Colombier #define B2PT(b) ((Btail*)((uchar*)(b)-sizeof(Btail)))
787dd7cddfSDavid du Colombier #define T2HDR(t) ((Bhdr*)((uchar*)(t)+sizeof(Btail)-(t)->size))
797dd7cddfSDavid du Colombier struct Free {
807dd7cddfSDavid du Colombier 			Bhdr;
817dd7cddfSDavid du Colombier 	Free*	left;
827dd7cddfSDavid du Colombier 	Free*	right;
837dd7cddfSDavid du Colombier 	Free*	next;
847dd7cddfSDavid du Colombier 	Free*	prev;
857dd7cddfSDavid du Colombier };
867dd7cddfSDavid du Colombier enum {
877dd7cddfSDavid du Colombier 	FREE_MAGIC = 0xBA5EBA11,
887dd7cddfSDavid du Colombier };
897dd7cddfSDavid du Colombier 
907dd7cddfSDavid du Colombier /*
917dd7cddfSDavid du Colombier  * the point of the notused fields is to make 8c differentiate
927dd7cddfSDavid du Colombier  * between Bhdr and Allocblk, and between Kempt and Unkempt.
937dd7cddfSDavid du Colombier  */
947dd7cddfSDavid du Colombier struct Alloc {
957dd7cddfSDavid du Colombier 			Bhdr;
967dd7cddfSDavid du Colombier };
977dd7cddfSDavid du Colombier enum {
985243b8d1SDavid du Colombier 	ALLOC_MAGIC = 0x0A110C09,
995243b8d1SDavid du Colombier 	UNALLOC_MAGIC = 0xCAB00D1E+1,
1007dd7cddfSDavid du Colombier };
1017dd7cddfSDavid du Colombier 
1027dd7cddfSDavid du Colombier struct Arena {
1037dd7cddfSDavid du Colombier 			Bhdr;
1047dd7cddfSDavid du Colombier 	Arena*	aup;
1057dd7cddfSDavid du Colombier 	Arena*	down;
1067dd7cddfSDavid du Colombier 	ulong	asize;
1077dd7cddfSDavid du Colombier 	ulong	pad;	/* to a multiple of 8 bytes */
1087dd7cddfSDavid du Colombier };
1097dd7cddfSDavid du Colombier enum {
1107dd7cddfSDavid du Colombier 	ARENA_MAGIC = 0xC0A1E5CE+1,
1117dd7cddfSDavid du Colombier 	ARENATAIL_MAGIC = 0xEC5E1A0C+1,
1127dd7cddfSDavid du Colombier };
1137dd7cddfSDavid du Colombier #define A2TB(a)	((Bhdr*)((uchar*)(a)+(a)->asize-sizeof(Bhdr)))
1147dd7cddfSDavid du Colombier #define A2B(a)	B2NB(a)
1157dd7cddfSDavid du Colombier 
1167dd7cddfSDavid du Colombier enum {
1175243b8d1SDavid du Colombier 	ALIGN_MAGIC = 0xA1F1D1C1,
1185243b8d1SDavid du Colombier };
1195243b8d1SDavid du Colombier 
1205243b8d1SDavid du Colombier enum {
1217dd7cddfSDavid du Colombier 	MINBLOCKSIZE = sizeof(Free)+sizeof(Btail)
1227dd7cddfSDavid du Colombier };
1237dd7cddfSDavid du Colombier 
1247dd7cddfSDavid du Colombier static uchar datamagic[] = { 0xFE, 0xF1, 0xF0, 0xFA };
1257dd7cddfSDavid du Colombier 
1267dd7cddfSDavid du Colombier #define	Poison	(void*)0xCafeBabe
1277dd7cddfSDavid du Colombier 
1287dd7cddfSDavid du Colombier #define _B2D(a)	((void*)((uchar*)a+sizeof(Bhdr)))
1297dd7cddfSDavid du Colombier #define _D2B(v)	((Alloc*)((uchar*)v-sizeof(Bhdr)))
1307dd7cddfSDavid du Colombier 
1317dd7cddfSDavid du Colombier // static void*	_B2D(void*);
1327dd7cddfSDavid du Colombier // static void*	_D2B(void*);
1337dd7cddfSDavid du Colombier static void*	B2D(Pool*, Alloc*);
1347dd7cddfSDavid du Colombier static Alloc*	D2B(Pool*, void*);
1357dd7cddfSDavid du Colombier static Arena*	arenamerge(Pool*, Arena*, Arena*);
1367dd7cddfSDavid du Colombier static void		blockcheck(Pool*, Bhdr*);
1377dd7cddfSDavid du Colombier static Alloc*	blockmerge(Pool*, Bhdr*, Bhdr*);
1387dd7cddfSDavid du Colombier static Alloc*	blocksetdsize(Pool*, Alloc*, ulong);
1397dd7cddfSDavid du Colombier static Bhdr*	blocksetsize(Bhdr*, ulong);
1407dd7cddfSDavid du Colombier static ulong	bsize2asize(Pool*, ulong);
1417dd7cddfSDavid du Colombier static ulong	dsize2bsize(Pool*, ulong);
1427dd7cddfSDavid du Colombier static ulong	getdsize(Alloc*);
1435243b8d1SDavid du Colombier static Alloc*	trim(Pool*, Alloc*, ulong);
1447dd7cddfSDavid du Colombier static Free*	listadd(Free*, Free*);
1457dd7cddfSDavid du Colombier static void		logstack(Pool*);
1467dd7cddfSDavid du Colombier static Free**	ltreewalk(Free**, ulong);
1477dd7cddfSDavid du Colombier static void		memmark(void*, int, ulong);
1487dd7cddfSDavid du Colombier static Free*	pooladd(Pool*, Alloc*);
1497dd7cddfSDavid du Colombier static void*	poolallocl(Pool*, ulong);
1507dd7cddfSDavid du Colombier static void		poolcheckl(Pool*);
1517dd7cddfSDavid du Colombier static void		poolcheckarena(Pool*, Arena*);
1527dd7cddfSDavid du Colombier static int		poolcompactl(Pool*);
1537dd7cddfSDavid du Colombier static Alloc*	pooldel(Pool*, Free*);
1547dd7cddfSDavid du Colombier static void		pooldumpl(Pool*);
1557dd7cddfSDavid du Colombier static void		pooldumparena(Pool*, Arena*);
1567dd7cddfSDavid du Colombier static void		poolfreel(Pool*, void*);
1577dd7cddfSDavid du Colombier static void		poolnewarena(Pool*, ulong);
1587dd7cddfSDavid du Colombier static void*	poolreallocl(Pool*, void*, ulong);
1597dd7cddfSDavid du Colombier static Free*	treedelete(Free*, Free*);
1607dd7cddfSDavid du Colombier static Free*	treeinsert(Free*, Free*);
1617dd7cddfSDavid du Colombier static Free*	treelookup(Free*, ulong);
1627dd7cddfSDavid du Colombier static Free*	treelookupgt(Free*, ulong);
1637dd7cddfSDavid du Colombier 
1647dd7cddfSDavid du Colombier /*
1657dd7cddfSDavid du Colombier  * Debugging
1667dd7cddfSDavid du Colombier  *
1677dd7cddfSDavid du Colombier  * Antagonism causes blocks to always be filled with garbage if their
1687dd7cddfSDavid du Colombier  * contents are undefined.  This tickles both programs and the library.
1697dd7cddfSDavid du Colombier  * It's a linear time hit but not so noticeable during nondegenerate use.
1707dd7cddfSDavid du Colombier  * It would be worth leaving in except that it negates the benefits of the
1717dd7cddfSDavid du Colombier  * kernel's demand-paging.  The tail magic and end-of-data magic
1727dd7cddfSDavid du Colombier  * provide most of the user-visible benefit that antagonism does anyway.
1737dd7cddfSDavid du Colombier  *
1747dd7cddfSDavid du Colombier  * Paranoia causes the library to recheck the entire pool on each lock
1757dd7cddfSDavid du Colombier  * or unlock.  A failed check on unlock means we tripped over ourselves,
1767dd7cddfSDavid du Colombier  * while a failed check on lock tends to implicate the user.  Paranoia has
1777dd7cddfSDavid du Colombier  * the potential to slow things down a fair amount for pools with large
1787dd7cddfSDavid du Colombier  * numbers of allocated blocks.  It completely negates all benefits won
1797dd7cddfSDavid du Colombier  * by the binary tree.  Turning on paranoia in the kernel makes it painfully
1807dd7cddfSDavid du Colombier  * slow.
1817dd7cddfSDavid du Colombier  *
1827dd7cddfSDavid du Colombier  * Verbosity induces the dumping of the pool via p->print at each lock operation.
1837dd7cddfSDavid du Colombier  * By default, only one line is logged for each alloc, free, and realloc.
1847dd7cddfSDavid du Colombier  */
1857dd7cddfSDavid du Colombier 
1867dd7cddfSDavid du Colombier /* the if(!x);else avoids ``dangling else'' problems */
1879a747e4fSDavid du Colombier #define antagonism	if(!(p->flags & POOL_ANTAGONISM)){}else
1889a747e4fSDavid du Colombier #define paranoia	if(!(p->flags & POOL_PARANOIA)){}else
1899a747e4fSDavid du Colombier #define verbosity	if(!(p->flags & POOL_VERBOSITY)){}else
1907dd7cddfSDavid du Colombier 
1919a747e4fSDavid du Colombier #define DPRINT	if(!(p->flags & POOL_DEBUGGING)){}else p->print
1929a747e4fSDavid du Colombier #define LOG		if(!(p->flags & POOL_LOGGING)){}else p->print
1937dd7cddfSDavid du Colombier 
1947dd7cddfSDavid du Colombier /*
1957dd7cddfSDavid du Colombier  * Tree walking
1967dd7cddfSDavid du Colombier  */
1977dd7cddfSDavid du Colombier 
1989a747e4fSDavid du Colombier static void
checklist(Free * t)1999a747e4fSDavid du Colombier checklist(Free *t)
2009a747e4fSDavid du Colombier {
2019a747e4fSDavid du Colombier 	Free *q;
2029a747e4fSDavid du Colombier 
2039a747e4fSDavid du Colombier 	for(q=t->next; q!=t; q=q->next){
2049a747e4fSDavid du Colombier 		assert(q->size == t->size);
2059a747e4fSDavid du Colombier 		assert(q->next==nil || q->next->prev==q);
2069a747e4fSDavid du Colombier 		assert(q->prev==nil || q->prev->next==q);
2079a747e4fSDavid du Colombier 	//	assert(q->left==nil);
2089a747e4fSDavid du Colombier 	//	assert(q->right==nil);
2099a747e4fSDavid du Colombier 		assert(q->magic==FREE_MAGIC);
2109a747e4fSDavid du Colombier 	}
2119a747e4fSDavid du Colombier }
2129a747e4fSDavid du Colombier 
2139a747e4fSDavid du Colombier static void
checktree(Free * t,int a,int b)2149a747e4fSDavid du Colombier checktree(Free *t, int a, int b)
2159a747e4fSDavid du Colombier {
2169a747e4fSDavid du Colombier 	assert(t->magic==FREE_MAGIC);
2179a747e4fSDavid du Colombier 	assert(a < t->size && t->size < b);
218e288d156SDavid du Colombier 	assert(t->next==nil || t->next->prev==t);
219e288d156SDavid du Colombier 	assert(t->prev==nil || t->prev->next==t);
2209a747e4fSDavid du Colombier 	checklist(t);
2219a747e4fSDavid du Colombier 	if(t->left)
2229a747e4fSDavid du Colombier 		checktree(t->left, a, t->size);
2239a747e4fSDavid du Colombier 	if(t->right)
2249a747e4fSDavid du Colombier 		checktree(t->right, t->size, b);
2259a747e4fSDavid du Colombier 
2269a747e4fSDavid du Colombier }
2279a747e4fSDavid du Colombier 
2287dd7cddfSDavid du Colombier /* ltreewalk: return address of pointer to node of size == size */
2297dd7cddfSDavid du Colombier static Free**
ltreewalk(Free ** t,ulong size)2307dd7cddfSDavid du Colombier ltreewalk(Free **t, ulong size)
2317dd7cddfSDavid du Colombier {
2327dd7cddfSDavid du Colombier 	assert(t != nil /* ltreewalk */);
2337dd7cddfSDavid du Colombier 
2347dd7cddfSDavid du Colombier 	for(;;) {
2357dd7cddfSDavid du Colombier 		if(*t == nil)
2367dd7cddfSDavid du Colombier 			return t;
2377dd7cddfSDavid du Colombier 
2387dd7cddfSDavid du Colombier 		assert((*t)->magic == FREE_MAGIC);
2397dd7cddfSDavid du Colombier 
2407dd7cddfSDavid du Colombier 		if(size == (*t)->size)
2417dd7cddfSDavid du Colombier 			return t;
2427dd7cddfSDavid du Colombier 		if(size < (*t)->size)
2437dd7cddfSDavid du Colombier 			t = &(*t)->left;
2447dd7cddfSDavid du Colombier 		else
2457dd7cddfSDavid du Colombier 			t = &(*t)->right;
2467dd7cddfSDavid du Colombier 	}
2477dd7cddfSDavid du Colombier }
2487dd7cddfSDavid du Colombier 
2497dd7cddfSDavid du Colombier /* treelookup: find node in tree with size == size */
2507dd7cddfSDavid du Colombier static Free*
treelookup(Free * t,ulong size)2517dd7cddfSDavid du Colombier treelookup(Free *t, ulong size)
2527dd7cddfSDavid du Colombier {
2537dd7cddfSDavid du Colombier 	return *ltreewalk(&t, size);
2547dd7cddfSDavid du Colombier }
2557dd7cddfSDavid du Colombier 
2567dd7cddfSDavid du Colombier /* treeinsert: insert node into tree */
2577dd7cddfSDavid du Colombier static Free*
treeinsert(Free * tree,Free * node)2587dd7cddfSDavid du Colombier treeinsert(Free *tree, Free *node)
2597dd7cddfSDavid du Colombier {
2607dd7cddfSDavid du Colombier 	Free **loc, *repl;
2617dd7cddfSDavid du Colombier 
2627dd7cddfSDavid du Colombier 	assert(node != nil /* treeinsert */);
2637dd7cddfSDavid du Colombier 
2647dd7cddfSDavid du Colombier 	loc = ltreewalk(&tree, node->size);
2657dd7cddfSDavid du Colombier 	if(*loc == nil) {
2667dd7cddfSDavid du Colombier 		node->left = nil;
2677dd7cddfSDavid du Colombier 		node->right = nil;
2687dd7cddfSDavid du Colombier 	} else {	/* replace existing node */
2697dd7cddfSDavid du Colombier 		repl = *loc;
2707dd7cddfSDavid du Colombier 		node->left = repl->left;
2717dd7cddfSDavid du Colombier 		node->right = repl->right;
2727dd7cddfSDavid du Colombier 	}
2737dd7cddfSDavid du Colombier 	*loc = node;
2747dd7cddfSDavid du Colombier 	return tree;
2757dd7cddfSDavid du Colombier }
2767dd7cddfSDavid du Colombier 
2777dd7cddfSDavid du Colombier /* treedelete: remove node from tree */
2787dd7cddfSDavid du Colombier static Free*
treedelete(Free * tree,Free * node)2797dd7cddfSDavid du Colombier treedelete(Free *tree, Free *node)
2807dd7cddfSDavid du Colombier {
2817dd7cddfSDavid du Colombier 	Free **loc, **lsucc, *succ;
2827dd7cddfSDavid du Colombier 
2837dd7cddfSDavid du Colombier 	assert(node != nil /* treedelete */);
2847dd7cddfSDavid du Colombier 
2857dd7cddfSDavid du Colombier 	loc = ltreewalk(&tree, node->size);
2867dd7cddfSDavid du Colombier 	assert(*loc == node);
2877dd7cddfSDavid du Colombier 
2887dd7cddfSDavid du Colombier 	if(node->left == nil)
2897dd7cddfSDavid du Colombier 		*loc = node->right;
2907dd7cddfSDavid du Colombier 	else if(node->right == nil)
2917dd7cddfSDavid du Colombier 		*loc = node->left;
2927dd7cddfSDavid du Colombier 	else {
2937dd7cddfSDavid du Colombier 		/* have two children, use inorder successor as replacement */
2947dd7cddfSDavid du Colombier 		for(lsucc = &node->right; (*lsucc)->left; lsucc = &(*lsucc)->left)
2957dd7cddfSDavid du Colombier 			;
2967dd7cddfSDavid du Colombier 		succ = *lsucc;
2977dd7cddfSDavid du Colombier 		*lsucc = succ->right;
2987dd7cddfSDavid du Colombier 		succ->left = node->left;
2997dd7cddfSDavid du Colombier 		succ->right = node->right;
3007dd7cddfSDavid du Colombier 		*loc = succ;
3017dd7cddfSDavid du Colombier 	}
3027dd7cddfSDavid du Colombier 
3037dd7cddfSDavid du Colombier 	node->left = node->right = Poison;
3047dd7cddfSDavid du Colombier 	return tree;
3057dd7cddfSDavid du Colombier }
3067dd7cddfSDavid du Colombier 
3077dd7cddfSDavid du Colombier /* treelookupgt: find smallest node in tree with size >= size */
3087dd7cddfSDavid du Colombier static Free*
treelookupgt(Free * t,ulong size)3097dd7cddfSDavid du Colombier treelookupgt(Free *t, ulong size)
3107dd7cddfSDavid du Colombier {
3117dd7cddfSDavid du Colombier 	Free *lastgood;	/* last node we saw that was big enough */
3127dd7cddfSDavid du Colombier 
3137dd7cddfSDavid du Colombier 	lastgood = nil;
3147dd7cddfSDavid du Colombier 	for(;;) {
3157dd7cddfSDavid du Colombier 		if(t == nil)
3167dd7cddfSDavid du Colombier 			return lastgood;
3177dd7cddfSDavid du Colombier 		if(size == t->size)
3187dd7cddfSDavid du Colombier 			return t;
3197dd7cddfSDavid du Colombier 		if(size < t->size) {
3207dd7cddfSDavid du Colombier 			lastgood = t;
3217dd7cddfSDavid du Colombier 			t = t->left;
322b85a8364SDavid du Colombier 		} else
3237dd7cddfSDavid du Colombier 			t = t->right;
3247dd7cddfSDavid du Colombier 	}
3257dd7cddfSDavid du Colombier }
3267dd7cddfSDavid du Colombier 
3277dd7cddfSDavid du Colombier /*
3287dd7cddfSDavid du Colombier  * List maintenance
3297dd7cddfSDavid du Colombier  */
3307dd7cddfSDavid du Colombier 
3319a747e4fSDavid du Colombier /* listadd: add a node to a doubly linked list */
3327dd7cddfSDavid du Colombier static Free*
listadd(Free * list,Free * node)3337dd7cddfSDavid du Colombier listadd(Free *list, Free *node)
3347dd7cddfSDavid du Colombier {
3357dd7cddfSDavid du Colombier 	if(list == nil) {
3367dd7cddfSDavid du Colombier 		node->next = node;
3377dd7cddfSDavid du Colombier 		node->prev = node;
3387dd7cddfSDavid du Colombier 		return node;
3397dd7cddfSDavid du Colombier 	}
3407dd7cddfSDavid du Colombier 
3417dd7cddfSDavid du Colombier 	node->prev = list->prev;
3427dd7cddfSDavid du Colombier 	node->next = list;
3437dd7cddfSDavid du Colombier 
3447dd7cddfSDavid du Colombier 	node->prev->next = node;
3457dd7cddfSDavid du Colombier 	node->next->prev = node;
3467dd7cddfSDavid du Colombier 
3477dd7cddfSDavid du Colombier 	return list;
3487dd7cddfSDavid du Colombier }
3497dd7cddfSDavid du Colombier 
3507dd7cddfSDavid du Colombier /* listdelete: remove node from a doubly linked list */
3517dd7cddfSDavid du Colombier static Free*
listdelete(Pool * p,Free * list,Free * node)35284ba54caSDavid du Colombier listdelete(Pool *p, Free *list, Free *node)
3537dd7cddfSDavid du Colombier {
3547dd7cddfSDavid du Colombier 	if(node->next == node) {	/* singular list */
3557dd7cddfSDavid du Colombier 		node->prev = node->next = Poison;
3567dd7cddfSDavid du Colombier 		return nil;
3577dd7cddfSDavid du Colombier 	}
35884ba54caSDavid du Colombier 	if(node->next == nil)
35984ba54caSDavid du Colombier 		p->panic(p, "pool->next");
36084ba54caSDavid du Colombier 	if(node->prev == nil)
36184ba54caSDavid du Colombier 		p->panic(p, "pool->prev");
3627dd7cddfSDavid du Colombier 	node->next->prev = node->prev;
3637dd7cddfSDavid du Colombier 	node->prev->next = node->next;
3647dd7cddfSDavid du Colombier 
3657dd7cddfSDavid du Colombier 	if(list == node)
3667dd7cddfSDavid du Colombier 		list = node->next;
3677dd7cddfSDavid du Colombier 
3687dd7cddfSDavid du Colombier 	node->prev = node->next = Poison;
3697dd7cddfSDavid du Colombier 	return list;
3707dd7cddfSDavid du Colombier }
3717dd7cddfSDavid du Colombier 
3727dd7cddfSDavid du Colombier /*
3737dd7cddfSDavid du Colombier  * Pool maintenance
3747dd7cddfSDavid du Colombier  */
3757dd7cddfSDavid du Colombier 
3767dd7cddfSDavid du Colombier /* pooladd: add anode to the free pool */
3777dd7cddfSDavid du Colombier static Free*
pooladd(Pool * p,Alloc * anode)3787dd7cddfSDavid du Colombier pooladd(Pool *p, Alloc *anode)
3797dd7cddfSDavid du Colombier {
3807dd7cddfSDavid du Colombier 	Free *lst, *olst;
3817dd7cddfSDavid du Colombier 	Free *node;
3827dd7cddfSDavid du Colombier 	Free **parent;
3837dd7cddfSDavid du Colombier 
3847dd7cddfSDavid du Colombier 	antagonism {
3857dd7cddfSDavid du Colombier 		memmark(_B2D(anode), 0xF7, anode->size-sizeof(Bhdr)-sizeof(Btail));
3867dd7cddfSDavid du Colombier 	}
3877dd7cddfSDavid du Colombier 
3887dd7cddfSDavid du Colombier 	node = (Free*)anode;
3897dd7cddfSDavid du Colombier 	node->magic = FREE_MAGIC;
3907dd7cddfSDavid du Colombier 	parent = ltreewalk(&p->freeroot, node->size);
3917dd7cddfSDavid du Colombier 	olst = *parent;
3927dd7cddfSDavid du Colombier 	lst = listadd(olst, node);
3937dd7cddfSDavid du Colombier 	if(olst != lst)	/* need to update tree */
3947dd7cddfSDavid du Colombier 		*parent = treeinsert(*parent, lst);
3957dd7cddfSDavid du Colombier 	p->curfree += node->size;
3967dd7cddfSDavid du Colombier 	return node;
3977dd7cddfSDavid du Colombier }
3987dd7cddfSDavid du Colombier 
3997dd7cddfSDavid du Colombier /* pooldel: remove node from the free pool */
4007dd7cddfSDavid du Colombier static Alloc*
pooldel(Pool * p,Free * node)4017dd7cddfSDavid du Colombier pooldel(Pool *p, Free *node)
4027dd7cddfSDavid du Colombier {
4037dd7cddfSDavid du Colombier 	Free *lst, *olst;
4047dd7cddfSDavid du Colombier 	Free **parent;
4057dd7cddfSDavid du Colombier 
4067dd7cddfSDavid du Colombier 	parent = ltreewalk(&p->freeroot, node->size);
4077dd7cddfSDavid du Colombier 	olst = *parent;
4087dd7cddfSDavid du Colombier 	assert(olst != nil /* pooldel */);
4097dd7cddfSDavid du Colombier 
41084ba54caSDavid du Colombier 	lst = listdelete(p, olst, node);
4117dd7cddfSDavid du Colombier 	if(lst == nil)
4127dd7cddfSDavid du Colombier 		*parent = treedelete(*parent, olst);
4137dd7cddfSDavid du Colombier 	else if(lst != olst)
4147dd7cddfSDavid du Colombier 		*parent = treeinsert(*parent, lst);
4157dd7cddfSDavid du Colombier 
4167dd7cddfSDavid du Colombier 	node->left = node->right = Poison;
4177dd7cddfSDavid du Colombier 	p->curfree -= node->size;
4187dd7cddfSDavid du Colombier 
4197dd7cddfSDavid du Colombier 	antagonism {
4207dd7cddfSDavid du Colombier 		memmark(_B2D(node), 0xF9, node->size-sizeof(Bhdr)-sizeof(Btail));
4217dd7cddfSDavid du Colombier 	}
4227dd7cddfSDavid du Colombier 
4235243b8d1SDavid du Colombier 	node->magic = UNALLOC_MAGIC;
4247dd7cddfSDavid du Colombier 	return (Alloc*)node;
4257dd7cddfSDavid du Colombier }
4267dd7cddfSDavid du Colombier 
4277dd7cddfSDavid du Colombier /*
4287dd7cddfSDavid du Colombier  * Block maintenance
4297dd7cddfSDavid du Colombier  */
4307dd7cddfSDavid du Colombier /* block allocation */
4317dd7cddfSDavid du Colombier static ulong
dsize2bsize(Pool * p,ulong sz)4327dd7cddfSDavid du Colombier dsize2bsize(Pool *p, ulong sz)
4337dd7cddfSDavid du Colombier {
4347dd7cddfSDavid du Colombier 	sz += sizeof(Bhdr)+sizeof(Btail);
4357dd7cddfSDavid du Colombier 	if(sz < p->minblock)
4367dd7cddfSDavid du Colombier 		sz = p->minblock;
4375e91980fSDavid du Colombier 	if(sz < MINBLOCKSIZE)
4385e91980fSDavid du Colombier 		sz = MINBLOCKSIZE;
4397dd7cddfSDavid du Colombier 	sz = (sz+p->quantum-1)&~(p->quantum-1);
4407dd7cddfSDavid du Colombier 	return sz;
4417dd7cddfSDavid du Colombier }
4427dd7cddfSDavid du Colombier 
4437dd7cddfSDavid du Colombier static ulong
bsize2asize(Pool * p,ulong sz)4447dd7cddfSDavid du Colombier bsize2asize(Pool *p, ulong sz)
4457dd7cddfSDavid du Colombier {
4467dd7cddfSDavid du Colombier 	sz += sizeof(Arena)+sizeof(Btail);
4477dd7cddfSDavid du Colombier 	if(sz < p->minarena)
4487dd7cddfSDavid du Colombier 		sz = p->minarena;
4497dd7cddfSDavid du Colombier 	sz = (sz+p->quantum)&~(p->quantum-1);
4507dd7cddfSDavid du Colombier 	return sz;
4517dd7cddfSDavid du Colombier }
4527dd7cddfSDavid du Colombier 
4537dd7cddfSDavid du Colombier /* blockmerge: merge a and b, known to be adjacent */
4547dd7cddfSDavid du Colombier /* both are removed from pool if necessary. */
4557dd7cddfSDavid du Colombier static Alloc*
blockmerge(Pool * pool,Bhdr * a,Bhdr * b)4567dd7cddfSDavid du Colombier blockmerge(Pool *pool, Bhdr *a, Bhdr *b)
4577dd7cddfSDavid du Colombier {
4587dd7cddfSDavid du Colombier 	Btail *t;
4597dd7cddfSDavid du Colombier 
4607dd7cddfSDavid du Colombier 	assert(B2NB(a) == b);
4617dd7cddfSDavid du Colombier 
4627dd7cddfSDavid du Colombier 	if(a->magic == FREE_MAGIC)
4637dd7cddfSDavid du Colombier 		pooldel(pool, (Free*)a);
4647dd7cddfSDavid du Colombier 	if(b->magic == FREE_MAGIC)
4657dd7cddfSDavid du Colombier 		pooldel(pool, (Free*)b);
4667dd7cddfSDavid du Colombier 
4677dd7cddfSDavid du Colombier 	t = B2T(a);
4687dd7cddfSDavid du Colombier 	t->size = (ulong)Poison;
4697dd7cddfSDavid du Colombier 	t->magic0 = NOT_MAGIC;
4707dd7cddfSDavid du Colombier 	t->magic1 = NOT_MAGIC;
4717dd7cddfSDavid du Colombier 	PSHORT(t->datasize, NOT_MAGIC);
4727dd7cddfSDavid du Colombier 
4737dd7cddfSDavid du Colombier 	a->size += b->size;
4747dd7cddfSDavid du Colombier 	t = B2T(a);
4757dd7cddfSDavid du Colombier 	t->size = a->size;
4767dd7cddfSDavid du Colombier 	PSHORT(t->datasize, 0xFFFF);
4777dd7cddfSDavid du Colombier 
4787dd7cddfSDavid du Colombier 	b->size = NOT_MAGIC;
4797dd7cddfSDavid du Colombier 	b->magic = NOT_MAGIC;
4807dd7cddfSDavid du Colombier 
4815243b8d1SDavid du Colombier 	a->magic = UNALLOC_MAGIC;
4827dd7cddfSDavid du Colombier 	return (Alloc*)a;
4837dd7cddfSDavid du Colombier }
4847dd7cddfSDavid du Colombier 
4857dd7cddfSDavid du Colombier /* blocksetsize: set the total size of a block, fixing tail pointers */
4867dd7cddfSDavid du Colombier static Bhdr*
blocksetsize(Bhdr * b,ulong bsize)4877dd7cddfSDavid du Colombier blocksetsize(Bhdr *b, ulong bsize)
4887dd7cddfSDavid du Colombier {
4897dd7cddfSDavid du Colombier 	Btail *t;
4907dd7cddfSDavid du Colombier 
4917dd7cddfSDavid du Colombier 	assert(b->magic != FREE_MAGIC /* blocksetsize */);
4927dd7cddfSDavid du Colombier 
4937dd7cddfSDavid du Colombier 	b->size = bsize;
4947dd7cddfSDavid du Colombier 	t = B2T(b);
4957dd7cddfSDavid du Colombier 	t->size = b->size;
4967dd7cddfSDavid du Colombier 	t->magic0 = TAIL_MAGIC0;
4977dd7cddfSDavid du Colombier 	t->magic1 = TAIL_MAGIC1;
4987dd7cddfSDavid du Colombier 	return b;
4997dd7cddfSDavid du Colombier }
5007dd7cddfSDavid du Colombier 
5017dd7cddfSDavid du Colombier /* getdsize: return the requested data size for an allocated block */
5027dd7cddfSDavid du Colombier static ulong
getdsize(Alloc * b)5037dd7cddfSDavid du Colombier getdsize(Alloc *b)
5047dd7cddfSDavid du Colombier {
5057dd7cddfSDavid du Colombier 	Btail *t;
5067dd7cddfSDavid du Colombier 	t = B2T(b);
5077dd7cddfSDavid du Colombier 	return b->size - SHORT(t->datasize);
5087dd7cddfSDavid du Colombier }
5097dd7cddfSDavid du Colombier 
5107dd7cddfSDavid du Colombier /* blocksetdsize: set the user data size of a block */
5117dd7cddfSDavid du Colombier static Alloc*
blocksetdsize(Pool * p,Alloc * b,ulong dsize)5127dd7cddfSDavid du Colombier blocksetdsize(Pool *p, Alloc *b, ulong dsize)
5137dd7cddfSDavid du Colombier {
5147dd7cddfSDavid du Colombier 	Btail *t;
5157dd7cddfSDavid du Colombier 	uchar *q, *eq;
5167dd7cddfSDavid du Colombier 
5177dd7cddfSDavid du Colombier 	assert(b->size >= dsize2bsize(p, dsize));
5187dd7cddfSDavid du Colombier 	assert(b->size - dsize < 0x10000);
5197dd7cddfSDavid du Colombier 
5207dd7cddfSDavid du Colombier 	t = B2T(b);
5217dd7cddfSDavid du Colombier 	PSHORT(t->datasize, b->size - dsize);
5227dd7cddfSDavid du Colombier 
5237dd7cddfSDavid du Colombier 	q=(uchar*)_B2D(b)+dsize;
5247dd7cddfSDavid du Colombier 	eq = (uchar*)t;
5257dd7cddfSDavid du Colombier 	if(eq > q+4)
5267dd7cddfSDavid du Colombier 		eq = q+4;
5277dd7cddfSDavid du Colombier 	for(; q<eq; q++)
5285e91980fSDavid du Colombier 		*q = datamagic[((ulong)(uintptr)q)%nelem(datamagic)];
5297dd7cddfSDavid du Colombier 
5307dd7cddfSDavid du Colombier 	return b;
5317dd7cddfSDavid du Colombier }
5327dd7cddfSDavid du Colombier 
5335243b8d1SDavid du Colombier /* trim: trim a block down to what is needed to hold dsize bytes of user data */
5347dd7cddfSDavid du Colombier static Alloc*
trim(Pool * p,Alloc * b,ulong dsize)5355243b8d1SDavid du Colombier trim(Pool *p, Alloc *b, ulong dsize)
5367dd7cddfSDavid du Colombier {
5377dd7cddfSDavid du Colombier 	ulong extra, bsize;
5387dd7cddfSDavid du Colombier 	Alloc *frag;
5397dd7cddfSDavid du Colombier 
5407dd7cddfSDavid du Colombier 	bsize = dsize2bsize(p, dsize);
5417dd7cddfSDavid du Colombier 	extra = b->size - bsize;
5427dd7cddfSDavid du Colombier 	if(b->size - dsize >= 0x10000 ||
5437dd7cddfSDavid du Colombier 	  (extra >= bsize>>2 && extra >= MINBLOCKSIZE && extra >= p->minblock)) {
5447dd7cddfSDavid du Colombier 		blocksetsize(b, bsize);
5457dd7cddfSDavid du Colombier 		frag = (Alloc*) B2NB(b);
5467dd7cddfSDavid du Colombier 
5477dd7cddfSDavid du Colombier 		antagonism {
5487dd7cddfSDavid du Colombier 			memmark(frag, 0xF1, extra);
5497dd7cddfSDavid du Colombier 		}
5507dd7cddfSDavid du Colombier 
5515243b8d1SDavid du Colombier 		frag->magic = UNALLOC_MAGIC;
5527dd7cddfSDavid du Colombier 		blocksetsize(frag, extra);
5537dd7cddfSDavid du Colombier 		pooladd(p, frag);
5547dd7cddfSDavid du Colombier 	}
5557dd7cddfSDavid du Colombier 
5565243b8d1SDavid du Colombier 	b->magic = ALLOC_MAGIC;
5577dd7cddfSDavid du Colombier 	blocksetdsize(p, b, dsize);
5587dd7cddfSDavid du Colombier 	return b;
5597dd7cddfSDavid du Colombier }
5607dd7cddfSDavid du Colombier 
5615243b8d1SDavid du Colombier static Alloc*
freefromfront(Pool * p,Alloc * b,ulong skip)5625243b8d1SDavid du Colombier freefromfront(Pool *p, Alloc *b, ulong skip)
5635243b8d1SDavid du Colombier {
5645243b8d1SDavid du Colombier 	Alloc *bb;
5655243b8d1SDavid du Colombier 
5665243b8d1SDavid du Colombier 	skip = skip&~(p->quantum-1);
5675243b8d1SDavid du Colombier 	if(skip >= 0x1000 || (skip >= b->size>>2 && skip >= MINBLOCKSIZE && skip >= p->minblock)){
5685243b8d1SDavid du Colombier 		bb = (Alloc*)((uchar*)b+skip);
5695243b8d1SDavid du Colombier 		blocksetsize(bb, b->size-skip);
5705243b8d1SDavid du Colombier 		bb->magic = UNALLOC_MAGIC;
5715243b8d1SDavid du Colombier 		blocksetsize(b, skip);
5725243b8d1SDavid du Colombier 		b->magic = UNALLOC_MAGIC;
5735243b8d1SDavid du Colombier 		pooladd(p, b);
5745243b8d1SDavid du Colombier 		return bb;
5755243b8d1SDavid du Colombier 	}
5765243b8d1SDavid du Colombier 	return b;
5775243b8d1SDavid du Colombier }
5785243b8d1SDavid du Colombier 
5797dd7cddfSDavid du Colombier /*
5807dd7cddfSDavid du Colombier  * Arena maintenance
5817dd7cddfSDavid du Colombier  */
5827dd7cddfSDavid du Colombier 
5837dd7cddfSDavid du Colombier /* arenasetsize: set arena size, updating tail */
5847dd7cddfSDavid du Colombier static void
arenasetsize(Arena * a,ulong asize)5857dd7cddfSDavid du Colombier arenasetsize(Arena *a, ulong asize)
5867dd7cddfSDavid du Colombier {
5877dd7cddfSDavid du Colombier 	Bhdr *atail;
5887dd7cddfSDavid du Colombier 
5897dd7cddfSDavid du Colombier 	a->asize = asize;
5907dd7cddfSDavid du Colombier 	atail = A2TB(a);
5917dd7cddfSDavid du Colombier 	atail->magic = ARENATAIL_MAGIC;
5927dd7cddfSDavid du Colombier 	atail->size = 0;
5937dd7cddfSDavid du Colombier }
5947dd7cddfSDavid du Colombier 
5957dd7cddfSDavid du Colombier /* poolnewarena: allocate new arena */
5967dd7cddfSDavid du Colombier static void
poolnewarena(Pool * p,ulong asize)5977dd7cddfSDavid du Colombier poolnewarena(Pool *p, ulong asize)
5987dd7cddfSDavid du Colombier {
5997dd7cddfSDavid du Colombier 	Arena *a;
6007dd7cddfSDavid du Colombier 	Arena *ap, *lastap;
6017dd7cddfSDavid du Colombier 	Alloc *b;
6027dd7cddfSDavid du Colombier 
6037dd7cddfSDavid du Colombier 	LOG(p, "newarena %lud\n", asize);
6047dd7cddfSDavid du Colombier 	if(p->cursize+asize > p->maxsize) {
6059a747e4fSDavid du Colombier 		if(poolcompactl(p) == 0){
6067dd7cddfSDavid du Colombier 			LOG(p, "pool too big: %lud+%lud > %lud\n",
6077dd7cddfSDavid du Colombier 				p->cursize, asize, p->maxsize);
6089a747e4fSDavid du Colombier 			werrstr("memory pool too large");
6099a747e4fSDavid du Colombier 		}
6107dd7cddfSDavid du Colombier 		return;
6117dd7cddfSDavid du Colombier 	}
6127dd7cddfSDavid du Colombier 
6137dd7cddfSDavid du Colombier 	if((a = p->alloc(asize)) == nil) {
6147dd7cddfSDavid du Colombier 		/* assume errstr set by p->alloc */
6157dd7cddfSDavid du Colombier 		return;
6167dd7cddfSDavid du Colombier 	}
6177dd7cddfSDavid du Colombier 
6187dd7cddfSDavid du Colombier 	p->cursize += asize;
6197dd7cddfSDavid du Colombier 
6207dd7cddfSDavid du Colombier 	/* arena hdr */
6217dd7cddfSDavid du Colombier 	a->magic = ARENA_MAGIC;
6227dd7cddfSDavid du Colombier 	blocksetsize(a, sizeof(Arena));
6237dd7cddfSDavid du Colombier 	arenasetsize(a, asize);
6247dd7cddfSDavid du Colombier 	blockcheck(p, a);
6257dd7cddfSDavid du Colombier 
6267dd7cddfSDavid du Colombier 	/* create one large block in arena */
6277dd7cddfSDavid du Colombier 	b = (Alloc*)A2B(a);
6285243b8d1SDavid du Colombier 	b->magic = UNALLOC_MAGIC;
6297dd7cddfSDavid du Colombier 	blocksetsize(b, (uchar*)A2TB(a)-(uchar*)b);
6307dd7cddfSDavid du Colombier 	blockcheck(p, b);
6317dd7cddfSDavid du Colombier 	pooladd(p, b);
6327dd7cddfSDavid du Colombier 	blockcheck(p, b);
6337dd7cddfSDavid du Colombier 
6347dd7cddfSDavid du Colombier 	/* sort arena into descending sorted arena list */
6357dd7cddfSDavid du Colombier 	for(lastap=nil, ap=p->arenalist; ap > a; lastap=ap, ap=ap->down)
6367dd7cddfSDavid du Colombier 		;
6377dd7cddfSDavid du Colombier 
6387dd7cddfSDavid du Colombier 	if(a->down = ap)	/* assign = */
6397dd7cddfSDavid du Colombier 		a->down->aup = a;
6407dd7cddfSDavid du Colombier 
6417dd7cddfSDavid du Colombier 	if(a->aup = lastap)	/* assign = */
6427dd7cddfSDavid du Colombier 		a->aup->down = a;
6437dd7cddfSDavid du Colombier 	else
6447dd7cddfSDavid du Colombier 		p->arenalist = a;
6457dd7cddfSDavid du Colombier 
6467dd7cddfSDavid du Colombier 	/* merge with surrounding arenas if possible */
6477dd7cddfSDavid du Colombier 	/* must do a with up before down with a (think about it) */
6487dd7cddfSDavid du Colombier 	if(a->aup)
6497dd7cddfSDavid du Colombier 		arenamerge(p, a, a->aup);
6507dd7cddfSDavid du Colombier 	if(a->down)
6517dd7cddfSDavid du Colombier 		arenamerge(p, a->down, a);
6527dd7cddfSDavid du Colombier }
6537dd7cddfSDavid du Colombier 
6547dd7cddfSDavid du Colombier /* blockresize: grow a block to encompass space past its end, possibly by */
6557dd7cddfSDavid du Colombier /* trimming it into two different blocks. */
6567dd7cddfSDavid du Colombier static void
blockgrow(Pool * p,Bhdr * b,ulong nsize)6577dd7cddfSDavid du Colombier blockgrow(Pool *p, Bhdr *b, ulong nsize)
6587dd7cddfSDavid du Colombier {
6597dd7cddfSDavid du Colombier 	if(b->magic == FREE_MAGIC) {
6607dd7cddfSDavid du Colombier 		Alloc *a;
6617dd7cddfSDavid du Colombier 		Bhdr *bnxt;
6627dd7cddfSDavid du Colombier 		a = pooldel(p, (Free*)b);
6637dd7cddfSDavid du Colombier 		blockcheck(p, a);
6647dd7cddfSDavid du Colombier 		blocksetsize(a, nsize);
6657dd7cddfSDavid du Colombier 		blockcheck(p, a);
6667dd7cddfSDavid du Colombier 		bnxt = B2NB(a);
6677dd7cddfSDavid du Colombier 		if(bnxt->magic == FREE_MAGIC)
6687dd7cddfSDavid du Colombier 			a = blockmerge(p, a, bnxt);
6697dd7cddfSDavid du Colombier 		blockcheck(p, a);
6707dd7cddfSDavid du Colombier 		pooladd(p, a);
6717dd7cddfSDavid du Colombier 	} else {
6727dd7cddfSDavid du Colombier 		Alloc *a;
6737dd7cddfSDavid du Colombier 		ulong dsize;
6747dd7cddfSDavid du Colombier 
6757dd7cddfSDavid du Colombier 		a = (Alloc*)b;
6767dd7cddfSDavid du Colombier 		dsize = getdsize(a);
6777dd7cddfSDavid du Colombier 		blocksetsize(a, nsize);
6785243b8d1SDavid du Colombier 		trim(p, a, dsize);
6797dd7cddfSDavid du Colombier 	}
6807dd7cddfSDavid du Colombier }
6817dd7cddfSDavid du Colombier 
6827dd7cddfSDavid du Colombier /* arenamerge: attempt to coalesce to arenas that might be adjacent */
6837dd7cddfSDavid du Colombier static Arena*
arenamerge(Pool * p,Arena * bot,Arena * top)6847dd7cddfSDavid du Colombier arenamerge(Pool *p, Arena *bot, Arena *top)
6857dd7cddfSDavid du Colombier {
6867dd7cddfSDavid du Colombier 	Bhdr *bbot, *btop;
6877dd7cddfSDavid du Colombier 	Btail *t;
6887dd7cddfSDavid du Colombier 
6897dd7cddfSDavid du Colombier 	blockcheck(p, bot);
6907dd7cddfSDavid du Colombier 	blockcheck(p, top);
6917dd7cddfSDavid du Colombier 	assert(bot->aup == top && top > bot);
6927dd7cddfSDavid du Colombier 
6937dd7cddfSDavid du Colombier 	if(p->merge == nil || p->merge(bot, top) == 0)
6947dd7cddfSDavid du Colombier 		return nil;
6957dd7cddfSDavid du Colombier 
6967dd7cddfSDavid du Colombier 	/* remove top from list */
6977dd7cddfSDavid du Colombier 	if(bot->aup = top->aup)	/* assign = */
6987dd7cddfSDavid du Colombier 		bot->aup->down = bot;
6997dd7cddfSDavid du Colombier 	else
7007dd7cddfSDavid du Colombier 		p->arenalist = bot;
7017dd7cddfSDavid du Colombier 
7027dd7cddfSDavid du Colombier 	/* save ptrs to last block in bot, first block in top */
7037dd7cddfSDavid du Colombier 	t = B2PT(A2TB(bot));
7047dd7cddfSDavid du Colombier 	bbot = T2HDR(t);
7057dd7cddfSDavid du Colombier 	btop = A2B(top);
7067dd7cddfSDavid du Colombier 	blockcheck(p, bbot);
7077dd7cddfSDavid du Colombier 	blockcheck(p, btop);
7087dd7cddfSDavid du Colombier 
7097dd7cddfSDavid du Colombier 	/* grow bottom arena to encompass top */
7107dd7cddfSDavid du Colombier 	arenasetsize(bot, top->asize + ((uchar*)top - (uchar*)bot));
7117dd7cddfSDavid du Colombier 
7127dd7cddfSDavid du Colombier 	/* grow bottom block to encompass space between arenas */
7137dd7cddfSDavid du Colombier 	blockgrow(p, bbot, (uchar*)btop-(uchar*)bbot);
7147dd7cddfSDavid du Colombier 	blockcheck(p, bbot);
7157dd7cddfSDavid du Colombier 	return bot;
7167dd7cddfSDavid du Colombier }
7177dd7cddfSDavid du Colombier 
7187dd7cddfSDavid du Colombier /* dumpblock: print block's vital stats */
7197dd7cddfSDavid du Colombier static void
dumpblock(Pool * p,Bhdr * b)7207dd7cddfSDavid du Colombier dumpblock(Pool *p, Bhdr *b)
7217dd7cddfSDavid du Colombier {
7227dd7cddfSDavid du Colombier 	ulong *dp;
7237dd7cddfSDavid du Colombier 	ulong dsize;
7247dd7cddfSDavid du Colombier 	uchar *cp;
7257dd7cddfSDavid du Colombier 
7267dd7cddfSDavid du Colombier 	dp = (ulong*)b;
7277dd7cddfSDavid du Colombier 	p->print(p, "pool %s block %p\nhdr %.8lux %.8lux %.8lux %.8lux %.8lux %.8lux\n",
7287dd7cddfSDavid du Colombier 		p->name, b, dp[0], dp[1], dp[2], dp[3], dp[4], dp[5], dp[6]);
7297dd7cddfSDavid du Colombier 
7307dd7cddfSDavid du Colombier 	dp = (ulong*)B2T(b);
7319a747e4fSDavid du Colombier 	p->print(p, "tail %.8lux %.8lux %.8lux %.8lux %.8lux %.8lux | %.8lux %.8lux\n",
7329a747e4fSDavid du Colombier 		dp[-6], dp[-5], dp[-4], dp[-3], dp[-2], dp[-1], dp[0], dp[1]);
7337dd7cddfSDavid du Colombier 
7345243b8d1SDavid du Colombier 	if(b->magic == ALLOC_MAGIC){
7357dd7cddfSDavid du Colombier 		dsize = getdsize((Alloc*)b);
7367dd7cddfSDavid du Colombier 		if(dsize >= b->size)	/* user data size corrupt */
7377dd7cddfSDavid du Colombier 			return;
7387dd7cddfSDavid du Colombier 
7397dd7cddfSDavid du Colombier 		cp = (uchar*)_B2D(b)+dsize;
7407dd7cddfSDavid du Colombier 		p->print(p, "user data ");
7417dd7cddfSDavid du Colombier 		p->print(p, "%.2ux %.2ux %.2ux %.2ux  %.2ux %.2ux %.2ux %.2ux",
7427dd7cddfSDavid du Colombier 			cp[-8], cp[-7], cp[-6], cp[-5], cp[-4], cp[-3], cp[-2], cp[-1]);
7437dd7cddfSDavid du Colombier 		p->print(p, " | %.2ux %.2ux %.2ux %.2ux  %.2ux %.2ux %.2ux %.2ux\n",
7447dd7cddfSDavid du Colombier 			cp[0], cp[1], cp[2], cp[3], cp[4], cp[5], cp[6], cp[7]);
7457dd7cddfSDavid du Colombier 	}
7467dd7cddfSDavid du Colombier }
7477dd7cddfSDavid du Colombier 
7487dd7cddfSDavid du Colombier static void
printblock(Pool * p,Bhdr * b,char * msg)7497dd7cddfSDavid du Colombier printblock(Pool *p, Bhdr *b, char *msg)
7507dd7cddfSDavid du Colombier {
7517dd7cddfSDavid du Colombier 	p->print(p, "%s\n", msg);
7527dd7cddfSDavid du Colombier 	dumpblock(p, b);
7537dd7cddfSDavid du Colombier }
7547dd7cddfSDavid du Colombier 
7557dd7cddfSDavid du Colombier static void
panicblock(Pool * p,Bhdr * b,char * msg)7567dd7cddfSDavid du Colombier panicblock(Pool *p, Bhdr *b, char *msg)
7577dd7cddfSDavid du Colombier {
7587dd7cddfSDavid du Colombier 	p->print(p, "%s\n", msg);
7597dd7cddfSDavid du Colombier 	dumpblock(p, b);
7607dd7cddfSDavid du Colombier 	p->panic(p, "pool panic");
7617dd7cddfSDavid du Colombier }
7627dd7cddfSDavid du Colombier 
7637dd7cddfSDavid du Colombier /* blockcheck: ensure a block consistent with our expectations */
7647dd7cddfSDavid du Colombier /* should only be called when holding pool lock */
7657dd7cddfSDavid du Colombier static void
blockcheck(Pool * p,Bhdr * b)7667dd7cddfSDavid du Colombier blockcheck(Pool *p, Bhdr *b)
7677dd7cddfSDavid du Colombier {
7687dd7cddfSDavid du Colombier 	Alloc *a;
7697dd7cddfSDavid du Colombier 	Btail *t;
7709a747e4fSDavid du Colombier 	int i, n;
7717dd7cddfSDavid du Colombier 	uchar *q, *bq, *eq;
7727dd7cddfSDavid du Colombier 	ulong dsize;
7737dd7cddfSDavid du Colombier 
7747dd7cddfSDavid du Colombier 	switch(b->magic) {
7757dd7cddfSDavid du Colombier 	default:
7767dd7cddfSDavid du Colombier 		panicblock(p, b, "bad magic");
7777dd7cddfSDavid du Colombier 	case FREE_MAGIC:
7785243b8d1SDavid du Colombier 	case UNALLOC_MAGIC:
7797dd7cddfSDavid du Colombier 	 	t = B2T(b);
7807dd7cddfSDavid du Colombier 		if(t->magic0 != TAIL_MAGIC0 || t->magic1 != TAIL_MAGIC1)
7817dd7cddfSDavid du Colombier 			panicblock(p, b, "corrupt tail magic");
7827dd7cddfSDavid du Colombier 		if(T2HDR(t) != b)
7837dd7cddfSDavid du Colombier 			panicblock(p, b, "corrupt tail ptr");
7847dd7cddfSDavid du Colombier 		break;
7859a747e4fSDavid du Colombier 	case DEAD_MAGIC:
7869a747e4fSDavid du Colombier 	 	t = B2T(b);
7879a747e4fSDavid du Colombier 		if(t->magic0 != TAIL_MAGIC0 || t->magic1 != TAIL_MAGIC1)
7889a747e4fSDavid du Colombier 			panicblock(p, b, "corrupt tail magic");
7899a747e4fSDavid du Colombier 		if(T2HDR(t) != b)
7909a747e4fSDavid du Colombier 			panicblock(p, b, "corrupt tail ptr");
7919a747e4fSDavid du Colombier 		n = getdsize((Alloc*)b);
7929a747e4fSDavid du Colombier 		q = _B2D(b);
7939a747e4fSDavid du Colombier 		q += 8;
7949a747e4fSDavid du Colombier 		for(i=8; i<n; i++)
7959a747e4fSDavid du Colombier 			if(*q++ != 0xDA)
7969a747e4fSDavid du Colombier 				panicblock(p, b, "dangling pointer write");
7979a747e4fSDavid du Colombier 		break;
7987dd7cddfSDavid du Colombier 	case ARENA_MAGIC:
7997dd7cddfSDavid du Colombier 		b = A2TB((Arena*)b);
8007dd7cddfSDavid du Colombier 		if(b->magic != ARENATAIL_MAGIC)
8017dd7cddfSDavid du Colombier 			panicblock(p, b, "bad arena size");
8027dd7cddfSDavid du Colombier 		/* fall through */
8037dd7cddfSDavid du Colombier 	case ARENATAIL_MAGIC:
8047dd7cddfSDavid du Colombier 		if(b->size != 0)
8057dd7cddfSDavid du Colombier 			panicblock(p, b, "bad arena tail size");
8067dd7cddfSDavid du Colombier 		break;
8075243b8d1SDavid du Colombier 	case ALLOC_MAGIC:
8087dd7cddfSDavid du Colombier 		a = (Alloc*)b;
8097dd7cddfSDavid du Colombier 	 	t = B2T(b);
8107dd7cddfSDavid du Colombier 		dsize = getdsize(a);
8117dd7cddfSDavid du Colombier 		bq = (uchar*)_B2D(a)+dsize;
8127dd7cddfSDavid du Colombier 		eq = (uchar*)t;
8137dd7cddfSDavid du Colombier 
8147dd7cddfSDavid du Colombier 		if(t->magic0 != TAIL_MAGIC0){
8157dd7cddfSDavid du Colombier 			/* if someone wrote exactly one byte over and it was a NUL, we sometimes only complain. */
8167dd7cddfSDavid du Colombier 			if((p->flags & POOL_TOLERANCE) && bq == eq && t->magic0 == 0)
8177dd7cddfSDavid du Colombier 				printblock(p, b, "mem user overflow (magic0)");
8187dd7cddfSDavid du Colombier 			else
8197dd7cddfSDavid du Colombier 				panicblock(p, b, "corrupt tail magic0");
8207dd7cddfSDavid du Colombier 		}
8217dd7cddfSDavid du Colombier 
8227dd7cddfSDavid du Colombier 		if(t->magic1 != TAIL_MAGIC1)
8237dd7cddfSDavid du Colombier 			panicblock(p, b, "corrupt tail magic1");
8247dd7cddfSDavid du Colombier 		if(T2HDR(t) != b)
8257dd7cddfSDavid du Colombier 			panicblock(p, b, "corrupt tail ptr");
8267dd7cddfSDavid du Colombier 
8277dd7cddfSDavid du Colombier 		if(dsize2bsize(p, dsize)  > a->size)
8287dd7cddfSDavid du Colombier 			panicblock(p, b, "too much block data");
8297dd7cddfSDavid du Colombier 
8307dd7cddfSDavid du Colombier 		if(eq > bq+4)
8317dd7cddfSDavid du Colombier 			eq = bq+4;
8327dd7cddfSDavid du Colombier 		for(q=bq; q<eq; q++){
8335e91980fSDavid du Colombier 			if(*q != datamagic[((uintptr)q)%nelem(datamagic)]){
8347dd7cddfSDavid du Colombier 				if(q == bq && *q == 0 && (p->flags & POOL_TOLERANCE)){
8357dd7cddfSDavid du Colombier 					printblock(p, b, "mem user overflow");
8367dd7cddfSDavid du Colombier 					continue;
8377dd7cddfSDavid du Colombier 				}
8387dd7cddfSDavid du Colombier 				panicblock(p, b, "mem user overflow");
8397dd7cddfSDavid du Colombier 			}
8407dd7cddfSDavid du Colombier 		}
8417dd7cddfSDavid du Colombier 		break;
8427dd7cddfSDavid du Colombier 	}
8437dd7cddfSDavid du Colombier }
8447dd7cddfSDavid du Colombier 
8457dd7cddfSDavid du Colombier /*
8467dd7cddfSDavid du Colombier  * compact an arena by shifting all the free blocks to the end.
8477dd7cddfSDavid du Colombier  * assumes pool lock is held.
8487dd7cddfSDavid du Colombier  */
8497dd7cddfSDavid du Colombier enum {
8507dd7cddfSDavid du Colombier 	FLOATING_MAGIC = 0xCBCBCBCB,	/* temporarily neither allocated nor in the free tree */
8517dd7cddfSDavid du Colombier };
8527dd7cddfSDavid du Colombier 
8537dd7cddfSDavid du Colombier static int
arenacompact(Pool * p,Arena * a)8547dd7cddfSDavid du Colombier arenacompact(Pool *p, Arena *a)
8557dd7cddfSDavid du Colombier {
8567dd7cddfSDavid du Colombier 	Bhdr *b, *wb, *eb, *nxt;
8577dd7cddfSDavid du Colombier 	int compacted;
8587dd7cddfSDavid du Colombier 
8597dd7cddfSDavid du Colombier 	if(p->move == nil)
8607dd7cddfSDavid du Colombier 		p->panic(p, "don't call me when pool->move is nil\n");
8617dd7cddfSDavid du Colombier 
8627dd7cddfSDavid du Colombier 	poolcheckarena(p, a);
8637dd7cddfSDavid du Colombier 	eb = A2TB(a);
8647dd7cddfSDavid du Colombier 	compacted = 0;
8657dd7cddfSDavid du Colombier 	for(b=wb=A2B(a); b && b < eb; b=nxt) {
8667dd7cddfSDavid du Colombier 		nxt = B2NB(b);
8677dd7cddfSDavid du Colombier 		switch(b->magic) {
8687dd7cddfSDavid du Colombier 		case FREE_MAGIC:
8697dd7cddfSDavid du Colombier 			pooldel(p, (Free*)b);
8707dd7cddfSDavid du Colombier 			b->magic = FLOATING_MAGIC;
8717dd7cddfSDavid du Colombier 			break;
8725243b8d1SDavid du Colombier 		case ALLOC_MAGIC:
8737dd7cddfSDavid du Colombier 			if(wb != b) {
8747dd7cddfSDavid du Colombier 				memmove(wb, b, b->size);
8757dd7cddfSDavid du Colombier 				p->move(_B2D(b), _B2D(wb));
8767dd7cddfSDavid du Colombier 				compacted = 1;
8777dd7cddfSDavid du Colombier 			}
8787dd7cddfSDavid du Colombier 			wb = B2NB(wb);
8797dd7cddfSDavid du Colombier 			break;
8807dd7cddfSDavid du Colombier 		}
8817dd7cddfSDavid du Colombier 	}
8827dd7cddfSDavid du Colombier 
8837dd7cddfSDavid du Colombier 	/*
8847dd7cddfSDavid du Colombier 	 * the only free data is now at the end of the arena, pointed
8857dd7cddfSDavid du Colombier 	 * at by wb.  all we need to do is set its size and get out.
8867dd7cddfSDavid du Colombier 	 */
8877dd7cddfSDavid du Colombier 	if(wb < eb) {
8885243b8d1SDavid du Colombier 		wb->magic = UNALLOC_MAGIC;
8897dd7cddfSDavid du Colombier 		blocksetsize(wb, (uchar*)eb-(uchar*)wb);
8907dd7cddfSDavid du Colombier 		pooladd(p, (Alloc*)wb);
8917dd7cddfSDavid du Colombier 	}
8927dd7cddfSDavid du Colombier 
8937dd7cddfSDavid du Colombier 	return compacted;
8947dd7cddfSDavid du Colombier }
8957dd7cddfSDavid du Colombier 
8967dd7cddfSDavid du Colombier /*
8977dd7cddfSDavid du Colombier  * compact a pool by compacting each individual arena.
8987dd7cddfSDavid du Colombier  * 'twould be nice to shift blocks from one arena to the
8997dd7cddfSDavid du Colombier  * next but it's a pain to code.
9007dd7cddfSDavid du Colombier  */
9017dd7cddfSDavid du Colombier static int
poolcompactl(Pool * pool)9027dd7cddfSDavid du Colombier poolcompactl(Pool *pool)
9037dd7cddfSDavid du Colombier {
9047dd7cddfSDavid du Colombier 	Arena *a;
9057dd7cddfSDavid du Colombier 	int compacted;
9067dd7cddfSDavid du Colombier 
9077dd7cddfSDavid du Colombier 	if(pool->move == nil || pool->lastcompact == pool->nfree)
9087dd7cddfSDavid du Colombier 		return 0;
9097dd7cddfSDavid du Colombier 
9107dd7cddfSDavid du Colombier 	pool->lastcompact = pool->nfree;
9117dd7cddfSDavid du Colombier 	compacted = 0;
9127dd7cddfSDavid du Colombier 	for(a=pool->arenalist; a; a=a->down)
9137dd7cddfSDavid du Colombier 		compacted |= arenacompact(pool, a);
9147dd7cddfSDavid du Colombier 	return compacted;
9157dd7cddfSDavid du Colombier }
9167dd7cddfSDavid du Colombier 
9177dd7cddfSDavid du Colombier /*
9187dd7cddfSDavid du Colombier static int
9197dd7cddfSDavid du Colombier poolcompactl(Pool*)
9207dd7cddfSDavid du Colombier {
9217dd7cddfSDavid du Colombier 	return 0;
9227dd7cddfSDavid du Colombier }
9237dd7cddfSDavid du Colombier */
9247dd7cddfSDavid du Colombier 
9257dd7cddfSDavid du Colombier /*
9267dd7cddfSDavid du Colombier  * Actual allocators
9277dd7cddfSDavid du Colombier  */
9287dd7cddfSDavid du Colombier 
9297dd7cddfSDavid du Colombier /*
9307dd7cddfSDavid du Colombier static void*
9317dd7cddfSDavid du Colombier _B2D(void *a)
9327dd7cddfSDavid du Colombier {
9337dd7cddfSDavid du Colombier 	return (uchar*)a+sizeof(Bhdr);
9347dd7cddfSDavid du Colombier }
9357dd7cddfSDavid du Colombier */
9367dd7cddfSDavid du Colombier 
9377dd7cddfSDavid du Colombier static void*
B2D(Pool * p,Alloc * a)9387dd7cddfSDavid du Colombier B2D(Pool *p, Alloc *a)
9397dd7cddfSDavid du Colombier {
9405243b8d1SDavid du Colombier 	if(a->magic != ALLOC_MAGIC)
9417dd7cddfSDavid du Colombier 		p->panic(p, "B2D called on unworthy block");
9427dd7cddfSDavid du Colombier 	return _B2D(a);
9437dd7cddfSDavid du Colombier }
9447dd7cddfSDavid du Colombier 
9457dd7cddfSDavid du Colombier /*
9467dd7cddfSDavid du Colombier static void*
9477dd7cddfSDavid du Colombier _D2B(void *v)
9487dd7cddfSDavid du Colombier {
9497dd7cddfSDavid du Colombier 	Alloc *a;
9507dd7cddfSDavid du Colombier 	a = (Alloc*)((uchar*)v-sizeof(Bhdr));
9517dd7cddfSDavid du Colombier 	return a;
9527dd7cddfSDavid du Colombier }
9537dd7cddfSDavid du Colombier */
9547dd7cddfSDavid du Colombier 
9557dd7cddfSDavid du Colombier static Alloc*
D2B(Pool * p,void * v)9567dd7cddfSDavid du Colombier D2B(Pool *p, void *v)
9577dd7cddfSDavid du Colombier {
9587dd7cddfSDavid du Colombier 	Alloc *a;
9595243b8d1SDavid du Colombier 	ulong *u;
9605243b8d1SDavid du Colombier 
9615e91980fSDavid du Colombier 	if((uintptr)v&(sizeof(ulong)-1))
9625e91980fSDavid du Colombier 		v = (char*)v - ((uintptr)v&(sizeof(ulong)-1));
9635243b8d1SDavid du Colombier 	u = v;
9645243b8d1SDavid du Colombier 	while(u[-1] == ALIGN_MAGIC)
9655243b8d1SDavid du Colombier 		u--;
9665243b8d1SDavid du Colombier 	a = _D2B(u);
9675243b8d1SDavid du Colombier 	if(a->magic != ALLOC_MAGIC)
968e288d156SDavid du Colombier 		p->panic(p, "D2B called on non-block %p (double-free?)", v);
9697dd7cddfSDavid du Colombier 	return a;
9707dd7cddfSDavid du Colombier }
9717dd7cddfSDavid du Colombier 
9727dd7cddfSDavid du Colombier /* poolallocl: attempt to allocate block to hold dsize user bytes; assumes lock held */
9737dd7cddfSDavid du Colombier static void*
poolallocl(Pool * p,ulong dsize)9747dd7cddfSDavid du Colombier poolallocl(Pool *p, ulong dsize)
9757dd7cddfSDavid du Colombier {
9767dd7cddfSDavid du Colombier 	ulong bsize;
9777dd7cddfSDavid du Colombier 	Free *fb;
9787dd7cddfSDavid du Colombier 	Alloc *ab;
9797dd7cddfSDavid du Colombier 
980208510e1SDavid du Colombier 	if(dsize >= 0x80000000UL){	/* for sanity, overflow */
9819a747e4fSDavid du Colombier 		werrstr("invalid allocation size");
9827dd7cddfSDavid du Colombier 		return nil;
9839a747e4fSDavid du Colombier 	}
9847dd7cddfSDavid du Colombier 
9857dd7cddfSDavid du Colombier 	bsize = dsize2bsize(p, dsize);
9867dd7cddfSDavid du Colombier 
9877dd7cddfSDavid du Colombier 	fb = treelookupgt(p->freeroot, bsize);
9887dd7cddfSDavid du Colombier 	if(fb == nil) {
9897dd7cddfSDavid du Colombier 		poolnewarena(p, bsize2asize(p, bsize));
9907dd7cddfSDavid du Colombier 		if((fb = treelookupgt(p->freeroot, bsize)) == nil) {
9917dd7cddfSDavid du Colombier 			/* assume poolnewarena failed and set %r */
9927dd7cddfSDavid du Colombier 			return nil;
9937dd7cddfSDavid du Colombier 		}
9947dd7cddfSDavid du Colombier 	}
9957dd7cddfSDavid du Colombier 
9965243b8d1SDavid du Colombier 	ab = trim(p, pooldel(p, fb), dsize);
9977dd7cddfSDavid du Colombier 	p->curalloc += ab->size;
998b85a8364SDavid du Colombier 	antagonism {
999b85a8364SDavid du Colombier 		memset(B2D(p, ab), 0xDF, dsize);
1000b85a8364SDavid du Colombier 	}
10017dd7cddfSDavid du Colombier 	return B2D(p, ab);
10027dd7cddfSDavid du Colombier }
10037dd7cddfSDavid du Colombier 
10047dd7cddfSDavid du Colombier /* poolreallocl: attempt to grow v to ndsize bytes; assumes lock held */
10057dd7cddfSDavid du Colombier static void*
poolreallocl(Pool * p,void * v,ulong ndsize)10067dd7cddfSDavid du Colombier poolreallocl(Pool *p, void *v, ulong ndsize)
10077dd7cddfSDavid du Colombier {
10087dd7cddfSDavid du Colombier 	Alloc *a;
10097dd7cddfSDavid du Colombier 	Bhdr *left, *right, *newb;
10107dd7cddfSDavid du Colombier 	Btail *t;
10117dd7cddfSDavid du Colombier 	ulong nbsize;
10127dd7cddfSDavid du Colombier 	ulong odsize;
10137dd7cddfSDavid du Colombier 	ulong obsize;
10147dd7cddfSDavid du Colombier 	void *nv;
10157dd7cddfSDavid du Colombier 
10167dd7cddfSDavid du Colombier 	if(v == nil)	/* for ANSI */
10177dd7cddfSDavid du Colombier 		return poolallocl(p, ndsize);
10187dd7cddfSDavid du Colombier 	if(ndsize == 0) {
10197dd7cddfSDavid du Colombier 		poolfreel(p, v);
10207dd7cddfSDavid du Colombier 		return nil;
10217dd7cddfSDavid du Colombier 	}
10227dd7cddfSDavid du Colombier 	a = D2B(p, v);
10237dd7cddfSDavid du Colombier 	blockcheck(p, a);
10247dd7cddfSDavid du Colombier 	odsize = getdsize(a);
10257dd7cddfSDavid du Colombier 	obsize = a->size;
10267dd7cddfSDavid du Colombier 
10277dd7cddfSDavid du Colombier 	/* can reuse the same block? */
10287dd7cddfSDavid du Colombier 	nbsize = dsize2bsize(p, ndsize);
10297dd7cddfSDavid du Colombier 	if(nbsize <= a->size) {
10307dd7cddfSDavid du Colombier 	Returnblock:
10317dd7cddfSDavid du Colombier 		if(v != _B2D(a))
10327dd7cddfSDavid du Colombier 			memmove(_B2D(a), v, odsize);
10335243b8d1SDavid du Colombier 		a = trim(p, a, ndsize);
10347dd7cddfSDavid du Colombier 		p->curalloc -= obsize;
10357dd7cddfSDavid du Colombier 		p->curalloc += a->size;
10367dd7cddfSDavid du Colombier 		v = B2D(p, a);
10377dd7cddfSDavid du Colombier 		return v;
10387dd7cddfSDavid du Colombier 	}
10397dd7cddfSDavid du Colombier 
10407dd7cddfSDavid du Colombier 	/* can merge with surrounding blocks? */
10417dd7cddfSDavid du Colombier 	right = B2NB(a);
10427dd7cddfSDavid du Colombier 	if(right->magic == FREE_MAGIC && a->size+right->size >= nbsize) {
10437dd7cddfSDavid du Colombier 		a = blockmerge(p, a, right);
10447dd7cddfSDavid du Colombier 		goto Returnblock;
10457dd7cddfSDavid du Colombier 	}
10467dd7cddfSDavid du Colombier 
10477dd7cddfSDavid du Colombier 	t = B2PT(a);
10487dd7cddfSDavid du Colombier 	left = T2HDR(t);
10497dd7cddfSDavid du Colombier 	if(left->magic == FREE_MAGIC && left->size+a->size >= nbsize) {
10507dd7cddfSDavid du Colombier 		a = blockmerge(p, left, a);
10517dd7cddfSDavid du Colombier 		goto Returnblock;
10527dd7cddfSDavid du Colombier 	}
10537dd7cddfSDavid du Colombier 
10547dd7cddfSDavid du Colombier 	if(left->magic == FREE_MAGIC && right->magic == FREE_MAGIC
10557dd7cddfSDavid du Colombier 	&& left->size+a->size+right->size >= nbsize) {
10567dd7cddfSDavid du Colombier 		a = blockmerge(p, blockmerge(p, left, a), right);
10577dd7cddfSDavid du Colombier 		goto Returnblock;
10587dd7cddfSDavid du Colombier 	}
10597dd7cddfSDavid du Colombier 
10607dd7cddfSDavid du Colombier 	if((nv = poolallocl(p, ndsize)) == nil)
10617dd7cddfSDavid du Colombier 		return nil;
10627dd7cddfSDavid du Colombier 
10637dd7cddfSDavid du Colombier 	/* maybe the new block is next to us; if so, merge */
10647dd7cddfSDavid du Colombier 	left = T2HDR(B2PT(a));
10657dd7cddfSDavid du Colombier 	right = B2NB(a);
10667dd7cddfSDavid du Colombier 	newb = D2B(p, nv);
10677dd7cddfSDavid du Colombier 	if(left == newb || right == newb) {
10687dd7cddfSDavid du Colombier 		if(left == newb || left->magic == FREE_MAGIC)
10697dd7cddfSDavid du Colombier 			a = blockmerge(p, left, a);
10707dd7cddfSDavid du Colombier 		if(right == newb || right->magic == FREE_MAGIC)
10717dd7cddfSDavid du Colombier 			a = blockmerge(p, a, right);
10727dd7cddfSDavid du Colombier 		assert(a->size >= nbsize);
10737dd7cddfSDavid du Colombier 		goto Returnblock;
10747dd7cddfSDavid du Colombier 	}
10757dd7cddfSDavid du Colombier 
10767dd7cddfSDavid du Colombier 	/* enough cleverness */
10777dd7cddfSDavid du Colombier 	memmove(nv, v, odsize);
1078b85a8364SDavid du Colombier 	antagonism {
1079b85a8364SDavid du Colombier 		memset((char*)nv+odsize, 0xDE, ndsize-odsize);
1080b85a8364SDavid du Colombier 	}
10817dd7cddfSDavid du Colombier 	poolfreel(p, v);
10827dd7cddfSDavid du Colombier 	return nv;
10837dd7cddfSDavid du Colombier }
10847dd7cddfSDavid du Colombier 
10855243b8d1SDavid du Colombier static void*
alignptr(void * v,ulong align,long offset)10865243b8d1SDavid du Colombier alignptr(void *v, ulong align, long offset)
10875243b8d1SDavid du Colombier {
10885243b8d1SDavid du Colombier 	char *c;
10895243b8d1SDavid du Colombier 	ulong off;
10905243b8d1SDavid du Colombier 
10915243b8d1SDavid du Colombier 	c = v;
10925243b8d1SDavid du Colombier 	if(align){
10935e91980fSDavid du Colombier 		off = (uintptr)c%align;
10945243b8d1SDavid du Colombier 		if(off != offset){
10955243b8d1SDavid du Colombier 			c += offset - off;
10965243b8d1SDavid du Colombier 			if(off > offset)
10975243b8d1SDavid du Colombier 				c += align;
10985243b8d1SDavid du Colombier 		}
10995243b8d1SDavid du Colombier 	}
11005243b8d1SDavid du Colombier 	return c;
11015243b8d1SDavid du Colombier }
11025243b8d1SDavid du Colombier 
1103*f7c114afSDavid du Colombier /* poolallocalignl: allocate as described below; assumes pool locked */
11045243b8d1SDavid du Colombier static void*
poolallocalignl(Pool * p,ulong dsize,ulong align,long offset,ulong span)11055243b8d1SDavid du Colombier poolallocalignl(Pool *p, ulong dsize, ulong align, long offset, ulong span)
11065243b8d1SDavid du Colombier {
11075243b8d1SDavid du Colombier 	ulong asize;
11085243b8d1SDavid du Colombier 	void *v;
11095243b8d1SDavid du Colombier 	char *c;
11105243b8d1SDavid du Colombier 	ulong *u;
11115243b8d1SDavid du Colombier 	int skip;
11125243b8d1SDavid du Colombier 	Alloc *b;
11135243b8d1SDavid du Colombier 
11145243b8d1SDavid du Colombier 	/*
11155243b8d1SDavid du Colombier 	 * allocate block
11165243b8d1SDavid du Colombier 	 * 	dsize bytes
11175243b8d1SDavid du Colombier 	 *	addr == offset (modulo align)
11185243b8d1SDavid du Colombier 	 *	does not cross span-byte block boundary
11195243b8d1SDavid du Colombier 	 *
11205243b8d1SDavid du Colombier 	 * to satisfy alignment, just allocate an extra
11215243b8d1SDavid du Colombier 	 * align bytes and then shift appropriately.
11225243b8d1SDavid du Colombier 	 *
11235243b8d1SDavid du Colombier 	 * to satisfy span, try once and see if we're
11245243b8d1SDavid du Colombier 	 * lucky.  the second time, allocate 2x asize
11255243b8d1SDavid du Colombier 	 * so that we definitely get one not crossing
11265243b8d1SDavid du Colombier 	 * the boundary.
11275243b8d1SDavid du Colombier 	 */
11285243b8d1SDavid du Colombier 	if(align){
11295243b8d1SDavid du Colombier 		if(offset < 0)
11305243b8d1SDavid du Colombier 			offset = align - ((-offset)%align);
11315243b8d1SDavid du Colombier 		else
11325243b8d1SDavid du Colombier 			offset %= align;
11335243b8d1SDavid du Colombier 	}
11345243b8d1SDavid du Colombier 	asize = dsize+align;
11355243b8d1SDavid du Colombier 	v = poolallocl(p, asize);
11365243b8d1SDavid du Colombier 	if(v == nil)
11375243b8d1SDavid du Colombier 		return nil;
11385e91980fSDavid du Colombier 	if(span && (uintptr)v/span != ((uintptr)v+asize)/span){
11395243b8d1SDavid du Colombier 		/* try again */
11405243b8d1SDavid du Colombier 		poolfreel(p, v);
11415243b8d1SDavid du Colombier 		v = poolallocl(p, 2*asize);
11425243b8d1SDavid du Colombier 		if(v == nil)
11435243b8d1SDavid du Colombier 			return nil;
11445243b8d1SDavid du Colombier 	}
11455243b8d1SDavid du Colombier 
11465243b8d1SDavid du Colombier 	/*
11475243b8d1SDavid du Colombier 	 * figure out what pointer we want to return
11485243b8d1SDavid du Colombier 	 */
11495243b8d1SDavid du Colombier 	c = alignptr(v, align, offset);
11505e91980fSDavid du Colombier 	if(span && (uintptr)c/span != (uintptr)(c+dsize-1)/span){
11515e91980fSDavid du Colombier 		c += span - (uintptr)c%span;
11525243b8d1SDavid du Colombier 		c = alignptr(c, align, offset);
11535e91980fSDavid du Colombier 		if((uintptr)c/span != (uintptr)(c+dsize-1)/span){
11545243b8d1SDavid du Colombier 			poolfreel(p, v);
11555243b8d1SDavid du Colombier 			werrstr("cannot satisfy dsize %lud span %lud with align %lud+%ld", dsize, span, align, offset);
11565243b8d1SDavid du Colombier 			return nil;
11575243b8d1SDavid du Colombier 		}
11585243b8d1SDavid du Colombier 	}
11595243b8d1SDavid du Colombier 	skip = c - (char*)v;
11605243b8d1SDavid du Colombier 
11615243b8d1SDavid du Colombier 	/*
11625243b8d1SDavid du Colombier 	 * free up the skip bytes before that pointer
11635243b8d1SDavid du Colombier 	 * or mark it as unavailable.
11645243b8d1SDavid du Colombier 	 */
11655243b8d1SDavid du Colombier 	b = _D2B(v);
11665243b8d1SDavid du Colombier 	b = freefromfront(p, b, skip);
11675243b8d1SDavid du Colombier 	v = _B2D(b);
11685243b8d1SDavid du Colombier 	skip = c - (char*)v;
11695243b8d1SDavid du Colombier 	if(c > (char*)v){
11705243b8d1SDavid du Colombier 		u = v;
11715243b8d1SDavid du Colombier 		while(c >= (char*)u+sizeof(ulong))
11725243b8d1SDavid du Colombier 			*u++ = ALIGN_MAGIC;
11735243b8d1SDavid du Colombier 	}
11745243b8d1SDavid du Colombier 	trim(p, b, skip+dsize);
11755243b8d1SDavid du Colombier 	assert(D2B(p, c) == b);
1176b85a8364SDavid du Colombier 	antagonism {
1177b85a8364SDavid du Colombier 		memset(c, 0xDD, dsize);
1178b85a8364SDavid du Colombier 	}
11795243b8d1SDavid du Colombier 	return c;
11805243b8d1SDavid du Colombier }
11815243b8d1SDavid du Colombier 
11827dd7cddfSDavid du Colombier /* poolfree: free block obtained from poolalloc; assumes lock held */
11837dd7cddfSDavid du Colombier static void
poolfreel(Pool * p,void * v)11847dd7cddfSDavid du Colombier poolfreel(Pool *p, void *v)
11857dd7cddfSDavid du Colombier {
11867dd7cddfSDavid du Colombier 	Alloc *ab;
11877dd7cddfSDavid du Colombier 	Bhdr *back, *fwd;
11887dd7cddfSDavid du Colombier 
11897dd7cddfSDavid du Colombier 	if(v == nil)	/* for ANSI */
11907dd7cddfSDavid du Colombier 		return;
11917dd7cddfSDavid du Colombier 
11927dd7cddfSDavid du Colombier 	ab = D2B(p, v);
11937dd7cddfSDavid du Colombier 	blockcheck(p, ab);
11947dd7cddfSDavid du Colombier 
11959a747e4fSDavid du Colombier 	if(p->flags&POOL_NOREUSE){
11969a747e4fSDavid du Colombier 		int n;
11979a747e4fSDavid du Colombier 
11989a747e4fSDavid du Colombier 		ab->magic = DEAD_MAGIC;
11999a747e4fSDavid du Colombier 		n = getdsize(ab)-8;
12009a747e4fSDavid du Colombier 		if(n > 0)
12019a747e4fSDavid du Colombier 			memset((uchar*)v+8, 0xDA, n);
12029a747e4fSDavid du Colombier 		return;
12039a747e4fSDavid du Colombier 	}
12049a747e4fSDavid du Colombier 
12057dd7cddfSDavid du Colombier 	p->nfree++;
12067dd7cddfSDavid du Colombier 	p->curalloc -= ab->size;
12077dd7cddfSDavid du Colombier 	back = T2HDR(B2PT(ab));
12087dd7cddfSDavid du Colombier 	if(back->magic == FREE_MAGIC)
12097dd7cddfSDavid du Colombier 		ab = blockmerge(p, back, ab);
12107dd7cddfSDavid du Colombier 
12117dd7cddfSDavid du Colombier 	fwd = B2NB(ab);
12127dd7cddfSDavid du Colombier 	if(fwd->magic == FREE_MAGIC)
12137dd7cddfSDavid du Colombier 		ab = blockmerge(p, ab, fwd);
12147dd7cddfSDavid du Colombier 
12157dd7cddfSDavid du Colombier 	pooladd(p, ab);
12167dd7cddfSDavid du Colombier }
12177dd7cddfSDavid du Colombier 
12187dd7cddfSDavid du Colombier void*
poolalloc(Pool * p,ulong n)12197dd7cddfSDavid du Colombier poolalloc(Pool *p, ulong n)
12207dd7cddfSDavid du Colombier {
12217dd7cddfSDavid du Colombier 	void *v;
12227dd7cddfSDavid du Colombier 
12237dd7cddfSDavid du Colombier 	p->lock(p);
12247dd7cddfSDavid du Colombier 	paranoia {
12257dd7cddfSDavid du Colombier 		poolcheckl(p);
12267dd7cddfSDavid du Colombier 	}
12277dd7cddfSDavid du Colombier 	verbosity {
12287dd7cddfSDavid du Colombier 		pooldumpl(p);
12297dd7cddfSDavid du Colombier 	}
12307dd7cddfSDavid du Colombier 	v = poolallocl(p, n);
12317dd7cddfSDavid du Colombier 	paranoia {
12327dd7cddfSDavid du Colombier 		poolcheckl(p);
12337dd7cddfSDavid du Colombier 	}
12347dd7cddfSDavid du Colombier 	verbosity {
12357dd7cddfSDavid du Colombier 		pooldumpl(p);
12367dd7cddfSDavid du Colombier 	}
12377dd7cddfSDavid du Colombier 	if(p->logstack && (p->flags & POOL_LOGGING)) p->logstack(p);
12387dd7cddfSDavid du Colombier 	LOG(p, "poolalloc %p %lud = %p\n", p, n, v);
12397dd7cddfSDavid du Colombier 	p->unlock(p);
12407dd7cddfSDavid du Colombier 	return v;
12417dd7cddfSDavid du Colombier }
12427dd7cddfSDavid du Colombier 
12435243b8d1SDavid du Colombier void*
poolallocalign(Pool * p,ulong n,ulong align,long offset,ulong span)12445243b8d1SDavid du Colombier poolallocalign(Pool *p, ulong n, ulong align, long offset, ulong span)
12455243b8d1SDavid du Colombier {
12465243b8d1SDavid du Colombier 	void *v;
12475243b8d1SDavid du Colombier 
12485243b8d1SDavid du Colombier 	p->lock(p);
12495243b8d1SDavid du Colombier 	paranoia {
12505243b8d1SDavid du Colombier 		poolcheckl(p);
12515243b8d1SDavid du Colombier 	}
12525243b8d1SDavid du Colombier 	verbosity {
12535243b8d1SDavid du Colombier 		pooldumpl(p);
12545243b8d1SDavid du Colombier 	}
12555243b8d1SDavid du Colombier 	v = poolallocalignl(p, n, align, offset, span);
12565243b8d1SDavid du Colombier 	paranoia {
12575243b8d1SDavid du Colombier 		poolcheckl(p);
12585243b8d1SDavid du Colombier 	}
12595243b8d1SDavid du Colombier 	verbosity {
12605243b8d1SDavid du Colombier 		pooldumpl(p);
12615243b8d1SDavid du Colombier 	}
12625243b8d1SDavid du Colombier 	if(p->logstack && (p->flags & POOL_LOGGING)) p->logstack(p);
12635243b8d1SDavid du Colombier 	LOG(p, "poolalignspanalloc %p %lud %lud %lud %ld = %p\n", p, n, align, span, offset, v);
12645243b8d1SDavid du Colombier 	p->unlock(p);
12655243b8d1SDavid du Colombier 	return v;
12665243b8d1SDavid du Colombier }
12675243b8d1SDavid du Colombier 
12687dd7cddfSDavid du Colombier int
poolcompact(Pool * p)12697dd7cddfSDavid du Colombier poolcompact(Pool *p)
12707dd7cddfSDavid du Colombier {
12717dd7cddfSDavid du Colombier 	int rv;
12727dd7cddfSDavid du Colombier 
12737dd7cddfSDavid du Colombier 	p->lock(p);
12747dd7cddfSDavid du Colombier 	paranoia {
12757dd7cddfSDavid du Colombier 		poolcheckl(p);
12767dd7cddfSDavid du Colombier 	}
12777dd7cddfSDavid du Colombier 	verbosity {
12787dd7cddfSDavid du Colombier 		pooldumpl(p);
12797dd7cddfSDavid du Colombier 	}
12807dd7cddfSDavid du Colombier 	rv = poolcompactl(p);
12817dd7cddfSDavid du Colombier 	paranoia {
12827dd7cddfSDavid du Colombier 		poolcheckl(p);
12837dd7cddfSDavid du Colombier 	}
12847dd7cddfSDavid du Colombier 	verbosity {
12857dd7cddfSDavid du Colombier 		pooldumpl(p);
12867dd7cddfSDavid du Colombier 	}
12877dd7cddfSDavid du Colombier 	LOG(p, "poolcompact %p\n", p);
12887dd7cddfSDavid du Colombier 	p->unlock(p);
12897dd7cddfSDavid du Colombier 	return rv;
12907dd7cddfSDavid du Colombier }
12917dd7cddfSDavid du Colombier 
12927dd7cddfSDavid du Colombier void*
poolrealloc(Pool * p,void * v,ulong n)12937dd7cddfSDavid du Colombier poolrealloc(Pool *p, void *v, ulong n)
12947dd7cddfSDavid du Colombier {
12957dd7cddfSDavid du Colombier 	void *nv;
12967dd7cddfSDavid du Colombier 
12977dd7cddfSDavid du Colombier 	p->lock(p);
12987dd7cddfSDavid du Colombier 	paranoia {
12997dd7cddfSDavid du Colombier 		poolcheckl(p);
13007dd7cddfSDavid du Colombier 	}
13017dd7cddfSDavid du Colombier 	verbosity {
13027dd7cddfSDavid du Colombier 		pooldumpl(p);
13037dd7cddfSDavid du Colombier 	}
13047dd7cddfSDavid du Colombier 	nv = poolreallocl(p, v, n);
13057dd7cddfSDavid du Colombier 	paranoia {
13067dd7cddfSDavid du Colombier 		poolcheckl(p);
13077dd7cddfSDavid du Colombier 	}
13087dd7cddfSDavid du Colombier 	verbosity {
13097dd7cddfSDavid du Colombier 		pooldumpl(p);
13107dd7cddfSDavid du Colombier 	}
13117dd7cddfSDavid du Colombier 	if(p->logstack && (p->flags & POOL_LOGGING)) p->logstack(p);
13127dd7cddfSDavid du Colombier 	LOG(p, "poolrealloc %p %p %ld = %p\n", p, v, n, nv);
13137dd7cddfSDavid du Colombier 	p->unlock(p);
13147dd7cddfSDavid du Colombier 	return nv;
13157dd7cddfSDavid du Colombier }
13167dd7cddfSDavid du Colombier 
13177dd7cddfSDavid du Colombier void
poolfree(Pool * p,void * v)13187dd7cddfSDavid du Colombier poolfree(Pool *p, void *v)
13197dd7cddfSDavid du Colombier {
13207dd7cddfSDavid du Colombier 	p->lock(p);
13217dd7cddfSDavid du Colombier 	paranoia {
13227dd7cddfSDavid du Colombier 		poolcheckl(p);
13237dd7cddfSDavid du Colombier 	}
13247dd7cddfSDavid du Colombier 	verbosity {
13257dd7cddfSDavid du Colombier 		pooldumpl(p);
13267dd7cddfSDavid du Colombier 	}
13277dd7cddfSDavid du Colombier 	poolfreel(p, v);
13287dd7cddfSDavid du Colombier 	paranoia {
13297dd7cddfSDavid du Colombier 		poolcheckl(p);
13307dd7cddfSDavid du Colombier 	}
13317dd7cddfSDavid du Colombier 	verbosity {
13327dd7cddfSDavid du Colombier 		pooldumpl(p);
13337dd7cddfSDavid du Colombier 	}
13347dd7cddfSDavid du Colombier 	if(p->logstack && (p->flags & POOL_LOGGING)) p->logstack(p);
13357dd7cddfSDavid du Colombier 	LOG(p, "poolfree %p %p\n", p, v);
13367dd7cddfSDavid du Colombier 	p->unlock(p);
13377dd7cddfSDavid du Colombier }
13387dd7cddfSDavid du Colombier 
13397dd7cddfSDavid du Colombier /*
13407dd7cddfSDavid du Colombier  * Return the real size of a block, and let the user use it.
13417dd7cddfSDavid du Colombier  */
13427dd7cddfSDavid du Colombier ulong
poolmsize(Pool * p,void * v)13437dd7cddfSDavid du Colombier poolmsize(Pool *p, void *v)
13447dd7cddfSDavid du Colombier {
13457dd7cddfSDavid du Colombier 	Alloc *b;
13467dd7cddfSDavid du Colombier 	ulong dsize;
13477dd7cddfSDavid du Colombier 
13487dd7cddfSDavid du Colombier 	p->lock(p);
13497dd7cddfSDavid du Colombier 	paranoia {
13507dd7cddfSDavid du Colombier 		poolcheckl(p);
13517dd7cddfSDavid du Colombier 	}
13527dd7cddfSDavid du Colombier 	verbosity {
13537dd7cddfSDavid du Colombier 		pooldumpl(p);
13547dd7cddfSDavid du Colombier 	}
13557dd7cddfSDavid du Colombier 	if(v == nil)	/* consistency with other braindead ANSI-ness */
13567dd7cddfSDavid du Colombier 		dsize = 0;
13577dd7cddfSDavid du Colombier 	else {
13587dd7cddfSDavid du Colombier 		b = D2B(p, v);
13597dd7cddfSDavid du Colombier 		dsize = (b->size&~(p->quantum-1)) - sizeof(Bhdr) - sizeof(Btail);
13607dd7cddfSDavid du Colombier 		assert(dsize >= getdsize(b));
13617dd7cddfSDavid du Colombier 		blocksetdsize(p, b, dsize);
13627dd7cddfSDavid du Colombier 	}
13637dd7cddfSDavid du Colombier 	paranoia {
13647dd7cddfSDavid du Colombier 		poolcheckl(p);
13657dd7cddfSDavid du Colombier 	}
13667dd7cddfSDavid du Colombier 	verbosity {
13677dd7cddfSDavid du Colombier 		pooldumpl(p);
13687dd7cddfSDavid du Colombier 	}
13697dd7cddfSDavid du Colombier 	if(p->logstack && (p->flags & POOL_LOGGING)) p->logstack(p);
13707dd7cddfSDavid du Colombier 	LOG(p, "poolmsize %p %p = %ld\n", p, v, dsize);
13717dd7cddfSDavid du Colombier 	p->unlock(p);
13727dd7cddfSDavid du Colombier 	return dsize;
13737dd7cddfSDavid du Colombier }
13747dd7cddfSDavid du Colombier 
13757dd7cddfSDavid du Colombier /*
13767dd7cddfSDavid du Colombier  * Debugging
13777dd7cddfSDavid du Colombier  */
13787dd7cddfSDavid du Colombier 
13797dd7cddfSDavid du Colombier static void
poolcheckarena(Pool * p,Arena * a)13807dd7cddfSDavid du Colombier poolcheckarena(Pool *p, Arena *a)
13817dd7cddfSDavid du Colombier {
13827dd7cddfSDavid du Colombier 	Bhdr *b;
13837dd7cddfSDavid du Colombier 	Bhdr *atail;
13847dd7cddfSDavid du Colombier 
13857dd7cddfSDavid du Colombier 	atail = A2TB(a);
13867dd7cddfSDavid du Colombier 	for(b=a; b->magic != ARENATAIL_MAGIC && b<atail; b=B2NB(b))
13877dd7cddfSDavid du Colombier 		blockcheck(p, b);
13887dd7cddfSDavid du Colombier 	blockcheck(p, b);
13897dd7cddfSDavid du Colombier 	if(b != atail)
13907dd7cddfSDavid du Colombier 		p->panic(p, "found wrong tail");
13917dd7cddfSDavid du Colombier }
13927dd7cddfSDavid du Colombier 
13937dd7cddfSDavid du Colombier static void
poolcheckl(Pool * p)13947dd7cddfSDavid du Colombier poolcheckl(Pool *p)
13957dd7cddfSDavid du Colombier {
13967dd7cddfSDavid du Colombier 	Arena *a;
13977dd7cddfSDavid du Colombier 
13987dd7cddfSDavid du Colombier 	for(a=p->arenalist; a; a=a->down)
13997dd7cddfSDavid du Colombier 		poolcheckarena(p, a);
1400e288d156SDavid du Colombier 	if(p->freeroot)
1401e288d156SDavid du Colombier 		checktree(p->freeroot, 0, 1<<30);
14027dd7cddfSDavid du Colombier }
14037dd7cddfSDavid du Colombier 
14047dd7cddfSDavid du Colombier void
poolcheck(Pool * p)14057dd7cddfSDavid du Colombier poolcheck(Pool *p)
14067dd7cddfSDavid du Colombier {
14077dd7cddfSDavid du Colombier 	p->lock(p);
14087dd7cddfSDavid du Colombier 	poolcheckl(p);
14097dd7cddfSDavid du Colombier 	p->unlock(p);
14107dd7cddfSDavid du Colombier }
14117dd7cddfSDavid du Colombier 
14127dd7cddfSDavid du Colombier void
poolblockcheck(Pool * p,void * v)14137dd7cddfSDavid du Colombier poolblockcheck(Pool *p, void *v)
14147dd7cddfSDavid du Colombier {
14157dd7cddfSDavid du Colombier 	if(v == nil)
14167dd7cddfSDavid du Colombier 		return;
14177dd7cddfSDavid du Colombier 
14187dd7cddfSDavid du Colombier 	p->lock(p);
14197dd7cddfSDavid du Colombier 	blockcheck(p, D2B(p, v));
14207dd7cddfSDavid du Colombier 	p->unlock(p);
14217dd7cddfSDavid du Colombier }
14227dd7cddfSDavid du Colombier 
14237dd7cddfSDavid du Colombier static void
pooldumpl(Pool * p)14247dd7cddfSDavid du Colombier pooldumpl(Pool *p)
14257dd7cddfSDavid du Colombier {
14267dd7cddfSDavid du Colombier 	Arena *a;
14277dd7cddfSDavid du Colombier 
14287dd7cddfSDavid du Colombier 	p->print(p, "pool %p %s\n", p, p->name);
14297dd7cddfSDavid du Colombier 	for(a=p->arenalist; a; a=a->down)
14307dd7cddfSDavid du Colombier 		pooldumparena(p, a);
14317dd7cddfSDavid du Colombier }
14327dd7cddfSDavid du Colombier 
14337dd7cddfSDavid du Colombier void
pooldump(Pool * p)14347dd7cddfSDavid du Colombier pooldump(Pool *p)
14357dd7cddfSDavid du Colombier {
14367dd7cddfSDavid du Colombier 	p->lock(p);
14377dd7cddfSDavid du Colombier 	pooldumpl(p);
14387dd7cddfSDavid du Colombier 	p->unlock(p);
14397dd7cddfSDavid du Colombier }
14407dd7cddfSDavid du Colombier 
14417dd7cddfSDavid du Colombier static void
pooldumparena(Pool * p,Arena * a)14427dd7cddfSDavid du Colombier pooldumparena(Pool *p, Arena *a)
14437dd7cddfSDavid du Colombier {
14447dd7cddfSDavid du Colombier 	Bhdr *b;
14457dd7cddfSDavid du Colombier 
14467dd7cddfSDavid du Colombier 	for(b=a; b->magic != ARENATAIL_MAGIC; b=B2NB(b))
14477dd7cddfSDavid du Colombier 		p->print(p, "(%p %.8lux %lud)", b, b->magic, b->size);
14487dd7cddfSDavid du Colombier 	p->print(p, "\n");
14497dd7cddfSDavid du Colombier }
14507dd7cddfSDavid du Colombier 
14517dd7cddfSDavid du Colombier /*
14527dd7cddfSDavid du Colombier  * mark the memory in such a way that we know who marked it
14537dd7cddfSDavid du Colombier  * (via the signature) and we know where the marking started.
14547dd7cddfSDavid du Colombier  */
14557dd7cddfSDavid du Colombier static void
memmark(void * v,int sig,ulong size)14567dd7cddfSDavid du Colombier memmark(void *v, int sig, ulong size)
14577dd7cddfSDavid du Colombier {
14587dd7cddfSDavid du Colombier 	uchar *p, *ep;
14597dd7cddfSDavid du Colombier 	ulong *lp, *elp;
14607dd7cddfSDavid du Colombier 	lp = v;
14617dd7cddfSDavid du Colombier 	elp = lp+size/4;
14627dd7cddfSDavid du Colombier 	while(lp < elp)
1463b85a8364SDavid du Colombier 		*lp++ = (sig<<24) ^ ((uintptr)lp-(uintptr)v);
14647dd7cddfSDavid du Colombier 	p = (uchar*)lp;
14657dd7cddfSDavid du Colombier 	ep = (uchar*)v+size;
14667dd7cddfSDavid du Colombier 	while(p<ep)
14677dd7cddfSDavid du Colombier 		*p++ = sig;
14687dd7cddfSDavid du Colombier }
1469