Advertisement
Guest User

project 1

a guest
Sep 30th, 2014
220
0
Never
Not a member of Pastebin yet? Sign Up, it unlocks many cool features!
text 0.83 KB | None | 0 0
  1. #define THRESHOLD 45
  2.  
  3. task main()
  4. {
  5. SetSensorTouch(IN_1);
  6. SetSensorTouch(IN_2);
  7. OnFwdReg(OUT_A,50,OUT_REGMODE_SPEED);
  8. OnFwdReg(OUT_B,70,OUT_REGMODE_SPEED);
  9. while (true)
  10. {
  11. if (SENSOR_1 == 1)
  12. {
  13. OnRevReg(OUT_B,50,OUT_REGMODE_SPEED);
  14. OnFwdReg(OUT_A,60,OUT_REGMODE_SPEED);
  15. until(SENSOR_1 != 1);
  16. OnFwdReg(OUT_A,50,OUT_REGMODE_SPEED);
  17. OnFwdReg(OUT_B,70,OUT_REGMODE_SPEED);
  18. }
  19. if (SENSOR_2 == 1)
  20. {
  21. OnRevReg(OUT_B,50,OUT_REGMODE_SPEED);
  22. OnFwdReg(OUT_A,60,OUT_REGMODE_SPEED);
  23. until (SENSOR_2 != 1);
  24. OnFwdReg(OUT_A,50,OUT_REGMODE_SPEED);
  25. OnFwdReg(OUT_B,70,OUT_REGMODE_SPEED);
  26. }
  27. }
  28. }
Advertisement
Add Comment
Please, Sign In to add comment
Advertisement