Advertisement
Not a member of Pastebin yet?
Sign Up,
it unlocks many cool features!
- #include <ATX2.h>
- byte x;
- void setup(){
- setTextSize(2);
- glcd(0,0,"You Press:");
- setTextSize(3);
- pinMode(2,INPUT_PULLUP); // Importance for Bluestick TxD pin
- servo(2,35);servo(1,30);delay(500); // Gripper Home
- }
- void Grab(){
- servo(2,160); delay(200); // Arm Down
- servo(1,150); delay(200); // Hand Grab
- servo(2,35); delay(200); // Arm Up
- }
- void unGrab(){
- servo(2,160); delay(200); // Arm Down
- servo(1,30); delay(200); // Hand unGrab
- servo(2,35); delay(200); // Arm Up
- }
- void loop(){
- if(uart1_available()){
- x=uart1_getkey();
- if(x==0x38){FD(80);}
- else if(x==0x32){BK(80);}
- else if(x==0x34){SL(80);}
- else if(x==0x36){SR(80);}
- else if(x==0x41){Grab();}
- else if(x==0x42){unGrab();}
- else {AO();}
- }
- }
Advertisement
Add Comment
Please, Sign In to add comment
Advertisement