adding lpc24xx BSP parts

1 files changed, 71 insertions, 0 deletions

diff --git a/c/src/lib/libbsp/shared/src/stackalloc.c b/c/src/lib/libbsp/shared/src/stackalloc.c
new file mode 100644
index 0000000000..31b7c14db3
--- /dev/null
+++ b/c/src/lib/libbsp/shared/src/stackalloc.c
@@ -0,0 +1,71 @@
+/**
+ * @file
+ *
+ * @ingroup bsp_shared
+ *
+ * @brief Stack initialization, allocation and free functions.
+ */
+
+/*
+ * Copyright (c) 2009
+ * embedded brains GmbH
+ * Obere Lagerstr. 30
+ * D-82178 Puchheim
+ * Germany
+ * rtems@embedded-brains.de
+ *
+ * The license and distribution terms for this file may be
+ * found in the file LICENSE in this distribution or at
+ * http://www.rtems.com/license/LICENSE.
+ */
+
+#include <rtems.h>
+#include <rtems/score/wkspace.h>
+
+#include <bsp/stackalloc.h>
+
+#define BSP_STACK_MAGIC 0xdeadbeef
+
+static Heap_Control bsp_stack_heap = {
+  .page_size = BSP_STACK_MAGIC
+};
+
+void bsp_stack_initialize(void *start, intptr_t size)
+{
+  bsp_stack_heap.begin = start;
+  bsp_stack_heap.end = (void *) size;
+}
+
+void *bsp_stack_allocate(uint32_t size)
+{
+  void *stack = NULL;
+
+  if (bsp_stack_heap.page_size == BSP_STACK_MAGIC) {
+    uint32_t rv = _Heap_Initialize(
+      &bsp_stack_heap,
+      bsp_stack_heap.begin,
+      (intptr_t) bsp_stack_heap.end,
+      CPU_STACK_ALIGNMENT
+    );
+    if (rv == 0) {
+      return NULL;
+    }
+  }
+
+  stack = _Heap_Allocate(&bsp_stack_heap, (intptr_t) size);
+
+  if (stack == NULL) {
+    stack = _Workspace_Allocate(size);
+  }
+
+  return stack;
+}
+
+void bsp_stack_free(void *stack)
+{
+  bool ok = _Heap_Free(&bsp_stack_heap, stack);
+
+  if (!ok) {
+    _Workspace_Free(stack);
+  }
+}