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

char *usage =
  "USAGE:\n"
  "  test 0 0\n"
  "  puts servo at origin in lower left\n"
  "  test 254 254\n"
  "  puts servo at upper right\n";
/*  "  test 254 0\n"
  "  puts servo at lower right\n";
  "  unknown why won't go all the way to 255\n";
  "  test 127 0\n"
  "  puts servo at lower middle\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
  if (argc==3){
    x_in = atoi(argv[1]);
    y_in = atoi(argv[2]);
  }
  else {
    fprintf(stderr,"%s",usage);
    exit(-1);
  }
  
  // connect to the ssc
  if(!ssc_open(port,baudrate)){
  
    // enter infinite loop that translates pairs of screen coordinates
    // to pairs of telepointer coodinates.
    
    fprintf(stderr,"%d,%d\n", x_in, y_in);
    ssc_move( 0, x_in );
    ssc_move( 2, y_in );
  }
}