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 <lib/bit.h>

#include <l4/macros.h>

#include <l4/types.h>

#include INC_GLUE(memory.h)

#include <lib/addr.h>

#include <stdio.h>

/*

 * Initializes an address pool, but uses an already

 * allocated id pool for it.

 */

int address_pool_init_with_idpool(struct address_pool *pool,

                                  struct id_pool *idpool,

                                  unsigned long start, unsigned long end)

{

        pool->idpool = idpool;

        pool->start = start;

        pool->end = end;

        return 0;

}

int address_pool_init(struct address_pool *pool, unsigned long start, unsigned long end)

{

        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 npages)

{

        unsigned int pfn;

        if ((int)(pfn = ids_new_contiguous(pool->idpool, npages)) < 0)

                return 0;

        return (void *)__pfn_to_addr(pfn) + pool->start;

}

int address_del(struct address_pool *pool, void *addr, int npages)

{

        unsigned long pfn = __pfn(page_align(addr) - pool->start);

        if (ids_del_contiguous(pool->idpool, pfn, npages) < 0) {

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

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

                return -1;

        }

        return 0;

}