#include <string.h>
#include "mmprivate.h"
static int initialize PARAMS ((struct mdesc *));
static PTR morecore PARAMS ((struct mdesc *, size_t));
static PTR align PARAMS ((struct mdesc *, size_t));
static PTR
align (mdp, size)
struct mdesc *mdp;
size_t size;
{
PTR result;
unsigned long int adj;
result = mdp -> morecore (mdp, size);
adj = RESIDUAL (result, BLOCKSIZE);
if (adj != 0)
{
adj = BLOCKSIZE - adj;
mdp -> morecore (mdp, adj);
result = (char *) result + adj;
}
return (result);
}
static int
initialize (mdp)
struct mdesc *mdp;
{
mdp -> heapsize = HEAP / BLOCKSIZE;
mdp -> heapinfo = (malloc_info *)
align (mdp, mdp -> heapsize * sizeof (malloc_info));
if (mdp -> heapinfo == NULL)
{
return (0);
}
memset ((PTR)mdp -> heapinfo, 0, mdp -> heapsize * sizeof (malloc_info));
mdp -> heapinfo[0].free.size = 0;
mdp -> heapinfo[0].free.next = mdp -> heapinfo[0].free.prev = 0;
mdp -> heapindex = 0;
mdp -> heapbase = (char *) mdp -> heapinfo;
mdp -> flags |= MMALLOC_INITIALIZED;
return (1);
}
static PTR
morecore (mdp, size)
struct mdesc *mdp;
size_t size;
{
PTR result;
malloc_info *newinfo, *oldinfo;
size_t newsize;
result = align (mdp, size);
if (result == NULL)
{
return (NULL);
}
if ((size_t) BLOCK ((char *) result + size) > mdp -> heapsize)
{
newsize = mdp -> heapsize;
while ((size_t) BLOCK ((char *) result + size) > newsize)
{
newsize *= 2;
}
newinfo = (malloc_info *) align (mdp, newsize * sizeof (malloc_info));
if (newinfo == NULL)
{
mdp -> morecore (mdp, -size);
return (NULL);
}
memset ((PTR) newinfo, 0, newsize * sizeof (malloc_info));
memcpy ((PTR) newinfo, (PTR) mdp -> heapinfo,
mdp -> heapsize * sizeof (malloc_info));
oldinfo = mdp -> heapinfo;
newinfo[BLOCK (oldinfo)].busy.type = 0;
newinfo[BLOCK (oldinfo)].busy.info.size
= BLOCKIFY (mdp -> heapsize * sizeof (malloc_info));
mdp -> heapinfo = newinfo;
__mmalloc_free (mdp, (PTR)oldinfo);
mdp -> heapsize = newsize;
}
mdp -> heaplimit = BLOCK ((char *) result + size);
return (result);
}
PTR
mmalloc (md, size)
PTR md;
size_t size;
{
struct mdesc *mdp;
PTR result;
size_t block, blocks, lastblocks, start;
register size_t i;
struct list *next;
register size_t log;
if (size == 0)
{
return (NULL);
}
mdp = MD_TO_MDP (md);
if (mdp -> mmalloc_hook != NULL)
{
return ((*mdp -> mmalloc_hook) (mdp, size));
}
if (!(mdp -> flags & MMALLOC_INITIALIZED))
{
if (!initialize (mdp))
{
return (NULL);
}
}
if (size < sizeof (struct list))
{
size = sizeof (struct list);
}
if (size <= BLOCKSIZE / 2)
{
log = 1;
--size;
while ((size /= 2) != 0)
{
++log;
}
next = mdp -> fraghead[log].next;
if (next != NULL)
{
result = (PTR) next;
next -> prev -> next = next -> next;
if (next -> next != NULL)
{
next -> next -> prev = next -> prev;
}
block = BLOCK (result);
if (--mdp -> heapinfo[block].busy.info.frag.nfree != 0)
{
mdp -> heapinfo[block].busy.info.frag.first =
RESIDUAL (next -> next, BLOCKSIZE) >> log;
}
mdp -> heapstats.chunks_used++;
mdp -> heapstats.bytes_used += 1 << log;
mdp -> heapstats.chunks_free--;
mdp -> heapstats.bytes_free -= 1 << log;
}
else
{
result = mmalloc (md, BLOCKSIZE);
if (result == NULL)
{
return (NULL);
}
for (i = 1; i < (size_t) (BLOCKSIZE >> log); ++i)
{
next = (struct list *) ((char *) result + (i << log));
next -> next = mdp -> fraghead[log].next;
next -> prev = &mdp -> fraghead[log];
next -> prev -> next = next;
if (next -> next != NULL)
{
next -> next -> prev = next;
}
}
block = BLOCK (result);
mdp -> heapinfo[block].busy.type = log;
mdp -> heapinfo[block].busy.info.frag.nfree = i - 1;
mdp -> heapinfo[block].busy.info.frag.first = i - 1;
mdp -> heapstats.chunks_free += (BLOCKSIZE >> log) - 1;
mdp -> heapstats.bytes_free += BLOCKSIZE - (1 << log);
mdp -> heapstats.bytes_used -= BLOCKSIZE - (1 << log);
}
}
else
{
blocks = BLOCKIFY(size);
start = block = MALLOC_SEARCH_START;
while (mdp -> heapinfo[block].free.size < blocks)
{
block = mdp -> heapinfo[block].free.next;
if (block == start)
{
block = mdp -> heapinfo[0].free.prev;
lastblocks = mdp -> heapinfo[block].free.size;
if (mdp -> heaplimit != 0 &&
block + lastblocks == mdp -> heaplimit &&
mdp -> morecore (mdp, 0) == ADDRESS(block + lastblocks) &&
(morecore (mdp, (blocks - lastblocks) * BLOCKSIZE)) != NULL)
{
block = mdp -> heapinfo[0].free.prev;
mdp -> heapinfo[block].free.size += (blocks - lastblocks);
mdp -> heapstats.bytes_free +=
(blocks - lastblocks) * BLOCKSIZE;
continue;
}
result = morecore(mdp, blocks * BLOCKSIZE);
if (result == NULL)
{
return (NULL);
}
block = BLOCK (result);
mdp -> heapinfo[block].busy.type = 0;
mdp -> heapinfo[block].busy.info.size = blocks;
mdp -> heapstats.chunks_used++;
mdp -> heapstats.bytes_used += blocks * BLOCKSIZE;
return (result);
}
}
result = ADDRESS(block);
if (mdp -> heapinfo[block].free.size > blocks)
{
mdp -> heapinfo[block + blocks].free.size
= mdp -> heapinfo[block].free.size - blocks;
mdp -> heapinfo[block + blocks].free.next
= mdp -> heapinfo[block].free.next;
mdp -> heapinfo[block + blocks].free.prev
= mdp -> heapinfo[block].free.prev;
mdp -> heapinfo[mdp -> heapinfo[block].free.prev].free.next
= mdp -> heapinfo[mdp -> heapinfo[block].free.next].free.prev
= mdp -> heapindex = block + blocks;
}
else
{
mdp -> heapinfo[mdp -> heapinfo[block].free.next].free.prev
= mdp -> heapinfo[block].free.prev;
mdp -> heapinfo[mdp -> heapinfo[block].free.prev].free.next
= mdp -> heapindex = mdp -> heapinfo[block].free.next;
mdp -> heapstats.chunks_free--;
}
mdp -> heapinfo[block].busy.type = 0;
mdp -> heapinfo[block].busy.info.size = blocks;
mdp -> heapstats.chunks_used++;
mdp -> heapstats.bytes_used += blocks * BLOCKSIZE;
mdp -> heapstats.bytes_free -= blocks * BLOCKSIZE;
}
return (result);
}
struct mdesc *__mmalloc_default_mdp = NULL;
extern void mmalloc_set_default_allocator (PTR p)
{
__mmalloc_default_mdp = (struct mdesc *) p;
}
extern PTR mmalloc_default_allocator (void)
{
return __mmalloc_default_mdp;
}
#if REPLACE_SYSMALLOC
PTR
malloc (size)
size_t size;
{
PTR result;
result = mmalloc ((PTR) NULL, size);
return (result);
}
#endif