#include <Servo.h>
Servo Servo1;
int trigger1=6;
int echo1=7;
int distance1;
long duration1;
int trigger2=8;
int echo2=9;
int distance2;
long duration2;
void setup()
{
pinMode(trigger1, OUTPUT);
pinMode(echo1, INPUT);
pinMode(trigger2, OUTPUT);
pinMode(echo2, INPUT);
Serial.begin(9600);
Servo1.attach(3);
Servo1.write(0);
}
void loop()
{
digitalWrite(trigger1, LOW);
delayMicroseconds(2);
digitalWrite(trigger1, HIGH);
delayMicroseconds(10);
digitalWrite(trigger1, LOW);
duration1 = pulseIn(echo1, HIGH);
distance1 = duration1 * 0.0343/ 2;
Serial.print("Distance1:");
Serial.print(distance1);
Serial.println("cm");
digitalWrite(trigger2, LOW);
delayMicroseconds(2);
digitalWrite(trigger2, HIGH);
delayMicroseconds(10);
digitalWrite(trigger2, LOW);
duration2 = pulseIn(echo2, HIGH);
distance2 = duration2 * 0.0349/ 2;
Serial.print("Distance2:");
Serial.print(distance2);
Serial.println("cm");
delay(1000);
Servo1.write(0);
if(distance1<=200||distance2<=200)
{
Servo1.write(180);
}
else if(distance1>200||distance2>200)
{
Servo1.write(0);
}
}