Advertisement
Guest User

Untitled

a guest
May 28th, 2016
59
0
Never
Not a member of Pastebin yet? Sign Up, it unlocks many cool features!
text 0.90 KB | None | 0 0
  1. int trigPin1 = A0;
  2. int echoPin1 = A1;
  3. int distance1 = 0;
  4. int E1 = 10;
  5. int brake1 = 7;
  6.  
  7.  
  8. void setup() {
  9. pinMode(trigPin1, OUTPUT);
  10. pinMode(echoPin1, INPUT);
  11. pinMode(brake1, OUTPUT);
  12. pinMode (E1, OUTPUT);
  13. Serial.begin(9600);
  14. }
  15.  
  16. void loop() {
  17. analogWrite(E1, 153);
  18. distance1 = getDistance(trigPin1, echoPin1);
  19. printDistance(1, distance1);
  20. delay(250);
  21. if(distance1 <=15){
  22. digitalWrite(brake1, HIGH);
  23. }
  24. else{
  25. analogWrite(E1, 153);
  26. }
  27.  
  28. }
  29.  
  30.  
  31. int getDistance (int initPin, int echoPin) {
  32. digitalWrite(initPin, HIGH);
  33. delayMicroseconds(10);
  34. digitalWrite(initPin, LOW);
  35. long pulseTime = pulseIn(echoPin, HIGH);
  36. int distance = pulseTime / 58.2;
  37. return distance;
  38. }
  39.  
  40. void printDistance(int id, int dist) {
  41.  
  42. Serial.print(id);
  43. if (dist >= 120 || dist <= 0 ) {
  44. Serial.println(" Out of range");
  45. }
  46. else{
  47. Serial.print("t");
  48. Serial.print(dist);
  49. Serial.println(" cm");
  50. }
  51. }
Advertisement
Add Comment
Please, Sign In to add comment
Advertisement