Advertisement
Guest User

Untitled

a guest
Mar 29th, 2017
53
0
Never
Not a member of Pastebin yet? Sign Up, it unlocks many cool features!
text 1.01 KB | None | 0 0
  1. void DriveLine()
  2. {
  3. left_motor.SetPercent(MOTOR_CORRECTION * 20);
  4. right_motor.SetPercent(20);
  5. float start = TimeNow();
  6. while (determineStateBlack() == CENTER && TimeNow() - start < 1) {
  7. LCD.WriteRC(left_encoder.Counts(), 4, 5);
  8. LCD.WriteRC(right_encoder.Counts(), 5, 5);
  9. }
  10. left_motor.Stop();
  11. right_motor.Stop();
  12. }
  13.  
  14. void turnLeftLine()
  15. {
  16. right_motor.SetPercent(0);
  17. left_motor.SetPercent(10);
  18. float start = TimeNow();
  19. while (determineStateBlack() == RIGHT && TimeNow() - start < 1) {
  20. LCD.WriteRC(left_encoder.Counts(), 4, 5);
  21. LCD.WriteRC(right_encoder.Counts(), 5, 5);
  22. }
  23. left_motor.Stop();
  24. right_motor.Stop();
  25. }
  26.  
  27. void turnRightLine()
  28. {
  29. left_motor.SetPercent(0);
  30. right_motor.SetPercent(10);
  31. float start = TimeNow();
  32. while (determineStateBlack() == LEFT && TimeNow() - start < 1) {
  33. LCD.WriteRC(left_encoder.Counts(), 4, 5);
  34. LCD.WriteRC(right_encoder.Counts(), 5, 5);
  35. }
  36. left_motor.Stop();
  37. right_motor.Stop();
  38. }
Advertisement
Add Comment
Please, Sign In to add comment
Advertisement