Colony

#include "queue.h"

#include <wl_defs.h>

#include <stdlib.h>

#include <stdio.h>

/**

 * @struct node_def

 * A node in the queue.

 **/

typedef struct node_def

{

        /** The item at this point in the queue. **/

        void* val;

        /** The next node in the queue. **/

        struct node_def* next;

} Node;

/**

 * Create a queue.

 *

 * @return the newly created queue.

 **/

Queue* queue_create()

{

        Queue* q = (Queue*)malloc(sizeof(Queue));

        if (q == NULL)

        {

                WL_DEBUG_PRINT("Out of memory.\r\n");

                return NULL;

        }

        q->head = NULL;

        q->size = 0;

        return q;

}

/**

 * Destroys a queue, freeing memory.

 *

 * @param q the queue to destroy

 **/

void queue_destroy(Queue* q)

{

        Node* t = q->head;

        while (t != NULL)

        {

                Node* t2 = t->next;

                free(t);

                t = t2;

        }

        free(q);

}

/**

 * Add an element to a queue.

 *

 * @param q the queue to add an element to

 * @param item the item to add to the queue

 **/

void queue_add(Queue* q, void* item)

{

        Node* n = (Node*)malloc(sizeof(Node));

        n->val = item;

        n->next = NULL;

        if (q->head == NULL)

        {

                q->head = n;

                q->tail = n;

        }

        else

        {

                q->tail->next = n;

                q->tail = n;

        }

        q->size++;

}

/**

 * Remove an element from the front of a queue.

 *

 * @param q the queue to remove the element from

 *

 * @return the element which was removed

 **/

void* queue_remove(Queue* q)

{

        Node* first = q->head;

        if (first == NULL)

        {

                WL_DEBUG_PRINT("Attempting to remove item \

                        from empty queue.\r\n");

                WL_DEBUG_PRINT_INT(queue_size(q));

        }

        void* ret = first->val;

        q->head = first->next;

        if (q->tail == first)

                q->tail = NULL;

        free(first);

        q->size--;

        return ret;

}

/**

 * Remove all instances of a given element from a queue.

 *

 * @param q the queue to remove the elements from

 * @param item the element to remove all instances of

 **/

void queue_remove_all(Queue* q, void* item)

{

        Node* curr = q->head;

        Node* prev = NULL;

        while (curr != NULL)

        {

                Node* next = curr->next;

                if (curr->val == item)

                {

                        if (q->head == curr)

                                q->head = next;

                        if (q->tail == curr)

                                q->tail = prev;

                        if (prev != NULL)

                                prev->next = next;

                        free(curr);

                        q->size--;

                }

                else

                        prev = curr;

                curr = next;

        }

}

/**

 * Get the number of elements in the queue.

 *

 * @param q the queue to get the size of

 * @return the size of the queue

 **/

int queue_size(Queue* q)

{

        return q->size;

}

/**

 * Check if the queue is empty.

 * 

 * @param q the queue to check

 * @return nonzero if the queue is empty, 0 otherwise

 **/

int queue_is_empty(Queue* q)

{

        return q->size == 0;

}