Advertisement
KRITSADA

Krabi Garnchana ATX2

Jun 28th, 2022
752
Never
Not a member of Pastebin yet? Sign Up, it unlocks many cool features!
  1. #include <ATX2.h>
  2. int L,R,RefL=510,RefR=505;
  3. void setup(){ OK();
  4. sHome();FD(50);delay(2000);FFF();FFF();CAN();
  5. LLL();RRR();RRR();FFF();LLL(); AO(); }
  6. void loop(){}
  7. void PUSH(){
  8.   while(1){
  9.     L=analog(5);             
  10.     R=analog(4);             
  11.     if(L<RefL&&R<RefR){
  12.         BK(50);delay(200);AO();drop();
  13.         AO();
  14.         break;
  15.     }
  16.     else if(L>RefL&&R>RefR){FD(40);}
  17.     else if(L<RefL&&R>RefR){SL(40);}
  18.     else if(L>RefL&&R<RefR){SR(40);}
  19.   }    
  20. }
  21. void CAN(){
  22.   while(1){
  23.     L=analog(5);             
  24.     R=analog(4);             
  25.     if(L<RefL&&R<RefR){
  26.         BK(50);delay(200);AO();keep();
  27.         SR(50);delay(900);
  28.         break;
  29.     }
  30.     else if(L>RefL&&R>RefR){FD(40);}
  31.     else if(L<RefL&&R>RefR){SL(40);}
  32.     else if(L>RefL&&R<RefR){SR(40);}
  33.   }
  34. }
  35. void sHome(){
  36.     servo(2,64); delay(300);
  37.     servo(1,33); delay(300);
  38. }
  39. void keep(){
  40.     servo(2,160); delay(300);
  41.     servo(1,156); delay(300);
  42.     servo(2,64); delay(300);
  43. }
  44. void drop(){
  45.     servo(2,160); delay(300);
  46.     servo(1,33); delay(300);
  47.     servo(2,64); delay(300);
  48. }
  49. void FFF(){
  50.   while(1){
  51.     L=analog(5);             
  52.     R=analog(4);             
  53.     if(L<RefL&&R<RefR){
  54.         FD(50);sound(500,150);
  55.         break;
  56.     }
  57.     else if(L>RefL&&R>RefR){FD(40);}
  58.     else if(L<RefL&&R>RefR){SL(40);}
  59.     else if(L>RefL&&R<RefR){SR(40);}
  60.   }
  61. }
  62. void RRR(){
  63.   while(1){
  64.     L=analog(5);             
  65.     R=analog(4);             
  66.     if(L<RefL&&R<RefR){
  67.         R90();
  68.         break;
  69.     }
  70.     else if(L>RefL&&R>RefR){FD(40);}
  71.     else if(L<RefL&&R>RefR){SL(40);}
  72.     else if(L>RefL&&R<RefR){SR(40);}
  73.   }
  74. }
  75. void LLL(){
  76.   while(1){
  77.     L=analog(5);             
  78.     R=analog(4);             
  79.     if(L<RefL&&R<RefR){
  80.         L90();
  81.         break;
  82.     }
  83.     else if(L>RefL&&R>RefR){FD(40);}
  84.     else if(L<RefL&&R>RefR){SL(40);}
  85.     else if(L>RefL&&R<RefR){SR(40);}
  86.   }
  87. }
  88. void R90(){
  89.   FD(40);sound(500,100);
  90.   while(analog(4)>RefR){SR(60);}
  91.   while(analog(4)<RefR){SR(60);}
  92. }
  93. void L90(){
  94.   FD(40);sound(500,100);
  95.   while(analog(5)>RefL){SL(60);}
  96.   while(analog(5)<RefL){SL(60);}
  97. }
  98.  
  99.  
  100.  
  101.  
  102.  
  103. https://1drv.ms/p/s!AjyV7tgYBxHbhtEEIPuvfJrPqulQLQ?e=AIb6CW
  104.  
  105.  
Advertisement
RAW Paste Data Copied
Advertisement