const int trigPin = 26;
const int echoPin = 25;
const int led = 4;
const int buzzer = 5;
long duration;
int distance;
int safetyDistance;
void setup()
{
pinMode(buzzer, OUTPUT);
pinMode(led, OUTPUT);
pinMode(trigPin, OUTPUT);
pinMode(echoPin, INPUT);
Serial.begin(9600);
}
void loop()
{
dos();
}
void dos()
{
digitalWrite(trigPin, LOW);
delayMicroseconds(2);
digitalWrite(trigPin, HIGH);
delayMicroseconds(10);
digitalWrite(trigPin, LOW);
duration = pulseIn(echoPin, HIGH);
distance = duration * 0.034 / 2;
safetyDistance = distance;
if (safetyDistance <= 20)
{
digitalWrite(buzzer, HIGH);
digitalWrite(led, HIGH);
}
else
{
digitalWrite(buzzer, LOW);
digitalWrite(led, LOW);
}
Serial.print("Distance: ");
Serial.println(distance);
}