Colony

/**

 *

 *  @author Jason Knichel

 *

 *  4/12/07

 */

#include <stdio.h>

#include <string.h>

#include <stdlib.h>

#include "includes/Lcd.h"

#include "includes/Client.h"

Lcd::Lcd()

{

}

void Lcd::printUsage()

{

  printf("\nUsage of the \"lcd\" command:\n");

  printf("lcd init\n");

  printf("lcd clearScreen\n");

  printf("lcd putByte <byteValue>\n");

  printf("lcd putChar <character>\n");

  printf("lcd putString <string>\n");

  printf("lcd goto <x> <y>\n");

  printf("lcd putInt <integer>\n");

  printf("\n");

}

int Lcd::parseCommand(char tokens[MAX_TOKENS][MAX_TOKEN_SIZE], int numTokens, Server server)

{

  if (numTokens < 2)

    {

      printf("Error: The lcd command did not contain enough fields.\n");

      return -1;

    }

  char buffer[MAX_COMMAND_LEN];

  buffer[0] = '\0';

  snprintf(buffer, MAX_COMMAND_LEN, "%d ", SEND_TO_ROBOT);

  int len = strlen(buffer);

  if (strcmp(tokens[1], "init") == 0)

    {

      snprintf(buffer+len, MAX_COMMAND_LEN - len, "%d", LCD_INIT);

    }

  else if (strcmp(tokens[1], "clearScreen") == 0)

    {

      snprintf(buffer+len, MAX_COMMAND_LEN - len, "%d", LCD_CLEAR_SCREEN);

    }

  else if (numTokens < 3)

    {

      printf("Error: The lcd %s command was invalid or did not contain enough fields.\n", tokens[1]);

      return -1;

    }

  else

    {

      if (strcmp(tokens[1], "putByte") == 0)

        {

          char * endPtr = NULL;

          int value = strtol(tokens[2], &endPtr, 10);

          if (tokens[2][0] == '\0' || *endPtr != '\0')

            {

              printf("Error: The specified value was invalid.\n");

              return -1;

            }

          if (value < 0 || value > 255)

            {

              printf("Error: The specified byte value was too large.\n");

              return -1;

            }

          snprintf(buffer+len, MAX_COMMAND_LEN - len, "%d %d", LCD_PUTBYTE, value);

        }

      else if (strcmp(tokens[1], "putChar") == 0)

        {

          int charLength = strlen(tokens[2]);

          if (charLength <= 0 || charLength > 1)

            {

              printf("Error: The specified character was invalid.\n");

              return -1;

            }

          char character = tokens[2][0];

          snprintf(buffer+len, MAX_COMMAND_LEN - len, "%d %c", LCD_PUTCHAR, character);

        }

      else if (strcmp(tokens[1], "putString") == 0)

        {

          //TODO: make this faster

          char stringBuffer[MAX_INPUT_LENGTH];

          stringBuffer[0] = '\0';

          for (int i = 2; i < numTokens; i++)

            {

              strncat(stringBuffer, tokens[i], MAX_INPUT_LENGTH - strlen(stringBuffer));

              strcat(stringBuffer, " ");

            }

          if ((signed)(strlen(stringBuffer)) > MAX_COMMAND_LEN - len - 3)

            {

              printf("Error: The string you want to send is too long.\n");

              return -1;

            }

          snprintf(buffer+len, MAX_COMMAND_LEN - len, "%d %s", LCD_PUTSTR, stringBuffer);

        }

      else if (strcmp(tokens[1], "goto") == 0)

        {

          if (numTokens < 4)

            {

              printf("Error: Not enough parameters for the goto command.\n");

              return -1;

            }

          char * endPtr = NULL;

          int xValue = strtol(tokens[2], &endPtr, 10);

          if (tokens[2][0] == '\0' || *endPtr != '\0')

            {

              printf("Error: The specified value was invalid.\n");

              return -1;

            }

          endPtr = NULL;

          int yValue = strtol(tokens[2], &endPtr, 10);

          if (tokens[2][0] == '\0' || *endPtr != '\0')

            {

              printf("Error: The specified value was invalid.\n");

              return -1;

            }

          snprintf(buffer+len, MAX_COMMAND_LEN - len, "%d %d %d", LCD_GOTOXY, xValue, yValue);

        }

      else if (strcmp(tokens[1], "putInt") == 0)

        {

          char * endPtr = NULL;

          int value = strtol(tokens[2], &endPtr, 10);

          if (tokens[2][0] == '\0' || *endPtr != '\0')

            {

              printf("Error: The specified value was invalid.\n");

              return -1;

            }

          snprintf(buffer+len, MAX_COMMAND_LEN - len, "%d %d", LCD_PUTINT, value);

        }

      else

        {

          printf("Error: invalid lcd command.\n");

          return -1;

        }

    }

  //TODO: remove this print later

  printf("Command being sent to server:\n%s\n", buffer);

  server.sendMsg(buffer);

  return 0;

}