Subversion Repositories c0or1k

/*

 * This module allocates an unused address range from

 * a given memory region defined as the pool range.

 *

 * Copyright (C) 2007 Bahadir Balban

 */

#include <l4lib/lib/addr.h>

#include <stdio.h>

/*

 * Initializes an address pool, but uses an already

 * allocated id pool for it.

 */

int address_pool_init(struct address_pool *pool,

                      struct id_pool *idpool,

                      unsigned long start, unsigned long end)

{

        pool->idpool = idpool;

        pool->start = start;

        pool->end = end;

        id_pool_init(idpool, __pfn(end - start));

        return 0;

}

/*

 * Allocates an id pool and initializes it

 */

int address_pool_alloc_init(struct address_pool *pool,

                            unsigned long start, unsigned long end,

                             unsigned int size)

{

        if ((pool->idpool = id_pool_new_init(__pfn(end - start) )) < 0)

                return (int)pool->idpool;

        pool->start = start;

        pool->end = end;

        return 0;

}

void *address_new(struct address_pool *pool, int nitems, int size)

{

        unsigned int idx;

        if ((int)(idx = ids_new_contiguous(pool->idpool, nitems)) < 0)

                return 0;

        return (void *)(idx * size) + pool->start;

}

int address_del(struct address_pool *pool, void *addr, int nitems, int size)

{

        unsigned long idx = (addr - (void *)pool->start) / size;

        if (ids_del_contiguous(pool->idpool, idx, nitems) < 0) {

                printf("%s: Invalid address range returned to "

                       "virtual address pool.\n", __FUNCTION__);

                return -1;

        }

        return 0;

}