Advertisement
Guest User

Mountain Dew

a guest
Jan 19th, 2017
80
0
Never
Not a member of Pastebin yet? Sign Up, it unlocks many cool features!
text 1.59 KB | None | 0 0
  1. #pragma config(Sensor, in1, , sensorPotentiometer)
  2. #pragma config(Sensor, in2, , sensorReflection)
  3. #pragma config(Sensor, in3, L, sensorLineFollower)
  4. #pragma config(Sensor, in4, C, sensorLineFollower)
  5. #pragma config(Sensor, in5, R, sensorLineFollower)
  6. #pragma config(Sensor, dgtl1, LeftLimitSwitch, sensorTouch)
  7. #pragma config(Sensor, dgtl2, RightLimitSwitch, sensorTouch)
  8. #pragma config(Sensor, dgtl3, UltrasonicRangeFinder, sensorSONAR_cm)
  9. #pragma config(Sensor, dgtl6, BumperSwitch, sensorTouch)
  10. #pragma config(Sensor, dgtl7, OpticalShaftEncoder, sensorQuadEncoder)
  11. #pragma config(Sensor, dgtl10, Red, sensorLEDtoVCC)
  12. #pragma config(Sensor, dgtl11, Yellow, sensorLEDtoVCC)
  13. #pragma config(Sensor, dgtl12, Green, sensorLEDtoVCC)
  14. #pragma config(Motor, port2, , tmotorVex393_MC29, openLoop, driveRight)
  15. #pragma config(Motor, port3, , tmotorVex393_MC29, openLoop, driveLeft)
  16. //*!!Code automatically generated by 'ROBOTC' configuration wizard !!*//
  17.  
  18. task main()
  19. {
  20. int speed = 0;
  21. speed = SensorValue(sensorPotentiometer)/32;
  22. while(SensorValue(BumperSwitch) ==0)
  23. {
  24. while(true)
  25. {
  26. if(SensorValue(UltrasonicRangeFinder) >25)
  27. {
  28. startMotor(port2,63);
  29. startMotor(port3,63);
  30. }
  31. else
  32. {
  33. motor[port2] = -speed;
  34. motor[port3] = speed;
  35. wait(1.5);
  36. if(SensorValue(UltrasonicRangeFinder) <25)
  37. { motor[port2] = speed;
  38. motor[port3] = -speed;
  39. wait(3.0);
  40. }
  41. }
  42. }
  43. }
  44. }
Advertisement
Add Comment
Please, Sign In to add comment
Advertisement