Advertisement
KRITSADA

IPST-SE Multi Cross Line tracking

Aug 5th, 2016
222
0
Never
Not a member of Pastebin yet? Sign Up, it unlocks many cool features!
C++ 0.70 KB | None | 0 0
  1. #include <ipst.h>  
  2. int L,R,ref=400 ;
  3. void setup(){OK();}  
  4. void loop(){  LLL();RRR();RRR();LLL(); }
  5. void RRR(){
  6.  while(1){
  7.       L=analog(0); R=analog(1);
  8.        if(L>ref&&R>ref){fd(41);}
  9.        else if(L<ref&&R>ref){sl(35);}
  10.        else if(L>ref&&R<ref){sr(35);}
  11.        else if(L<ref&&R<ref){
  12.          fd(40);sound(16,500,100);
  13.          while(analog(1)>ref){sr(30);}
  14.          while(analog(1)<ref){sr(30);} break ;
  15.        }   }  }
  16. void LLL(){
  17.  while(1){
  18.       L=analog(0); R=analog(1);
  19.        if(L>ref&&R>ref){fd(41);}
  20.        else if(L<ref&&R>ref){sl(35);}
  21.        else if(L>ref&&R<ref){sr(35);}
  22.        else if(L<ref&&R<ref){
  23.          fd(40);sound(16,500,100);
  24.          while(analog(0)>ref){sl(30);}
  25.          while(analog(0)<ref){sl(30);} break ;
  26.        }
  27.    }
  28. }
Advertisement
Add Comment
Please, Sign In to add comment
Advertisement