Sensor de distancia

1long readUltrasonicDistance(int triggerPin, int echoPin)
2{
3  pinMode(triggerPin,
4  OUTPUT);  // Clear the trigger
5  digitalWrite(triggerPin, LOW);
6  delayMicroseconds(2);
7
8  // Sets the trigger pin to HIGH state for 10 microseconds
9  digitalWrite(triggerPin,
10  HIGH);
11  delayMicroseconds(10);
12  digitalWrite(triggerPin, LOW);
13  pinMode(echoPin,
14  INPUT);
15  // Reads the echo pin, and returns the sound wave travel time in microseconds
16
17  return pulseIn(echoPin, HIGH);
18}
19
20void setup()
21{
22  pinMode(8, OUTPUT);
23
24  pinMode(5, OUTPUT);
25  pinMode(1, OUTPUT);
26}
27
28void loop()
29{
30
31  if (0.01723 * readUltrasonicDistance(0, 0) == 30) {
32    digitalWrite(8, HIGH);
33
34  } else {
35    if (0.01723 * readUltrasonicDistance(0, 0) == 20) {
36      digitalWrite(5,
37  HIGH);
38    } else {
39      if (0.01723 * readUltrasonicDistance(0, 0) == 10)
40  {
41        digitalWrite(1, HIGH);
42      }
43    }
44  }
45  delay(10); //
46  Delay a little bit to improve simulation performance
47}

1long readUltrasonicDistance(int triggerPin, int echoPin)
2{
3  pinMode(triggerPin,  OUTPUT);  // Clear the trigger
4  digitalWrite(triggerPin, LOW);
5  delayMicroseconds(2);
6  // Sets the trigger pin to HIGH state for 10 microseconds
7  digitalWrite(triggerPin,  HIGH);
8  delayMicroseconds(10);
9  digitalWrite(triggerPin, LOW);
10  pinMode(echoPin,  INPUT);
11  // Reads the echo pin, and returns the sound wave travel time in microseconds
12  return pulseIn(echoPin, HIGH);
13}
14
15void setup()
16{
17  pinMode(8, OUTPUT);
18  pinMode(5, OUTPUT);
19  pinMode(1, OUTPUT);
20}
21
22void loop()
23{
24  if (0.01723 * readUltrasonicDistance(0, 0) == 30) {
25    digitalWrite(8, HIGH);
26  } else {
27    if (0.01723 * readUltrasonicDistance(0, 0) == 20) {
28      digitalWrite(5,  HIGH);
29    } else {
30      if (0.01723 * readUltrasonicDistance(0, 0) == 10)  {
31        digitalWrite(1, HIGH);
32      }
33    }
34  }
35  delay(10); //  Delay a little bit to improve simulation performance
36}