mem-pool.con commit Third batch (4c86140)
   1/*
   2 * Memory Pool implementation logic.
   3 */
   4
   5#include "cache.h"
   6#include "mem-pool.h"
   7
   8#define BLOCK_GROWTH_SIZE 1024*1024 - sizeof(struct mp_block);
   9
  10/*
  11 * Allocate a new mp_block and insert it after the block specified in
  12 * `insert_after`. If `insert_after` is NULL, then insert block at the
  13 * head of the linked list.
  14 */
  15static struct mp_block *mem_pool_alloc_block(struct mem_pool *mem_pool, size_t block_alloc, struct mp_block *insert_after)
  16{
  17        struct mp_block *p;
  18
  19        mem_pool->pool_alloc += sizeof(struct mp_block) + block_alloc;
  20        p = xmalloc(st_add(sizeof(struct mp_block), block_alloc));
  21
  22        p->next_free = (char *)p->space;
  23        p->end = p->next_free + block_alloc;
  24
  25        if (insert_after) {
  26                p->next_block = insert_after->next_block;
  27                insert_after->next_block = p;
  28        } else {
  29                p->next_block = mem_pool->mp_block;
  30                mem_pool->mp_block = p;
  31        }
  32
  33        return p;
  34}
  35
  36void mem_pool_init(struct mem_pool **mem_pool, size_t initial_size)
  37{
  38        struct mem_pool *pool;
  39
  40        if (*mem_pool)
  41                return;
  42
  43        pool = xcalloc(1, sizeof(*pool));
  44
  45        pool->block_alloc = BLOCK_GROWTH_SIZE;
  46
  47        if (initial_size > 0)
  48                mem_pool_alloc_block(pool, initial_size, NULL);
  49
  50        *mem_pool = pool;
  51}
  52
  53void mem_pool_discard(struct mem_pool *mem_pool, int invalidate_memory)
  54{
  55        struct mp_block *block, *block_to_free;
  56
  57        block = mem_pool->mp_block;
  58        while (block)
  59        {
  60                block_to_free = block;
  61                block = block->next_block;
  62
  63                if (invalidate_memory)
  64                        memset(block_to_free->space, 0xDD, ((char *)block_to_free->end) - ((char *)block_to_free->space));
  65
  66                free(block_to_free);
  67        }
  68
  69        free(mem_pool);
  70}
  71
  72void *mem_pool_alloc(struct mem_pool *mem_pool, size_t len)
  73{
  74        struct mp_block *p = NULL;
  75        void *r;
  76
  77        /* round up to a 'uintmax_t' alignment */
  78        if (len & (sizeof(uintmax_t) - 1))
  79                len += sizeof(uintmax_t) - (len & (sizeof(uintmax_t) - 1));
  80
  81        if (mem_pool->mp_block &&
  82            mem_pool->mp_block->end - mem_pool->mp_block->next_free >= len)
  83                p = mem_pool->mp_block;
  84
  85        if (!p) {
  86                if (len >= (mem_pool->block_alloc / 2))
  87                        return mem_pool_alloc_block(mem_pool, len, mem_pool->mp_block);
  88
  89                p = mem_pool_alloc_block(mem_pool, mem_pool->block_alloc, NULL);
  90        }
  91
  92        r = p->next_free;
  93        p->next_free += len;
  94        return r;
  95}
  96
  97void *mem_pool_calloc(struct mem_pool *mem_pool, size_t count, size_t size)
  98{
  99        size_t len = st_mult(count, size);
 100        void *r = mem_pool_alloc(mem_pool, len);
 101        memset(r, 0, len);
 102        return r;
 103}
 104
 105int mem_pool_contains(struct mem_pool *mem_pool, void *mem)
 106{
 107        struct mp_block *p;
 108
 109        /* Check if memory is allocated in a block */
 110        for (p = mem_pool->mp_block; p; p = p->next_block)
 111                if ((mem >= ((void *)p->space)) &&
 112                    (mem < ((void *)p->end)))
 113                        return 1;
 114
 115        return 0;
 116}
 117
 118void mem_pool_combine(struct mem_pool *dst, struct mem_pool *src)
 119{
 120        struct mp_block *p;
 121
 122        /* Append the blocks from src to dst */
 123        if (dst->mp_block && src->mp_block) {
 124                /*
 125                 * src and dst have blocks, append
 126                 * blocks from src to dst.
 127                 */
 128                p = dst->mp_block;
 129                while (p->next_block)
 130                        p = p->next_block;
 131
 132                p->next_block = src->mp_block;
 133        } else if (src->mp_block) {
 134                /*
 135                 * src has blocks, dst is empty.
 136                 */
 137                dst->mp_block = src->mp_block;
 138        } else {
 139                /* src is empty, nothing to do. */
 140        }
 141
 142        dst->pool_alloc += src->pool_alloc;
 143        src->pool_alloc = 0;
 144        src->mp_block = NULL;
 145}