#include <stdio.h>
#include <stdlib.h>
#include <string.h>
#include <termios.h>
#include "definitions.h"
#include "rs232.h"

#define COMMAND_LENGTH 80 /* max length of a command. */

int main() {
  int i=1;
  int file_descriptor=0;
  int status=FAILURE;
  int number_of_terminators=1;
  char *command=NULL;
  char **reply=NULL;
  
  if ((command = (char *) calloc(COMMAND_LENGTH, sizeof(char)))==NULL) {
    fprintf(stderr, "*ERROR* failed to allocate command buffer!");
    fflush(stderr);
    exit(EXIT_FAILURE);
  }
  if ((reply = (char **) calloc(COMMAND_LENGTH, sizeof(char *))) == NULL) {
    fprintf(stderr, "*ERROR* failed to allocate command buffer!");
    fflush(stderr);
    exit(EXIT_FAILURE);
  }
  for (i=0; i<COMMAND_LENGTH; i++) {
#ifdef DEBUG
    printf("allocating i=%d\n", i);
#endif
    if ((reply[i] = (char *) calloc(COMMAND_LENGTH, sizeof(char)))==NULL) {
      fprintf(stderr, "*ERROR* failed to allocate command buffer!");
      fflush(stderr);
      exit(EXIT_FAILURE);
    }
  }

  /* First lets open the device for communication */
  
  status = rs232_openport(&(file_descriptor), PORT, B9600);

  if (status != SUCCESS) {
    fprintf(stderr, "*ERROR* failed to open device %s!\n", PORT);
    fflush(stderr);
    exit(EXIT_FAILURE);
  }

  while (1) {
    printf("Enter a command\n");
    scanf("%s", command);
    printf("Enter the expected number of lines in the reply of the compumotor command\n");
    scanf("%d", &(number_of_terminators));

    printf("Read in the following command:\n\t%s\n",command);

    status = compumotor_command(file_descriptor, command, reply, (int) COMMAND_LENGTH,number_of_terminators);
    if (status != SUCCESS) {
      fprintf(stderr,"*ERROR* failed to send command %s\n", command);
      fflush(stderr);
      exit(EXIT_FAILURE);
    }
    if (reply != NULL) {
      for (i=0; i<number_of_terminators; i++) {
	printf("Received the reply:\n\t%s\n",reply[i]);
      }
    }
  }
  exit(EXIT_SUCCESS);
}