Advertisement
Not a member of Pastebin yet?
Sign Up,
it unlocks many cool features!
- #include <ATX2.h>
- byte x,s01=0,s02=0,s03=0;
- byte s1[5] = {10,40,107,158};
- byte s2[3] = {5,95};
- byte s3[6] = {0,25,50,148,180};
- void setup(){
- XIOinit();
- pinMode(2,INPUT_PULLUP);
- }
- void loop(){
- while(uart1_ready()>0){
- x=uart1_read();
- }
- switch (x){
- case 0x01: BK(60);break;
- case 0x02: SR(60);break;
- case 0x04: SL(60);break;
- case 0x08: FD2(60,60);break;
- case 0x81: BK(100);break;
- case 0x82: SR(100);break;
- case 0x84: SL(100);break;
- case 0x88: FD2(100,100);break;
- case 0x11: servo(1,0);servo(2,180);break;
- case 0x12: servo(1,166);servo(2,14);break;
- case 0x18: servo(1,60);servo(2,120);break;
- case 0x21:
- if(s01<3){s01++;}
- else{s01=0;}
- servo(1,s1[s01]);
- delay(250);break;
- case 0x22:
- if(s02==0){s02=1;}
- else{s02=0;}
- servo(2,s2[s02]);
- delay(250);break;
- case 0x24:
- if(s03<4){s03++;}
- else{s03=0;}
- servo(3,s3[s03]);
- delay(250);break;
- case 0x28:
- if(s01>0){s01--;}
- else{s01=3;}
- servo(1,s1[s01]);
- delay(250);break;
- default: AO();
- }
- }
Advertisement
Add Comment
Please, Sign In to add comment
Advertisement