Colony

/* A simple server in the internet domain using TCP

   The port number is passed as an argument */

#include <stdio.h>

#include <stdlib.h>

#include <strings.h>

#include <string.h>

#include <unistd.h>

#include <sys/types.h> 

#include <sys/socket.h>

#include <netinet/in.h>

#include "netserv.h"

#include "robots.h"

#include "wireless.h"

void donothin()

{

     return;

}

int main(int argc, char *argv[])

{

     char buffer[256];

     char outbuf[256];

     int n, newsockfd, len;

     Packet *received;

     if (argc < 2) {

          fprintf(stderr,"usage: %s <port number>\n", argv[0]);

          exit(1);

     }

     newsockfd = make_sock(atoi(argv[1]));

     make_listener();

     printf("Robot listener created.\n");

     bzero(buffer,256);

     while (1)

     {

          wl_do();

          /* this is a completely useless queue, since wl_do only reads one packet at a time */

          received = dequeue();

          /* oh well */

          if (received)

          {

               fprintf(stdout, "len: %d\n", buffer[1]);

               buffer[0] = (char) received->source;

               buffer[1] = (char) received->length-2;

               buffer[2] = (char) received->type;

               memcpy(buffer+3, received->packet, received->length);

               n = write(newsockfd, buffer, 200);

               free(received);

               bzero(buffer, 256);

          }

     }

     return 0; 

}

void error(char *msg)

{

     printf(msg);

     exit(1);

}