#include <Servo.h>;

Servo Servo1;
Servo Servo2;
Servo Servo3;
Servo Servo4;

const int echo = 2;
const int trig = 3;

void setup() {
  // put your setup code here, to run once:

  Serial.begin (9600);
  pinMode(trig, OUTPUT);
  Servo1.attach(11);
  Servo2.attach(10);
  Servo3.attach(9);
  Servo4.attach(6);

}

void loop() {
  // put your main code here, to run repeatedly:
    digitalWrite(trig, LOW);
    delayMicroseconds(2);
    digitalWrite(trig, HIGH);
    delayMicroseconds(10);
    digitalWrite(trig, LOW);
    int distance = pulseIn(echo, HIGH)/58;
    String distanceString = String(distance) + " cm";
    Serial.println(distanceString);
    delay(100);

if (distance >= 300 && distance <= 400) {
  Servo1.write(180);
  delay(100);
  Servo1.write(-180);
}
else if (distance >= 200 && distance < 300) {
  Servo2.write(180);
  delay(100);
  Servo2.write(-180);
}
else if (distance >= 100 && distance < 200) {
  Servo3.write(180);
  delay(100);
  Servo3.write(-180);
}
else if (distance >= 0 && distance < 100) {
  Servo4.write(180);
  delay(100);
  Servo4.write(-180);
}
else {Serial.print("Too far ");}

}