Advertisement
KRITSADA

POP_XT for BlueStick

Jul 9th, 2015
340
0
Never
Not a member of Pastebin yet? Sign Up, it unlocks many cool features!
C++ 0.89 KB | None | 0 0
  1. #include <popxt.h>
  2. char key;
  3. void servo_open(){
  4.    servo(2,80);sleep(400);
  5.    servo(1,140);sleep(400);
  6.    servo(1,-1);servo(2,-1);
  7. }
  8. void servo_close(){
  9.   servo(1,0);sleep(1000);
  10.   servo(2,0);sleep(1000);
  11.   servo(1,-1);servo(2,-1);
  12. }
  13. void setup(){
  14.   glcdMode(1);                      
  15.   setTextSize(2);                    
  16.   glcd(1,1,"Press OK");              
  17.   sw_ok_press();                 
  18.   glcdClear();
  19. }
  20. void loop(){
  21.     key=uart1_getkey();
  22.     if(key==0x38){fd(50);}
  23.     else if (key==0x32){bk(50);}
  24.     else if (key==0x34){sl(50);}
  25.     else if (key==0x36){sr(50);}
  26.     else if (key==0x42){servo_open();}
  27.     else if (key==0x41){servo_close();}
  28.     else if (key==0x43){servo(1,0);sleep(200);}
  29.     else if (key==0x44){servo(1,140);sleep(200);}
  30.     else if (key==0x45){servo(2,0);sleep(200);}
  31.     else if (key==0x46){servo(2,80);sleep(200);}
  32.     else if (key==0x30){ao();}  
  33. }
Advertisement
Add Comment
Please, Sign In to add comment
Advertisement