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

Quantum Controller/SW/testapplication-0.0.1/MessageHandlerQueue.c

@@ -0,0 +1,208 @@
+/* ---------------------------------------------------------------------------
+ * MessageHandlerQueue.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 30, 2008, FSc
+ *                   Creation.
+ * ---------------------------------------------------------------------------
+ */
+
+/* ---------------------------------------------------------------------------
+ * System include files
+ * ---------------------------------------------------------------------------
+ */
+#include <pthread.h>
+
+/* ---------------------------------------------------------------------------
+ * Application include files
+ * ---------------------------------------------------------------------------
+ */
+#include "BpPort.h"
+#include "MessageHandlerQueue.h"
+
+
+/* ---------------------------------------------------------------------------
+ * Local constant and macro definitions
+ * ---------------------------------------------------------------------------
+ */
+
+typedef struct t_mhq_ENTITY
+{
+	UINT8                  messageId;
+	t_bp_messagehandler    messageHandler;
+	int                    ownHandle;
+	struct t_mhq_ENTITY   *next;
+	struct t_mhq_ENTITY   *previous; 
+} t_mhq_entity;
+
+typedef struct t_mhq_ADMIN
+{
+	struct t_mhq_ENTITY  *head;
+	struct t_mhq_ENTITY  *tail;
+	pthread_mutex_t       mutex;	
+} t_mhq_admin;
+
+/* ---------------------------------------------------------------------------
+ * Global variable definitions
+ * ---------------------------------------------------------------------------
+ */
+
+/* ---------------------------------------------------------------------------
+ * Local variable definitions
+ * ---------------------------------------------------------------------------
+ */
+
+/* ---------------------------------------------------------------------------
+ * Local function definitions
+ * ---------------------------------------------------------------------------
+ */
+static t_mhq_entity *lookupMhqEntry(int handle, UINT8 messageId);
+
+
+int mhqInit()
+{
+	t_mhq_admin *newAdmin = (t_mhq_admin *)pvPortMalloc( sizeof(t_mhq_admin) );
+	
+	newAdmin->head = NULL;
+
+	// initialise Mutex
+	pthread_mutex_init(&(newAdmin->mutex), NULL);
+	
+	return (int)newAdmin;
+}
+
+void mhqDeinit(int handle)
+{
+	t_mhq_entity *iterator = ((t_mhq_admin *)handle)->head;
+	
+	while (iterator != NULL)
+	{
+		t_mhq_entity *nextItem = iterator->next;
+		vPortFree( iterator );
+		iterator = nextItem;
+	}
+		
+	vPortFree( (t_mhq_admin *)handle );
+}
+
+void mhqAdd(int handle, UINT8 messageId, t_bp_messagehandler messageHandler, int ownHandle)
+{
+	t_mhq_admin  *theAdmin = (t_mhq_admin *)handle;
+	t_mhq_entity *newEntry = (t_mhq_entity  *)pvPortMalloc( sizeof(t_mhq_entity) );
+
+	// fill entry
+	newEntry->messageId  = messageId;
+	newEntry->messageHandler = messageHandler;
+	newEntry->ownHandle   = ownHandle;
+	newEntry->next        = NULL;
+	newEntry->previous    = NULL;
+		
+	pthread_mutex_lock(&(theAdmin->mutex));
+	{
+		// Add to linked list
+		if (theAdmin->head != NULL)
+		{
+			theAdmin->tail->next = newEntry;
+			newEntry->previous = theAdmin->tail;
+			theAdmin->tail = newEntry;
+		}
+		else
+		{
+			theAdmin->head = newEntry;
+			theAdmin->tail = newEntry;
+		}
+	}
+	pthread_mutex_unlock(&(theAdmin->mutex));
+}
+
+void mhqRemove(int handle, UINT8 messageId, t_bp_messagehandler messageHandler)
+{
+	t_mhq_entity *entry = lookupMhqEntry(handle, messageId);
+	t_mhq_admin *theAdmin = (t_mhq_admin *)handle;
+
+	pthread_mutex_lock(&(theAdmin->mutex));
+	{
+		if (entry != NULL)
+		{
+			// rebuild linked list
+			if (entry->next != NULL)
+			{
+				entry->next->previous = entry->previous;
+			}
+			else
+			{
+				theAdmin->tail = entry->previous;
+			}
+	
+			if (entry->previous != NULL)
+			{
+				entry->previous->next = entry->next;
+			}
+			else
+			{
+				theAdmin->head = entry->next;
+			}
+			
+			// remove entry
+			vPortFree( entry );
+		}
+	}
+	pthread_mutex_unlock(&(theAdmin->mutex));
+}
+
+RESULT mhqExecute(int handle, UINT8 messageId, t_bpmsg_message *message)
+{
+	t_mhq_entity *item = lookupMhqEntry(handle, messageId);
+	
+	if (item != NULL)
+	{
+		item->messageHandler( message, item->ownHandle );
+		
+		return OK;
+	}
+	else
+	{
+		return ERROR;
+	}
+}
+ 
+
+t_mhq_entity *lookupMhqEntry(int handle, UINT8 messageId)
+{
+	t_mhq_admin *theAdmin = (t_mhq_admin *)handle;
+	t_mhq_entity *result = NULL;
+	t_mhq_entity *iterator;
+	
+	pthread_mutex_lock(&(theAdmin->mutex));
+	{
+		iterator = theAdmin->head;
+		while ((result == NULL) && (iterator != NULL))
+		{
+			if (iterator->messageId == messageId)
+			{
+				result = iterator;
+			}
+			else
+			{
+				iterator = iterator->next;
+			}
+		}
+	}
+	pthread_mutex_unlock(&(theAdmin->mutex));
+	
+	return result;
+}
+
+
+
+