Colony

#include <stdlib.h>

#include <wireless.h>

#include <string.h>

#include <stdio.h>

#include "robots.h"

#define CHANNEL 0xE

typedef struct Node {

     Packet *info;

     struct Node *next;

     struct Node *prev;

} Node;

Node *thead = NULL;

void enqueue(char typ, int src, unsigned char *wrds,int len);

void make_listener()

{ 

     PacketGroupHandler *receiver;

     printf("wl_init() returned %d\n", wl_init());

     wl_set_channel(CHANNEL);

     receiver = malloc(sizeof(PacketGroupHandler));

     receiver->groupCode = GROUP;

     receiver->handle_response = NULL;

     receiver->timeout_handler = NULL;

     receiver->handle_receive = enqueue;

     wl_register_packet_group(receiver);

}

void enqueue(char typ, int src, unsigned char *wrds,int len)

{

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

     new->info = malloc(sizeof(Packet));

     new->info->source = src;

     new->info->length = len;

     new->info->type = typ;

     new->info->packet = malloc((strlen(wrds)+1)*sizeof(char));

     strcpy(new->info->packet, wrds);

     if (!thead)

          thead = new;

     else

     {

          new->next = thead;

          thead->prev = new;

          thead = new;

     }

}

Packet * dequeue()

{

     Node *iter;

     Packet *ret;

     if (!thead)

          return NULL;

     for (iter = thead; iter->next != NULL; iter = iter->next)

          ;

     ret = iter->info;

     if (iter->prev)

          (iter->prev)->next = NULL;

     else

          thead = NULL;

     free (iter);

     return ret;

}