RTOS/rtems
1
0
Fork 0
forked from Imagelibrary/rtems
Code Pull Requests Activity

bsps/stackalloc: Add initialization hook

Browse Source
This commit is contained in:
Sebastian Huber
2012-04-26 10:03:38 +02:00
parent c36ebbda30
commit ed67d93171
2 changed files with 23 additions and 16 deletions
Download Patch File Download Diff File Expand all files Collapse all files

11
c/src/lib/libbsp/shared/include/stackalloc.h
View File

@@ -51,6 +51,12 @@ extern "C" {
* @{
*/
/**
* @brief Task stack allocator initialization for
* @ref CONFIGURE_TASK_STACK_ALLOCATOR_INIT.
*/
void bsp_stack_allocate_init(size_t stack_space_size);
/**
* @brief Task stack allocator for @ref CONFIGURE_TASK_STACK_ALLOCATOR.
*
@@ -64,6 +70,11 @@ void *bsp_stack_allocate(size_t size);
*/
void bsp_stack_free(void *stack);
/**
* @brief Task stack allocator initialization configuration option.
*/
#define CONFIGURE_TASK_STACK_ALLOCATOR_INIT bsp_stack_allocate_init
/**
* @brief Task stack allocator configuration option.
*/

28
c/src/lib/libbsp/shared/src/stackalloc.c
View File

@@ -27,30 +27,26 @@
#include <bsp/linker-symbols.h>
#define BSP_STACK_MAGIC 0xdeadbeef
static Heap_Control bsp_stack_heap;
static Heap_Control bsp_stack_heap = {
.page_size = BSP_STACK_MAGIC
};
void bsp_stack_allocate_init(size_t stack_space_size)
{
_Heap_Initialize(
&bsp_stack_heap,
bsp_section_stack_begin,
(uintptr_t) bsp_section_stack_size,
CPU_STACK_ALIGNMENT
);
}
void *bsp_stack_allocate(size_t size)
{
void *stack = NULL;
if (bsp_stack_heap.page_size == BSP_STACK_MAGIC) {
uintptr_t rv = _Heap_Initialize(
&bsp_stack_heap,
bsp_section_stack_begin,
(uintptr_t) bsp_section_stack_size,
CPU_STACK_ALIGNMENT
);
if (rv == 0) {
return NULL;
}
if (bsp_stack_heap.area_begin != 0) {
stack = _Heap_Allocate(&bsp_stack_heap, size);
}
stack = _Heap_Allocate(&bsp_stack_heap, size);
if (stack == NULL) {
stack = _Workspace_Allocate(size);
}