#include <Servo.h>
Servo servo1;
Servo servo2;
const int trig = 9;
const int echo = 10;
const int trig2 = 5;
const int echo2 = 3;
const int servo1Pin = 4;
const int servo2Pin = 2;
void setup() {
Serial.begin(115200);
pinMode(trig, OUTPUT);
pinMode(echo, INPUT);
pinMode(trig2, OUTPUT);
pinMode(echo2, INPUT);
servo1.attach(servo1Pin);
servo2.attach(servo2Pin);
servo1.write(0);
servo2.write(0);
}
void loop (){
long duration, distance;
long duration2, distance2;
digitalWrite(trig, HIGH);
digitalWrite(trig2, HIGH);
delayMicroseconds(10);
digitalWrite(trig, LOW);
digitalWrite(trig2, HIGH);
duration = pulseIn(echo, HIGH);
duration2 = pulseIn(echo2, HIGH);
distance = duration * 0.034 / 2;
distance2 = duration2 * 0.034 / 2;
if (distance <= 10){
servo1.write(180);
servo2.write(180);
} else {
servo1.write(0);
servo2.write(0);
}
delay(500);
}