216 lines
5.5 KiB
C
216 lines
5.5 KiB
C
// first-fit SLOB (simple list of blocks) allocator
|
|
|
|
#include "sloballoc.h"
|
|
#include <stdint.h>
|
|
#include <assert.h>
|
|
|
|
struct alloc {
|
|
size_t size;
|
|
uint8_t data[];
|
|
};
|
|
|
|
struct block {
|
|
size_t size; // read: struct alloc
|
|
struct block *next;
|
|
};
|
|
|
|
struct slob {
|
|
size_t size;
|
|
struct block *head;
|
|
uint8_t data[];
|
|
};
|
|
|
|
|
|
SLOB *slobinit(void *mem, size_t size)
|
|
{
|
|
SLOB *slob = mem;
|
|
|
|
assert(size >= sizeof(SLOB) + sizeof(struct block));
|
|
assert(size < UINTPTR_MAX - (uintptr_t)mem);
|
|
|
|
slob = mem;
|
|
slob->size = size - sizeof(SLOB);
|
|
slob->head = (struct block *)((uint8_t *)mem + sizeof(SLOB));
|
|
slob->head->size = slob->size - sizeof(struct alloc);
|
|
slob->head->next = NULL;
|
|
|
|
return slob;
|
|
}
|
|
|
|
void *sloballoc(SLOB *slob, size_t size)
|
|
{
|
|
struct block *b, **p;
|
|
size_t fitblock, remblock;
|
|
|
|
// size must be enough to extend to a struct block in case of free
|
|
fitblock = sizeof(struct block) - sizeof(struct alloc);
|
|
if(size < fitblock) size = fitblock;
|
|
|
|
// need this much to fit another block in the remaining space
|
|
remblock = size + sizeof(struct block);
|
|
if(remblock < size) return NULL; // overflow
|
|
|
|
// scan list for the first block of sufficient size
|
|
for(p=&slob->head; (b=*p); p=&b->next) {
|
|
if(b->size >= remblock) {
|
|
// cut from the end of the block
|
|
b->size -= sizeof(struct alloc) + size;
|
|
struct alloc *a = (struct alloc *)(((struct alloc *)b)->data + b->size);
|
|
a->size = size;
|
|
return a->data;
|
|
} else if(b->size >= size) {
|
|
// when a block fills, it converts directly to a struct alloc
|
|
*p = b->next; // unlink
|
|
return ((struct alloc *)b)->data;
|
|
}
|
|
}
|
|
|
|
return NULL;
|
|
}
|
|
|
|
void slobfree(SLOB *slob, void *a_)
|
|
{
|
|
struct alloc *a = (struct alloc *)((uint8_t *)a_ - sizeof(struct alloc));
|
|
struct block *b, **p, *left=NULL, *right=NULL, **rightp=NULL;
|
|
|
|
// sanity check: a lies inside slob
|
|
assert((uint8_t *)a >= slob->data);
|
|
assert(a->data + a->size <= slob->data + slob->size);
|
|
|
|
// scan list for blocks adjacent to a
|
|
for(p=&slob->head; (b=*p); p=&b->next) {
|
|
if((uint8_t *)a == ((struct alloc *)b)->data + b->size) {
|
|
assert(!left);
|
|
left = b;
|
|
}
|
|
if(a->data + a->size == (uint8_t *)b) {
|
|
assert(!right);
|
|
right = b;
|
|
rightp = p;
|
|
}
|
|
|
|
if(left && right) {
|
|
// extend left and unlink right
|
|
left->size += sizeof(*a) + a->size +
|
|
sizeof(struct alloc) + right->size;
|
|
*rightp = right->next;
|
|
return;
|
|
}
|
|
}
|
|
|
|
if(left) {
|
|
// extend left to absorb a
|
|
left->size += sizeof(*a) + a->size;
|
|
} else if(right) {
|
|
// shift and extend right to absorb a
|
|
right->size += sizeof(*a) + a->size;
|
|
*rightp = (struct block *)a; **rightp = *right;
|
|
} else {
|
|
// spawn new block over a
|
|
struct block *b = (struct block *)a;
|
|
b->next = slob->head; slob->head = b;
|
|
}
|
|
}
|
|
|
|
int slobcheck(SLOB *slob)
|
|
{
|
|
// invariants:
|
|
// 1. memory area is divided seamlessly and exactly into n blocks
|
|
// 2. every block is large enough to hold a 'struct block'.
|
|
// 3. free list has at most n elements.
|
|
// 4. every element of the free list is one of the valid blocks.
|
|
// 5. every block appears at most once in the free list.
|
|
|
|
uint8_t *p;
|
|
size_t nblocks=0, nfree=0;
|
|
|
|
#define FORBLOCKS \
|
|
for(p = slob->data; \
|
|
p != slob->data + slob->size; \
|
|
p += sizeof(struct alloc) + ((struct alloc *)p)->size)
|
|
|
|
// 1. memory area is divided seamlessly and exactly into n blocks
|
|
FORBLOCKS {
|
|
if(p < slob->data)
|
|
return 1;
|
|
if(p > slob->data + slob->size)
|
|
return 2;
|
|
nblocks++;
|
|
|
|
struct alloc *a = (struct alloc *)p;
|
|
if(a->size > UINTPTR_MAX - (uintptr_t)p)
|
|
return 3;
|
|
|
|
// 2. every block is large enough to hold a 'struct block'.
|
|
if(a->size + sizeof(struct alloc) < sizeof(struct block))
|
|
return 4;
|
|
}
|
|
|
|
// 3. free list has at most n elements.
|
|
for(struct block *b=slob->head; b; b=b->next) {
|
|
nfree++;
|
|
if(nfree > nblocks)
|
|
return 5;
|
|
|
|
// 4. every element of the free list is one of the valid blocks.
|
|
FORBLOCKS
|
|
if(p == (uint8_t *)b) break;
|
|
if(!p)
|
|
return 6;
|
|
}
|
|
|
|
// 5. every block appears at most once in the free list.
|
|
FORBLOCKS {
|
|
size_t count=0;
|
|
for(struct block *b=slob->head; b; b=b->next)
|
|
if(p == (uint8_t *)b) count++;
|
|
if(count > 1)
|
|
return 7;
|
|
}
|
|
|
|
#undef FORBLOCKS
|
|
return 0;
|
|
}
|
|
|
|
|
|
// hammer interface
|
|
|
|
#include "hammer.h"
|
|
|
|
static void *h_slob_alloc(HAllocator *mm, size_t size)
|
|
{
|
|
SLOB *slob = (SLOB *)(mm+1);
|
|
return sloballoc(slob, size);
|
|
}
|
|
|
|
static void h_slob_free(HAllocator *mm, void *p)
|
|
{
|
|
SLOB *slob = (SLOB *)(mm+1);
|
|
slobfree(slob, p);
|
|
}
|
|
|
|
static void *h_slob_realloc(HAllocator *mm, void *p, size_t size)
|
|
{
|
|
SLOB *slob = (SLOB *)(mm+1);
|
|
|
|
assert(((void)"XXX need realloc for SLOB allocator", 0));
|
|
return NULL;
|
|
}
|
|
|
|
HAllocator *h_sloballoc(void *mem, size_t size)
|
|
{
|
|
if(size < sizeof(HAllocator))
|
|
return NULL;
|
|
|
|
HAllocator *mm = mem;
|
|
SLOB *slob = slobinit((uint8_t *)mem + sizeof(HAllocator), size - sizeof(HAllocator));
|
|
if(!slob)
|
|
return NULL;
|
|
assert(slob == (SLOB *)(mm+1));
|
|
|
|
mm->alloc = h_slob_alloc;
|
|
mm->realloc = h_slob_realloc;
|
|
mm->free = h_slob_free;
|
|
|
|
return mm;
|
|
}
|