#include "..\\Glove.h"

int main()
{
  // connect to glove
  Glove g;
  g.setComm(1);
  printf("Attempting to connect to Glove on COM %d... ", g.getComm());
  if (!g.open())
  {
    printf("failed, aborting.\n\n");
    return 1;
  } else
    printf("succeeded.\n\n");

  // run calibration to get normalization bounds  
  printf("Running calibration routine (~5 seconds):\n  => extend each finger through range of motion... ");

  Glove::GloveCalib calib;
  if (!g.calibrate(&calib))
  {
    printf("failed, aborting.\n\n");
    return 1;
  } else
    printf("succeeded.\n\n");

  g.setCalib(calib);

  printf("Calibration data gathered (bounds and offset):\n\n");
  for (int i = 0; i < 5; i++)
    printf("%f  <  ( finger #%d + %f )  <  %f\n", calib.min[i], i + 1, calib.offset[i], calib.max[i]);
  printf("\n");

  Glove::GloveData frame;
  char ch = _getch();
  FILE *fp;
  char fname[100];
  size_t namelen;
  printf("Type the name of the data file:\n");
  _cgets_s( fname, 99, &namelen );
  fname[namelen] = '\0';
  fp = fopen( fname, "w" );
  if( !fp )
  {
	  printf( "failed to generate file. aborting.\n\n" );
	  return 1;
  }
	if (!g.getState(&frame))
	{
	  printf("failed, aborting.\n\n");
	  return 1;
	}
	fprintf( fp, "%-4d %-4d %-4d %-4d %-4d\n", frame.finger_pos[4], frame.finger_pos[3], frame.finger_pos[2], frame.finger_pos[1], frame.finger_pos[0]);
    printf("\n\n  ...quitting.\n\n");

  return 0;
}