Advertisement
Guest User

program test

a guest
Oct 22nd, 2018
85
0
Never
Not a member of Pastebin yet? Sign Up, it unlocks many cool features!
C 2.11 KB | None | 0 0
  1. #pragma config(Sensor, S1,     ochidreapta,    sensorEV3_Ultrasonic)
  2. #pragma config(Sensor, S2,     ochistanga,     sensorEV3_Ultrasonic)
  3. #pragma config(Sensor, S3,     culoaredreapta, sensorEV3_Color)
  4. #pragma config(Sensor, S4,     culoarestanga,  sensorEV3_Color)
  5. #pragma config(Motor,  motorA,          Atac,          tmotorNXT, openLoop, reversed, encoder)
  6. #pragma config(Motor,  motorB,          Stanga,        tmotorEV3_Large, PIDControl, reversed, driveLeft, encoder)
  7. #pragma config(Motor,  motorC,          Dreapta,       tmotorEV3_Large, PIDControl, reversed, driveRight, encoder)
  8. #pragma config(Motor,  motorD,           ,             tmotorEV3_Large, openLoop, encoder)
  9. //*!!Code automatically generated by 'ROBOTC' configuration wizard               !!*//
  10.  
  11. task main()
  12. {
  13. motor[motorC]=0;
  14. motor[motorB]=0;
  15.  
  16. wait1Msec(4300);
  17. motor[motorB]=100;
  18. motor[motorC]=100;
  19. wait1Msec(500);
  20. motor[motorA]=100;
  21.  
  22.  
  23.  
  24. while(true)
  25. {
  26.  
  27.  
  28. if(SensorValue(S1)<=35&&SensorValue(S2)>35)//dreapta vede, stanga nu
  29.             {
  30.                 motor[motorC]=0;  
  31.               motor[motorB]=100;
  32.             }
  33.      if(SensorValue(S1)>25&&SensorValue(S2)<=25)//Stanga vede,dreapta nu
  34.  
  35.     {  
  36.         motor[motorC]=100;
  37.       motor[motorB]=0;}
  38.  
  39.       if(SensorValue(S1)<=25&&SensorValue(S2)<=25)//ambii vad
  40.      {
  41.             motor[motorC]=100;
  42.           motor[motorB]=100;
  43.      }
  44.  
  45.       if(SensorValue(S1)>25&&SensorValue(S2)>25)
  46.         {
  47.             motor[motorC]=-40;
  48.           motor[motorB]=40;
  49.         }
  50.  
  51.        if(SensorValue(S3)<40)//dreapta vede
  52.           {
  53.             motor[motorB]=-35;
  54.             motor[motorC]=-5;
  55.             wait1Msec(400);
  56.             motor[motorB]=50;
  57.             motor[motorC]=-50;
  58.             }
  59.      if(SensorValue(S4)>=15)//stanga vede
  60.               {
  61.                     motor[motorB]=-5;
  62.                 motor[motorC]=-35;
  63.                 wait1Msec(400);
  64.                 motor[motorB]=-50;
  65.                 motor[motorC]=50;
  66.                 }
  67.  
  68.      if(SensorValue(S3)<15&&SensorValue(S4)<15)//ambii vad
  69.                     {
  70.                 motor[motorB]=-30;
  71.             motor[motorC]=-30;
  72.             wait1Msec(200);
  73.             motor[motorB]=-50;
  74.             motor[motorC]=50;
  75.          
  76.          }
  77.          
  78.         }
  79.     }
Advertisement
Add Comment
Please, Sign In to add comment
Advertisement