#include <Servo.h>
Servo servoMain;
Servo servoSecondary;
int trigpin = 5;
int echopin = 4;
int distance;
float duration;
float cm;
void setup()
{
servoMain.attach(6);
servoSecondary.attach(7); // Attach the second servo to pin 7
pinMode(trigpin, OUTPUT);
pinMode(echopin, INPUT);
}
void loop()
{
digitalWrite(trigpin, LOW);
delay(2);
digitalWrite(trigpin, HIGH);
delayMicroseconds(10);
digitalWrite(trigpin, LOW);
duration = pulseIn(echopin, HIGH);
cm = (duration/58.82);
distance = cm;
if(distance<30)
{
servoMain.write(0); // Turn Servo back to center position (90 degrees)
servoSecondary.write(0);
delay(2000);
}
else{
servoMain.write(110);
servoSecondary.write(110);
delay(50);
}
}