Advertisement
KRITSADA

ATX2 & Wireless-X control Motor and Servo

Dec 12th, 2016
251
0
Never
Not a member of Pastebin yet? Sign Up, it unlocks many cool features!
C++ 1.36 KB | None | 0 0
  1. #include <ATX2.h>
  2. byte x,s01=0,s02=0,s03=0;
  3. byte s1[5] =  {10,40,107,158};
  4. byte s2[3] =  {5,95};
  5. byte s3[6] = {0,25,50,148,180};
  6. void setup(){
  7.   XIO();
  8.   pinMode(2,INPUT_PULLUP);
  9. }
  10. void loop(){
  11.    while(uart1_ready()>0){          
  12.        x=uart1_read();
  13.    }
  14.     switch (x){
  15.       case 0x01: BK(60);break;
  16.       case 0x02: SR(60);break;
  17.       case 0x04: SL(60);break;
  18.       case 0x08: FD2(60,60);break;
  19.       case 0x81: BK(100);break;
  20.       case 0x82: SR(100);break;
  21.       case 0x84: SL(100);break;
  22.       case 0x88: FD2(100,100);break;
  23.       case 0x11: servo(1,0);servo(2,180);break;
  24.       case 0x12: servo(1,166);servo(2,14);break;
  25.       case 0x18: servo(1,60);servo(2,120);break;
  26.      
  27.       case 0x21:
  28.                   if(s01<3){s01++;}
  29.                   else{s01=0;}
  30.                   servo(1,s1[s01]);
  31.                   delay(250);break;
  32.       case 0x22:
  33.                   if(s02==0){s02=1;}
  34.                   else{s02=0;}
  35.                   servo(2,s2[s02]);
  36.                   delay(250);break;
  37.       case 0x24:  
  38.                   if(s03<4){s03++;}
  39.                   else{s03=0;}
  40.                   servo(3,s3[s03]);
  41.                   delay(250);break;
  42.       case 0x28:
  43.                   if(s01>0){s01--;}
  44.                   else{s01=3;}
  45.                   servo(1,s1[s01]);
  46.                   delay(250);break;
  47.       default: AO();
  48.      }
  49. }
Advertisement
Add Comment
Please, Sign In to add comment
Advertisement