KRITSADA

POP-X2 Simple Line Tracking Turn Lefr when Cross

Mar 30th, 2017
328
0
Never
Not a member of Pastebin yet? Sign Up, it unlocks many cool features!
C++ 0.95 KB | None | 0 0
  1. #include <popx2.h>  // POP-X2 Board
  2. word L,R,C=500,j=0;
  3. void setup() {  
  4.   OK();
  5.   setTextSize(3);
  6. }
  7. void loop() {
  8.   L=analog(0);R=analog(1);
  9.   if(L>C&&R>C){fd2(43,45);}
  10.   else if(L<C&&R>C){sl(50);}
  11.   else if(L>C&&R<C){sr(50);}
  12.   else if(L<C&&R<C){
  13.     fd2(43,45);sound(600,200);//delay(400);
  14.     while(analog(0)>C){sl(40);}
  15.     while(analog(0)<C){sl(40);}
  16.   }
  17.   if(analog(2)>250){
  18.     ao();
  19.       setTextColor(color[1]);glcd(1,1,"S");
  20.       setTextColor(color[2]);glcd(1,2,"T");
  21.       setTextColor(color[3]);glcd(1,3,"O");
  22.       setTextColor(color[5]);glcd(1,4,"P");
  23.       setTextColor(color[6]);glcd(1,5,"!");
  24.     while(analog(2)>250);  
  25.       setTextColor(color[1]);glcd(1,1,"R");
  26.       setTextColor(color[2]);glcd(1,2,"U");
  27.       setTextColor(color[3]);glcd(1,3,"N");
  28.       setTextColor(color[5]);glcd(1,4," ");
  29.       setTextColor(color[6]);glcd(1,5,"!");
  30.       j++;
  31.       setTextColor(color[7]);glcd(2,1,"%d ",j);
  32.       delay(500);
  33.   }
  34. }
Advertisement
Add Comment
Please, Sign In to add comment