Advertisement
Guest User

RobotC

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