#include <Servo.h>
//servo
Servo myServo1;
Servo myServo2;
Servo myServo3;
//ultrasonic
int trigPin = 5;
int echoPin = 4;
long duration,distance;


void setup() {
//servo
 myServo1.attach(9);
 myServo2.attach(10);
 myServo3.attach(11);
//ultrasonik
 pinMode(trigPin, OUTPUT);    // Sets the trigPin as an Output
 pinMode(echoPin, INPUT);    // Sets the echoPin as an Input
 Serial.begin(9600);

}

void loop() {
 digitalWrite(trigPin, LOW);
 delayMicroseconds(2);
 digitalWrite(trigPin, HIGH);
 delayMicroseconds(2);
 digitalWrite(trigPin, LOW);

 duration = pulseIn(echoPin, HIGH);
 distance = duration * 0.034 / 2;
 Serial.println(distance);

 if (distance < 10)
 { //Check distance is less than 10cm
   delay(1000); 

   //servo
   myServo1.write(0);
   delay(2000);
   myServo1.write(180);
   delay(1000);

   myServo2.write(0);
   delay(2000);
   myServo2.write(180);
   delay(1000);

   myServo3.write(0);
   delay(2000);
   myServo3.write(180);
   delay(1000);
 }
 else
 {
  myServo1.write(0);
  delay(500);
  myServo2.write(0);
  delay(500);
  myServo3.write(0);
  delay(500);
 }
}