#include "windows_queue.h" #include "windows_glue.h" #include static int queueFull(windows_queue_t * queue) { return queue->items == queue->size; } static int queueEmpty(windows_queue_t * queue) { return queue->items == 0; } windows_queue_t * windows_queue_create(int length, size_t item_size) { windows_queue_t *queue = (windows_queue_t*)malloc(sizeof(windows_queue_t)); if(queue == NULL) goto queue_malloc_failed; queue->buffer = malloc(length*item_size); if(queue->buffer == NULL) goto buffer_malloc_failed; queue->size = length; queue->item_size = item_size; queue->items = 0; queue->head_idx = 0; InitializeCriticalSection(&(queue->mutex)); InitializeConditionVariable(&(queue->cond_full)); InitializeConditionVariable(&(queue->cond_empty)); goto queue_init_success; buffer_malloc_failed: free(queue); queue = NULL; queue_malloc_failed: queue_init_success: return queue; } void windows_queue_delete(windows_queue_t * q) { if(q==NULL) return; DeleteCriticalSection(&(q->mutex)); free(q->buffer); free(q); } int windows_queue_enqueue(windows_queue_t * queue, void * value, int timeout) { int offset; EnterCriticalSection(&(queue->mutex)); while(queueFull(queue)) { int ret = SleepConditionVariableCS(&(queue->cond_full), &(queue->mutex), timeout); if( !ret ) { LeaveCriticalSection(&(queue->mutex)); return ret == WAIT_TIMEOUT ? WINDOWS_QUEUE_FULL : WINDOWS_QUEUE_ERROR; } } offset = ((queue->head_idx+queue->items) % queue->size) * queue->item_size; memcpy((unsigned char*)queue->buffer + offset, value, queue->item_size); queue->items++; LeaveCriticalSection(&(queue->mutex)); WakeAllConditionVariable(&(queue->cond_empty)); return WINDOWS_QUEUE_OK; } int windows_queue_dequeue(windows_queue_t * queue, void * buf, int timeout) { EnterCriticalSection(&(queue->mutex)); while(queueEmpty(queue)) { int ret = SleepConditionVariableCS(&(queue->cond_empty), &(queue->mutex), timeout); if( !ret ) { LeaveCriticalSection(&(queue->mutex)); return ret == WAIT_TIMEOUT ? WINDOWS_QUEUE_EMPTY : WINDOWS_QUEUE_ERROR; } } memcpy(buf, (unsigned char*)queue->buffer+(queue->head_idx%queue->size*queue->item_size), queue->item_size); queue->items--; queue->head_idx = (queue->head_idx + 1) % queue->size; LeaveCriticalSection(&(queue->mutex)); WakeAllConditionVariable(&(queue->cond_full)); return WINDOWS_QUEUE_OK; } int windows_queue_items(windows_queue_t * queue) { int items; EnterCriticalSection(&(queue->mutex)); items = queue->items; LeaveCriticalSection(&(queue->mutex)); return items; }