Advertisement
Guest User

Untitled

a guest
Mar 29th, 2017
52
0
Never
Not a member of Pastebin yet? Sign Up, it unlocks many cool features!
text 0.84 KB | None | 0 0
  1. void DriveFindLineOrange(){
  2. reset();
  3. for (int i = 0; i < 4; i++){
  4. LCD.WriteRC("In Loop",7,1);
  5. float start = TimeNow();
  6. left_motor.SetPercent(15);
  7. right_motor.SetPercent(10);
  8. while (TimeNow() - start < 1){
  9. if (left.Value() < ORANGE_LEFT_THRESHOLD || right.Value() < ORANGE_RIGHT_THRESHOLD || middle.Value() < ORANGE_MIDDLE_THRESHOLD) {
  10. reset();
  11. return;
  12. }
  13. }
  14. reset();
  15. start = TimeNow();
  16. right_motor.SetPercent(15);
  17. left_motor.SetPercent(10);
  18. while (TimeNow() - start < 1){
  19. if (left.Value() < ORANGE_LEFT_THRESHOLD || right.Value() < ORANGE_RIGHT_THRESHOLD || middle.Value() < ORANGE_MIDDLE_THRESHOLD) {
  20. reset();
  21. return;
  22. }
  23. }
  24. reset();
  25. }
  26. }
Advertisement
Add Comment
Please, Sign In to add comment
Advertisement