Advertisement
ConnorSiebens

LineFollowerRobotC

Nov 7th, 2017
84
0
Never
Not a member of Pastebin yet? Sign Up, it unlocks many cool features!
C 1.76 KB | None | 0 0
  1. #pragma config(Sensor, in1,    left,           sensorLineFollower)
  2. #pragma config(Sensor, in2,    middle,         sensorLineFollower)
  3. #pragma config(Sensor, in3,    right,          sensorLineFollower)
  4. #pragma config(Motor,  port1,           backleft,      tmotorServoContinuousRotation, openLoop, reversed)
  5. #pragma config(Motor,  port2,           backright,     tmotorServoContinuousRotation, openLoop)
  6. #pragma config(Motor,  port3,           frontleft,     tmotorServoContinuousRotation, openLoop, reversed)
  7. #pragma config(Motor,  port4,           frontright,    tmotorServoContinuousRotation, openLoop)
  8. task main(){
  9.     /*
  10.     @ConnorSiebens
  11.     */
  12. int speed=25,turnspeed=35,sensor=600,oppturn=-35;
  13.     while(true){
  14.         if (SensorValue[middle]>sensor){
  15.             motor[backleft] = speed;
  16.             motor[backright] = speed;
  17.             motor[frontleft] = speed;
  18.             motor[frontright] = speed;
  19.         }else{
  20.         if (SensorValue[left]<sensor&&SensorValue[middle]<sensor&&SensorValue[right]>sensor){
  21.             motor[backleft] = turnspeed;
  22.             motor[backright] = oppturn;
  23.             motor[frontleft] = turnspeed;
  24.             motor[frontright] = oppturn;
  25.         }
  26.         if (SensorValue[right]<sensor&&SensorValue[middle]<sensor&&SensorValue[left]>sensor){
  27.             motor[backright] = turnspeed;
  28.             motor[backleft] = oppturn;
  29.             motor[frontright] = turnspeed;
  30.             motor[frontleft] = oppturn;
  31.         }
  32.        
  33.         if (SensorValue[middle]<sensor&&SensorValue[right]<sensor&&SensorValue[left]<sensor){
  34.             motor[backleft] = 0;
  35.             motor[backright] = speed;
  36.             motor[frontleft] = 0;
  37.             motor[frontright] = speed;
  38.             wait1Msec(400);
  39.             while(SensorValue[middle]<sensor&&SensorValue[right]<sensor&&SensorValue[left]<sensor){
  40.                 motor[backleft] = -speed;
  41.                 motor[backright] = -speed;
  42.                 motor[frontleft] = -speed;
  43.                 motor[frontright] = -speed;
  44.                 }
  45.             }
  46.         }
  47.     }
  48. }
Advertisement
Add Comment
Please, Sign In to add comment
Advertisement