Advertisement
Guest User

Untitled

a guest
Jan 17th, 2018
70
0
Never
Not a member of Pastebin yet? Sign Up, it unlocks many cool features!
text 0.79 KB | None | 0 0
  1. #pragma config(Sensor, dgtl1, rightEncoder, sensorQuadEncoder)
  2. #pragma config(Sensor, dgtl3, leftEncoder, sensorQuadEncoder)
  3. #pragma config(Motor, port2, rightMotor, tmotorNormal, openLoop, reversed)
  4. #pragma config(Motor, port3, leftMotor, tmotorNormal, openLoop)
  5.  
  6. //*!!Code automatically generated by ‘ROBOTC’ configuration wizard !!*//
  7. task main()
  8. {
  9. //set int
  10. int s1;
  11. int s2;
  12. s1 = 63;
  13. s2 = 63;
  14. //set sensors
  15. SensorValue[rightEncoder]= 0;
  16. SensorValue[leftEncoder]= 0;
  17. while(SensorValue[leftEncoder] < 1960)
  18. {
  19. if(SensorValue[leftEncoder] == SensorValue[rightEncoder])
  20. {
  21. motor[rightMotor] = s1;
  22. motor[leftMotor] = s2;
  23. }
  24. else(SensorValue[rightEncoder] > SensorValue[leftEncoder]);
  25. {
  26. s1 = s1-63;
  27. wait1Msec(5000);
  28. s1 = s1+63;
  29. }
  30. }
  31. }
Advertisement
Add Comment
Please, Sign In to add comment
Advertisement