From 2c46df1916a25b7880416aee974a518cc607717a Mon Sep 17 00:00:00 2001
From: gdisirio <gdisirio@35acf78f-673a-0410-8e92-d51de3d6d3f4>
Date: Fri, 16 Oct 2009 17:45:19 +0000
Subject: New heap manager.

git-svn-id: svn://svn.code.sf.net/p/chibios/svn/trunk@1221 35acf78f-673a-0410-8e92-d51de3d6d3f4
---
 os/kernel/src/chmemcore.c | 99 +++++++++++++++++++++++++++++++++++++++++++++++
 1 file changed, 99 insertions(+)
 create mode 100644 os/kernel/src/chmemcore.c

(limited to 'os/kernel/src/chmemcore.c')

diff --git a/os/kernel/src/chmemcore.c b/os/kernel/src/chmemcore.c
new file mode 100644
index 000000000..87ef6037a
--- /dev/null
+++ b/os/kernel/src/chmemcore.c
@@ -0,0 +1,99 @@
+/*
+    ChibiOS/RT - Copyright (C) 2006-2007 Giovanni Di Sirio.
+
+    This file is part of ChibiOS/RT.
+
+    ChibiOS/RT is free software; you can redistribute it and/or modify
+    it under the terms of the GNU General Public License as published by
+    the Free Software Foundation; either version 3 of the License, or
+    (at your option) any later version.
+
+    ChibiOS/RT is distributed in the hope that it will be useful,
+    but WITHOUT ANY WARRANTY; without even the implied warranty of
+    MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
+    GNU General Public License for more details.
+
+    You should have received a copy of the GNU General Public License
+    along with this program.  If not, see <http://www.gnu.org/licenses/>.
+*/
+
+/**
+ * @file chmemcore.c
+ * @brief Core memory manager code.
+ * @addtogroup memcore
+ * @{
+ */
+
+#include <ch.h>
+
+#if CH_USE_MEMCORE
+
+#if CH_MEMCORE_SIZE == 0
+  extern align_t __heap_base__;
+  extern align_t __heap_end__;
+#else
+align_t buffer[ALIGN_SIZE(CH_MEMCORE_SIZE) / sizeof(align_t)];
+#endif
+
+static align_t *nextmem;
+static align_t *endmem;
+
+/**
+ * @brief Low level memory manager initialization.
+ *
+ * @note Internal use only.
+ */
+void core_init(void) {
+#if CH_MEMCORE_SIZE == 0
+  nextmem = &__heap_base__;
+  endmem = &__heap_end__;
+#else
+  nextmem = &buffer[0];
+  endmem = &buffer[ALIGN_SIZE(CH_MEMCORE_SIZE) / sizeof(align_t)];
+#endif
+}
+
+/**
+ * @brief Allocates a block of memory.
+ * @details The size of the returned block is aligned to the alignment
+ *          type @p align_t so it is not possible to allocate less than
+ *          <code>sizeof(align_t)</code>.
+ *
+ *
+ * @param[in] the size of the block to be allocated
+ * @return A pointer to the allocated memory block.
+ * @retval NULL allocation failed, core memory exhausted.
+ */
+void *chCoreAlloc(size_t size) {
+  void *p;
+
+  chSysLock();
+  p = chCoreAllocI(size);
+  chSysUnlock();
+  return p;
+}
+
+/**
+ * @brief Allocates a block of memory.
+ * @details The size of the returned block is aligned to the alignment
+ *          type @p align_t so it is not possible to allocate less than
+ *          <code>sizeof(align_t)</code>.
+ *
+ * @param[in] the size of the block to be allocated.
+ * @return A pointer to the allocated memory block.
+ * @retval NULL allocation failed, core memory exhausted.
+ */
+void *chCoreAllocI(size_t size) {
+  void *p;
+
+  size = MEM_ALIGN_SIZE(size);
+  if (nextmem + size > endmem)
+    return NULL;
+  p = nextmem;
+  nextmem += size;
+  return p;
+}
+
+#endif /* CH_USE_MEMCORE */
+
+/** @} */
-- 
cgit v1.2.3