#include <stdio.h>
#include <math.h>
#include "mini_ssc.h"

char *usage =
  "USAGE:\n"
  "  test [-p<port number>] [-b<baud rate>] [-s<servo 0-31>]\n"
  "       [-m<min position 0-255] [-x<max position 0-255>]\n";

int main(int argc,char **argv)
{
  int port, baudrate, servo, min, max, delay, step;

  char *s;
  int i,n;
  int x_in, y_in;
  int x_out, y_out;

  // defaults
  port     = 0;
  baudrate = 2400;

  // get parameter values
  for(i=0; i<argc; i++){
    s = argv[i];
    if((strlen(s) > 2) && s[0]=='-'){
      n = atoi(s + 2);
      switch(s[1]){
	case 'h':
	  printf(usage);
	  exit(0);
	  break;

        case 'p': port     = n; break;
        case 'b': baudrate = n; break;
      }
    }
  }
  
  // connect to the ssc
  if(!ssc_open(port,baudrate)){
  
    // enter infinite loop that translates pairs of screen coordinates
    // to pairs of telepointer coodinates.
    
    while(1){
      scanf("%d,%d", &x_in, &y_in);
      fprintf(stderr,"%d,%d\n", x_in, y_in);
      ssc_move( 0, x_in );
      ssc_move( 2, y_in );
    }
  }
}