#include <Servo.h>
#include <Ultrasonic.h>
Servo servoM;
Ultrasonic ultrasonic1(4,5);
Ultrasonic ultrasonic2(6,7);
Ultrasonic ultrasonic3(8,9);
int angle =0;
void setup() {
// put your setup code here, to run once:
servoM.attach(3);
}
void loop() {
// put your main code here, to run repeatedly:
long distance1=ultrasonic1.read();
long distance2=ultrasonic2.read();
long distance3=ultrasonic3.read();
long d1=distance1;
long d2=distance2;
long d3=distance3;
if (d1==d2 and d2==d3){
servoM.write(90);
}else if (d1<d3 and d2<d3 ){
servoM.write(0);
}else if (d1<d2 and d3<d2){
servoM.write(180);
}else if (d1>d2 and d1>d3){
servoM.write(90);
}else if (d1==d2 and d3>d2 ){
servoM.write(90);
}else if (d3==d2 and d1<d2){
servoM.write(180);
}
delay(200);
}