Added Software projects

git-svn-id: file:///srv/dev-disk-by-uuid-17e88007-4d0c-45e0-8757-cacfcc458630/repositories/svn/Diplomarbeit@55 9fe90eed-be63-e94b-8204-d34ff4c2ff93
2008-12-23 10:34:08 +00:00
parent ee5a771818
commit 373a8c32b2
348 changed files with 86781 additions and 0 deletions
@@ -0,0 +1,90 @@
+
+#include "mem_mod.h"
+
+/* FreeRTOS includes */
+#include "FreeRTOS.h"
+#include "Task.h"
+#include "Queue.h"
+     
+extern void serWrite (
+  int device, 
+  short length, /**< Lengh of data in bytes */ 
+  char * data   /**< Pointer to data */
+);
+
+void Memmod_Init(memman *me,unsigned char buf_count,unsigned short buf_size)
+{
+    unsigned char *buffer;
+    unsigned short i;
+    me->count = buf_count;
+    me->size = buf_size;
+    buffer = pvPortMalloc(buf_count*buf_size);
+    me->buffer = buffer;
+    me->free_index = buf_count;
+    me->freelist = pvPortMalloc(buf_count*sizeof(link_item));
+    for(i=0;i<buf_count;i++)
+    {
+        me->freelist[i].data = buffer;
+        buffer = buffer+buf_size;
+    }
+}
+
+unsigned char* Memmod_GetBuffer(memman *me)
+{
+	return me->buffer;
+}
+
+memman *Memmod_Create(unsigned char buf_count,unsigned short buf_size)
+{
+    memman *new_item;
+    new_item = (memman *)pvPortMalloc(sizeof(memman));
+    Memmod_Init(new_item,buf_count,buf_size);
+    return new_item;
+}
+
+void *Memmod_Alloc(memman *me)
+{
+    unsigned char index;
+    void *retval;
+
+    taskENTER_CRITICAL();
+    {
+        index = me->free_index;
+        if(index > 0)
+        {
+            index--;
+            me->free_index=index;
+            retval = me->freelist[index].data;
+        }
+        else
+        {
+            retval = 0;
+        }
+    }
+    taskEXIT_CRITICAL();
+    
+	if (retval == 0)
+	{
+	    serWrite(1, sizeof("buffer error"), "buffer error");
+	}
+
+    return retval;
+}
+
+void Memmod_Free(memman *me,void *buffer)
+{
+    unsigned char index;
+
+    taskENTER_CRITICAL();
+    {
+        index = me->free_index;
+        if(index < me->count)
+        {
+            me->freelist[index].data = buffer;
+            index++;
+            me->free_index=index;
+        }
+    }
+    taskEXIT_CRITICAL();
+
+}