Advertisement
KRITSADA

ATX2 with WirelessX New Code Control motor and Servo

Mar 30th, 2017
189
0
Never
Not a member of Pastebin yet? Sign Up, it unlocks many cool features!
C++ 0.67 KB | None | 0 0
  1. #include <ATX2.h>
  2. byte x;
  3. void setup(){
  4.   XIO();
  5.   pinMode(2,INPUT_PULLUP);
  6. }
  7. void loop(){
  8.    while(uart1_ready()>0){          
  9.        x=uart1_read();
  10.    }
  11.     switch (x){
  12.       case 0x01: BK(60);break;
  13.       case 0x02: SR(60);break;
  14.       case 0x04: SL(60);break;
  15.       case 0x08: FD2(60,60);break;
  16.       case 0x81: BK(100);break;
  17.       case 0x82: SR(100);break;
  18.       case 0x84: SL(100);break;
  19.       case 0x88: FD2(100,100);break;
  20.       case 0x11: servo(2,110);break;
  21.       case 0x12: servo(1,34);break;
  22.       case 0x14: servo(1,110);break;
  23.       case 0x18: servo(2,20);break;
  24.  
  25.       default: AO();
  26.      }
  27. }
  28.  
  29. // keep 110
  30. // ar  34
  31. // yok 20
  32. // wang 110
Advertisement
Add Comment
Please, Sign In to add comment
Advertisement