105 lines
2.6 KiB
C
105 lines
2.6 KiB
C
// 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
|
|
|