// Version 1

//#ifndef Servo_H
//#define Servo_H

/*#include "FootClass.h";

int ConverttoMS(int Position, int low, int high)
{
  int tmp = ( Position * ( ( high - low ) / 180 ) );
  return low + tmp;
}

void mSend(Foot f1, Foot f2, Foot f3, Foot f4, Foot f5, Foot f6)
{
  int smin0 = 600;
  int smin1 = 960;
  int smin2 = 600;
  int smin3 = 600;
  int smax0 = 2400;
  int smax1 = 2100;
  int smax2 = 2400;
  int smax3 = 2400;

  Serial1.print(" #"); 
  Serial1.print(0);
  Serial1.print(" P");
  Serial1.print(ConverttoMS(f1.O1, smin0, smax0));
  Serial1.print(" #"); 
  Serial1.print(1);
  Serial1.print(" P");
  Serial1.print(ConverttoMS(f1.O2, smin1, smax1));
  Serial1.print(" #"); 
  Serial1.print(2);
  Serial1.print(" P");
  Serial1.print(ConverttoMS(f1.O3, smin2, smax2));
  Serial1.print(" #"); 
  Serial1.print(4);
  Serial1.print(" P");
  Serial1.print(ConverttoMS(f1.O1, smin0, smax0));
  Serial1.print(" #"); 
  Serial1.print(5);
  Serial1.print(" P");
  Serial1.print(ConverttoMS(f1.O2, smin1, smax1));
  Serial1.print(" #"); 
  Serial1.print(6);
  Serial1.print(" P");
  Serial1.print(ConverttoMS(f1.O3, smin2, smax2));
  Serial1.print(" #"); 
  Serial1.print(7);
  Serial1.print(" P");
  Serial1.print(ConverttoMS(f1.O1, smin0, smax0));
  Serial1.print(" #"); 
  Serial1.print(8);
  Serial1.print(" P");
  Serial1.print(ConverttoMS(f1.O2, smin1, smax1));
  Serial1.print(" #"); 
  Serial1.print(9);
  Serial1.print(" P");
  Serial1.print(ConverttoMS(f1.O3, smin2, smax2));

  Serial1.print(" #"); 
  Serial1.print(16);
  Serial1.print(" P");
  Serial1.print(ConverttoMS(f1.O1, smin0, smax0));
  Serial1.print(" #"); 
  Serial1.print(17);
  Serial1.print(" P");
  Serial1.print(ConverttoMS(f1.O2, smin1, smax1));
  Serial1.print(" #"); 
  Serial1.print(18);
  Serial1.print(" P");
  Serial1.print(ConverttoMS(f1.O3, smin2, smax2));
  Serial1.print(" #"); 
  Serial1.print(19);
  Serial1.print(" P");
  Serial1.print(ConverttoMS(f1.O1, smin0, smax0));
  Serial1.print(" #"); 
  Serial1.print(20);
  Serial1.print(" P");
  Serial1.print(ConverttoMS(f1.O2, smin1, smax1));
  Serial1.print(" #"); 
  Serial1.print(21);
  Serial1.print(" P");
  Serial1.print(ConverttoMS(f1.O3, smin2, smax2));
  Serial1.print(" #"); 
  Serial1.print(22);
  Serial1.print(" P");
  Serial1.print(ConverttoMS(f1.O1, smin0, smax0));
  Serial1.print(" #"); 
  Serial1.print(23);
  Serial1.print(" P");
  Serial1.print(ConverttoMS(f1.O2, smin1, smax1));
  Serial1.print(" #"); 
  Serial1.print(24);
  Serial1.print(" P");
  Serial1.print(ConverttoMS(f1.O3, smin2, smax2));

  Serial1.print(" T");
  Serial1.println(0);
}*/

//#endif