char Trig[] = {5,19};
char Echo[] = {2,4};
#define Buzzer 14
#define GreenLED 27
#define RedLED 26
void setup() {
Serial.begin(115200);
for(int i = 0; i < 2; i++){
pinMode(Trig[i], OUTPUT);
pinMode(Echo[i], INPUT);
}
pinMode(GreenLED, OUTPUT);
pinMode(RedLED, OUTPUT);
pinMode(Buzzer, OUTPUT);
noTone(Buzzer);
}
void loop() {
UltraSonic();
}
void UltraSonic(){
for(int i =0; i < 2; i++){
long duration, distance;
digitalWrite(Trig[i], LOW);
delayMicroseconds(2);
digitalWrite(Trig[i], HIGH);
delayMicroseconds(10);
digitalWrite(Trig[i], LOW);
duration = pulseIn(Echo[i], HIGH);
distance =(duration / 2) / 29.1;
Serial.println("Distance " + String(i+1) + " : " + String(distance) + "cm");
if (distance > 0 && distance <= 50) {
Serial.println("Youe Dead");
delay(1000);
for (int j = 0; j < 5; j++) {
tone(Buzzer, 1000);
delay(200);
noTone(Buzzer);
delay(200);
}
digitalWrite(RedLED, HIGH);
digitalWrite(GreenLED, LOW);
} else if(distance <= 100){
Serial.println("Dead zone");
delay(1000);
for (int j = 0; j < 3; j++) {
tone(Buzzer, 500);
delay(400);
noTone(Buzzer);
delay(400);
}
digitalWrite(RedLED, HIGH);
digitalWrite(GreenLED, LOW);
} else {
Serial.println("Self zone");
delay(1000);
noTone(Buzzer);
digitalWrite(RedLED, LOW);
digitalWrite(GreenLED, HIGH);
}
}
}