EchoAlert: Smart Obstacle Detector

1const int trigPin = 8;
2const int echoPin = 9;
3const int ledPin = 7;
4const int ld=6;
5const int ldp=5;
6
7long duration;
8float distance;
9
10void setup() {
11  pinMode(trigPin, OUTPUT);
12  pinMode(echoPin, INPUT);
13  pinMode(ledPin, OUTPUT);
14  pinMode(ld, OUTPUT);
15  pinMode(ldp, OUTPUT);
16  Serial.begin(9600);
17}
18
19void loop() {
20
21  // Send ultrasonic pulse
22  digitalWrite(trigPin, LOW);
23  delayMicroseconds(2);
24
25  digitalWrite(trigPin, HIGH);
26  delayMicroseconds(10);
27
28  digitalWrite(trigPin, LOW);
29
30  // Measure echo time
31  duration = pulseIn(echoPin, HIGH);
32
33  // Calculate distance
34  distance = duration * 0.0343 / 2;
35
36  Serial.print("Distance: ");
37  Serial.print(distance);
38  Serial.println(" cm");
39
40  // Obstacle Detection
41  if (distance > 0 && distance <= 200) {
42    digitalWrite(ledPin, HIGH);
43    Serial.println("Obstacle Detected!");
44  } else {
45    digitalWrite(ledPin, LOW);
46    Serial.println("No Obstacle");
47  }
48  if (distance > 0 && distance <= 160) {
49    digitalWrite(ld, HIGH);
50    Serial.println("Obstacle Detected!");
51  } else {
52    digitalWrite(ld, LOW);
53    Serial.println("No Obstacle");
54  }
55  if (distance > 0 && distance <= 100) {
56    digitalWrite(ldp, HIGH);
57    Serial.println("Obstacle Detected!");
58  } else {
59    digitalWrite(ldp, LOW);
60    Serial.println("No Obstacle");
61  }
62
63  delay(200);
64}