codezero/conts/libl4/src/addr.c

/*
 * This module allocates an unused address range from
 * a given memory region defined as the pool range.
 *
 * Copyright (C) 2007 Bahadir Balban
 */
#include <l4lib/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,
			unsigned int size)
{
	if ((pool->idpool = id_pool_new_init(__pfn(end - start) / size)) < 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;
}