Matthias
581bdc3e23
git-svn-id: file:///srv/dev-disk-by-uuid-17e88007-4d0c-45e0-8757-cacfcc458630/repositories/svn/Diplomarbeit@106 9fe90eed-be63-e94b-8204-d34ff4c2ff93
128 lines
3.5 KiB
C
128 lines
3.5 KiB
C
/* ---------------------------------------------------------------------------
|
|
* 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);
|
|
}
|
|
|