Advertisement
Not a member of Pastebin yet?
Sign Up,
it unlocks many cool features!
- #include <popxt.h>
- char key;
- void servo_open(){
- servo(2,80);sleep(400);
- servo(1,140);sleep(400);
- servo(1,-1);servo(2,-1);
- }
- void servo_close(){
- servo(1,0);sleep(1000);
- servo(2,0);sleep(1000);
- servo(1,-1);servo(2,-1);
- }
- void setup(){
- glcdMode(1);
- setTextSize(2);
- glcd(1,1,"Press OK");
- sw_ok_press();
- glcdClear();
- }
- void loop(){
- key=uart1_getkey();
- if(key==0x38){fd(50);}
- else if (key==0x32){bk(50);}
- else if (key==0x34){sl(50);}
- else if (key==0x36){sr(50);}
- else if (key==0x42){servo_open();}
- else if (key==0x41){servo_close();}
- else if (key==0x43){servo(1,0);sleep(200);}
- else if (key==0x44){servo(1,140);sleep(200);}
- else if (key==0x45){servo(2,0);sleep(200);}
- else if (key==0x46){servo(2,80);sleep(200);}
- else if (key==0x30){ao();}
- }
Advertisement
Add Comment
Please, Sign In to add comment
Advertisement