Subversion Repositories c0or1k

/*
 * Boot memory allocator
 *
 * Copyright (C) 2009 Bahadir Balban
 */
#include <l4/macros.h>
#include <l4/config.h>
#include <l4/types.h>
#include <l4/lib/list.h>
#include <l4/lib/math.h>
#include <l4/api/thread.h>
#include <l4/api/kip.h>
#include <l4/api/errno.h>
#include INC_GLUE(memory.h)
 
#include <stdio.h>
 
/* All memory allocated here is discarded after boot */
 
#define BOOTMEM_SIZE		SZ_32K
 
SECTION(".init.bootmem") char bootmem[BOOTMEM_SIZE];
SECTION(".stack") char stack[4096];
// SECTION("init.data")
 
extern unsigned long __stack[];		/* Linker defined */
 
static unsigned long cursor = (unsigned long)&bootmem;
 
void *alloc_bootmem(int size, int alignment)
{
	void *ptr;
 
	/* If alignment is required */
	if (alignment) {
		/* And cursor is not aligned */
		if (!is_aligned(cursor, alignment))
			/* Align the cursor to alignment */
			cursor = align_up(cursor, alignment);
	/* Align to 4 byte by default */
	} else if (size >= 4) {
		/* And cursor is not aligned */
		if (!is_aligned(cursor, 4))
			/* Align the cursor to alignment */
			cursor = align_up(cursor, 4);
	}
 
	/* Allocate from cursor */
	ptr = (void *)cursor;
 
	/* Update cursor */
	cursor += size;
 
	/* Check if cursor is passed bootmem area */
	if (cursor >= (unsigned long)&bootmem[BOOTMEM_SIZE]) {
		printk("Fatal: Insufficient boot memory.\n");
		BUG();
	}
 
	return ptr;
}