Renamed remotely

git-svn-id: file:///srv/dev-disk-by-uuid-17e88007-4d0c-45e0-8757-cacfcc458630/repositories/svn/Diplomarbeit@106 9fe90eed-be63-e94b-8204-d34ff4c2ff93

Test_Item/SW/testapplication-0.0.1/MessageQueue.c

@@ -0,0 +1,127 @@
+/* ---------------------------------------------------------------------------
+ * MessageQueue.c - v0.1                                (c) 2008 Micro-key bv
+ * ---------------------------------------------------------------------------
+ * Micro-key bv
+ * Industrieweg 28, 9804 TG Noordhorn
+ * Postbus 92, 9800 AB Zuidhorn
+ * The Netherlands
+ * Tel: +31 594 503020
+ * Fax: +31 594 505825
+ * Email: support@microkey.nl  
+ * Web: www.microkey.nl
+ * ---------------------------------------------------------------------------
+ * Description: 
+ * ---------------------------------------------------------------------------
+ * Version(s):  0.1, Jan 29, 2008, FSc
+ *                   Creation.
+ * ---------------------------------------------------------------------------
+ */
+
+/* ---------------------------------------------------------------------------
+ * System include files
+ * ---------------------------------------------------------------------------
+ */
+#include <stdio.h>
+#include <stdlib.h>
+#include <string.h>
+
+
+/* ---------------------------------------------------------------------------
+ * Application include files
+ * ---------------------------------------------------------------------------
+ */
+#include "BpPort.h"
+#include "MessageQueue.h"
+
+/* ---------------------------------------------------------------------------
+ * Local constant and macro definitions
+ * ---------------------------------------------------------------------------
+ */
+
+/* ---------------------------------------------------------------------------
+ * Global variable definitions
+ * ---------------------------------------------------------------------------
+ */
+
+/* ---------------------------------------------------------------------------
+ * Local variable definitions
+ * ---------------------------------------------------------------------------
+ */
+
+/* ---------------------------------------------------------------------------
+ * Local function definitions
+ * ---------------------------------------------------------------------------
+ */
+
+ t_mq_messagequeue *mqInit()
+ {
+	 t_mq_messagequeue *newMessageQueue = (t_mq_messagequeue *)pvPortMalloc( sizeof(t_mq_messagequeue) );
+	 
+	 newMessageQueue->count = 0;
+	 newMessageQueue->head = 0;
+	 newMessageQueue->tail = 0;
+	 
+	 // initialise Mutex
+	 pthread_mutex_init(&(newMessageQueue->mutex), NULL);
+	 
+	 return newMessageQueue;
+ }
+ 
+RESULT mqAdd( t_mq_messagequeue *queue, t_bpmsg_message *message)
+{
+	RESULT result = OK;
+	
+	pthread_mutex_lock(&(queue->mutex));
+	{
+		if(queue->count >= TX_QUEUE_SIZE)
+	    {
+			printf("messagequeue full\n"); fflush(stdout);
+			result = ERROR;
+	    }
+		else
+	    {
+			memcpy( &(queue->messages[queue->tail]), message, sizeof(t_bpmsg_message) );
+			queue->count++;
+			queue->tail = (queue->tail + 1) % TX_QUEUE_SIZE;
+	    }
+	}
+	pthread_mutex_unlock(&(queue->mutex));
+	
+	return result;
+}
+
+RESULT mqGet( t_mq_messagequeue *queue, t_bpmsg_message *message)
+{
+	RESULT result = OK;
+
+	pthread_mutex_lock(&(queue->mutex));
+	{
+		if(queue->count > 0)
+		{
+			memcpy( message, &(queue->messages[queue->head]), sizeof(t_bpmsg_message) );
+			queue->head = (queue->head + 1) % TX_QUEUE_SIZE;
+			queue->count--;
+		}
+		else
+		{
+			result = ERROR;
+		}
+	}
+	pthread_mutex_unlock(&(queue->mutex));
+
+	return result;
+}
+
+BOOLEAN mqEmpty( t_mq_messagequeue *queue )
+{
+	UINT8 count;
+	
+	pthread_mutex_lock(&(queue->mutex));
+	{
+		count = queue->count;
+	}
+	pthread_mutex_unlock(&(queue->mutex));
+	
+	return ( count == 0 ? TRUE : FALSE);
+}
+