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];

     int tmp = 0;

     char outbuf[256];

     int n, newsockfd, len;

     short int tprint;

     Packet *received;

     if (argc < 2) {

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

          exit(1);

     }

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

     printf("Made socket\n");

     make_listener();

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

     bzero(buffer,256);

     while (1)

     {

          bzero(buffer, 256);

          wl_do();

          received = dequeue();

          if (received)

          {

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

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

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

               buffer[3] = 0;

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

               memcpy(&tprint, buffer+4, 2);

               printf("%d\n", tprint);

               n = write(newsockfd, buffer, 22);

               free(received);

               bzero(buffer, 256);

          }

     }

     return 0; 

}

void error(char *msg)

{

     printf(msg);

     exit(1);

}