Data hosted with ♥ by Pastebin.com - Download Raw - See Original
  1. #include <ipst.h>
  2. int i=0;
  3. char x[20];
  4. void setup(){
  5.   glcdMode(1);
  6.   out(17,0);delay(100);
  7.   out(17,1);delay(1000);
  8.   Serial1.begin(2400);
  9.   Serial1.print("!SCSBR");
  10.   Serial1.write(1);
  11.   Serial1.write(0x0D);
  12.   delay(100);
  13.   Serial1.begin(38400);
  14. }
  15. void loop(){
  16.   for(i=0;i<16;i++){
  17.     servoWrite(i,1250);
  18.   }
  19.   delay(1000);
  20.   for(i=0;i<16;i++){
  21.     servoWrite(i,250);
  22.   }
  23.   delay(1000);
  24. }
  25.  
  26. void servoWrite(byte CH,int POS){
  27. byte L,H;
  28.   Serial1.print("!SC");
  29.   Serial1.write(CH);
  30.   Serial1.write(0x00);
  31.   L=lowByte(POS);  
  32.   H=highByte(POS);
  33.   Serial1.write(L);
  34.   Serial1.write(H);  
  35.   Serial1.write(0x0D);  
  36. }