Guest User

Untitled

a guest
Oct 22nd, 2018
141
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.                 resetGyro(S2);
  22.             }
  23.         }
  24.         //zorgt ervoor dat het object wordt omzeild
  25.         displayBigTextLine(3, "obstakel omzeilen");
  26.         setMotorSpeed(motorC, 20); // links
  27.         setMotorSpeed(motorB, 0);
  28.         sleep(1500);
  29.         setMotorSpeed(motorB, 20); //rechtdoor
  30.         setMotorSpeed(motorC, 20);
  31.         sleep(1500);
  32.         setMotorSpeed(motorC, 0); //rechts
  33.         setMotorSpeed(motorB, 20);
  34.         sleep(1500);
  35.         setMotorSpeed(motorB, 20); //rechtdoor
  36.         setMotorSpeed(motorC, 20);
  37.         sleep(1500);
  38.         setMotorSpeed(motorC, 0); //rechts
  39.         setMotorSpeed(motorB, 20);
  40.         sleep(1500);
  41.         setMotorSpeed(motorB, 20); //rechtdoor
  42.         setMotorSpeed(motorC, 20);
  43.         sleep(2000)
  44.  
  45.  
  46.  
  47.  
  48.     }
  49. }
RAW Paste Data