const int trigPin = 9;
const int echoPin = 10;
void setup() {
Serial.begin(9600);
pinMode(trigPin, OUTPUT);
pinMode(echoPin, INPUT);
pinMode(6, OUTPUT);
pinMode(7, OUTPUT);
}
void loop() {
long duration, distance;
digitalWrite(trigPin, LOW);
delayMicroseconds(2);
digitalWrite(trigPin, HIGH);
delayMicroseconds(10);
digitalWrite(trigPin, LOW);
duration = pulseIn(echoPin, HIGH);
distance = (duration / 2) * 0.0344;
if (distance<100){
Serial.print("Distancenear: ");
Serial.print(distance);
Serial.println(" cm");
digitalWrite(6, HIGH);
digitalWrite(7, LOW); }
else {Serial.print("Distancefar: ");
Serial.print(distance);
Serial.println(" cm");
digitalWrite(7, HIGH);
digitalWrite(6, LOW);
}
delay(1000); }