Advertisement
Jim421616

car_if_else

Jul 15th, 2018
213
0
Never
Not a member of Pastebin yet? Sign Up, it unlocks many cool features!
text 0.93 KB | None | 0 0
  1. void loop()
  2. {
  3. getDistance();
  4. if (distance > 20)
  5. goForward();
  6. else
  7. goBackward();
  8. }
  9.  
  10. void goForward()
  11. {
  12. Serial.println("Going forward");
  13. analogWrite(enA, runSpeed*3/4);
  14. analogWrite(enB, runSpeed*3/4);
  15. digitalWrite(leftBack,LOW);
  16. digitalWrite(leftFwd,HIGH);
  17. digitalWrite(rightBack,LOW);
  18. digitalWrite(rightFwd,HIGH);
  19. }
  20.  
  21. void goBackward()
  22. {
  23. Serial.println("Going backward");
  24. analogWrite(enA, runSpeed*1/2);
  25. analogWrite(enB, runSpeed*1/2);
  26. digitalWrite(leftBack,HIGH);
  27. digitalWrite(leftFwd,LOW);
  28. digitalWrite(rightBack,HIGH);
  29. digitalWrite(rightFwd,LOW);
  30. }
  31.  
  32. int getDistance()
  33. {
  34. // Getting the distance from the sensor
  35. long duration, distance;
  36. digitalWrite(trig,HIGH);
  37. delayMicroseconds(1000);
  38. digitalWrite(trig, LOW);
  39. duration=pulseIn(echo, HIGH);
  40. distance =(duration/2)/29.1;
  41. Serial.print(distance);
  42. Serial.println(" cm");
  43. delay(10);
  44. return distance;
  45. }
Advertisement
Add Comment
Please, Sign In to add comment
Advertisement