SHARE
TWEET

Untitled

a guest Oct 11th, 2018 109 Never
Not a member of Pastebin yet? Sign Up, it unlocks many cool features!
  1. // credits: Pim Arts. Voor het uitleggen van de loop structuur. En naar Remco bischops voor het helpen met de code.
  2. task main()
  3. {
  4.  
  5.     waitUntil(getTouchValue(S1) == 1);
  6.     int kleurwaarde = getColorAmbient(S3); //hier gebeurd de calibratie. Start op de lijn om te kleur te caliberen
  7.     playSoundFile("/home/root/lms2012/resources/Sounds/One");
  8.  
  9.     while(true)
  10.     {
  11.         while(getUSDistance(S4) > 15){
  12.             if(getColorAmbient(S3) <= kleurwaarde + 1)
  13.             {
  14.                 setMotorSpeed(motorB, 0);
  15.                 setMotorSpeed(motorC, 25);
  16.             }
  17.             if(getColorAmbient(S3) > kleurwaarde + 1)
  18.             {
  19.                 setMotorSpeed(motorB, 25);
  20.                 setMotorSpeed(motorC, 0);
  21.             }
  22.         }
  23.         //zorgt ervoor dat het object wordt omzeild
  24.         displayBigTextLine(3, "obstakel omzeilen");
  25.         resetGyro(S2);
  26.         repeatUntil(getGyroDegrees(S2) >= 90){  //links
  27.             setMotorSpeed(motorC, 0);
  28.             setMotorSpeed(motorB, 20);
  29.         }
  30.         setMotorSync(motorB, motorC, 800, 20); //rechtdoor
  31.         resetGyro(S2);
  32.         repeatUntil(getGyroDegrees(S2) >= 90){  //rechts
  33.             setMotorSpeed(motorC, 20);
  34.             setMotorSpeed(motorB, 0);
  35.         }
  36.         setMotorSync(motorB, motorC, 800,  20); // rechtdoor
  37.         resetGyro(S2);
  38.         repeatUntil(getGyroDegrees(S2) >= 90){ //rechts
  39.             setMotorSpeed(motorC, 20);
  40.             setMotorSpeed(motorB, 0);
  41.  
  42.             setMotorSync(motorB, motorC, 800,  20); //rechtdoor en weer kijken voor lijn
  43.             displayBigTextLine(3, "%d", getColorAmbient(S3));
  44.         }
  45.  
  46.     }
  47. }
RAW Paste Data
We use cookies for various purposes including analytics. By continuing to use Pastebin, you agree to our use of cookies as described in the Cookies Policy. OK, I Understand
Top