Advertisement
Guest User

Untitled

a guest
Mar 29th, 2017
54
0
Never
Not a member of Pastebin yet? Sign Up, it unlocks many cool features!
text 1.38 KB | None | 0 0
  1. void turnLeft() {
  2. reset();
  3. right_motor.SetPercent(TURNING_POWER);
  4. left_motor.SetPercent(-1 * TURNING_POWER);
  5. while (left_encoder.Counts() < 280 && right_encoder.Counts() < 280) {
  6. LCD.WriteRC(left_encoder.Counts(), 4, 5);
  7. LCD.WriteRC(right_encoder.Counts(), 5, 5);
  8. }
  9. reset();
  10. }
  11.  
  12. void turnLeft(float degrees) {
  13. reset();
  14. left_motor.SetPercent(-1 * TURNING_POWER);
  15. right_motor.SetPercent(TURNING_POWER);
  16. while (left_encoder.Counts() < (TURN_COUNT / 90) * degrees && right_encoder.Counts() < (TURN_COUNT / 90) * degrees) {
  17. LCD.WriteRC(left_encoder.Counts(), 4, 5);
  18. LCD.WriteRC(right_encoder.Counts(), 5, 5);
  19. }
  20. reset();
  21. }
  22.  
  23. void turnRight() {
  24. reset();
  25. left_motor.SetPercent(TURNING_POWER);
  26. right_motor.SetPercent(-1 * TURNING_POWER);
  27. while (left_encoder.Counts() < TURN_COUNT && right_encoder.Counts() < TURN_COUNT) {
  28. LCD.WriteRC(left_encoder.Counts(), 4, 5);
  29. LCD.WriteRC(right_encoder.Counts(), 5, 5);
  30. }
  31. reset();
  32. }
  33.  
  34. void turnRight(float degrees) {
  35. reset();
  36. left_motor.SetPercent(TURNING_POWER);
  37. right_motor.SetPercent(-1 * TURNING_POWER);
  38. while (left_encoder.Counts() < (TURN_COUNT / 90) * degrees && right_encoder.Counts() < (TURN_COUNT / 90) * degrees) {
  39. LCD.WriteRC(left_encoder.Counts(), 4, 5);
  40. LCD.WriteRC(right_encoder.Counts(), 5, 5);
  41. }
  42. reset();
  43. }
Advertisement
Add Comment
Please, Sign In to add comment
Advertisement