Advertisement
KRITSADA

BlueStick Control ATX2 Gripper

Feb 6th, 2016
181
0
Never
Not a member of Pastebin yet? Sign Up, it unlocks many cool features!
C++ 0.83 KB | None | 0 0
  1. #include <ATX2.h>
  2. byte x;
  3. void setup(){
  4.   setTextSize(2);
  5.   glcd(0,0,"You Press:");
  6.   setTextSize(3);
  7.   pinMode(2,INPUT_PULLUP);         // Importance for Bluestick TxD pin
  8.   servo(2,35);servo(1,30);delay(500);    // Gripper Home
  9. }
  10. void Grab(){
  11.   servo(2,160); delay(200);        // Arm Down
  12.   servo(1,150); delay(200);        // Hand Grab
  13.   servo(2,35);  delay(200);        // Arm Up
  14. }
  15. void unGrab(){
  16.   servo(2,160); delay(200);        // Arm Down
  17.   servo(1,30);  delay(200);        //  Hand unGrab
  18.   servo(2,35);  delay(200);        // Arm Up
  19. }
  20. void loop(){
  21.   if(uart1_available()){
  22.     x=uart1_getkey();
  23.     if(x==0x38){FD(80);}
  24.     else if(x==0x32){BK(80);}
  25.     else if(x==0x34){SL(80);}
  26.     else if(x==0x36){SR(80);}
  27.     else if(x==0x41){Grab();}
  28.     else if(x==0x42){unGrab();}
  29.     else {AO();}              
  30.  }
  31. }
Advertisement
Add Comment
Please, Sign In to add comment
Advertisement